changed the plumbing to put the extra state on the end of the state vector (instead of in the middle as a fake position)
lots of changes in here.  including a change to the inputs of manipulatorDynamics.  (but one that is easy to catch)