Alternative implementation of multi-group trajectories and update motoman error handling#488

Draft

nardavin wants to merge 4 commits intoros-industrial:kinetic-develfrom MisoRobotics:user/nardavin/feature/multi-group-trajectories

+373-433