package frc.robot.commands;

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

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

    public IntakeIntermediate(MainMech mech)
    { 
        m_arm = mech.m_arm;
        m_chain = mech.m_chain;

        addRequirements(mech, m_arm, m_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);
    }    
}