first fully working commit
still todo:
-find better timer args for speed
-calib everything again (calib values may should be stored on PC and not
on uC)
-control all lights
-push wiring diagram