void setup_actuators () { enable_servos(); center_servos(); } void center_servos () { servo(LEFT_SERVO, LEFT_SERVO_CENTER); servo(RIGHT_SERVO, RIGHT_SERVO_CENTER); sleep(0.1); } void shift_servos (int shift) { servo(LEFT_SERVO, LEFT_SERVO_CENTER + shift); servo(RIGHT_SERVO, RIGHT_SERVO_CENTER + shift); sleep(0.1); } void kill_after (float timeout) { sleep(timeout); kill_process(TIMEOUT_PID); TIMEOUT_FLAG = 1; }