more on small angle approximation 6dof joint