ros1_visualization complied ~/ros1_visualization$ catkin build run source devel/setup.bash roslaunch viz_ros1 rviz_test.launch draw robot history trajectory
