@@ -0,0 +1,474 @@
+package org.usfirst.frc620.Warbot2017.commands;%0D%0A%0D%0Aimport org.usfirst.frc620.Warbot2017.RobotMap;%0D%0A%0D%0Aimport edu.wpi.first.wpilibj.command.Command;%0D%0A%0D%0Apublic class ToggleServo extends Command %7B%0D%0A%09@Override%0D%0A%09protected void initialize() %7B%0D%0A%09%09if(RobotMap.ropeServo.get() %3E .5)%7B%0D%0A%09%09%09RobotMap.ropeServo.set(0);%0D%0A%09%09%7Delse%7B%0D%0A%09%09%09RobotMap.ropeServo.set(1);%0D%0A%09%09%09%0D%0A%09%09%7D%0D%0A%09%7D%0D%0A%0D%0A%09@Override%0D%0A%09protected boolean isFinished() %7B%0D%0A%09%09// TODO Auto-generated method stub%0D%0A%09%09return true;%0D%0A%09%7D%0D%0A%0D%0A%7D%0D%0A

add toggle servo