Inital Commit

Threads ready.
motors: moving.
Kill-Switch: Killing.
Ultrasound: ultra-ing.
no light sensor.