Added a debug mode with timeouts while waiting for button
Add debug_mode parameter
Stupid error fixed
Experimenting on dynamic params
Experimenting on dynamic params
Do not switch on/aff AR markers tracker (always on a low rate). Publish real intensities on Ir laser scan. Many other small fixes