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

游戏引擎

开发平台:

Visual C++

  1. /*
  2. * Copyright (c) 2006-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. #ifndef TIME_OF_IMPACT_H
  19. #define TIME_OF_IMPACT_H
  20. class TimeOfImpact : public Test
  21. {
  22. public:
  23. TimeOfImpact()
  24. {
  25. m_shapeA.SetAsBox(25.0f, 5.0f);
  26. m_shapeB.SetAsBox(2.5f, 2.5f);
  27. }
  28. static Test* Create()
  29. {
  30. return new TimeOfImpact;
  31. }
  32. void Step(Settings* settings)
  33. {
  34. Test::Step(settings);
  35. b2Sweep sweepA;
  36. sweepA.c0.Set(24.0f, -60.0f);
  37. sweepA.a0 = 2.95f;
  38. sweepA.c = sweepA.c0;
  39. sweepA.a = sweepA.a0;
  40. sweepA.localCenter.SetZero();
  41. b2Sweep sweepB;
  42. sweepB.c0.Set(53.474274f, -50.252514f);
  43. sweepB.a0 = 513.36676f; // - 162.0f * b2_pi;
  44. sweepB.c.Set(54.595478f, -51.083473f);
  45. sweepB.a = 513.62781f; //  - 162.0f * b2_pi;
  46. sweepB.localCenter.SetZero();
  47. //sweepB.a0 -= 300.0f * b2_pi;
  48. //sweepB.a -= 300.0f * b2_pi;
  49. b2TOIInput input;
  50. input.proxyA.Set(&m_shapeA);
  51. input.proxyB.Set(&m_shapeB);
  52. input.sweepA = sweepA;
  53. input.sweepB = sweepB;
  54. input.tMax = 1.0f;
  55. b2TOIOutput output;
  56. b2TimeOfImpact(&output, &input);
  57. m_debugDraw.DrawString(5, m_textLine, "toi = %g", output.t);
  58. m_textLine += 15;
  59. extern int32 b2_toiMaxIters, b2_toiMaxRootIters;
  60. m_debugDraw.DrawString(5, m_textLine, "max toi iters = %d, max root iters = %d", b2_toiMaxIters, b2_toiMaxRootIters);
  61. m_textLine += 15;
  62. b2Vec2 vertices[b2_maxPolygonVertices];
  63. b2Transform transformA;
  64. sweepA.GetTransform(&transformA, 0.0f);
  65. for (int32 i = 0; i < m_shapeA.m_vertexCount; ++i)
  66. {
  67. vertices[i] = b2Mul(transformA, m_shapeA.m_vertices[i]);
  68. }
  69. m_debugDraw.DrawPolygon(vertices, m_shapeA.m_vertexCount, b2Color(0.9f, 0.9f, 0.9f));
  70. b2Transform transformB;
  71. sweepB.GetTransform(&transformB, 0.0f);
  72. b2Vec2 localPoint(2.0f, -0.1f);
  73. b2Vec2 rB = b2Mul(transformB, localPoint) - sweepB.c0;
  74. float32 wB = sweepB.a - sweepB.a0;
  75. b2Vec2 vB = sweepB.c - sweepB.c0;
  76. b2Vec2 v = vB + b2Cross(wB, rB);
  77. for (int32 i = 0; i < m_shapeB.m_vertexCount; ++i)
  78. {
  79. vertices[i] = b2Mul(transformB, m_shapeB.m_vertices[i]);
  80. }
  81. m_debugDraw.DrawPolygon(vertices, m_shapeB.m_vertexCount, b2Color(0.5f, 0.9f, 0.5f));
  82. sweepB.GetTransform(&transformB, output.t);
  83. for (int32 i = 0; i < m_shapeB.m_vertexCount; ++i)
  84. {
  85. vertices[i] = b2Mul(transformB, m_shapeB.m_vertices[i]);
  86. }
  87. m_debugDraw.DrawPolygon(vertices, m_shapeB.m_vertexCount, b2Color(0.5f, 0.7f, 0.9f));
  88. sweepB.GetTransform(&transformB, 1.0f);
  89. for (int32 i = 0; i < m_shapeB.m_vertexCount; ++i)
  90. {
  91. vertices[i] = b2Mul(transformB, m_shapeB.m_vertices[i]);
  92. }
  93. m_debugDraw.DrawPolygon(vertices, m_shapeB.m_vertexCount, b2Color(0.9f, 0.5f, 0.5f));
  94. #if 0
  95. for (float32 t = 0.0f; t < 1.0f; t += 0.1f)
  96. {
  97. sweepB.GetTransform(&transformB, t);
  98. for (int32 i = 0; i < m_shapeB.m_vertexCount; ++i)
  99. {
  100. vertices[i] = b2Mul(transformB, m_shapeB.m_vertices[i]);
  101. }
  102. m_debugDraw.DrawPolygon(vertices, m_shapeB.m_vertexCount, b2Color(0.9f, 0.5f, 0.5f));
  103. }
  104. #endif
  105. }
  106. b2PolygonShape m_shapeA;
  107. b2PolygonShape m_shapeB;
  108. };
  109. #endif