made changes to OSIM code.  Constraints are working properly, but error from numerical drift causes long-term constraint violation.