now visualized in rviz