rewrote RevoluteConstraint on new Equation form