Add leds/motors driver and manager + tests