works with rviz and Gazebo