robot.check_turn_safety = false;
pthread_create(&thid, NULL, timing_thread, NULL);
start_timer();
+ act_camera_on();
}
// We set initial position periodically in order for it to be updated
type=robot_cmd topic=robot_cmd deadline=1
type=robot_switches topic=robot_switches deadline=1
type=camera_result topic=camera_result
-type=camera_control topic=camera_control
+type=camera_control topic=camera_control pubdelay=1
type=fsm_state topic=fsm_main pubdelay=1
type=fsm_state topic=fsm_act pubdelay=1
type=fsm_state topic=fsm_motion pubdelay=1