Rviz porting for CRAM