Bugfix: Motion constraints in sixDOFqODE. Author: Vuko Vukcevic. Merge: Hrvoje...