Added a very primitive watchdog. Stops when no ack from controller within the last 300ms, disconnects and starts listening when no ack within the last 2 sec.