package Box2D.Dynamics { import Box2D.Collision.*; import Box2D.Collision.Shapes.*; import Box2D.Common.*; import Box2D.Common.Math.*; import Box2D.Dynamics.Contacts.*; import Box2D.Dynamics.Joints.*; public class b2World { public static var m_positionCorrection:Boolean; public static var m_warmStarting:Boolean; public static var m_continuousPhysics:Boolean; private static var s_jointColor:b2Color = new b2Color(0.5,0.8,0.8); private static var s_coreColor:b2Color = new b2Color(0.9,0.6,0.6); private static var s_xf:b2XForm = new b2XForm(); public var m_blockAllocator:*; public var m_stackAllocator:*; public var m_lock:Boolean; public var m_broadPhase:b2BroadPhase; public var m_contactManager:b2ContactManager = new b2ContactManager(); public var m_bodyList:b2Body; public var m_jointList:b2Joint; public var m_contactList:b2Contact; public var m_bodyCount:int; public var m_contactCount:int; public var m_jointCount:int; public var m_gravity:b2Vec2; public var m_allowSleep:Boolean; public var m_groundBody:b2Body; public var m_destructionListener:b2DestructionListener; public var m_boundaryListener:b2BoundaryListener; public var m_contactFilter:b2ContactFilter; public var m_contactListener:b2ContactListener; public var m_debugDraw:b2DebugDraw; public var m_inv_dt0:Number; public var m_positionIterationCount:int; public function b2World(param1:b2AABB, param2:b2Vec2, param3:Boolean) { super(); m_destructionListener = null; m_boundaryListener = null; m_contactFilter = b2ContactFilter.b2_defaultFilter; m_contactListener = null; m_debugDraw = null; m_bodyList = null; m_contactList = null; m_jointList = null; m_bodyCount = 0; m_contactCount = 0; m_jointCount = 0; m_positionCorrection = true; m_warmStarting = true; m_continuousPhysics = true; m_allowSleep = param3; m_gravity = param2; m_lock = false; m_inv_dt0 = 0; m_contactManager.m_world = this; m_broadPhase = new b2BroadPhase(param1,m_contactManager); var _loc4_:b2BodyDef = new b2BodyDef(); m_groundBody = CreateBody(_loc4_); } public function SetDestructionListener(param1:b2DestructionListener) : void { m_destructionListener = param1; } public function SetBoundaryListener(param1:b2BoundaryListener) : void { m_boundaryListener = param1; } public function SetContactFilter(param1:b2ContactFilter) : void { m_contactFilter = param1; } public function SetContactListener(param1:b2ContactListener) : void { m_contactListener = param1; } public function SetDebugDraw(param1:b2DebugDraw) : void { m_debugDraw = param1; } public function Validate() : void { m_broadPhase.Validate(); } public function GetProxyCount() : int { return m_broadPhase.m_proxyCount; } public function GetPairCount() : int { return m_broadPhase.m_pairManager.m_pairCount; } public function CreateBody(param1:b2BodyDef) : b2Body { if(m_lock == true) { return null; } var _loc2_:b2Body = new b2Body(param1,this); _loc2_.m_prev = null; _loc2_.m_next = m_bodyList; if(m_bodyList) { m_bodyList.m_prev = _loc2_; } m_bodyList = _loc2_; m_bodyCount = m_bodyCount + 1; return _loc2_; } public function DestroyBody(param1:b2Body) : void { var _loc4_:b2JointEdge = null; var _loc5_:b2Shape = null; if(m_lock == true) { return; } var _loc3_:b2JointEdge = param1.m_jointList; while(_loc3_) { _loc4_ = _loc3_; _loc3_ = _loc3_.next; if(m_destructionListener) { m_destructionListener.SayGoodbyeJoint(_loc4_.joint); } DestroyJoint(_loc4_.joint); } var _loc2_:b2Shape = param1.m_shapeList; while(_loc2_) { _loc5_ = _loc2_; _loc2_ = _loc2_.m_next; if(m_destructionListener) { m_destructionListener.SayGoodbyeShape(_loc5_); } _loc5_.DestroyProxy(m_broadPhase); b2Shape.Destroy(_loc5_,m_blockAllocator); } if(param1.m_prev) { param1.m_prev.m_next = param1.m_next; } if(param1.m_next) { param1.m_next.m_prev = param1.m_prev; } if(param1 == m_bodyList) { m_bodyList = param1.m_next; } m_bodyCount = m_bodyCount - 1; } public function CreateJoint(param1:b2JointDef) : b2Joint { var _loc2_:b2Body = null; var _loc3_:b2Shape = null; var _loc4_:b2Joint = b2Joint.Create(param1,m_blockAllocator); _loc4_.m_prev = null; _loc4_.m_next = m_jointList; if(m_jointList) { m_jointList.m_prev = _loc4_; } m_jointList = _loc4_; m_jointCount = m_jointCount + 1; _loc4_.m_node1.joint = _loc4_; _loc4_.m_node1.other = _loc4_.m_body2; _loc4_.m_node1.prev = null; _loc4_.m_node1.next = _loc4_.m_body1.m_jointList; if(_loc4_.m_body1.m_jointList) { _loc4_.m_body1.m_jointList.prev = _loc4_.m_node1; } _loc4_.m_body1.m_jointList = _loc4_.m_node1; _loc4_.m_node2.joint = _loc4_; _loc4_.m_node2.other = _loc4_.m_body1; _loc4_.m_node2.prev = null; _loc4_.m_node2.next = _loc4_.m_body2.m_jointList; if(_loc4_.m_body2.m_jointList) { _loc4_.m_body2.m_jointList.prev = _loc4_.m_node2; } _loc4_.m_body2.m_jointList = _loc4_.m_node2; if(param1.collideConnected == false) { _loc2_ = param1.body1.m_shapeCount < param1.body2.m_shapeCount ? param1.body1 : param1.body2; _loc3_ = _loc2_.m_shapeList; while(_loc3_) { _loc3_.RefilterProxy(m_broadPhase,_loc2_.m_xf); _loc3_ = _loc3_.m_next; } } return _loc4_; } public function DestroyJoint(param1:b2Joint) : void { var _loc2_:b2Body = null; var _loc3_:b2Shape = null; var _loc4_:Boolean = param1.m_collideConnected; if(param1.m_prev) { param1.m_prev.m_next = param1.m_next; } if(param1.m_next) { param1.m_next.m_prev = param1.m_prev; } if(param1 == m_jointList) { m_jointList = param1.m_next; } var _loc5_:b2Body = param1.m_body1; var _loc6_:b2Body = param1.m_body2; _loc5_.WakeUp(); _loc6_.WakeUp(); if(param1.m_node1.prev) { param1.m_node1.prev.next = param1.m_node1.next; } if(param1.m_node1.next) { param1.m_node1.next.prev = param1.m_node1.prev; } if(param1.m_node1 == _loc5_.m_jointList) { _loc5_.m_jointList = param1.m_node1.next; } param1.m_node1.prev = null; param1.m_node1.next = null; if(param1.m_node2.prev) { param1.m_node2.prev.next = param1.m_node2.next; } if(param1.m_node2.next) { param1.m_node2.next.prev = param1.m_node2.prev; } if(param1.m_node2 == _loc6_.m_jointList) { _loc6_.m_jointList = param1.m_node2.next; } param1.m_node2.prev = null; param1.m_node2.next = null; b2Joint.Destroy(param1,m_blockAllocator); m_jointCount = m_jointCount - 1; if(_loc4_ == false) { _loc2_ = _loc5_.m_shapeCount < _loc6_.m_shapeCount ? _loc5_ : _loc6_; _loc3_ = _loc2_.m_shapeList; while(_loc3_) { _loc3_.RefilterProxy(m_broadPhase,_loc2_.m_xf); _loc3_ = _loc3_.m_next; } } } public function Refilter(param1:b2Shape) : void { param1.RefilterProxy(m_broadPhase,param1.m_body.m_xf); } public function SetWarmStarting(param1:Boolean) : void { m_warmStarting = param1; } public function SetPositionCorrection(param1:Boolean) : void { m_positionCorrection = param1; } public function SetContinuousPhysics(param1:Boolean) : void { m_continuousPhysics = param1; } public function GetBodyCount() : int { return m_bodyCount; } public function GetJointCount() : int { return m_jointCount; } public function GetContactCount() : int { return m_contactCount; } public function SetGravity(param1:b2Vec2) : void { m_gravity = param1; } public function GetGroundBody() : b2Body { return m_groundBody; } public function Step(param1:Number, param2:int) : void { m_lock = true; var _loc3_:b2TimeStep = new b2TimeStep(); _loc3_.dt = param1; _loc3_.maxIterations = param2; if(param1 > 0) { _loc3_.inv_dt = 1 / param1; } else { _loc3_.inv_dt = 0; } _loc3_.dtRatio = m_inv_dt0 * param1; _loc3_.positionCorrection = m_positionCorrection; _loc3_.warmStarting = m_warmStarting; m_contactManager.Collide(); if(_loc3_.dt > 0) { Solve(_loc3_); } if(m_continuousPhysics && _loc3_.dt > 0) { SolveTOI(_loc3_); } DrawDebugData(); m_inv_dt0 = _loc3_.inv_dt; m_lock = false; } public function Query(param1:b2AABB, param2:Array, param3:int) : int { var _loc5_:int = 0; var _loc6_:Array = new Array(param3); var _loc4_:int = m_broadPhase.QueryAABB(param1,_loc6_,param3); _loc5_ = 0; while(_loc5_ < _loc4_) { param2[_loc5_] = _loc6_[_loc5_]; _loc5_++; } return _loc4_; } public function GetBodyList() : b2Body { return m_bodyList; } public function GetJointList() : b2Joint { return m_jointList; } public function Solve(param1:b2TimeStep) : void { var _loc2_:b2Body = null; var _loc5_:b2Contact = null; var _loc10_:b2Joint = null; var _loc6_:b2Body = null; var _loc13_:int = 0; var _loc4_:b2Body = null; var _loc11_:b2ContactEdge = null; var _loc7_:b2JointEdge = null; var _loc9_:int = 0; var _loc12_:Boolean = false; m_positionIterationCount = 0; var _loc8_:b2Island = new b2Island(m_bodyCount,m_contactCount,m_jointCount,m_stackAllocator,m_contactListener); _loc2_ = m_bodyList; while(_loc2_) { _loc2_.m_flags &= ~b2Body.e_islandFlag; _loc2_ = _loc2_.m_next; } _loc5_ = m_contactList; while(_loc5_) { _loc5_.m_flags &= ~b2Contact.e_islandFlag; _loc5_ = _loc5_.m_next; } _loc10_ = m_jointList; while(_loc10_) { _loc10_.m_islandFlag = false; _loc10_ = _loc10_.m_next; } var _loc14_:int = m_bodyCount; var _loc3_:Array = new Array(_loc14_); _loc6_ = m_bodyList; while(_loc6_) { if(!(_loc6_.m_flags & (b2Body.e_islandFlag | b2Body.e_sleepFlag | b2Body.e_frozenFlag))) { if(!_loc6_.IsStatic()) { _loc8_.Clear(); _loc13_ = 0; _loc3_[_loc13_++] = _loc6_; _loc6_.m_flags |= b2Body.e_islandFlag; while(_loc13_ > 0) { _loc2_ = _loc3_[--_loc13_]; _loc8_.AddBody(_loc2_); _loc2_.m_flags &= ~b2Body.e_sleepFlag; if(!_loc2_.IsStatic()) { _loc11_ = _loc2_.m_contactList; while(_loc11_) { if(!(_loc11_.contact.m_flags & (b2Contact.e_islandFlag | b2Contact.e_nonSolidFlag))) { if(_loc11_.contact.m_manifoldCount != 0) { _loc8_.AddContact(_loc11_.contact); _loc11_.contact.m_flags |= b2Contact.e_islandFlag; _loc4_ = _loc11_.other; if(!(_loc4_.m_flags & b2Body.e_islandFlag)) { _loc3_[_loc13_++] = _loc4_; _loc4_.m_flags |= b2Body.e_islandFlag; } } } _loc11_ = _loc11_.next; } _loc7_ = _loc2_.m_jointList; while(_loc7_) { if(_loc7_.joint.m_islandFlag != true) { _loc8_.AddJoint(_loc7_.joint); _loc7_.joint.m_islandFlag = true; _loc4_ = _loc7_.other; if(!(_loc4_.m_flags & b2Body.e_islandFlag)) { _loc3_[_loc13_++] = _loc4_; _loc4_.m_flags |= b2Body.e_islandFlag; } } _loc7_ = _loc7_.next; } } } _loc8_.Solve(param1,m_gravity,m_positionCorrection,m_allowSleep); if(_loc8_.m_positionIterationCount > m_positionIterationCount) { m_positionIterationCount = _loc8_.m_positionIterationCount; } _loc9_ = 0; while(_loc9_ < _loc8_.m_bodyCount) { _loc2_ = _loc8_.m_bodies[_loc9_]; if(_loc2_.IsStatic()) { _loc2_.m_flags &= ~b2Body.e_islandFlag; } _loc9_++; } } } _loc6_ = _loc6_.m_next; } _loc2_ = m_bodyList; while(_loc2_) { if(!(_loc2_.m_flags & (b2Body.e_sleepFlag | b2Body.e_frozenFlag))) { if(!_loc2_.IsStatic()) { _loc12_ = _loc2_.SynchronizeShapes(); if(_loc12_ == false && m_boundaryListener != null) { m_boundaryListener.Violation(_loc2_); } } } _loc2_ = _loc2_.m_next; } m_broadPhase.Commit(); } public function SolveTOI(param1:b2TimeStep) : void { var _loc2_:b2Body = null; var _loc20_:b2Shape = null; var _loc21_:b2Shape = null; var _loc14_:b2Body = null; var _loc16_:b2Body = null; var _loc11_:b2ContactEdge = null; var _loc5_:b2Contact = null; var _loc9_:b2Contact = null; var _loc8_:Number = NaN; var _loc15_:Number = NaN; var _loc19_:Number = NaN; var _loc6_:b2Body = null; var _loc17_:int = 0; var _loc4_:b2Body = null; var _loc12_:b2TimeStep = null; var _loc10_:int = 0; var _loc13_:Boolean = false; var _loc7_:b2Island = new b2Island(m_bodyCount,32,0,m_stackAllocator,m_contactListener); var _loc18_:int = m_bodyCount; var _loc3_:Array = new Array(_loc18_); _loc2_ = m_bodyList; while(_loc2_) { _loc2_.m_flags &= ~b2Body.e_islandFlag; _loc2_.m_sweep.t0 = 0; _loc2_ = _loc2_.m_next; } _loc5_ = m_contactList; while(_loc5_) { _loc5_.m_flags &= ~(b2Contact.e_toiFlag | b2Contact.e_islandFlag); _loc5_ = _loc5_.m_next; } while(true) { _loc9_ = null; _loc8_ = 1; _loc5_ = m_contactList; for(; _loc5_; _loc5_ = _loc5_.m_next) { if(!(_loc5_.m_flags & (b2Contact.e_slowFlag | b2Contact.e_nonSolidFlag))) { _loc15_ = 1; if(_loc5_.m_flags & b2Contact.e_toiFlag) { _loc15_ = _loc5_.m_toi; } else { _loc20_ = _loc5_.m_shape1; _loc21_ = _loc5_.m_shape2; _loc14_ = _loc20_.m_body; _loc16_ = _loc21_.m_body; if((_loc14_.IsStatic() || _loc14_.IsSleeping()) && (_loc16_.IsStatic() || _loc16_.IsSleeping())) { continue; } _loc19_ = _loc14_.m_sweep.t0; if(_loc14_.m_sweep.t0 < _loc16_.m_sweep.t0) { _loc19_ = _loc16_.m_sweep.t0; _loc14_.m_sweep.Advance(_loc19_); } else if(_loc16_.m_sweep.t0 < _loc14_.m_sweep.t0) { _loc19_ = _loc14_.m_sweep.t0; _loc16_.m_sweep.Advance(_loc19_); } _loc15_ = b2TimeOfImpact.TimeOfImpact(_loc5_.m_shape1,_loc14_.m_sweep,_loc5_.m_shape2,_loc16_.m_sweep); if(_loc15_ > 0 && _loc15_ < 1) { _loc15_ = (1 - _loc15_) * _loc19_ + _loc15_; if(_loc15_ > 1) { _loc15_ = 1; } } _loc5_.m_toi = _loc15_; _loc5_.m_flags |= b2Contact.e_toiFlag; } if(Number.MIN_VALUE < _loc15_ && _loc15_ < _loc8_) { _loc9_ = _loc5_; _loc8_ = _loc15_; } } } if(_loc9_ == null || 1 - 100 * Number.MIN_VALUE < _loc8_) { break; } _loc20_ = _loc9_.m_shape1; _loc21_ = _loc9_.m_shape2; _loc14_ = _loc20_.m_body; _loc16_ = _loc21_.m_body; _loc14_.Advance(_loc8_); _loc16_.Advance(_loc8_); _loc9_.Update(m_contactListener); _loc9_.m_flags &= ~b2Contact.e_toiFlag; if(_loc9_.m_manifoldCount != 0) { _loc6_ = _loc14_; if(_loc6_.IsStatic()) { _loc6_ = _loc16_; } _loc7_.Clear(); _loc17_ = 0; _loc3_[_loc17_++] = _loc6_; _loc6_.m_flags |= b2Body.e_islandFlag; while(_loc17_ > 0) { _loc2_ = _loc3_[--_loc17_]; _loc7_.AddBody(_loc2_); _loc2_.m_flags &= ~b2Body.e_sleepFlag; if(!_loc2_.IsStatic()) { _loc11_ = _loc2_.m_contactList; while(_loc11_) { if(_loc7_.m_contactCount != _loc7_.m_contactCapacity) { if(!(_loc11_.contact.m_flags & (b2Contact.e_islandFlag | b2Contact.e_slowFlag | b2Contact.e_nonSolidFlag))) { if(_loc11_.contact.m_manifoldCount != 0) { _loc7_.AddContact(_loc11_.contact); _loc11_.contact.m_flags |= b2Contact.e_islandFlag; _loc4_ = _loc11_.other; if(!(_loc4_.m_flags & b2Body.e_islandFlag)) { if(_loc4_.IsStatic() == false) { _loc4_.Advance(_loc8_); _loc4_.WakeUp(); } _loc3_[_loc17_++] = _loc4_; _loc4_.m_flags |= b2Body.e_islandFlag; } } } } _loc11_ = _loc11_.next; } } } _loc12_ = new b2TimeStep(); _loc12_.dt = (1 - _loc8_) * param1.dt; _loc12_.inv_dt = 1 / _loc12_.dt; _loc12_.maxIterations = param1.maxIterations; _loc7_.SolveTOI(_loc12_); _loc10_ = 0; while(_loc10_ < _loc7_.m_bodyCount) { _loc2_ = _loc7_.m_bodies[_loc10_]; _loc2_.m_flags &= ~b2Body.e_islandFlag; if(!(_loc2_.m_flags & (b2Body.e_sleepFlag | b2Body.e_frozenFlag))) { if(!_loc2_.IsStatic()) { _loc13_ = _loc2_.SynchronizeShapes(); if(_loc13_ == false && m_boundaryListener != null) { m_boundaryListener.Violation(_loc2_); } _loc11_ = _loc2_.m_contactList; while(_loc11_) { _loc11_.contact.m_flags &= ~b2Contact.e_toiFlag; _loc11_ = _loc11_.next; } } } _loc10_++; } _loc10_ = 0; while(_loc10_ < _loc7_.m_contactCount) { _loc5_ = _loc7_.m_contacts[_loc10_]; _loc5_.m_flags = _loc5_.m_flags & ~(b2Contact.e_toiFlag | b2Contact.e_islandFlag); _loc10_++; } m_broadPhase.Commit(); } } } public function DrawJoint(param1:b2Joint) : void { var _loc11_:b2PulleyJoint = null; var _loc12_:b2Vec2 = null; var _loc13_:b2Vec2 = null; var _loc7_:b2Body = param1.m_body1; var _loc8_:b2Body = param1.m_body2; var _loc3_:b2XForm = _loc7_.m_xf; var _loc6_:b2XForm = _loc8_.m_xf; var _loc9_:b2Vec2 = _loc3_.position; var _loc10_:b2Vec2 = _loc6_.position; var _loc2_:b2Vec2 = param1.GetAnchor1(); var _loc4_:b2Vec2 = param1.GetAnchor2(); var _loc5_:b2Color = s_jointColor; switch(param1.m_type - 3) { case 0: m_debugDraw.DrawSegment(_loc2_,_loc4_,_loc5_); break; case 1: _loc11_ = param1 as b2PulleyJoint; _loc12_ = _loc11_.GetGroundAnchor1(); _loc13_ = _loc11_.GetGroundAnchor2(); m_debugDraw.DrawSegment(_loc12_,_loc2_,_loc5_); m_debugDraw.DrawSegment(_loc13_,_loc4_,_loc5_); m_debugDraw.DrawSegment(_loc12_,_loc13_,_loc5_); break; case 2: m_debugDraw.DrawSegment(_loc2_,_loc4_,_loc5_); break; default: if(_loc7_ != m_groundBody) { m_debugDraw.DrawSegment(_loc9_,_loc2_,_loc5_); } m_debugDraw.DrawSegment(_loc2_,_loc4_,_loc5_); if(_loc8_ != m_groundBody) { m_debugDraw.DrawSegment(_loc10_,_loc4_,_loc5_); } } } public function DrawShape(param1:b2Shape, param2:b2XForm, param3:b2Color, param4:Boolean) : void { var _loc14_:b2CircleShape = null; var _loc7_:b2Vec2 = null; var _loc15_:Number = NaN; var _loc9_:b2Vec2 = null; var _loc8_:int = 0; var _loc12_:b2PolygonShape = null; var _loc11_:int = 0; var _loc10_:Array = null; var _loc5_:Array = null; var _loc6_:Array = null; var _loc13_:b2Color = s_coreColor; switch(param1.m_type) { case 0: _loc14_ = param1 as b2CircleShape; _loc7_ = b2Math.b2MulX(param2,_loc14_.m_localPosition); _loc15_ = _loc14_.m_radius; _loc9_ = param2.R.col1; m_debugDraw.DrawSolidCircle(_loc7_,_loc15_,_loc9_,param3); if(param4) { m_debugDraw.DrawCircle(_loc7_,_loc15_ - 0.04,_loc13_); } break; case 1: _loc12_ = param1 as b2PolygonShape; _loc11_ = _loc12_.GetVertexCount(); _loc10_ = _loc12_.GetVertices(); _loc5_ = new Array(8); _loc8_ = 0; while(_loc8_ < _loc11_) { _loc5_[_loc8_] = b2Math.b2MulX(param2,_loc10_[_loc8_]); _loc8_++; } m_debugDraw.DrawSolidPolygon(_loc5_,_loc11_,param3); if(param4) { _loc6_ = _loc12_.GetCoreVertices(); _loc8_ = 0; while(_loc8_ < _loc11_) { _loc5_[_loc8_] = b2Math.b2MulX(param2,_loc6_[_loc8_]); _loc8_++; } m_debugDraw.DrawPolygon(_loc5_,_loc11_,_loc13_); } } } public function DrawDebugData() : void { var _loc12_:int = 0; var _loc9_:b2Body = null; var _loc22_:b2Shape = null; var _loc14_:b2Joint = null; var _loc6_:b2BroadPhase = null; var _loc15_:b2XForm = null; var _loc20_:Boolean = false; var _loc13_:* = 0; var _loc16_:b2Pair = null; var _loc1_:b2Proxy = null; var _loc2_:b2Proxy = null; var _loc21_:b2Vec2 = null; var _loc5_:b2Vec2 = null; var _loc18_:b2Proxy = null; var _loc24_:b2PolygonShape = null; var _loc17_:b2OBB = null; var _loc11_:b2Vec2 = null; var _loc26_:b2Mat22 = null; var _loc23_:b2Vec2 = null; var _loc10_:Number = NaN; if(m_debugDraw == null) { return; } m_debugDraw.m_sprite.graphics.clear(); var _loc4_:uint = m_debugDraw.GetFlags(); var _loc19_:b2Vec2 = new b2Vec2(); var _loc25_:b2Vec2 = new b2Vec2(); var _loc27_:b2Vec2 = new b2Vec2(); var _loc3_:b2Color = new b2Color(0,0,0); var _loc7_:b2AABB = new b2AABB(); var _loc8_:b2AABB = new b2AABB(); var _loc28_:Array = [new b2Vec2(),new b2Vec2(),new b2Vec2(),new b2Vec2()]; if(_loc4_ & b2DebugDraw.e_shapeBit) { _loc20_ = (_loc4_ & b2DebugDraw.e_coreShapeBit) == b2DebugDraw.e_coreShapeBit; _loc9_ = m_bodyList; while(_loc9_) { _loc15_ = _loc9_.m_xf; _loc22_ = _loc9_.GetShapeList(); while(_loc22_) { if(_loc9_.IsStatic()) { DrawShape(_loc22_,_loc15_,new b2Color(0.5,0.9,0.5),_loc20_); } else if(_loc9_.IsSleeping()) { DrawShape(_loc22_,_loc15_,new b2Color(0.5,0.5,0.9),_loc20_); } else { DrawShape(_loc22_,_loc15_,new b2Color(0.9,0.9,0.9),_loc20_); } _loc22_ = _loc22_.m_next; } _loc9_ = _loc9_.m_next; } } if(_loc4_ & b2DebugDraw.e_jointBit) { _loc14_ = m_jointList; while(_loc14_) { DrawJoint(_loc14_); _loc14_ = _loc14_.m_next; } } if(_loc4_ & b2DebugDraw.e_pairBit) { _loc6_ = m_broadPhase; _loc19_.Set(1 / _loc6_.m_quantizationFactor.x,1 / _loc6_.m_quantizationFactor.y); _loc3_.Set(0.9,0.9,0.3); _loc12_ = 0; while(_loc12_ < b2Pair.b2_tableCapacity) { _loc13_ = uint(_loc6_.m_pairManager.m_hashTable[_loc12_]); while(_loc13_ != b2Pair.b2_nullPair) { _loc16_ = _loc6_.m_pairManager.m_pairs[_loc13_]; _loc1_ = _loc6_.m_proxyPool[_loc16_.proxyId1]; _loc2_ = _loc6_.m_proxyPool[_loc16_.proxyId2]; _loc7_.lowerBound.x = _loc6_.m_worldAABB.lowerBound.x + _loc19_.x * _loc6_.m_bounds[0][_loc1_.lowerBounds[0]].value; _loc7_.lowerBound.y = _loc6_.m_worldAABB.lowerBound.y + _loc19_.y * _loc6_.m_bounds[1][_loc1_.lowerBounds[1]].value; _loc7_.upperBound.x = _loc6_.m_worldAABB.lowerBound.x + _loc19_.x * _loc6_.m_bounds[0][_loc1_.upperBounds[0]].value; _loc7_.upperBound.y = _loc6_.m_worldAABB.lowerBound.y + _loc19_.y * _loc6_.m_bounds[1][_loc1_.upperBounds[1]].value; _loc8_.lowerBound.x = _loc6_.m_worldAABB.lowerBound.x + _loc19_.x * _loc6_.m_bounds[0][_loc2_.lowerBounds[0]].value; _loc8_.lowerBound.y = _loc6_.m_worldAABB.lowerBound.y + _loc19_.y * _loc6_.m_bounds[1][_loc2_.lowerBounds[1]].value; _loc8_.upperBound.x = _loc6_.m_worldAABB.lowerBound.x + _loc19_.x * _loc6_.m_bounds[0][_loc2_.upperBounds[0]].value; _loc8_.upperBound.y = _loc6_.m_worldAABB.lowerBound.y + _loc19_.y * _loc6_.m_bounds[1][_loc2_.upperBounds[1]].value; _loc25_.x = 0.5 * (_loc7_.lowerBound.x + _loc7_.upperBound.x); _loc25_.y = 0.5 * (_loc7_.lowerBound.y + _loc7_.upperBound.y); _loc27_.x = 0.5 * (_loc8_.lowerBound.x + _loc8_.upperBound.x); _loc27_.y = 0.5 * (_loc8_.lowerBound.y + _loc8_.upperBound.y); m_debugDraw.DrawSegment(_loc25_,_loc27_,_loc3_); _loc13_ = _loc16_.next; } _loc12_++; } } if(_loc4_ & b2DebugDraw.e_aabbBit) { _loc6_ = m_broadPhase; _loc21_ = _loc6_.m_worldAABB.lowerBound; _loc5_ = _loc6_.m_worldAABB.upperBound; _loc19_.Set(1 / _loc6_.m_quantizationFactor.x,1 / _loc6_.m_quantizationFactor.y); _loc3_.Set(0.9,0.3,0.9); _loc12_ = 0; while(_loc12_ < 512) { _loc18_ = _loc6_.m_proxyPool[_loc12_]; if(_loc18_.IsValid() != false) { _loc7_.lowerBound.x = _loc21_.x + _loc19_.x * _loc6_.m_bounds[0][_loc18_.lowerBounds[0]].value; _loc7_.lowerBound.y = _loc21_.y + _loc19_.y * _loc6_.m_bounds[1][_loc18_.lowerBounds[1]].value; _loc7_.upperBound.x = _loc21_.x + _loc19_.x * _loc6_.m_bounds[0][_loc18_.upperBounds[0]].value; _loc7_.upperBound.y = _loc21_.y + _loc19_.y * _loc6_.m_bounds[1][_loc18_.upperBounds[1]].value; _loc28_[0].Set(_loc7_.lowerBound.x,_loc7_.lowerBound.y); _loc28_[1].Set(_loc7_.upperBound.x,_loc7_.lowerBound.y); _loc28_[2].Set(_loc7_.upperBound.x,_loc7_.upperBound.y); _loc28_[3].Set(_loc7_.lowerBound.x,_loc7_.upperBound.y); m_debugDraw.DrawPolygon(_loc28_,4,_loc3_); } _loc12_++; } _loc28_[0].Set(_loc21_.x,_loc21_.y); _loc28_[1].Set(_loc5_.x,_loc21_.y); _loc28_[2].Set(_loc5_.x,_loc5_.y); _loc28_[3].Set(_loc21_.x,_loc5_.y); m_debugDraw.DrawPolygon(_loc28_,4,new b2Color(0.3,0.9,0.9)); } if(_loc4_ & b2DebugDraw.e_obbBit) { _loc3_.Set(0.5,0.3,0.5); _loc9_ = m_bodyList; while(_loc9_) { _loc15_ = _loc9_.m_xf; _loc22_ = _loc9_.GetShapeList(); while(_loc22_) { if(_loc22_.m_type == 1) { _loc24_ = _loc22_ as b2PolygonShape; _loc17_ = _loc24_.GetOBB(); _loc11_ = _loc17_.extents; _loc28_[0].Set(-_loc11_.x,-_loc11_.y); _loc28_[1].Set(_loc11_.x,-_loc11_.y); _loc28_[2].Set(_loc11_.x,_loc11_.y); _loc28_[3].Set(-_loc11_.x,_loc11_.y); _loc12_ = 0; while(_loc12_ < 4) { _loc26_ = _loc17_.R; _loc23_ = _loc28_[_loc12_]; _loc10_ = _loc17_.center.x + (_loc26_.col1.x * _loc23_.x + _loc26_.col2.x * _loc23_.y); _loc28_[_loc12_].y = _loc17_.center.y + (_loc26_.col1.y * _loc23_.x + _loc26_.col2.y * _loc23_.y); _loc28_[_loc12_].x = _loc10_; _loc26_ = _loc15_.R; _loc10_ = _loc15_.position.x + (_loc26_.col1.x * _loc23_.x + _loc26_.col2.x * _loc23_.y); _loc28_[_loc12_].y = _loc15_.position.y + (_loc26_.col1.y * _loc23_.x + _loc26_.col2.y * _loc23_.y); _loc28_[_loc12_].x = _loc10_; _loc12_++; } m_debugDraw.DrawPolygon(_loc28_,4,_loc3_); } _loc22_ = _loc22_.m_next; } _loc9_ = _loc9_.m_next; } } if(_loc4_ & b2DebugDraw.e_centerOfMassBit) { _loc9_ = m_bodyList; while(_loc9_) { _loc15_ = s_xf; _loc15_.R = _loc9_.m_xf.R; _loc15_.position = _loc9_.GetWorldCenter(); m_debugDraw.DrawXForm(_loc15_); _loc9_ = _loc9_.m_next; } } } } }