[ ] Add ros_control to provide a MoveIt! compatible interface
[ ] Start with plain joint position trajectories that can (will) be coming from MoveIt.
[ ] Also, need to have a MoveIt package for the dVRK: how many PSM go in there and how to deal with setup joints? These could be use as virtual joints but unsure if these can be adjusted or MoveIt assume they are static.