void setBelt(String position) {
if (position.toLowerCase() == "down") {
pickupPiston.SetB();
}
if (position.toLowerCase() == "up") {
pickupPiston.SetA();
}
}
/** Initializes the TowerControl class, setting the belt and hood position to known states. */
public void run() {
if (initDone == false) {
initDone = true;
pickupPiston.SetB();
shootPiston.SetA();
if (robot.isComp()) {
robot.InitializeCANTalon((CANTalon) belt);
launchMotor1 = new Talon(0);
launchMotor2 = new Talon(1);
Util.consoleLog("Launch Motors end");
} else if (robot.isClone()) {
launchMotor1 = new Talon(1);
launchMotor2 = new Talon(2);
}
shoot = new Shooter(robot);
pickup = new Pickup(robot);
}
}