updated jointStiffnessCalibration: now it first finds the floating states and then the stiffnesses.
now using quaternion parameterization inside motionCaptureJointCalibration. Floating states found are more often correct, but there's still issues with [3.14; x; 3.14] rpy's
updated documentation, fewer poses in stiffness test so that it runs faster