Improve conformity with the original project
Fix a porting mistake
Fix quaternion multiplication order in Quaternion#multiply(Quaternion, Vector3)

Fixes most joint problem (excluding arthritis)