challenge-bot.com Git - 3501/2015-FRC-Spark/blob - src/org/usfirst/frc3501/RiceCatRobot/commands/MoveArmToLevel1.java

   1 package org.usfirst.frc3501.RiceCatRobot.commands;
   2
   3 import org.usfirst.frc3501.RiceCatRobot.Robot;
   4
   5 import edu.wpi.first.wpilibj.command.Command;
   6
   7 public class MoveArmToLevel1 extends Command {
   8
   9         double slowSpeed = 0.2;
  10
  11         public MoveArmToLevel1() {
  12                 Robot.arm.setArmSpeeds(slowSpeed);
  13         }
  14
  15         protected void initialize() {
  16                 Robot.arm.initializeCounters();
  17         }
  18
  19         protected void execute() {
  20         }
  21
  22         protected boolean isFinished() {
  23                 return Robot.arm.isSwitch1Hit();
  24         }
  25
  26         protected void end() {
  27                 System.out.println("Robot arm has reached level 1");
  28         }
  29
  30         protected void interrupted() {
  31                 end();
  32         }
  33 }