added partial solution for robot navigation - gets wrong answer