add two more commands id, just for completeness
measure time even when not in debug mode
removed unecessary delays, make roomba access syncrhonized and worked more on the state machine
added LEDS command (+MOTORS that we will never use)
new method to control the roomba leds