dynamics and kinematics fixed. The constraint jacobian was not being updated at every iteration in newmarks.Minor bugs fixed.
TODO: finish implementing relx,rely and reldist constraints jacobian calculations