add command to robot.java to actually run the LimitSwitchTest

[3501/2015-FRC-Spark] / src / org / usfirst / frc3501 / RiceCatRobot / commands / MoveArmToLevel3.java

package org.usfirst.frc3501.RiceCatRobot.commands;

import org.usfirst.frc3501.RiceCatRobot.Robot;
import org.usfirst.frc3501.RiceCatRobot.subsystems.Arm;

import edu.wpi.first.wpilibj.command.Command;

public class MoveArmToLevel3 extends Command {

        double slowSpeed = 0.2;

        public MoveArmToLevel3() {
                if (Robot.arm.getArmSpeed() == 0.0) {
                        Robot.arm.setArmSpeeds(slowSpeed);
                }
        }

        protected void initialize() {
                Robot.arm.initializeCounters();
        }

        protected void execute() {
        }

        protected boolean isFinished() {
                return Robot.arm.isSwitch3Hit();
        }

        protected void end() {
                System.out.println("Robot arm has reached level 3");
                Robot.arm.stop();
        }

        protected void interrupted() {
                end();
        }
}