First Test for GotoTarget function

Started implementing a gotoTarget function for the car.