1 package org
.usfirst
.frc3501
.RiceCatRobot
.commands
;
3 import org
.usfirst
.frc3501
.RiceCatRobot
.subsystems
.Arm
;
5 import edu
.wpi
.first
.wpilibj
.command
.Command
;
7 public class MoveArmToLevel2
extends Command
{
9 double slowSpeed
= 0.2;
10 public MoveArmToLevel2() {
11 if(arm
.getArmSpeed() == 0.0) {
12 arm
.setArmSpeeds(slowSpeed
);
16 protected void initialize() {
17 arm
.initializeCounters();
20 protected void execute() {
23 protected boolean isFinished() {
24 return arm
.isSwitch2Hit();
27 protected void end() {
28 System
.out
.println("Robot arm has reached level 2");
31 protected void interrupted() {