Fix matrix decompose (wxyz quaternion)

This commit is contained in:
Stéphane GINIER 2021-06-01 16:15:11 +02:00
parent 66062497b1
commit f32eea1345

View File

@ -172,12 +172,18 @@ namespace detail
j = Next[i]; j = Next[i];
k = Next[j]; k = Next[j];
# ifdef GLM_FORCE_QUAT_DATA_XYZW
int off = 0;
# else
int off = 1;
# endif
root = sqrt(Row[i][i] - Row[j][j] - Row[k][k] + static_cast<T>(1.0)); root = sqrt(Row[i][i] - Row[j][j] - Row[k][k] + static_cast<T>(1.0));
Orientation[i] = static_cast<T>(0.5) * root; Orientation[i + off] = static_cast<T>(0.5) * root;
root = static_cast<T>(0.5) / root; root = static_cast<T>(0.5) / root;
Orientation[j] = root * (Row[i][j] + Row[j][i]); Orientation[j + off] = root * (Row[i][j] + Row[j][i]);
Orientation[k] = root * (Row[i][k] + Row[k][i]); Orientation[k + off] = root * (Row[i][k] + Row[k][i]);
Orientation.w = root * (Row[j][k] - Row[k][j]); Orientation.w = root * (Row[j][k] - Row[k][j]);
} // End if <= 0 } // End if <= 0