added rviz support