Ændret tracking algoritme ! - Robot styring OK- Juhuuuu