object ontwijk functie

Obstakel ontwijk functie voor het navigatie programma. Er is rekening
gehouden met de defines motorLeft en motorRight.