Første sensor ting

Lavet det første til sensor.c og fikset en lille ting i motor.c