|
|
|
@ -252,6 +252,356 @@ namespace glm |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template <typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> eulerAngleXZX |
|
|
|
|
( |
|
|
|
|
T const & t1, |
|
|
|
|
T const & t2, |
|
|
|
|
T const & t3 |
|
|
|
|
) |
|
|
|
|
{ |
|
|
|
|
T c1 = glm::cos(t1); |
|
|
|
|
T s1 = glm::sin(t1); |
|
|
|
|
T c2 = glm::cos(t2); |
|
|
|
|
T s2 = glm::sin(t2); |
|
|
|
|
T c3 = glm::cos(t3); |
|
|
|
|
T s3 = glm::sin(t3); |
|
|
|
|
|
|
|
|
|
mat<4, 4, T, defaultp> Result; |
|
|
|
|
Result[0][0] = c2; |
|
|
|
|
Result[0][1] = c1 * s2; |
|
|
|
|
Result[0][2] = s1 * s2; |
|
|
|
|
Result[0][3] = static_cast<T>(0); |
|
|
|
|
Result[1][0] =-c3 * s2; |
|
|
|
|
Result[1][1] = c1 * c2 * c3 - s1 * s3; |
|
|
|
|
Result[1][2] = c1 * s3 + c2 * c3 * s1; |
|
|
|
|
Result[1][3] = static_cast<T>(0); |
|
|
|
|
Result[2][0] = s2 * s3; |
|
|
|
|
Result[2][1] =-c3 * s1 - c1 * c2 * s3; |
|
|
|
|
Result[2][2] = c1 * c3 - c2 * s1 * s3; |
|
|
|
|
Result[2][3] = static_cast<T>(0); |
|
|
|
|
Result[3][0] = static_cast<T>(0); |
|
|
|
|
Result[3][1] = static_cast<T>(0); |
|
|
|
|
Result[3][2] = static_cast<T>(0); |
|
|
|
|
Result[3][3] = static_cast<T>(1); |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template <typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> eulerAngleXYX |
|
|
|
|
( |
|
|
|
|
T const & t1, |
|
|
|
|
T const & t2, |
|
|
|
|
T const & t3 |
|
|
|
|
) |
|
|
|
|
{ |
|
|
|
|
T c1 = glm::cos(t1); |
|
|
|
|
T s1 = glm::sin(t1); |
|
|
|
|
T c2 = glm::cos(t2); |
|
|
|
|
T s2 = glm::sin(t2); |
|
|
|
|
T c3 = glm::cos(t3); |
|
|
|
|
T s3 = glm::sin(t3); |
|
|
|
|
|
|
|
|
|
mat<4, 4, T, defaultp> Result; |
|
|
|
|
Result[0][0] = c2; |
|
|
|
|
Result[0][1] = s1 * s2; |
|
|
|
|
Result[0][2] =-c1 * s2; |
|
|
|
|
Result[0][3] = static_cast<T>(0); |
|
|
|
|
Result[1][0] = s2 * s3; |
|
|
|
|
Result[1][1] = c1 * c3 - c2 * s1 * s3; |
|
|
|
|
Result[1][2] = c3 * s1 + c1 * c2 * s3; |
|
|
|
|
Result[1][3] = static_cast<T>(0); |
|
|
|
|
Result[2][0] = c3 * s2; |
|
|
|
|
Result[2][1] =-c1 * s3 - c2 * c3 * s1; |
|
|
|
|
Result[2][2] = c1 * c2 * c3 - s1 * s3; |
|
|
|
|
Result[2][3] = static_cast<T>(0); |
|
|
|
|
Result[3][0] = static_cast<T>(0); |
|
|
|
|
Result[3][1] = static_cast<T>(0); |
|
|
|
|
Result[3][2] = static_cast<T>(0); |
|
|
|
|
Result[3][3] = static_cast<T>(1); |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template <typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> eulerAngleYXY |
|
|
|
|
( |
|
|
|
|
T const & t1, |
|
|
|
|
T const & t2, |
|
|
|
|
T const & t3 |
|
|
|
|
) |
|
|
|
|
{ |
|
|
|
|
T c1 = glm::cos(t1); |
|
|
|
|
T s1 = glm::sin(t1); |
|
|
|
|
T c2 = glm::cos(t2); |
|
|
|
|
T s2 = glm::sin(t2); |
|
|
|
|
T c3 = glm::cos(t3); |
|
|
|
|
T s3 = glm::sin(t3); |
|
|
|
|
|
|
|
|
|
mat<4, 4, T, defaultp> Result; |
|
|
|
|
Result[0][0] = c1 * c3 - c2 * s1 * s3; |
|
|
|
|
Result[0][1] = s2* s3; |
|
|
|
|
Result[0][2] =-c3 * s1 - c1 * c2 * s3; |
|
|
|
|
Result[0][3] = static_cast<T>(0); |
|
|
|
|
Result[1][0] = s1 * s2; |
|
|
|
|
Result[1][1] = c2; |
|
|
|
|
Result[1][2] = c1 * s2; |
|
|
|
|
Result[1][3] = static_cast<T>(0); |
|
|
|
|
Result[2][0] = c1 * s3 + c2 * c3 * s1; |
|
|
|
|
Result[2][1] =-c3 * s2; |
|
|
|
|
Result[2][2] = c1 * c2 * c3 - s1 * s3; |
|
|
|
|
Result[2][3] = static_cast<T>(0); |
|
|
|
|
Result[3][0] = static_cast<T>(0); |
|
|
|
|
Result[3][1] = static_cast<T>(0); |
|
|
|
|
Result[3][2] = static_cast<T>(0); |
|
|
|
|
Result[3][3] = static_cast<T>(1); |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template <typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> eulerAngleYZY |
|
|
|
|
( |
|
|
|
|
T const & t1, |
|
|
|
|
T const & t2, |
|
|
|
|
T const & t3 |
|
|
|
|
) |
|
|
|
|
{ |
|
|
|
|
T c1 = glm::cos(t1); |
|
|
|
|
T s1 = glm::sin(t1); |
|
|
|
|
T c2 = glm::cos(t2); |
|
|
|
|
T s2 = glm::sin(t2); |
|
|
|
|
T c3 = glm::cos(t3); |
|
|
|
|
T s3 = glm::sin(t3); |
|
|
|
|
|
|
|
|
|
mat<4, 4, T, defaultp> Result; |
|
|
|
|
Result[0][0] = c1 * c2 * c3 - s1 * s3; |
|
|
|
|
Result[0][1] = c3 * s2; |
|
|
|
|
Result[0][2] =-c1 * s3 - c2 * c3 * s1; |
|
|
|
|
Result[0][3] = static_cast<T>(0); |
|
|
|
|
Result[1][0] =-c1 * s2; |
|
|
|
|
Result[1][1] = c2; |
|
|
|
|
Result[1][2] = s1 * s2; |
|
|
|
|
Result[1][3] = static_cast<T>(0); |
|
|
|
|
Result[2][0] = c3 * s1 + c1 * c2 * s3; |
|
|
|
|
Result[2][1] = s2 * s3; |
|
|
|
|
Result[2][2] = c1 * c3 - c2 * s1 * s3; |
|
|
|
|
Result[2][3] = static_cast<T>(0); |
|
|
|
|
Result[3][0] = static_cast<T>(0); |
|
|
|
|
Result[3][1] = static_cast<T>(0); |
|
|
|
|
Result[3][2] = static_cast<T>(0); |
|
|
|
|
Result[3][3] = static_cast<T>(1); |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template <typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> eulerAngleZYZ |
|
|
|
|
( |
|
|
|
|
T const & t1, |
|
|
|
|
T const & t2, |
|
|
|
|
T const & t3 |
|
|
|
|
) |
|
|
|
|
{ |
|
|
|
|
T c1 = glm::cos(t1); |
|
|
|
|
T s1 = glm::sin(t1); |
|
|
|
|
T c2 = glm::cos(t2); |
|
|
|
|
T s2 = glm::sin(t2); |
|
|
|
|
T c3 = glm::cos(t3); |
|
|
|
|
T s3 = glm::sin(t3); |
|
|
|
|
|
|
|
|
|
mat<4, 4, T, defaultp> Result; |
|
|
|
|
Result[0][0] = c1 * c2 * c3 - s1 * s3; |
|
|
|
|
Result[0][1] = c1 * s3 + c2 * c3 * s1; |
|
|
|
|
Result[0][2] =-c3 * s2; |
|
|
|
|
Result[0][3] = static_cast<T>(0); |
|
|
|
|
Result[1][0] =-c3 * s1 - c1 * c2 * s3; |
|
|
|
|
Result[1][1] = c1 * c3 - c2 * s1 * s3; |
|
|
|
|
Result[1][2] = s2 * s3; |
|
|
|
|
Result[1][3] = static_cast<T>(0); |
|
|
|
|
Result[2][0] = c1 * s2; |
|
|
|
|
Result[2][1] = s1 * s2; |
|
|
|
|
Result[2][2] = c2; |
|
|
|
|
Result[2][3] = static_cast<T>(0); |
|
|
|
|
Result[3][0] = static_cast<T>(0); |
|
|
|
|
Result[3][1] = static_cast<T>(0); |
|
|
|
|
Result[3][2] = static_cast<T>(0); |
|
|
|
|
Result[3][3] = static_cast<T>(1); |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template <typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> eulerAngleZXZ |
|
|
|
|
( |
|
|
|
|
T const & t1, |
|
|
|
|
T const & t2, |
|
|
|
|
T const & t3 |
|
|
|
|
) |
|
|
|
|
{ |
|
|
|
|
T c1 = glm::cos(t1); |
|
|
|
|
T s1 = glm::sin(t1); |
|
|
|
|
T c2 = glm::cos(t2); |
|
|
|
|
T s2 = glm::sin(t2); |
|
|
|
|
T c3 = glm::cos(t3); |
|
|
|
|
T s3 = glm::sin(t3); |
|
|
|
|
|
|
|
|
|
mat<4, 4, T, defaultp> Result; |
|
|
|
|
Result[0][0] = c1 * c3 - c2 * s1 * s3; |
|
|
|
|
Result[0][1] = c3 * s1 + c1 * c2 * s3; |
|
|
|
|
Result[0][2] = s2 *s3; |
|
|
|
|
Result[0][3] = static_cast<T>(0); |
|
|
|
|
Result[1][0] =-c1 * s3 - c2 * c3 * s1; |
|
|
|
|
Result[1][1] = c1 * c2 * c3 - s1 * s3; |
|
|
|
|
Result[1][2] = c3 * s2; |
|
|
|
|
Result[1][3] = static_cast<T>(0); |
|
|
|
|
Result[2][0] = s1 * s2; |
|
|
|
|
Result[2][1] =-c1 * s2; |
|
|
|
|
Result[2][2] = c2; |
|
|
|
|
Result[2][3] = static_cast<T>(0); |
|
|
|
|
Result[3][0] = static_cast<T>(0); |
|
|
|
|
Result[3][1] = static_cast<T>(0); |
|
|
|
|
Result[3][2] = static_cast<T>(0); |
|
|
|
|
Result[3][3] = static_cast<T>(1); |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template <typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> eulerAngleXZY |
|
|
|
|
( |
|
|
|
|
T const & t1, |
|
|
|
|
T const & t2, |
|
|
|
|
T const & t3 |
|
|
|
|
) |
|
|
|
|
{ |
|
|
|
|
T c1 = glm::cos(t1); |
|
|
|
|
T s1 = glm::sin(t1); |
|
|
|
|
T c2 = glm::cos(t2); |
|
|
|
|
T s2 = glm::sin(t2); |
|
|
|
|
T c3 = glm::cos(t3); |
|
|
|
|
T s3 = glm::sin(t3); |
|
|
|
|
|
|
|
|
|
mat<4, 4, T, defaultp> Result; |
|
|
|
|
Result[0][0] = c2 * c3; |
|
|
|
|
Result[0][1] = s1 * s3 + c1 * c3 * s2; |
|
|
|
|
Result[0][2] = c3 * s1 * s2 - c1 * s3; |
|
|
|
|
Result[0][3] = static_cast<T>(0); |
|
|
|
|
Result[1][0] =-s2; |
|
|
|
|
Result[1][1] = c1 * c2; |
|
|
|
|
Result[1][2] = c2 * s1; |
|
|
|
|
Result[1][3] = static_cast<T>(0); |
|
|
|
|
Result[2][0] = c2 * s3; |
|
|
|
|
Result[2][1] = c1 * s2 * s3 - c3 * s1; |
|
|
|
|
Result[2][2] = c1 * c3 + s1 * s2 *s3; |
|
|
|
|
Result[2][3] = static_cast<T>(0); |
|
|
|
|
Result[3][0] = static_cast<T>(0); |
|
|
|
|
Result[3][1] = static_cast<T>(0); |
|
|
|
|
Result[3][2] = static_cast<T>(0); |
|
|
|
|
Result[3][3] = static_cast<T>(1); |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template <typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> eulerAngleYZX |
|
|
|
|
( |
|
|
|
|
T const & t1, |
|
|
|
|
T const & t2, |
|
|
|
|
T const & t3 |
|
|
|
|
) |
|
|
|
|
{ |
|
|
|
|
T c1 = glm::cos(t1); |
|
|
|
|
T s1 = glm::sin(t1); |
|
|
|
|
T c2 = glm::cos(t2); |
|
|
|
|
T s2 = glm::sin(t2); |
|
|
|
|
T c3 = glm::cos(t3); |
|
|
|
|
T s3 = glm::sin(t3); |
|
|
|
|
|
|
|
|
|
mat<4, 4, T, defaultp> Result; |
|
|
|
|
Result[0][0] = c1 * c2; |
|
|
|
|
Result[0][1] = s2; |
|
|
|
|
Result[0][2] =-c2 * s1; |
|
|
|
|
Result[0][3] = static_cast<T>(0); |
|
|
|
|
Result[1][0] = s1 * s3 - c1 * c3 * s2; |
|
|
|
|
Result[1][1] = c2 * c3; |
|
|
|
|
Result[1][2] = c1 * s3 + c3 * s1 * s2; |
|
|
|
|
Result[1][3] = static_cast<T>(0); |
|
|
|
|
Result[2][0] = c3 * s1 + c1 * s2 * s3; |
|
|
|
|
Result[2][1] =-c2 * s3; |
|
|
|
|
Result[2][2] = c1 * c3 - s1 * s2 * s3; |
|
|
|
|
Result[2][3] = static_cast<T>(0); |
|
|
|
|
Result[3][0] = static_cast<T>(0); |
|
|
|
|
Result[3][1] = static_cast<T>(0); |
|
|
|
|
Result[3][2] = static_cast<T>(0); |
|
|
|
|
Result[3][3] = static_cast<T>(1); |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template <typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> eulerAngleZYX |
|
|
|
|
( |
|
|
|
|
T const & t1, |
|
|
|
|
T const & t2, |
|
|
|
|
T const & t3 |
|
|
|
|
) |
|
|
|
|
{ |
|
|
|
|
T c1 = glm::cos(t1); |
|
|
|
|
T s1 = glm::sin(t1); |
|
|
|
|
T c2 = glm::cos(t2); |
|
|
|
|
T s2 = glm::sin(t2); |
|
|
|
|
T c3 = glm::cos(t3); |
|
|
|
|
T s3 = glm::sin(t3); |
|
|
|
|
|
|
|
|
|
mat<4, 4, T, defaultp> Result; |
|
|
|
|
Result[0][0] = c1 * c2; |
|
|
|
|
Result[0][1] = c2 * s1; |
|
|
|
|
Result[0][2] =-s2; |
|
|
|
|
Result[0][3] = static_cast<T>(0); |
|
|
|
|
Result[1][0] = c1 * s2 * s3 - c3 * s1; |
|
|
|
|
Result[1][1] = c1 * c3 + s1 * s2 * s3; |
|
|
|
|
Result[1][2] = c2 * s3; |
|
|
|
|
Result[1][3] = static_cast<T>(0); |
|
|
|
|
Result[2][0] = s1 * s3 + c1 * c3 * s2; |
|
|
|
|
Result[2][1] = c3 * s1 * s2 - c1 * s3; |
|
|
|
|
Result[2][2] = c2 * c3; |
|
|
|
|
Result[2][3] = static_cast<T>(0); |
|
|
|
|
Result[3][0] = static_cast<T>(0); |
|
|
|
|
Result[3][1] = static_cast<T>(0); |
|
|
|
|
Result[3][2] = static_cast<T>(0); |
|
|
|
|
Result[3][3] = static_cast<T>(1); |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template <typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> eulerAngleZXY |
|
|
|
|
( |
|
|
|
|
T const & t1, |
|
|
|
|
T const & t2, |
|
|
|
|
T const & t3 |
|
|
|
|
) |
|
|
|
|
{ |
|
|
|
|
T c1 = glm::cos(t1); |
|
|
|
|
T s1 = glm::sin(t1); |
|
|
|
|
T c2 = glm::cos(t2); |
|
|
|
|
T s2 = glm::sin(t2); |
|
|
|
|
T c3 = glm::cos(t3); |
|
|
|
|
T s3 = glm::sin(t3); |
|
|
|
|
|
|
|
|
|
mat<4, 4, T, defaultp> Result; |
|
|
|
|
Result[0][0] = c1 * c3 - s1 * s2 * s3; |
|
|
|
|
Result[0][1] = c3 * s1 + c1 * s2 * s3; |
|
|
|
|
Result[0][2] =-c2 * s3; |
|
|
|
|
Result[0][3] = static_cast<T>(0); |
|
|
|
|
Result[1][0] =-c2 * s1; |
|
|
|
|
Result[1][1] = c1 * c2; |
|
|
|
|
Result[1][2] = s2; |
|
|
|
|
Result[1][3] = static_cast<T>(0); |
|
|
|
|
Result[2][0] = c1 * s3 + c3 * s1 * s2; |
|
|
|
|
Result[2][1] = s1 * s3 - c1 * c3 * s2; |
|
|
|
|
Result[2][2] = c2 * c3; |
|
|
|
|
Result[2][3] = static_cast<T>(0); |
|
|
|
|
Result[3][0] = static_cast<T>(0); |
|
|
|
|
Result[3][1] = static_cast<T>(0); |
|
|
|
|
Result[3][2] = static_cast<T>(0); |
|
|
|
|
Result[3][3] = static_cast<T>(1); |
|
|
|
|
return Result; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
template<typename T> |
|
|
|
|
GLM_FUNC_QUALIFIER mat<4, 4, T, defaultp> yawPitchRoll |
|
|
|
|
( |
|
|
|
|