b2Math.cpp
上传用户:gb3593
上传日期:2022-01-07
资源大小:3028k
文件大小:2k
源码类别:

游戏引擎

开发平台:

Visual C++

  1. /*
  2. * Copyright (c) 2007-2009 Erin Catto http://www.gphysics.com
  3. *
  4. * This software is provided 'as-is', without any express or implied
  5. * warranty.  In no event will the authors be held liable for any damages
  6. * arising from the use of this software.
  7. * Permission is granted to anyone to use this software for any purpose,
  8. * including commercial applications, and to alter it and redistribute it
  9. * freely, subject to the following restrictions:
  10. * 1. The origin of this software must not be misrepresented; you must not
  11. * claim that you wrote the original software. If you use this software
  12. * in a product, an acknowledgment in the product documentation would be
  13. * appreciated but is not required.
  14. * 2. Altered source versions must be plainly marked as such, and must not be
  15. * misrepresented as being the original software.
  16. * 3. This notice may not be removed or altered from any source distribution.
  17. */
  18. #include <Box2D/Common/b2Math.h>
  19. const b2Vec2 b2Vec2_zero(0.0f, 0.0f);
  20. const b2Mat22 b2Mat22_identity(1.0f, 0.0f, 0.0f, 1.0f);
  21. const b2Transform b2Transform_identity(b2Vec2_zero, b2Mat22_identity);
  22. /// Solve A * x = b, where b is a column vector. This is more efficient
  23. /// than computing the inverse in one-shot cases.
  24. b2Vec3 b2Mat33::Solve33(const b2Vec3& b) const
  25. {
  26. float32 det = b2Dot(col1, b2Cross(col2, col3));
  27. if (det != 0.0f)
  28. {
  29. det = 1.0f / det;
  30. }
  31. b2Vec3 x;
  32. x.x = det * b2Dot(b, b2Cross(col2, col3));
  33. x.y = det * b2Dot(col1, b2Cross(b, col3));
  34. x.z = det * b2Dot(col1, b2Cross(col2, b));
  35. return x;
  36. }
  37. /// Solve A * x = b, where b is a column vector. This is more efficient
  38. /// than computing the inverse in one-shot cases.
  39. b2Vec2 b2Mat33::Solve22(const b2Vec2& b) const
  40. {
  41. float32 a11 = col1.x, a12 = col2.x, a21 = col1.y, a22 = col2.y;
  42. float32 det = a11 * a22 - a12 * a21;
  43. if (det != 0.0f)
  44. {
  45. det = 1.0f / det;
  46. }
  47. b2Vec2 x;
  48. x.x = det * (a22 * b.x - a12 * b.y);
  49. x.y = det * (a11 * b.y - a21 * b.x);
  50. return x;
  51. }