directionToObstacle() færdig og integreret