Navigating through maze, moving the robot correctly. Some navigation
issues still.