added dABA code, but it needs to be fixed-up; fixed a bug where qmap mapped a
1-dof joint connected to the frame 0 to joint 1 regardless of its actual joint
number.  also protected the global variable q to avoid accidental writes to it.
improved constraints interface, going to now modify Josim.