Changed the multi-joint-controller to have the proper command type
Changed code for updating and commanding each joint
Cleaned up code and removed code for publishing joint state.  This should be done elsewhere.