Visualize the robot in Rviz:
roslaunch stretch_core stretch.launch
Visualize the simulated robot in Rviz:
TODO