예제 #1
0
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;
    }
}
예제 #2
0
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;
}