Files

1006 lines
36 KiB
ActionScript

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 _loc2_:b2Shape = null;
if(m_lock == true)
{
return;
}
var _loc5_:b2JointEdge = param1.m_jointList;
while(_loc5_)
{
_loc4_ = _loc5_;
_loc5_ = _loc5_.next;
if(m_destructionListener)
{
m_destructionListener.SayGoodbyeJoint(_loc4_.joint);
}
DestroyJoint(_loc4_.joint);
}
var _loc3_:b2Shape = param1.m_shapeList;
while(_loc3_)
{
_loc2_ = _loc3_;
_loc3_ = _loc3_.m_next;
if(m_destructionListener)
{
m_destructionListener.SayGoodbyeShape(_loc2_);
}
_loc2_.DestroyProxy(m_broadPhase);
b2Shape.Destroy(_loc2_,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 _loc3_:b2Body = null;
var _loc2_: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)
{
_loc3_ = param1.body1.m_shapeCount < param1.body2.m_shapeCount ? param1.body1 : param1.body2;
_loc2_ = _loc3_.m_shapeList;
while(_loc2_)
{
_loc2_.RefilterProxy(m_broadPhase,_loc3_.m_xf);
_loc2_ = _loc2_.m_next;
}
}
return _loc4_;
}
public function DestroyJoint(param1:b2Joint) : void
{
var _loc4_:b2Body = null;
var _loc3_:b2Shape = null;
var _loc5_: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 _loc6_:b2Body = param1.m_body1;
var _loc2_:b2Body = param1.m_body2;
_loc6_.WakeUp();
_loc2_.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 == _loc6_.m_jointList)
{
_loc6_.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 == _loc2_.m_jointList)
{
_loc2_.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(_loc5_ == false)
{
_loc4_ = _loc6_.m_shapeCount < _loc2_.m_shapeCount ? _loc6_ : _loc2_;
_loc3_ = _loc4_.m_shapeList;
while(_loc3_)
{
_loc3_.RefilterProxy(m_broadPhase,_loc4_.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 _loc6_:int = 0;
var _loc5_:Array = new Array(param3);
var _loc4_:int = m_broadPhase.QueryAABB(param1,_loc5_,param3);
_loc6_ = 0;
while(_loc6_ < _loc4_)
{
param2[_loc6_] = _loc5_[_loc6_];
_loc6_++;
}
return _loc4_;
}
public function GetBodyList() : b2Body
{
return m_bodyList;
}
public function GetJointList() : b2Joint
{
return m_jointList;
}
public function Solve(param1:b2TimeStep) : void
{
var _loc4_:b2Body = null;
var _loc5_:b2Contact = null;
var _loc9_:b2Joint = null;
var _loc6_:b2Body = null;
var _loc2_:int = 0;
var _loc3_:b2Body = null;
var _loc12_:b2ContactEdge = null;
var _loc8_:b2JointEdge = null;
var _loc10_:int = 0;
var _loc7_:Boolean = false;
m_positionIterationCount = 0;
var _loc11_:b2Island = new b2Island(m_bodyCount,m_contactCount,m_jointCount,m_stackAllocator,m_contactListener);
_loc4_ = m_bodyList;
while(_loc4_)
{
_loc4_.m_flags &= ~b2Body.e_islandFlag;
_loc4_ = _loc4_.m_next;
}
_loc5_ = m_contactList;
while(_loc5_)
{
_loc5_.m_flags &= ~b2Contact.e_islandFlag;
_loc5_ = _loc5_.m_next;
}
_loc9_ = m_jointList;
while(_loc9_)
{
_loc9_.m_islandFlag = false;
_loc9_ = _loc9_.m_next;
}
var _loc13_:int = m_bodyCount;
var _loc14_:Array = new Array(_loc13_);
_loc6_ = m_bodyList;
while(_loc6_)
{
if(!(_loc6_.m_flags & (b2Body.e_islandFlag | b2Body.e_sleepFlag | b2Body.e_frozenFlag)))
{
if(!_loc6_.IsStatic())
{
_loc11_.Clear();
_loc2_ = 0;
_loc14_[_loc2_++] = _loc6_;
_loc6_.m_flags |= b2Body.e_islandFlag;
while(_loc2_ > 0)
{
_loc4_ = _loc14_[--_loc2_];
_loc11_.AddBody(_loc4_);
_loc4_.m_flags &= ~b2Body.e_sleepFlag;
if(!_loc4_.IsStatic())
{
_loc12_ = _loc4_.m_contactList;
while(_loc12_)
{
if(!(_loc12_.contact.m_flags & (b2Contact.e_islandFlag | b2Contact.e_nonSolidFlag)))
{
if(_loc12_.contact.m_manifoldCount != 0)
{
_loc11_.AddContact(_loc12_.contact);
_loc12_.contact.m_flags |= b2Contact.e_islandFlag;
_loc3_ = _loc12_.other;
if(!(_loc3_.m_flags & b2Body.e_islandFlag))
{
_loc14_[_loc2_++] = _loc3_;
_loc3_.m_flags |= b2Body.e_islandFlag;
}
}
}
_loc12_ = _loc12_.next;
}
_loc8_ = _loc4_.m_jointList;
while(_loc8_)
{
if(_loc8_.joint.m_islandFlag != true)
{
_loc11_.AddJoint(_loc8_.joint);
_loc8_.joint.m_islandFlag = true;
_loc3_ = _loc8_.other;
if(!(_loc3_.m_flags & b2Body.e_islandFlag))
{
_loc14_[_loc2_++] = _loc3_;
_loc3_.m_flags |= b2Body.e_islandFlag;
}
}
_loc8_ = _loc8_.next;
}
}
}
_loc11_.Solve(param1,m_gravity,m_positionCorrection,m_allowSleep);
if(_loc11_.m_positionIterationCount > m_positionIterationCount)
{
m_positionIterationCount = _loc11_.m_positionIterationCount;
}
_loc10_ = 0;
while(_loc10_ < _loc11_.m_bodyCount)
{
_loc4_ = _loc11_.m_bodies[_loc10_];
if(_loc4_.IsStatic())
{
_loc4_.m_flags &= ~b2Body.e_islandFlag;
}
_loc10_++;
}
}
}
_loc6_ = _loc6_.m_next;
}
_loc4_ = m_bodyList;
while(_loc4_)
{
if(!(_loc4_.m_flags & (b2Body.e_sleepFlag | b2Body.e_frozenFlag)))
{
if(!_loc4_.IsStatic())
{
_loc7_ = _loc4_.SynchronizeShapes();
if(_loc7_ == false && m_boundaryListener != null)
{
m_boundaryListener.Violation(_loc4_);
}
}
}
_loc4_ = _loc4_.m_next;
}
m_broadPhase.Commit();
}
public function SolveTOI(param1:b2TimeStep) : void
{
var _loc7_:b2Body = null;
var _loc6_:b2Shape = null;
var _loc2_:b2Shape = null;
var _loc18_:b2Body = null;
var _loc11_:b2Body = null;
var _loc17_:b2ContactEdge = null;
var _loc9_:b2Contact = null;
var _loc21_:b2Contact = null;
var _loc14_:Number = NaN;
var _loc8_:Number = NaN;
var _loc5_:Number = NaN;
var _loc10_:b2Body = null;
var _loc4_:int = 0;
var _loc3_:b2Body = null;
var _loc16_:b2TimeStep = null;
var _loc13_:int = 0;
var _loc12_:Boolean = false;
var _loc15_:b2Island = new b2Island(m_bodyCount,32,0,m_stackAllocator,m_contactListener);
var _loc19_:int = m_bodyCount;
var _loc20_:Array = new Array(_loc19_);
_loc7_ = m_bodyList;
while(_loc7_)
{
_loc7_.m_flags &= ~b2Body.e_islandFlag;
_loc7_.m_sweep.t0 = 0;
_loc7_ = _loc7_.m_next;
}
_loc9_ = m_contactList;
while(_loc9_)
{
_loc9_.m_flags &= ~(b2Contact.e_toiFlag | b2Contact.e_islandFlag);
_loc9_ = _loc9_.m_next;
}
while(true)
{
_loc21_ = null;
_loc14_ = 1;
_loc9_ = m_contactList;
for(; _loc9_; _loc9_ = _loc9_.m_next)
{
if(!(_loc9_.m_flags & (b2Contact.e_slowFlag | b2Contact.e_nonSolidFlag)))
{
_loc8_ = 1;
if(_loc9_.m_flags & b2Contact.e_toiFlag)
{
_loc8_ = _loc9_.m_toi;
}
else
{
_loc6_ = _loc9_.m_shape1;
_loc2_ = _loc9_.m_shape2;
_loc18_ = _loc6_.m_body;
_loc11_ = _loc2_.m_body;
if((_loc18_.IsStatic() || _loc18_.IsSleeping()) && (_loc11_.IsStatic() || _loc11_.IsSleeping()))
{
continue;
}
_loc5_ = _loc18_.m_sweep.t0;
if(_loc18_.m_sweep.t0 < _loc11_.m_sweep.t0)
{
_loc5_ = _loc11_.m_sweep.t0;
_loc18_.m_sweep.Advance(_loc5_);
}
else if(_loc11_.m_sweep.t0 < _loc18_.m_sweep.t0)
{
_loc5_ = _loc18_.m_sweep.t0;
_loc11_.m_sweep.Advance(_loc5_);
}
_loc8_ = b2TimeOfImpact.TimeOfImpact(_loc9_.m_shape1,_loc18_.m_sweep,_loc9_.m_shape2,_loc11_.m_sweep);
if(_loc8_ > 0 && _loc8_ < 1)
{
_loc8_ = (1 - _loc8_) * _loc5_ + _loc8_;
if(_loc8_ > 1)
{
_loc8_ = 1;
}
}
_loc9_.m_toi = _loc8_;
_loc9_.m_flags |= b2Contact.e_toiFlag;
}
if(Number.MIN_VALUE < _loc8_ && _loc8_ < _loc14_)
{
_loc21_ = _loc9_;
_loc14_ = _loc8_;
}
}
}
if(_loc21_ == null || 1 - 100 * Number.MIN_VALUE < _loc14_)
{
break;
}
_loc6_ = _loc21_.m_shape1;
_loc2_ = _loc21_.m_shape2;
_loc18_ = _loc6_.m_body;
_loc11_ = _loc2_.m_body;
_loc18_.Advance(_loc14_);
_loc11_.Advance(_loc14_);
_loc21_.Update(m_contactListener);
_loc21_.m_flags &= ~b2Contact.e_toiFlag;
if(_loc21_.m_manifoldCount != 0)
{
_loc10_ = _loc18_;
if(_loc10_.IsStatic())
{
_loc10_ = _loc11_;
}
_loc15_.Clear();
_loc4_ = 0;
_loc20_[_loc4_++] = _loc10_;
_loc10_.m_flags |= b2Body.e_islandFlag;
while(_loc4_ > 0)
{
_loc7_ = _loc20_[--_loc4_];
_loc15_.AddBody(_loc7_);
_loc7_.m_flags &= ~b2Body.e_sleepFlag;
if(!_loc7_.IsStatic())
{
_loc17_ = _loc7_.m_contactList;
while(_loc17_)
{
if(_loc15_.m_contactCount != _loc15_.m_contactCapacity)
{
if(!(_loc17_.contact.m_flags & (b2Contact.e_islandFlag | b2Contact.e_slowFlag | b2Contact.e_nonSolidFlag)))
{
if(_loc17_.contact.m_manifoldCount != 0)
{
_loc15_.AddContact(_loc17_.contact);
_loc17_.contact.m_flags |= b2Contact.e_islandFlag;
_loc3_ = _loc17_.other;
if(!(_loc3_.m_flags & b2Body.e_islandFlag))
{
if(_loc3_.IsStatic() == false)
{
_loc3_.Advance(_loc14_);
_loc3_.WakeUp();
}
_loc20_[_loc4_++] = _loc3_;
_loc3_.m_flags |= b2Body.e_islandFlag;
}
}
}
}
_loc17_ = _loc17_.next;
}
}
}
_loc16_ = new b2TimeStep();
_loc16_.dt = (1 - _loc14_) * param1.dt;
_loc16_.inv_dt = 1 / _loc16_.dt;
_loc16_.maxIterations = param1.maxIterations;
_loc15_.SolveTOI(_loc16_);
_loc13_ = 0;
while(_loc13_ < _loc15_.m_bodyCount)
{
_loc7_ = _loc15_.m_bodies[_loc13_];
_loc7_.m_flags = _loc7_.m_flags & ~b2Body.e_islandFlag;
if(!(_loc7_.m_flags & (b2Body.e_sleepFlag | b2Body.e_frozenFlag)))
{
if(!_loc7_.IsStatic())
{
_loc12_ = _loc7_.SynchronizeShapes();
if(_loc12_ == false && m_boundaryListener != null)
{
m_boundaryListener.Violation(_loc7_);
}
_loc17_ = _loc7_.m_contactList;
while(_loc17_)
{
_loc17_.contact.m_flags &= ~b2Contact.e_toiFlag;
_loc17_ = _loc17_.next;
}
}
}
_loc13_++;
}
_loc13_ = 0;
while(_loc13_ < _loc15_.m_contactCount)
{
_loc9_ = _loc15_.m_contacts[_loc13_];
_loc9_.m_flags = _loc9_.m_flags & ~(b2Contact.e_toiFlag | b2Contact.e_islandFlag);
_loc13_++;
}
m_broadPhase.Commit();
}
}
}
public function DrawJoint(param1:b2Joint) : void
{
var _loc3_:b2PulleyJoint = null;
var _loc5_:b2Vec2 = null;
var _loc4_:b2Vec2 = null;
var _loc10_:b2Body = param1.m_body1;
var _loc11_:b2Body = param1.m_body2;
var _loc2_:b2XForm = _loc10_.m_xf;
var _loc9_:b2XForm = _loc11_.m_xf;
var _loc13_:b2Vec2 = _loc2_.position;
var _loc12_:b2Vec2 = _loc9_.position;
var _loc8_:b2Vec2 = param1.GetAnchor1();
var _loc7_:b2Vec2 = param1.GetAnchor2();
var _loc6_:b2Color = s_jointColor;
switch(param1.m_type - 3)
{
case 0:
m_debugDraw.DrawSegment(_loc8_,_loc7_,_loc6_);
break;
case 1:
_loc3_ = param1 as b2PulleyJoint;
_loc5_ = _loc3_.GetGroundAnchor1();
_loc4_ = _loc3_.GetGroundAnchor2();
m_debugDraw.DrawSegment(_loc5_,_loc8_,_loc6_);
m_debugDraw.DrawSegment(_loc4_,_loc7_,_loc6_);
m_debugDraw.DrawSegment(_loc5_,_loc4_,_loc6_);
break;
case 2:
m_debugDraw.DrawSegment(_loc8_,_loc7_,_loc6_);
break;
default:
if(_loc10_ != m_groundBody)
{
m_debugDraw.DrawSegment(_loc13_,_loc8_,_loc6_);
}
m_debugDraw.DrawSegment(_loc8_,_loc7_,_loc6_);
if(_loc11_ != m_groundBody)
{
m_debugDraw.DrawSegment(_loc12_,_loc7_,_loc6_);
}
}
}
public function DrawShape(param1:b2Shape, param2:b2XForm, param3:b2Color, param4:Boolean) : void
{
var _loc9_:b2CircleShape = null;
var _loc11_:b2Vec2 = null;
var _loc14_:Number = NaN;
var _loc5_:b2Vec2 = null;
var _loc10_:int = 0;
var _loc8_:b2PolygonShape = null;
var _loc12_:int = 0;
var _loc13_:Array = null;
var _loc7_:Array = null;
var _loc15_:Array = null;
var _loc6_:b2Color = s_coreColor;
switch(param1.m_type)
{
case 0:
_loc9_ = param1 as b2CircleShape;
_loc11_ = b2Math.b2MulX(param2,_loc9_.m_localPosition);
_loc14_ = _loc9_.m_radius;
_loc5_ = param2.R.col1;
m_debugDraw.DrawSolidCircle(_loc11_,_loc14_,_loc5_,param3);
if(param4)
{
m_debugDraw.DrawCircle(_loc11_,_loc14_ - 0.04,_loc6_);
}
break;
case 1:
_loc8_ = param1 as b2PolygonShape;
_loc12_ = _loc8_.GetVertexCount();
_loc13_ = _loc8_.GetVertices();
_loc7_ = new Array(8);
_loc10_ = 0;
while(_loc10_ < _loc12_)
{
_loc7_[_loc10_] = b2Math.b2MulX(param2,_loc13_[_loc10_]);
_loc10_++;
}
m_debugDraw.DrawSolidPolygon(_loc7_,_loc12_,param3);
if(param4)
{
_loc15_ = _loc8_.GetCoreVertices();
_loc10_ = 0;
while(_loc10_ < _loc12_)
{
_loc7_[_loc10_] = b2Math.b2MulX(param2,_loc15_[_loc10_]);
_loc10_++;
}
m_debugDraw.DrawPolygon(_loc7_,_loc12_,_loc6_);
}
}
}
public function DrawDebugData() : void
{
var _loc23_:int = 0;
var _loc18_:b2Body = null;
var _loc24_:b2Shape = null;
var _loc20_:b2Joint = null;
var _loc10_:b2BroadPhase = null;
var _loc13_:b2XForm = null;
var _loc28_:Boolean = false;
var _loc15_:* = 0;
var _loc2_:b2Pair = null;
var _loc4_:b2Proxy = null;
var _loc3_:b2Proxy = null;
var _loc12_:b2Vec2 = null;
var _loc1_:b2Vec2 = null;
var _loc27_:b2Proxy = null;
var _loc19_:b2PolygonShape = null;
var _loc17_:b2OBB = null;
var _loc22_:b2Vec2 = null;
var _loc26_:b2Mat22 = null;
var _loc21_:b2Vec2 = null;
var _loc14_:Number = NaN;
if(m_debugDraw == null)
{
return;
}
m_debugDraw.m_sprite.graphics.clear();
var _loc16_:uint = m_debugDraw.GetFlags();
var _loc5_:b2Vec2 = new b2Vec2();
var _loc9_:b2Vec2 = new b2Vec2();
var _loc8_:b2Vec2 = new b2Vec2();
var _loc25_:b2Color = new b2Color(0,0,0);
var _loc11_:b2AABB = new b2AABB();
var _loc6_:b2AABB = new b2AABB();
var _loc7_:Array = [new b2Vec2(),new b2Vec2(),new b2Vec2(),new b2Vec2()];
if(_loc16_ & b2DebugDraw.e_shapeBit)
{
_loc28_ = (_loc16_ & b2DebugDraw.e_coreShapeBit) == b2DebugDraw.e_coreShapeBit;
_loc18_ = m_bodyList;
while(_loc18_)
{
_loc13_ = _loc18_.m_xf;
_loc24_ = _loc18_.GetShapeList();
while(_loc24_)
{
if(_loc18_.IsStatic())
{
DrawShape(_loc24_,_loc13_,new b2Color(0.5,0.9,0.5),_loc28_);
}
else if(_loc18_.IsSleeping())
{
DrawShape(_loc24_,_loc13_,new b2Color(0.5,0.5,0.9),_loc28_);
}
else
{
DrawShape(_loc24_,_loc13_,new b2Color(0.9,0.9,0.9),_loc28_);
}
_loc24_ = _loc24_.m_next;
}
_loc18_ = _loc18_.m_next;
}
}
if(_loc16_ & b2DebugDraw.e_jointBit)
{
_loc20_ = m_jointList;
while(_loc20_)
{
DrawJoint(_loc20_);
_loc20_ = _loc20_.m_next;
}
}
if(_loc16_ & b2DebugDraw.e_pairBit)
{
_loc10_ = m_broadPhase;
_loc5_.Set(1 / _loc10_.m_quantizationFactor.x,1 / _loc10_.m_quantizationFactor.y);
_loc25_.Set(0.9,0.9,0.3);
_loc23_ = 0;
while(_loc23_ < b2Pair.b2_tableCapacity)
{
_loc15_ = uint(_loc10_.m_pairManager.m_hashTable[_loc23_]);
while(_loc15_ != b2Pair.b2_nullPair)
{
_loc2_ = _loc10_.m_pairManager.m_pairs[_loc15_];
_loc4_ = _loc10_.m_proxyPool[_loc2_.proxyId1];
_loc3_ = _loc10_.m_proxyPool[_loc2_.proxyId2];
_loc11_.lowerBound.x = _loc10_.m_worldAABB.lowerBound.x + _loc5_.x * _loc10_.m_bounds[0][_loc4_.lowerBounds[0]].value;
_loc11_.lowerBound.y = _loc10_.m_worldAABB.lowerBound.y + _loc5_.y * _loc10_.m_bounds[1][_loc4_.lowerBounds[1]].value;
_loc11_.upperBound.x = _loc10_.m_worldAABB.lowerBound.x + _loc5_.x * _loc10_.m_bounds[0][_loc4_.upperBounds[0]].value;
_loc11_.upperBound.y = _loc10_.m_worldAABB.lowerBound.y + _loc5_.y * _loc10_.m_bounds[1][_loc4_.upperBounds[1]].value;
_loc6_.lowerBound.x = _loc10_.m_worldAABB.lowerBound.x + _loc5_.x * _loc10_.m_bounds[0][_loc3_.lowerBounds[0]].value;
_loc6_.lowerBound.y = _loc10_.m_worldAABB.lowerBound.y + _loc5_.y * _loc10_.m_bounds[1][_loc3_.lowerBounds[1]].value;
_loc6_.upperBound.x = _loc10_.m_worldAABB.lowerBound.x + _loc5_.x * _loc10_.m_bounds[0][_loc3_.upperBounds[0]].value;
_loc6_.upperBound.y = _loc10_.m_worldAABB.lowerBound.y + _loc5_.y * _loc10_.m_bounds[1][_loc3_.upperBounds[1]].value;
_loc9_.x = 0.5 * (_loc11_.lowerBound.x + _loc11_.upperBound.x);
_loc9_.y = 0.5 * (_loc11_.lowerBound.y + _loc11_.upperBound.y);
_loc8_.x = 0.5 * (_loc6_.lowerBound.x + _loc6_.upperBound.x);
_loc8_.y = 0.5 * (_loc6_.lowerBound.y + _loc6_.upperBound.y);
m_debugDraw.DrawSegment(_loc9_,_loc8_,_loc25_);
_loc15_ = _loc2_.next;
}
_loc23_++;
}
}
if(_loc16_ & b2DebugDraw.e_aabbBit)
{
_loc10_ = m_broadPhase;
_loc12_ = _loc10_.m_worldAABB.lowerBound;
_loc1_ = _loc10_.m_worldAABB.upperBound;
_loc5_.Set(1 / _loc10_.m_quantizationFactor.x,1 / _loc10_.m_quantizationFactor.y);
_loc25_.Set(0.9,0.3,0.9);
_loc23_ = 0;
while(_loc23_ < 512)
{
_loc27_ = _loc10_.m_proxyPool[_loc23_];
if(_loc27_.IsValid() != false)
{
_loc11_.lowerBound.x = _loc12_.x + _loc5_.x * _loc10_.m_bounds[0][_loc27_.lowerBounds[0]].value;
_loc11_.lowerBound.y = _loc12_.y + _loc5_.y * _loc10_.m_bounds[1][_loc27_.lowerBounds[1]].value;
_loc11_.upperBound.x = _loc12_.x + _loc5_.x * _loc10_.m_bounds[0][_loc27_.upperBounds[0]].value;
_loc11_.upperBound.y = _loc12_.y + _loc5_.y * _loc10_.m_bounds[1][_loc27_.upperBounds[1]].value;
_loc7_[0].Set(_loc11_.lowerBound.x,_loc11_.lowerBound.y);
_loc7_[1].Set(_loc11_.upperBound.x,_loc11_.lowerBound.y);
_loc7_[2].Set(_loc11_.upperBound.x,_loc11_.upperBound.y);
_loc7_[3].Set(_loc11_.lowerBound.x,_loc11_.upperBound.y);
m_debugDraw.DrawPolygon(_loc7_,4,_loc25_);
}
_loc23_++;
}
_loc7_[0].Set(_loc12_.x,_loc12_.y);
_loc7_[1].Set(_loc1_.x,_loc12_.y);
_loc7_[2].Set(_loc1_.x,_loc1_.y);
_loc7_[3].Set(_loc12_.x,_loc1_.y);
m_debugDraw.DrawPolygon(_loc7_,4,new b2Color(0.3,0.9,0.9));
}
if(_loc16_ & b2DebugDraw.e_obbBit)
{
_loc25_.Set(0.5,0.3,0.5);
_loc18_ = m_bodyList;
while(_loc18_)
{
_loc13_ = _loc18_.m_xf;
_loc24_ = _loc18_.GetShapeList();
while(_loc24_)
{
if(_loc24_.m_type == 1)
{
_loc19_ = _loc24_ as b2PolygonShape;
_loc17_ = _loc19_.GetOBB();
_loc22_ = _loc17_.extents;
_loc7_[0].Set(-_loc22_.x,-_loc22_.y);
_loc7_[1].Set(_loc22_.x,-_loc22_.y);
_loc7_[2].Set(_loc22_.x,_loc22_.y);
_loc7_[3].Set(-_loc22_.x,_loc22_.y);
_loc23_ = 0;
while(_loc23_ < 4)
{
_loc26_ = _loc17_.R;
_loc21_ = _loc7_[_loc23_];
_loc14_ = _loc17_.center.x + (_loc26_.col1.x * _loc21_.x + _loc26_.col2.x * _loc21_.y);
_loc7_[_loc23_].y = _loc17_.center.y + (_loc26_.col1.y * _loc21_.x + _loc26_.col2.y * _loc21_.y);
_loc7_[_loc23_].x = _loc14_;
_loc26_ = _loc13_.R;
_loc14_ = _loc13_.position.x + (_loc26_.col1.x * _loc21_.x + _loc26_.col2.x * _loc21_.y);
_loc7_[_loc23_].y = _loc13_.position.y + (_loc26_.col1.y * _loc21_.x + _loc26_.col2.y * _loc21_.y);
_loc7_[_loc23_].x = _loc14_;
_loc23_++;
}
m_debugDraw.DrawPolygon(_loc7_,4,_loc25_);
}
_loc24_ = _loc24_.m_next;
}
_loc18_ = _loc18_.m_next;
}
}
if(_loc16_ & b2DebugDraw.e_centerOfMassBit)
{
_loc18_ = m_bodyList;
while(_loc18_)
{
_loc13_ = s_xf;
_loc13_.R = _loc18_.m_xf.R;
_loc13_.position = _loc18_.GetWorldCenter();
m_debugDraw.DrawXForm(_loc13_);
_loc18_ = _loc18_.m_next;
}
}
}
}
}