|
@@ -115,15 +115,9 @@ THREE.Euler.prototype = {
|
|
|
|
|
|
setFromRotationMatrix: function ( m, order ) {
|
|
|
|
|
|
- // assumes the upper 3x3 of m is a pure rotation matrix (i.e, unscaled)
|
|
|
-
|
|
|
- // clamp, to handle numerical problems
|
|
|
-
|
|
|
- function clamp( x ) {
|
|
|
+ var clamp = THREE.Math.clamp;
|
|
|
|
|
|
- return Math.min( Math.max( x, -1 ), 1 );
|
|
|
-
|
|
|
- }
|
|
|
+ // assumes the upper 3x3 of m is a pure rotation matrix (i.e, unscaled)
|
|
|
|
|
|
var te = m.elements;
|
|
|
var m11 = te[0], m12 = te[4], m13 = te[8];
|
|
@@ -134,7 +128,7 @@ THREE.Euler.prototype = {
|
|
|
|
|
|
if ( order === 'XYZ' ) {
|
|
|
|
|
|
- this._y = Math.asin( clamp( m13 ) );
|
|
|
+ this._y = Math.asin( clamp( m13, -1, 1 ) );
|
|
|
|
|
|
if ( Math.abs( m13 ) < 0.99999 ) {
|
|
|
|
|
@@ -150,7 +144,7 @@ THREE.Euler.prototype = {
|
|
|
|
|
|
} else if ( order === 'YXZ' ) {
|
|
|
|
|
|
- this._x = Math.asin( - clamp( m23 ) );
|
|
|
+ this._x = Math.asin( - clamp( m23, -1, 1 ) );
|
|
|
|
|
|
if ( Math.abs( m23 ) < 0.99999 ) {
|
|
|
|
|
@@ -166,7 +160,7 @@ THREE.Euler.prototype = {
|
|
|
|
|
|
} else if ( order === 'ZXY' ) {
|
|
|
|
|
|
- this._x = Math.asin( clamp( m32 ) );
|
|
|
+ this._x = Math.asin( clamp( m32, -1, 1 ) );
|
|
|
|
|
|
if ( Math.abs( m32 ) < 0.99999 ) {
|
|
|
|
|
@@ -182,7 +176,7 @@ THREE.Euler.prototype = {
|
|
|
|
|
|
} else if ( order === 'ZYX' ) {
|
|
|
|
|
|
- this._y = Math.asin( - clamp( m31 ) );
|
|
|
+ this._y = Math.asin( - clamp( m31, -1, 1 ) );
|
|
|
|
|
|
if ( Math.abs( m31 ) < 0.99999 ) {
|
|
|
|
|
@@ -198,7 +192,7 @@ THREE.Euler.prototype = {
|
|
|
|
|
|
} else if ( order === 'YZX' ) {
|
|
|
|
|
|
- this._z = Math.asin( clamp( m21 ) );
|
|
|
+ this._z = Math.asin( clamp( m21, -1, 1 ) );
|
|
|
|
|
|
if ( Math.abs( m21 ) < 0.99999 ) {
|
|
|
|
|
@@ -214,7 +208,7 @@ THREE.Euler.prototype = {
|
|
|
|
|
|
} else if ( order === 'XZY' ) {
|
|
|
|
|
|
- this._z = Math.asin( - clamp( m12 ) );
|
|
|
+ this._z = Math.asin( - clamp( m12, -1, 1 ) );
|
|
|
|
|
|
if ( Math.abs( m12 ) < 0.99999 ) {
|
|
|
|
|
@@ -244,15 +238,9 @@ THREE.Euler.prototype = {
|
|
|
|
|
|
setFromQuaternion: function ( q, order, update ) {
|
|
|
|
|
|
- // q is assumed to be normalized
|
|
|
-
|
|
|
- // clamp, to handle numerical problems
|
|
|
-
|
|
|
- function clamp( x ) {
|
|
|
+ var clamp = THREE.Math.clamp;
|
|
|
|
|
|
- return Math.min( Math.max( x, -1 ), 1 );
|
|
|
-
|
|
|
- }
|
|
|
+ // q is assumed to be normalized
|
|
|
|
|
|
// http://www.mathworks.com/matlabcentral/fileexchange/20696-function-to-convert-between-dcm-euler-angles-quaternions-and-euler-vectors/content/SpinCalc.m
|
|
|
|
|
@@ -266,38 +254,38 @@ THREE.Euler.prototype = {
|
|
|
if ( order === 'XYZ' ) {
|
|
|
|
|
|
this._x = Math.atan2( 2 * ( q.x * q.w - q.y * q.z ), ( sqw - sqx - sqy + sqz ) );
|
|
|
- this._y = Math.asin( clamp( 2 * ( q.x * q.z + q.y * q.w ) ) );
|
|
|
+ this._y = Math.asin( clamp( 2 * ( q.x * q.z + q.y * q.w ), -1, 1 ) );
|
|
|
this._z = Math.atan2( 2 * ( q.z * q.w - q.x * q.y ), ( sqw + sqx - sqy - sqz ) );
|
|
|
|
|
|
} else if ( order === 'YXZ' ) {
|
|
|
|
|
|
- this._x = Math.asin( clamp( 2 * ( q.x * q.w - q.y * q.z ) ) );
|
|
|
+ this._x = Math.asin( clamp( 2 * ( q.x * q.w - q.y * q.z ), -1, 1 ) );
|
|
|
this._y = Math.atan2( 2 * ( q.x * q.z + q.y * q.w ), ( sqw - sqx - sqy + sqz ) );
|
|
|
this._z = Math.atan2( 2 * ( q.x * q.y + q.z * q.w ), ( sqw - sqx + sqy - sqz ) );
|
|
|
|
|
|
} else if ( order === 'ZXY' ) {
|
|
|
|
|
|
- this._x = Math.asin( clamp( 2 * ( q.x * q.w + q.y * q.z ) ) );
|
|
|
+ this._x = Math.asin( clamp( 2 * ( q.x * q.w + q.y * q.z ), -1, 1 ) );
|
|
|
this._y = Math.atan2( 2 * ( q.y * q.w - q.z * q.x ), ( sqw - sqx - sqy + sqz ) );
|
|
|
this._z = Math.atan2( 2 * ( q.z * q.w - q.x * q.y ), ( sqw - sqx + sqy - sqz ) );
|
|
|
|
|
|
} else if ( order === 'ZYX' ) {
|
|
|
|
|
|
this._x = Math.atan2( 2 * ( q.x * q.w + q.z * q.y ), ( sqw - sqx - sqy + sqz ) );
|
|
|
- this._y = Math.asin( clamp( 2 * ( q.y * q.w - q.x * q.z ) ) );
|
|
|
+ this._y = Math.asin( clamp( 2 * ( q.y * q.w - q.x * q.z ), -1, 1 ) );
|
|
|
this._z = Math.atan2( 2 * ( q.x * q.y + q.z * q.w ), ( sqw + sqx - sqy - sqz ) );
|
|
|
|
|
|
} else if ( order === 'YZX' ) {
|
|
|
|
|
|
this._x = Math.atan2( 2 * ( q.x * q.w - q.z * q.y ), ( sqw - sqx + sqy - sqz ) );
|
|
|
this._y = Math.atan2( 2 * ( q.y * q.w - q.x * q.z ), ( sqw + sqx - sqy - sqz ) );
|
|
|
- this._z = Math.asin( clamp( 2 * ( q.x * q.y + q.z * q.w ) ) );
|
|
|
+ this._z = Math.asin( clamp( 2 * ( q.x * q.y + q.z * q.w ), -1, 1 ) );
|
|
|
|
|
|
} else if ( order === 'XZY' ) {
|
|
|
|
|
|
this._x = Math.atan2( 2 * ( q.x * q.w + q.y * q.z ), ( sqw - sqx + sqy - sqz ) );
|
|
|
this._y = Math.atan2( 2 * ( q.x * q.z + q.y * q.w ), ( sqw + sqx - sqy - sqz ) );
|
|
|
- this._z = Math.asin( clamp( 2 * ( q.z * q.w - q.x * q.y ) ) );
|
|
|
+ this._z = Math.asin( clamp( 2 * ( q.z * q.w - q.x * q.y ), -1, 1 ) );
|
|
|
|
|
|
} else {
|
|
|
|