matrix_transform.inl 7.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207
  1. namespace glm
  2. {
  3. template<typename genType>
  4. GLM_FUNC_QUALIFIER GLM_CONSTEXPR genType identity()
  5. {
  6. return detail::init_gentype<genType, detail::genTypeTrait<genType>::GENTYPE>::identity();
  7. }
  8. template<typename T, qualifier Q>
  9. GLM_FUNC_QUALIFIER GLM_CONSTEXPR mat<4, 4, T, Q> translate(mat<4, 4, T, Q> const& m, vec<3, T, Q> const& v)
  10. {
  11. mat<4, 4, T, Q> Result(m);
  12. Result[3] = m[0] * v[0] + m[1] * v[1] + m[2] * v[2] + m[3];
  13. return Result;
  14. }
  15. template<typename T, qualifier Q>
  16. GLM_FUNC_QUALIFIER mat<4, 4, T, Q> rotate(mat<4, 4, T, Q> const& m, T angle, vec<3, T, Q> const& v)
  17. {
  18. T const a = angle;
  19. T const c = cos(a);
  20. T const s = sin(a);
  21. vec<3, T, Q> axis(normalize(v));
  22. vec<3, T, Q> temp((T(1) - c) * axis);
  23. mat<4, 4, T, Q> Rotate;
  24. Rotate[0][0] = c + temp[0] * axis[0];
  25. Rotate[0][1] = temp[0] * axis[1] + s * axis[2];
  26. Rotate[0][2] = temp[0] * axis[2] - s * axis[1];
  27. Rotate[1][0] = temp[1] * axis[0] - s * axis[2];
  28. Rotate[1][1] = c + temp[1] * axis[1];
  29. Rotate[1][2] = temp[1] * axis[2] + s * axis[0];
  30. Rotate[2][0] = temp[2] * axis[0] + s * axis[1];
  31. Rotate[2][1] = temp[2] * axis[1] - s * axis[0];
  32. Rotate[2][2] = c + temp[2] * axis[2];
  33. mat<4, 4, T, Q> Result;
  34. Result[0] = m[0] * Rotate[0][0] + m[1] * Rotate[0][1] + m[2] * Rotate[0][2];
  35. Result[1] = m[0] * Rotate[1][0] + m[1] * Rotate[1][1] + m[2] * Rotate[1][2];
  36. Result[2] = m[0] * Rotate[2][0] + m[1] * Rotate[2][1] + m[2] * Rotate[2][2];
  37. Result[3] = m[3];
  38. return Result;
  39. }
  40. template<typename T, qualifier Q>
  41. GLM_FUNC_QUALIFIER mat<4, 4, T, Q> rotate_slow(mat<4, 4, T, Q> const& m, T angle, vec<3, T, Q> const& v)
  42. {
  43. T const a = angle;
  44. T const c = cos(a);
  45. T const s = sin(a);
  46. mat<4, 4, T, Q> Result;
  47. vec<3, T, Q> axis = normalize(v);
  48. Result[0][0] = c + (static_cast<T>(1) - c) * axis.x * axis.x;
  49. Result[0][1] = (static_cast<T>(1) - c) * axis.x * axis.y + s * axis.z;
  50. Result[0][2] = (static_cast<T>(1) - c) * axis.x * axis.z - s * axis.y;
  51. Result[0][3] = static_cast<T>(0);
  52. Result[1][0] = (static_cast<T>(1) - c) * axis.y * axis.x - s * axis.z;
  53. Result[1][1] = c + (static_cast<T>(1) - c) * axis.y * axis.y;
  54. Result[1][2] = (static_cast<T>(1) - c) * axis.y * axis.z + s * axis.x;
  55. Result[1][3] = static_cast<T>(0);
  56. Result[2][0] = (static_cast<T>(1) - c) * axis.z * axis.x + s * axis.y;
  57. Result[2][1] = (static_cast<T>(1) - c) * axis.z * axis.y - s * axis.x;
  58. Result[2][2] = c + (static_cast<T>(1) - c) * axis.z * axis.z;
  59. Result[2][3] = static_cast<T>(0);
  60. Result[3] = vec<4, T, Q>(0, 0, 0, 1);
  61. return m * Result;
  62. }
  63. template<typename T, qualifier Q>
  64. GLM_FUNC_QUALIFIER mat<4, 4, T, Q> scale(mat<4, 4, T, Q> const& m, vec<3, T, Q> const& v)
  65. {
  66. mat<4, 4, T, Q> Result;
  67. Result[0] = m[0] * v[0];
  68. Result[1] = m[1] * v[1];
  69. Result[2] = m[2] * v[2];
  70. Result[3] = m[3];
  71. return Result;
  72. }
  73. template<typename T, qualifier Q>
  74. GLM_FUNC_QUALIFIER mat<4, 4, T, Q> scale_slow(mat<4, 4, T, Q> const& m, vec<3, T, Q> const& v)
  75. {
  76. mat<4, 4, T, Q> Result(T(1));
  77. Result[0][0] = v.x;
  78. Result[1][1] = v.y;
  79. Result[2][2] = v.z;
  80. return m * Result;
  81. }
  82. template <typename T, qualifier Q>
  83. GLM_FUNC_QUALIFIER mat<4, 4, T, Q> shear(mat<4, 4, T, Q> const &m, vec<3, T, Q> const& p, vec<2, T, Q> const &l_x, vec<2, T, Q> const &l_y, vec<2, T, Q> const &l_z)
  84. {
  85. T const lambda_xy = l_x[0];
  86. T const lambda_xz = l_x[1];
  87. T const lambda_yx = l_y[0];
  88. T const lambda_yz = l_y[1];
  89. T const lambda_zx = l_z[0];
  90. T const lambda_zy = l_z[1];
  91. vec<3, T, Q> point_lambda = vec<3, T, Q>(
  92. (lambda_xy + lambda_xz), (lambda_yx + lambda_yz), (lambda_zx + lambda_zy)
  93. );
  94. mat<4, 4, T, Q> Shear = mat<4, 4, T, Q>(
  95. 1 , lambda_yx , lambda_zx , 0,
  96. lambda_xy , 1 , lambda_zy , 0,
  97. lambda_xz , lambda_yz , 1 , 0,
  98. -point_lambda[0] * p[0], -point_lambda[1] * p[1], -point_lambda[2] * p[2], 1
  99. );
  100. mat<4, 4, T, Q> Result;
  101. Result[0] = m[0] * Shear[0][0] + m[1] * Shear[0][1] + m[2] * Shear[0][2] + m[3] * Shear[0][3];
  102. Result[1] = m[0] * Shear[1][0] + m[1] * Shear[1][1] + m[2] * Shear[1][2] + m[3] * Shear[1][3];
  103. Result[2] = m[0] * Shear[2][0] + m[1] * Shear[2][1] + m[2] * Shear[2][2] + m[3] * Shear[2][3];
  104. Result[3] = m[0] * Shear[3][0] + m[1] * Shear[3][1] + m[2] * Shear[3][2] + m[3] * Shear[3][3];
  105. return Result;
  106. }
  107. template <typename T, qualifier Q>
  108. GLM_FUNC_QUALIFIER mat<4, 4, T, Q> shear_slow(mat<4, 4, T, Q> const &m, vec<3, T, Q> const& p, vec<2, T, Q> const &l_x, vec<2, T, Q> const &l_y, vec<2, T, Q> const &l_z)
  109. {
  110. T const lambda_xy = static_cast<T>(l_x[0]);
  111. T const lambda_xz = static_cast<T>(l_x[1]);
  112. T const lambda_yx = static_cast<T>(l_y[0]);
  113. T const lambda_yz = static_cast<T>(l_y[1]);
  114. T const lambda_zx = static_cast<T>(l_z[0]);
  115. T const lambda_zy = static_cast<T>(l_z[1]);
  116. vec<3, T, Q> point_lambda = vec<3, T, Q>(
  117. static_cast<T>(lambda_xy + lambda_xz),
  118. static_cast<T>(lambda_yx + lambda_yz),
  119. static_cast<T>(lambda_zx + lambda_zy)
  120. );
  121. mat<4, 4, T, Q> Shear = mat<4, 4, T, Q>(
  122. 1 , lambda_yx , lambda_zx , 0,
  123. lambda_xy , 1 , lambda_zy , 0,
  124. lambda_xz , lambda_yz , 1 , 0,
  125. -point_lambda[0] * p[0], -point_lambda[1] * p[1], -point_lambda[2] * p[2], 1
  126. );
  127. return m * Shear;
  128. }
  129. template<typename T, qualifier Q>
  130. GLM_FUNC_QUALIFIER mat<4, 4, T, Q> lookAtRH(vec<3, T, Q> const& eye, vec<3, T, Q> const& center, vec<3, T, Q> const& up)
  131. {
  132. vec<3, T, Q> const f(normalize(center - eye));
  133. vec<3, T, Q> const s(normalize(cross(f, up)));
  134. vec<3, T, Q> const u(cross(s, f));
  135. mat<4, 4, T, Q> Result(1);
  136. Result[0][0] = s.x;
  137. Result[1][0] = s.y;
  138. Result[2][0] = s.z;
  139. Result[0][1] = u.x;
  140. Result[1][1] = u.y;
  141. Result[2][1] = u.z;
  142. Result[0][2] =-f.x;
  143. Result[1][2] =-f.y;
  144. Result[2][2] =-f.z;
  145. Result[3][0] =-dot(s, eye);
  146. Result[3][1] =-dot(u, eye);
  147. Result[3][2] = dot(f, eye);
  148. return Result;
  149. }
  150. template<typename T, qualifier Q>
  151. GLM_FUNC_QUALIFIER mat<4, 4, T, Q> lookAtLH(vec<3, T, Q> const& eye, vec<3, T, Q> const& center, vec<3, T, Q> const& up)
  152. {
  153. vec<3, T, Q> const f(normalize(center - eye));
  154. vec<3, T, Q> const s(normalize(cross(up, f)));
  155. vec<3, T, Q> const u(cross(f, s));
  156. mat<4, 4, T, Q> Result(1);
  157. Result[0][0] = s.x;
  158. Result[1][0] = s.y;
  159. Result[2][0] = s.z;
  160. Result[0][1] = u.x;
  161. Result[1][1] = u.y;
  162. Result[2][1] = u.z;
  163. Result[0][2] = f.x;
  164. Result[1][2] = f.y;
  165. Result[2][2] = f.z;
  166. Result[3][0] = -dot(s, eye);
  167. Result[3][1] = -dot(u, eye);
  168. Result[3][2] = -dot(f, eye);
  169. return Result;
  170. }
  171. template<typename T, qualifier Q>
  172. GLM_FUNC_QUALIFIER mat<4, 4, T, Q> lookAt(vec<3, T, Q> const& eye, vec<3, T, Q> const& center, vec<3, T, Q> const& up)
  173. {
  174. # if (GLM_CONFIG_CLIP_CONTROL & GLM_CLIP_CONTROL_LH_BIT)
  175. return lookAtLH(eye, center, up);
  176. # else
  177. return lookAtRH(eye, center, up);
  178. # endif
  179. }
  180. }//namespace glm