Robot turns in the corect direction now