Fix weld joint constraint

* Fix weld joint constraint bug when two bodies are constrained
* Not allow arbitrary relative transformation between the bodies to prevent instability of dynamics