Plane.cpp 2.6 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879
  1. //
  2. // Copyright (c) 2008-2015 the Urho3D project.
  3. //
  4. // Permission is hereby granted, free of charge, to any person obtaining a copy
  5. // of this software and associated documentation files (the "Software"), to deal
  6. // in the Software without restriction, including without limitation the rights
  7. // to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  8. // copies of the Software, and to permit persons to whom the Software is
  9. // furnished to do so, subject to the following conditions:
  10. //
  11. // The above copyright notice and this permission notice shall be included in
  12. // all copies or substantial portions of the Software.
  13. //
  14. // THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15. // IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16. // FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  17. // AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  18. // LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  19. // OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  20. // THE SOFTWARE.
  21. //
  22. #include "../Math/Plane.h"
  23. namespace Urho3D
  24. {
  25. // Static initialization order can not be relied on, so do not use Vector3 constants
  26. const Plane Plane::UP(Vector3(0.0f, 1.0f, 0.0f), Vector3(0.0f, 0.0f, 0.0f));
  27. void Plane::Transform(const Matrix3& transform)
  28. {
  29. Define(Matrix4(transform).Inverse().Transpose() * ToVector4());
  30. }
  31. void Plane::Transform(const Matrix3x4& transform)
  32. {
  33. Define(transform.ToMatrix4().Inverse().Transpose() * ToVector4());
  34. }
  35. void Plane::Transform(const Matrix4& transform)
  36. {
  37. Define(transform.Inverse().Transpose() * ToVector4());
  38. }
  39. Matrix3x4 Plane::ReflectionMatrix() const
  40. {
  41. return Matrix3x4(
  42. -2.0f * normal_.x_ * normal_.x_ + 1.0f,
  43. -2.0f * normal_.x_ * normal_.y_,
  44. -2.0f * normal_.x_ * normal_.z_,
  45. -2.0f * normal_.x_ * d_,
  46. -2.0f * normal_.y_ * normal_.x_ ,
  47. -2.0f * normal_.y_ * normal_.y_ + 1.0f,
  48. -2.0f * normal_.y_ * normal_.z_,
  49. -2.0f * normal_.y_ * d_,
  50. -2.0f * normal_.z_ * normal_.x_,
  51. -2.0f * normal_.z_ * normal_.y_,
  52. -2.0f * normal_.z_ * normal_.z_ + 1.0f,
  53. -2.0f * normal_.z_ * d_
  54. );
  55. }
  56. Plane Plane::Transformed(const Matrix3& transform) const
  57. {
  58. return Plane(Matrix4(transform).Inverse().Transpose() * ToVector4());
  59. }
  60. Plane Plane::Transformed(const Matrix3x4& transform) const
  61. {
  62. return Plane(transform.ToMatrix4().Inverse().Transpose() * ToVector4());
  63. }
  64. Plane Plane::Transformed(const Matrix4& transform) const
  65. {
  66. return Plane(transform.Inverse().Transpose() * ToVector4());
  67. }
  68. }