ändrat så vi inte får dummyvärden från sensorerna och gjort så vi endast reglerar på den ena sidan
uppdaterat kp, kd och hastighet i forward
Merge branch 'master' of http://github.com/mymlan/Lassie