Switched to using hubo_robot_msgs Trajectories instead of vanilla trajectory_msgs.