added pid(working), added ultrasonic(some errors)
changed ultrasonic(still some errors)
added strategy, little chrüsimüsi corrections hie und da...