Big ol rewrite
More refactoring
Arm Control Debug
Torso debug
Head and Gaze Debug
Namespace Fixes
Launch files
Respawn rviz
Straighten out cart_marker
Merge branch 'interactive_markers_work' into catkinized