Fixed ROS nav configuration. The sim robot can now navigate to nearby poses, avoiding obstacles along the way.