summaryrefslogtreecommitdiff
path: root/src/main/java/frc/robot/commands/IntakeIntermediate.java
blob: e8ea7eebb8b855dc95a73f58c4f0f3bbcc2da102 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
package frc.robot.commands;

import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Arm;
import frc.robot.subsystems.Chain;

public class IntakeIntermediate extends Command 
{
    public Arm m_arm;
    public Chain m_chain;

    public IntakeIntermediate(Arm arm, Chain chain)
    { 
        m_arm = arm;
        m_chain = chain;

        addRequirements(arm, chain);
    }

    @Override
    public void execute()
    {
        m_arm.atAngleDegrees(-10);
        m_chain.atPercentage(1);
    }

    @Override
    public boolean isFinished()
    {
        return m_arm.isAtAngleDegree(-10) && m_chain.isAtPosition(1);
    }    
}