task deadman_ltd() { if (!deadman_ltu_running) { deadman_ltd_running = true; shoulder_enter_state(SHOULDER_DOWN); while ((joy1Btn(Btn7)) && (deadman_ltu_running == false)) { } shoulder_enter_state(SHOULDER_STOP); deadman_ltd_running = false; } }
void initializeRobot() { nMotorEncoder[shoulder] = 0; shoulder_enter_state(SHOULDER_STOP); brush_enter_state(BRUSH_OFF); arm_enter_state(ARM_RETRACTED); dock_enter_state(DOCK_FINGER_UP); center_dispenser_enter_state(CENTER_DISPENSER_STOWED); deadman_ltu_running = false; deadman_ltd_running = false; servo[dockarm] = SERVO_DOCK_ARM_STOPPED; all_stop(); return; }