seems to work in rviz