- add mutex around mutex send instruction - add minimum delay between sent messages - detect situation where both motors are off and send special both motor stop command. This might fix issue "right motor stay always on"