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);
    }    
}