nav_msgs added