adding watchdog to architecture to avoid uncontrolled behavior. Watchdog occurs every 500ms and desactivate servos