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

游戏引擎

开发平台:

Visual C++

  1. /*
  2. * Copyright (c) 2006-2007 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 "b2TensorDampingController.h"
  19. b2TensorDampingController::b2TensorDampingController(const b2TensorDampingControllerDef* def) : b2Controller(def)
  20. {
  21. T = def->T;
  22. maxTimestep = def->maxTimestep;
  23. }
  24. void b2TensorDampingController::Step(const b2TimeStep& step)
  25. {
  26. float32 timestep = step.dt;
  27. if(timestep<=B2_FLT_EPSILON)
  28. return;
  29. if(timestep>maxTimestep && maxTimestep>0)
  30. timestep = maxTimestep;
  31. for(b2ControllerEdge *i=m_bodyList;i;i=i->nextBody){
  32. b2Body* body = i->body;
  33. if(body->IsSleeping())
  34. continue;
  35. b2Vec2 damping = body->GetWorldVector(
  36. b2Mul(T,
  37. body->GetLocalVector(
  38. body->GetLinearVelocity()
  39. )
  40. )
  41. );
  42. body->SetLinearVelocity(body->GetLinearVelocity() + timestep * damping);
  43. }
  44. }
  45. void b2TensorDampingControllerDef::SetAxisAligned(float32 xDamping, float32 yDamping)
  46. {
  47. T.col1.x = -xDamping;
  48. T.col1.y = 0;
  49. T.col2.x = 0;
  50. T.col2.y = -yDamping;
  51. if(xDamping>0 || yDamping>0){
  52. maxTimestep = 1/b2Max(xDamping,yDamping);
  53. }else{
  54. maxTimestep = 0;
  55. }
  56. }
  57. void b2TensorDampingController::Destroy(b2BlockAllocator* allocator)
  58. {
  59. allocator->Free(this, sizeof(b2TensorDampingController));
  60. }
  61. b2TensorDampingController* b2TensorDampingControllerDef::Create(b2BlockAllocator* allocator) const
  62. {
  63. void* mem = allocator->Allocate(sizeof(b2TensorDampingController));
  64. return new (mem) b2TensorDampingController(this);
  65. }