Matrix3.cpp 1.3 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253
  1. // Copyright (c) 2008-2023 the Urho3D project
  2. // License: MIT
  3. #include "../Precompiled.h"
  4. #include "../Math/Matrix3.h"
  5. #include <cstdio>
  6. #include "../DebugNew.h"
  7. namespace Urho3D
  8. {
  9. const Matrix3 Matrix3::ZERO(
  10. 0.0f, 0.0f, 0.0f,
  11. 0.0f, 0.0f, 0.0f,
  12. 0.0f, 0.0f, 0.0f);
  13. const Matrix3 Matrix3::IDENTITY;
  14. Matrix3 Matrix3::Inverse() const
  15. {
  16. float det = m00_ * m11_ * m22_ +
  17. m10_ * m21_ * m02_ +
  18. m20_ * m01_ * m12_ -
  19. m20_ * m11_ * m02_ -
  20. m10_ * m01_ * m22_ -
  21. m00_ * m21_ * m12_;
  22. float invDet = 1.0f / det;
  23. return Matrix3(
  24. (m11_ * m22_ - m21_ * m12_) * invDet,
  25. -(m01_ * m22_ - m21_ * m02_) * invDet,
  26. (m01_ * m12_ - m11_ * m02_) * invDet,
  27. -(m10_ * m22_ - m20_ * m12_) * invDet,
  28. (m00_ * m22_ - m20_ * m02_) * invDet,
  29. -(m00_ * m12_ - m10_ * m02_) * invDet,
  30. (m10_ * m21_ - m20_ * m11_) * invDet,
  31. -(m00_ * m21_ - m20_ * m01_) * invDet,
  32. (m00_ * m11_ - m10_ * m01_) * invDet
  33. );
  34. }
  35. String Matrix3::ToString() const
  36. {
  37. char tempBuffer[MATRIX_CONVERSION_BUFFER_LENGTH];
  38. sprintf(tempBuffer, "%g %g %g %g %g %g %g %g %g", m00_, m01_, m02_, m10_, m11_, m12_, m20_, m21_, m22_);
  39. return String(tempBuffer);
  40. }
  41. }