Markers indicating motor commands now show up in RVIZ