Added constraintTest app. Changed ConstraintDynamics so that constraint does not need to know the skeleton IDs