Added nodes on robot_pose for 2D nav view