changed display to rviz
changed display to rviz
change to realtime
Merge hongbin