works also in rviz now ...