package Box2D.Dynamics { import Box2D.Collision.Shapes.b2MassData; import Box2D.Collision.Shapes.b2Shape; import Box2D.Collision.Shapes.b2ShapeDef; import Box2D.Common.Math.b2Mat22; import Box2D.Common.Math.b2Math; import Box2D.Common.Math.b2Sweep; import Box2D.Common.Math.b2Vec2; import Box2D.Common.Math.b2XForm; import Box2D.Dynamics.Contacts.b2ContactEdge; import Box2D.Dynamics.Joints.b2JointEdge; public class b2Body { public static var e_frozenFlag:uint = 2; public static var e_islandFlag:uint = 4; public static var e_sleepFlag:uint = 8; public static var e_allowSleepFlag:uint = 16; public static var e_bulletFlag:uint = 32; public static var e_fixedRotationFlag:uint = 64; public static var e_staticType:uint = 1; public static var e_dynamicType:uint = 2; public static var e_maxTypes:uint = 3; private static var s_massData:b2MassData = new b2MassData(); private static var s_xf1:b2XForm = new b2XForm(); public var m_flags:uint; public var m_type:int; public var m_xf:b2XForm = new b2XForm(); public var m_sweep:b2Sweep = new b2Sweep(); public var m_linearVelocity:b2Vec2 = new b2Vec2(); public var m_angularVelocity:Number; public var m_force:b2Vec2 = new b2Vec2(); public var m_torque:Number; public var m_world:b2World; public var m_prev:b2Body; public var m_next:b2Body; public var m_shapeList:b2Shape; public var m_shapeCount:int; public var m_jointList:b2JointEdge; public var m_contactList:b2ContactEdge; public var m_mass:Number; public var m_invMass:Number; public var m_I:Number; public var m_invI:Number; public var m_linearDamping:Number; public var m_angularDamping:Number; public var m_sleepTime:Number; public var m_userData:*; public function b2Body(param1:b2BodyDef, param2:b2World) { super(); m_flags = 0; if(param1.isBullet) { m_flags |= e_bulletFlag; } if(param1.fixedRotation) { m_flags |= e_fixedRotationFlag; } if(param1.allowSleep) { m_flags |= e_allowSleepFlag; } if(param1.isSleeping) { m_flags |= e_sleepFlag; } m_world = param2; m_xf.position.SetV(param1.position); m_xf.R.Set(param1.angle); m_sweep.localCenter.SetV(param1.massData.center); m_sweep.t0 = 1; m_sweep.a0 = m_sweep.a = param1.angle; var _loc4_:b2Mat22 = m_xf.R; var _loc3_:b2Vec2 = m_sweep.localCenter; m_sweep.c.x = _loc4_.col1.x * _loc3_.x + _loc4_.col2.x * _loc3_.y; m_sweep.c.y = _loc4_.col1.y * _loc3_.x + _loc4_.col2.y * _loc3_.y; m_sweep.c.x += m_xf.position.x; m_sweep.c.y += m_xf.position.y; m_sweep.c0.SetV(m_sweep.c); m_jointList = null; m_contactList = null; m_prev = null; m_next = null; m_linearDamping = param1.linearDamping; m_angularDamping = param1.angularDamping; m_force.Set(0,0); m_torque = 0; m_linearVelocity.SetZero(); m_angularVelocity = 0; m_sleepTime = 0; m_invMass = 0; m_I = 0; m_invI = 0; m_mass = param1.massData.mass; if(m_mass > 0) { m_invMass = 1 / m_mass; } if((m_flags & b2Body.e_fixedRotationFlag) == 0) { m_I = param1.massData.I; } if(m_I > 0) { m_invI = 1 / m_I; } if(m_invMass == 0 && m_invI == 0) { m_type = e_staticType; } else { m_type = e_dynamicType; } m_userData = param1.userData; m_shapeList = null; m_shapeCount = 0; } public function CreateShape(param1:b2ShapeDef) : b2Shape { if(m_world.m_lock == true) { return null; } var _loc2_:b2Shape = b2Shape.Create(param1,m_world.m_blockAllocator); _loc2_.m_next = m_shapeList; m_shapeList = _loc2_; m_shapeCount = m_shapeCount + 1; _loc2_.m_body = this; _loc2_.CreateProxy(m_world.m_broadPhase,m_xf); _loc2_.UpdateSweepRadius(m_sweep.localCenter); return _loc2_; } public function DestroyShape(param1:b2Shape) : void { if(m_world.m_lock == true) { return; } param1.DestroyProxy(m_world.m_broadPhase); var _loc2_:b2Shape = m_shapeList; var _loc3_:b2Shape = null; var _loc4_:Boolean = false; while(_loc2_ != null) { if(_loc2_ == param1) { if(_loc3_) { _loc3_.m_next = param1.m_next; } else { m_shapeList = param1.m_next; } _loc4_ = true; break; } _loc3_ = _loc2_; _loc2_ = _loc2_.m_next; } param1.m_body = null; param1.m_next = null; m_shapeCount = m_shapeCount - 1; b2Shape.Destroy(param1,m_world.m_blockAllocator); } public function SetMass(param1:b2MassData) : void { var _loc2_:b2Shape = null; if(m_world.m_lock == true) { return; } m_invMass = 0; m_I = 0; m_invI = 0; m_mass = param1.mass; if(m_mass > 0) { m_invMass = 1 / m_mass; } if((m_flags & b2Body.e_fixedRotationFlag) == 0) { m_I = param1.I; } if(m_I > 0) { m_invI = 1 / m_I; } m_sweep.localCenter.SetV(param1.center); var _loc4_:b2Mat22 = m_xf.R; var _loc3_:b2Vec2 = m_sweep.localCenter; m_sweep.c.x = _loc4_.col1.x * _loc3_.x + _loc4_.col2.x * _loc3_.y; m_sweep.c.y = _loc4_.col1.y * _loc3_.x + _loc4_.col2.y * _loc3_.y; m_sweep.c.x += m_xf.position.x; m_sweep.c.y += m_xf.position.y; m_sweep.c0.SetV(m_sweep.c); _loc2_ = m_shapeList; while(_loc2_) { _loc2_.UpdateSweepRadius(m_sweep.localCenter); _loc2_ = _loc2_.m_next; } var _loc5_:int = m_type; if(m_invMass == 0 && m_invI == 0) { m_type = e_staticType; } else { m_type = e_dynamicType; } if(_loc5_ != m_type) { _loc2_ = m_shapeList; while(_loc2_) { _loc2_.RefilterProxy(m_world.m_broadPhase,m_xf); _loc2_ = _loc2_.m_next; } } } public function SetMassFromShapes() : void { var _loc3_:b2Shape = null; if(m_world.m_lock == true) { return; } m_mass = 0; m_invMass = 0; m_I = 0; m_invI = 0; var _loc4_:Number = 0; var _loc2_:Number = 0; var _loc1_:b2MassData = s_massData; _loc3_ = m_shapeList; while(_loc3_) { _loc3_.ComputeMass(_loc1_); m_mass += _loc1_.mass; _loc4_ += _loc1_.mass * _loc1_.center.x; _loc2_ += _loc1_.mass * _loc1_.center.y; m_I += _loc1_.I; _loc3_ = _loc3_.m_next; } if(m_mass > 0) { m_invMass = 1 / m_mass; _loc4_ *= m_invMass; _loc2_ *= m_invMass; } if(m_I > 0 && (m_flags & e_fixedRotationFlag) == 0) { m_I -= m_mass * (_loc4_ * _loc4_ + _loc2_ * _loc2_); m_invI = 1 / m_I; } else { m_I = 0; m_invI = 0; } m_sweep.localCenter.Set(_loc4_,_loc2_); var _loc6_:b2Mat22 = m_xf.R; var _loc5_:b2Vec2 = m_sweep.localCenter; m_sweep.c.x = _loc6_.col1.x * _loc5_.x + _loc6_.col2.x * _loc5_.y; m_sweep.c.y = _loc6_.col1.y * _loc5_.x + _loc6_.col2.y * _loc5_.y; m_sweep.c.x += m_xf.position.x; m_sweep.c.y += m_xf.position.y; m_sweep.c0.SetV(m_sweep.c); _loc3_ = m_shapeList; while(_loc3_) { _loc3_.UpdateSweepRadius(m_sweep.localCenter); _loc3_ = _loc3_.m_next; } var _loc7_:int = m_type; if(m_invMass == 0 && m_invI == 0) { m_type = e_staticType; } else { m_type = e_dynamicType; } if(_loc7_ != m_type) { _loc3_ = m_shapeList; while(_loc3_) { _loc3_.RefilterProxy(m_world.m_broadPhase,m_xf); _loc3_ = _loc3_.m_next; } } } public function SetXForm(param1:b2Vec2, param2:Number) : Boolean { var _loc3_:b2Shape = null; var _loc7_:Boolean = false; if(m_world.m_lock == true) { return true; } if(IsFrozen()) { return false; } m_xf.R.Set(param2); m_xf.position.SetV(param1); var _loc6_:b2Mat22 = m_xf.R; var _loc5_:b2Vec2 = m_sweep.localCenter; m_sweep.c.x = _loc6_.col1.x * _loc5_.x + _loc6_.col2.x * _loc5_.y; m_sweep.c.y = _loc6_.col1.y * _loc5_.x + _loc6_.col2.y * _loc5_.y; m_sweep.c.x += m_xf.position.x; m_sweep.c.y += m_xf.position.y; m_sweep.c0.SetV(m_sweep.c); m_sweep.a0 = m_sweep.a = param2; var _loc4_:Boolean = false; _loc3_ = m_shapeList; while(_loc3_) { _loc7_ = _loc3_.Synchronize(m_world.m_broadPhase,m_xf,m_xf); if(_loc7_ == false) { _loc4_ = true; break; } _loc3_ = _loc3_.m_next; } if(_loc4_ == true) { m_flags |= e_frozenFlag; m_linearVelocity.SetZero(); m_angularVelocity = 0; _loc3_ = m_shapeList; while(_loc3_) { _loc3_.DestroyProxy(m_world.m_broadPhase); _loc3_ = _loc3_.m_next; } return false; } m_world.m_broadPhase.Commit(); return true; } public function GetXForm() : b2XForm { return m_xf; } public function GetPosition() : b2Vec2 { return m_xf.position; } public function GetAngle() : Number { return m_sweep.a; } public function GetWorldCenter() : b2Vec2 { return m_sweep.c; } public function GetLocalCenter() : b2Vec2 { return m_sweep.localCenter; } public function SetLinearVelocity(param1:b2Vec2) : void { m_linearVelocity.SetV(param1); } public function GetLinearVelocity() : b2Vec2 { return m_linearVelocity; } public function SetAngularVelocity(param1:Number) : void { m_angularVelocity = param1; } public function GetAngularVelocity() : Number { return m_angularVelocity; } public function ApplyForce(param1:b2Vec2, param2:b2Vec2) : void { if(IsSleeping()) { WakeUp(); } m_force.x += param1.x; m_force.y += param1.y; m_torque += (param2.x - m_sweep.c.x) * param1.y - (param2.y - m_sweep.c.y) * param1.x; } public function ApplyTorque(param1:Number) : void { if(IsSleeping()) { WakeUp(); } m_torque += param1; } public function ApplyImpulse(param1:b2Vec2, param2:b2Vec2) : void { if(IsSleeping()) { WakeUp(); } m_linearVelocity.x += m_invMass * param1.x; m_linearVelocity.y += m_invMass * param1.y; m_angularVelocity += m_invI * ((param2.x - m_sweep.c.x) * param1.y - (param2.y - m_sweep.c.y) * param1.x); } public function GetMass() : Number { return m_mass; } public function GetInertia() : Number { return m_I; } public function GetWorldPoint(param1:b2Vec2) : b2Vec2 { var _loc2_:b2Mat22 = m_xf.R; var _loc3_:b2Vec2 = new b2Vec2(_loc2_.col1.x * param1.x + _loc2_.col2.x * param1.y,_loc2_.col1.y * param1.x + _loc2_.col2.y * param1.y); _loc3_.x += m_xf.position.x; _loc3_.y += m_xf.position.y; return _loc3_; } public function GetWorldVector(param1:b2Vec2) : b2Vec2 { return b2Math.b2MulMV(m_xf.R,param1); } public function GetLocalPoint(param1:b2Vec2) : b2Vec2 { return b2Math.b2MulXT(m_xf,param1); } public function GetLocalVector(param1:b2Vec2) : b2Vec2 { return b2Math.b2MulTMV(m_xf.R,param1); } public function GetLinearVelocityFromWorldPoint(param1:b2Vec2) : b2Vec2 { return new b2Vec2(m_linearVelocity.x - m_angularVelocity * (param1.y - m_sweep.c.y),m_linearVelocity.y + m_angularVelocity * (param1.x - m_sweep.c.x)); } public function GetLinearVelocityFromLocalPoint(param1:b2Vec2) : b2Vec2 { var _loc2_:b2Mat22 = m_xf.R; var _loc3_:b2Vec2 = new b2Vec2(_loc2_.col1.x * param1.x + _loc2_.col2.x * param1.y,_loc2_.col1.y * param1.x + _loc2_.col2.y * param1.y); _loc3_.x += m_xf.position.x; _loc3_.y += m_xf.position.y; return new b2Vec2(m_linearVelocity.x + m_angularVelocity * (_loc3_.y - m_sweep.c.y),m_linearVelocity.x - m_angularVelocity * (_loc3_.x - m_sweep.c.x)); } public function IsBullet() : Boolean { return (m_flags & e_bulletFlag) == e_bulletFlag; } public function SetBullet(param1:Boolean) : void { if(param1) { m_flags |= e_bulletFlag; } else { m_flags &= ~e_bulletFlag; } } public function IsStatic() : Boolean { return m_type == e_staticType; } public function IsDynamic() : Boolean { return m_type == e_dynamicType; } public function IsFrozen() : Boolean { return (m_flags & e_frozenFlag) == e_frozenFlag; } public function IsSleeping() : Boolean { return (m_flags & e_sleepFlag) == e_sleepFlag; } public function AllowSleeping(param1:Boolean) : void { if(param1) { m_flags |= e_allowSleepFlag; } else { m_flags &= ~e_allowSleepFlag; WakeUp(); } } public function WakeUp() : void { m_flags &= ~e_sleepFlag; m_sleepTime = 0; } public function PutToSleep() : void { m_flags |= e_sleepFlag; m_sleepTime = 0; m_linearVelocity.SetZero(); m_angularVelocity = 0; m_force.SetZero(); m_torque = 0; } public function GetShapeList() : b2Shape { return m_shapeList; } public function GetJointList() : b2JointEdge { return m_jointList; } public function GetNext() : b2Body { return m_next; } public function GetUserData() : * { return m_userData; } public function SetUserData(param1:*) : void { m_userData = param1; } public function GetWorld() : b2World { return m_world; } public function SynchronizeShapes() : Boolean { var _loc2_:b2Shape = null; var _loc1_:b2XForm = s_xf1; _loc1_.R.Set(m_sweep.a0); var _loc4_:b2Mat22 = _loc1_.R; var _loc3_:b2Vec2 = m_sweep.localCenter; _loc1_.position.x = m_sweep.c0.x - (_loc4_.col1.x * _loc3_.x + _loc4_.col2.x * _loc3_.y); _loc1_.position.y = m_sweep.c0.y - (_loc4_.col1.y * _loc3_.x + _loc4_.col2.y * _loc3_.y); var _loc5_:Boolean = true; _loc2_ = m_shapeList; while(_loc2_) { _loc5_ = _loc2_.Synchronize(m_world.m_broadPhase,_loc1_,m_xf); if(_loc5_ == false) { break; } _loc2_ = _loc2_.m_next; } if(_loc5_ == false) { m_flags |= e_frozenFlag; m_linearVelocity.SetZero(); m_angularVelocity = 0; _loc2_ = m_shapeList; while(_loc2_) { _loc2_.DestroyProxy(m_world.m_broadPhase); _loc2_ = _loc2_.m_next; } return false; } return true; } public function SynchronizeTransform() : void { m_xf.R.Set(m_sweep.a); var _loc2_:b2Mat22 = m_xf.R; var _loc1_:b2Vec2 = m_sweep.localCenter; m_xf.position.x = m_sweep.c.x - (_loc2_.col1.x * _loc1_.x + _loc2_.col2.x * _loc1_.y); m_xf.position.y = m_sweep.c.y - (_loc2_.col1.y * _loc1_.x + _loc2_.col2.y * _loc1_.y); } public function IsConnected(param1:b2Body) : Boolean { var _loc2_:b2JointEdge = null; _loc2_ = m_jointList; while(_loc2_) { if(_loc2_.other == param1) { return _loc2_.joint.m_collideConnected == false; } _loc2_ = _loc2_.next; } return false; } public function Advance(param1:Number) : void { m_sweep.Advance(param1); m_sweep.c.SetV(m_sweep.c0); m_sweep.a = m_sweep.a0; SynchronizeTransform(); } } }