Add test code for multidof joints ;; omniwheel-joint, sphere-joint, and 6dof-joint

Add test code for multidof joints ;; omniwheel-joint, sphere-joint, and 6dof-joint.
These test code are moved from euslib/demo/ik/ik-test.l.