Add new test trajectory
Merge branch 'master' of ssh://github.com/WPI-ARC/hubo_ros_control