Added graphics from rviz