Brought up to date with the private repository (feea4c7)

This commit is contained in:
S committed 2026-10-14 20:57:33 +03:00
1 parent 1aa738d692
commit 1b1df1ae48
7925 files changed
+2617237 -20

No files matched your search

@@ -0,0 +1,116 @@
package Box2D.Dynamics.Contacts
{
import Box2D.Collision.*;
import Box2D.Collision.Shapes.*;
import Box2D.Common.*;
import Box2D.Common.Math.*;
import Box2D.Dynamics.*;
public class b2CircleContact extends b2Contact
{
private static const s_evalCP:b2ContactPoint = new b2ContactPoint();
private var m_manifolds:Array = [new b2Manifold()];
public var m_manifold:b2Manifold;
private var m0:b2Manifold = new b2Manifold();
public function b2CircleContact(param1:b2Shape, param2:b2Shape)
{
super(param1,param2);
m_manifold = m_manifolds[0];
m_manifold.pointCount = 0;
var _loc3_:b2ManifoldPoint = m_manifold.points[0];
_loc3_.normalImpulse = 0;
_loc3_.tangentImpulse = 0;
}
public static function Create(param1:b2Shape, param2:b2Shape, param3:*) : b2Contact
{
return new b2CircleContact(param1,param2);
}
public static function Destroy(param1:b2Contact, param2:*) : void
{
}
override public function Evaluate(param1:b2ContactListener) : void
{
var _loc4_:b2Vec2 = null;
var _loc5_:b2Vec2 = null;
var _loc6_:b2ManifoldPoint = null;
var _loc3_:b2ManifoldPoint = null;
var _loc8_:b2Body = m_shape1.m_body;
var _loc2_:b2Body = m_shape2.m_body;
m0.Set(m_manifold);
b2Collision.b2CollideCircles(m_manifold,m_shape1 as b2CircleShape,_loc8_.m_xf,m_shape2 as b2CircleShape,_loc2_.m_xf);
var _loc7_:b2ContactPoint = s_evalCP;
_loc7_.shape1 = m_shape1;
_loc7_.shape2 = m_shape2;
_loc7_.friction = m_friction;
_loc7_.restitution = m_restitution;
if(m_manifold.pointCount > 0)
{
m_manifoldCount = 1;
_loc3_ = m_manifold.points[0];
if(m0.pointCount == 0)
{
_loc3_.normalImpulse = 0;
_loc3_.tangentImpulse = 0;
if(param1)
{
_loc7_.position = _loc8_.GetWorldPoint(_loc3_.localPoint1);
_loc4_ = _loc8_.GetLinearVelocityFromLocalPoint(_loc3_.localPoint1);
_loc5_ = _loc2_.GetLinearVelocityFromLocalPoint(_loc3_.localPoint2);
_loc7_.velocity.Set(_loc5_.x - _loc4_.x,_loc5_.y - _loc4_.y);
_loc7_.normal.SetV(m_manifold.normal);
_loc7_.separation = _loc3_.separation;
_loc7_.id.key = _loc3_.id._key;
param1.Add(_loc7_);
}
}
else
{
_loc6_ = m0.points[0];
_loc3_.normalImpulse = _loc6_.normalImpulse;
_loc3_.tangentImpulse = _loc6_.tangentImpulse;
if(param1)
{
_loc7_.position = _loc8_.GetWorldPoint(_loc3_.localPoint1);
_loc4_ = _loc8_.GetLinearVelocityFromLocalPoint(_loc3_.localPoint1);
_loc5_ = _loc2_.GetLinearVelocityFromLocalPoint(_loc3_.localPoint2);
_loc7_.velocity.Set(_loc5_.x - _loc4_.x,_loc5_.y - _loc4_.y);
_loc7_.normal.SetV(m_manifold.normal);
_loc7_.separation = _loc3_.separation;
_loc7_.id.key = _loc3_.id._key;
param1.Persist(_loc7_);
}
}
}
else
{
m_manifoldCount = 0;
if(m0.pointCount > 0 && param1)
{
_loc6_ = m0.points[0];
_loc7_.position = _loc8_.GetWorldPoint(_loc6_.localPoint1);
_loc4_ = _loc8_.GetLinearVelocityFromLocalPoint(_loc6_.localPoint1);
_loc5_ = _loc2_.GetLinearVelocityFromLocalPoint(_loc6_.localPoint2);
_loc7_.velocity.Set(_loc5_.x - _loc4_.x,_loc5_.y - _loc4_.y);
_loc7_.normal.SetV(m0.normal);
_loc7_.separation = _loc6_.separation;
_loc7_.id.key = _loc6_.id._key;
param1.Remove(_loc7_);
}
}
}
override public function GetManifolds() : Array
{
return m_manifolds;
}
}
}
@@ -0,0 +1,216 @@
package Box2D.Dynamics.Contacts
{
import Box2D.Collision.*;
import Box2D.Collision.Shapes.*;
import Box2D.Common.*;
import Box2D.Common.Math.*;
import Box2D.Dynamics.*;
public class b2Contact
{
public static var e_nonSolidFlag:uint = 1;
public static var e_slowFlag:uint = 2;
public static var e_islandFlag:uint = 4;
public static var e_toiFlag:uint = 8;
public static var s_registers:Array;
public static var s_initialized:Boolean = false;
public var m_flags:uint;
public var m_prev:b2Contact;
public var m_next:b2Contact;
public var m_node1:b2ContactEdge = new b2ContactEdge();
public var m_node2:b2ContactEdge = new b2ContactEdge();
public var m_shape1:b2Shape;
public var m_shape2:b2Shape;
public var m_manifoldCount:int;
public var m_friction:Number;
public var m_restitution:Number;
public var m_toi:Number;
public function b2Contact(param1:b2Shape = null, param2:b2Shape = null)
{
super();
m_flags = 0;
if(!param1 || !param2)
{
m_shape1 = null;
m_shape2 = null;
return;
}
if(param1.IsSensor() || param2.IsSensor())
{
m_flags |= e_nonSolidFlag;
}
m_shape1 = param1;
m_shape2 = param2;
m_manifoldCount = 0;
m_friction = Math.sqrt(m_shape1.m_friction * m_shape2.m_friction);
m_restitution = b2Math.b2Max(m_shape1.m_restitution,m_shape2.m_restitution);
m_prev = null;
m_next = null;
m_node1.contact = null;
m_node1.prev = null;
m_node1.next = null;
m_node1.other = null;
m_node2.contact = null;
m_node2.prev = null;
m_node2.next = null;
m_node2.other = null;
}
public static function AddType(param1:Function, param2:Function, param3:int, param4:int) : void
{
s_registers[param3][param4].createFcn = param1;
s_registers[param3][param4].destroyFcn = param2;
s_registers[param3][param4].primary = true;
if(param3 != param4)
{
s_registers[param4][param3].createFcn = param1;
s_registers[param4][param3].destroyFcn = param2;
s_registers[param4][param3].primary = false;
}
}
public static function InitializeRegisters() : void
{
var _loc1_:int = 0;
var _loc2_:int = 0;
s_registers = new Array(2);
_loc1_ = 0;
while(_loc1_ < 2)
{
s_registers[_loc1_] = new Array(2);
_loc2_ = 0;
while(_loc2_ < 2)
{
s_registers[_loc1_][_loc2_] = new b2ContactRegister();
_loc2_++;
}
_loc1_++;
}
AddType(b2CircleContact.Create,b2CircleContact.Destroy,0,0);
AddType(b2PolyAndCircleContact.Create,b2PolyAndCircleContact.Destroy,1,0);
AddType(b2PolygonContact.Create,b2PolygonContact.Destroy,1,1);
}
public static function Create(param1:b2Shape, param2:b2Shape, param3:*) : b2Contact
{
var _loc5_:b2Contact = null;
var _loc7_:int = 0;
var _loc9_:b2Manifold = null;
if(s_initialized == false)
{
InitializeRegisters();
s_initialized = true;
}
var _loc8_:int = param1.m_type;
var _loc4_:int = param2.m_type;
var _loc6_:b2ContactRegister = s_registers[_loc8_][_loc4_];
var _loc10_:Function = _loc6_.createFcn;
if(_loc10_ != null)
{
if(_loc6_.primary)
{
return _loc10_(param1,param2,param3);
}
_loc5_ = _loc10_(param2,param1,param3);
_loc7_ = 0;
while(_loc7_ < _loc5_.m_manifoldCount)
{
_loc9_ = _loc5_.GetManifolds()[_loc7_];
_loc9_.normal = _loc9_.normal.Negative();
_loc7_++;
}
return _loc5_;
}
return null;
}
public static function Destroy(param1:b2Contact, param2:*) : void
{
if(param1.m_manifoldCount > 0)
{
param1.m_shape1.m_body.WakeUp();
param1.m_shape2.m_body.WakeUp();
}
var _loc6_:int = param1.m_shape1.m_type;
var _loc4_:int = param1.m_shape2.m_type;
var _loc5_:b2ContactRegister = s_registers[_loc6_][_loc4_];
var _loc3_:Function = _loc5_.destroyFcn;
_loc3_(param1,param2);
}
public function GetManifolds() : Array
{
return null;
}
public function GetManifoldCount() : int
{
return m_manifoldCount;
}
public function IsSolid() : Boolean
{
return (m_flags & e_nonSolidFlag) == 0;
}
public function GetNext() : b2Contact
{
return m_next;
}
public function GetShape1() : b2Shape
{
return m_shape1;
}
public function GetShape2() : b2Shape
{
return m_shape2;
}
public function Update(param1:b2ContactListener) : void
{
var _loc2_:int = m_manifoldCount;
Evaluate(param1);
var _loc3_:int = m_manifoldCount;
var _loc4_:b2Body = m_shape1.m_body;
var _loc5_:b2Body = m_shape2.m_body;
if(_loc3_ == 0 && _loc2_ > 0)
{
_loc4_.WakeUp();
_loc5_.WakeUp();
}
if(_loc4_.IsStatic() || _loc4_.IsBullet() || _loc5_.IsStatic() || _loc5_.IsBullet())
{
m_flags &= ~e_slowFlag;
}
else
{
m_flags |= e_slowFlag;
}
}
public function Evaluate(param1:b2ContactListener) : void
{
}
}
}
@@ -0,0 +1,41 @@
package Box2D.Dynamics.Contacts
{
import Box2D.Collision.*;
import Box2D.Common.*;
import Box2D.Common.Math.*;
import Box2D.Dynamics.*;
public class b2ContactConstraint
{
public var points:Array;
public var normal:b2Vec2 = new b2Vec2();
public var manifold:b2Manifold;
public var body1:b2Body;
public var body2:b2Body;
public var friction:Number;
public var restitution:Number;
public var pointCount:int;
public function b2ContactConstraint()
{
var _loc1_:int = 0;
super();
points = new Array(2);
_loc1_ = 0;
while(_loc1_ < 2)
{
points[_loc1_] = new b2ContactConstraintPoint();
_loc1_++;
}
}
}
}
@@ -0,0 +1,38 @@
package Box2D.Dynamics.Contacts
{
import Box2D.Common.Math.b2Vec2;
public class b2ContactConstraintPoint
{
public var localAnchor1:b2Vec2 = new b2Vec2();
public var localAnchor2:b2Vec2 = new b2Vec2();
public var r1:b2Vec2 = new b2Vec2();
public var r2:b2Vec2 = new b2Vec2();
public var normalImpulse:Number;
public var tangentImpulse:Number;
public var positionImpulse:Number;
public var normalMass:Number;
public var tangentMass:Number;
public var equalizedMass:Number;
public var separation:Number;
public var velocityBias:Number;
public function b2ContactConstraintPoint()
{
super();
}
}
}
@@ -0,0 +1,22 @@
package Box2D.Dynamics.Contacts
{
import Box2D.Dynamics.b2Body;
public class b2ContactEdge
{
public var other:b2Body;
public var contact:b2Contact;
public var prev:b2ContactEdge;
public var next:b2ContactEdge;
public function b2ContactEdge()
{
super();
}
}
}
@@ -0,0 +1,18 @@
package Box2D.Dynamics.Contacts
{
public class b2ContactRegister
{
public var createFcn:Function;
public var destroyFcn:Function;
public var primary:Boolean;
public function b2ContactRegister()
{
super();
}
}
}
@@ -0,0 +1,30 @@
package Box2D.Dynamics.Contacts
{
import Box2D.Collision.Shapes.b2Shape;
import Box2D.Collision.b2ContactID;
import Box2D.Common.Math.b2Vec2;
public class b2ContactResult
{
public var shape1:b2Shape;
public var shape2:b2Shape;
public var position:b2Vec2 = new b2Vec2();
public var normal:b2Vec2 = new b2Vec2();
public var normalImpulse:Number;
public var tangentImpulse:Number;
public var id:b2ContactID = new b2ContactID();
public function b2ContactResult()
{
super();
}
}
}
@@ -0,0 +1,475 @@
package Box2D.Dynamics.Contacts
{
import Box2D.Collision.*;
import Box2D.Common.*;
import Box2D.Common.Math.*;
import Box2D.Dynamics.*;
public class b2ContactSolver
{
public var m_step:b2TimeStep = new b2TimeStep();
public var m_allocator:*;
public var m_constraints:Array = [];
public var m_constraintCount:int;
public function b2ContactSolver(param1:b2TimeStep, param2:Array, param3:int, param4:*)
{
var _loc14_:b2Contact = null;
var _loc28_:int = 0;
var _loc40_:* = null;
var _loc44_:b2Mat22 = null;
var _loc9_:b2Body = null;
var _loc10_:b2Body = null;
var _loc11_:int = 0;
var _loc6_:Array = null;
var _loc33_:Number = NaN;
var _loc37_:Number = NaN;
var _loc46_:Number = NaN;
var _loc47_:Number = NaN;
var _loc21_:Number = NaN;
var _loc20_:Number = NaN;
var _loc18_:Number = NaN;
var _loc19_:Number = NaN;
var _loc29_:int = 0;
var _loc16_:b2Manifold = null;
var _loc5_:Number = NaN;
var _loc7_:Number = NaN;
var _loc23_:b2ContactConstraint = null;
var _loc31_:* = 0;
var _loc32_:b2ManifoldPoint = null;
var _loc12_:b2ContactConstraintPoint = null;
var _loc24_:Number = NaN;
var _loc25_:Number = NaN;
var _loc43_:Number = NaN;
var _loc45_:Number = NaN;
var _loc17_:Number = NaN;
var _loc15_:Number = NaN;
var _loc8_:Number = NaN;
var _loc30_:Number = NaN;
var _loc38_:Number = NaN;
var _loc41_:Number = NaN;
var _loc13_:Number = NaN;
var _loc36_:Number = NaN;
var _loc26_:Number = NaN;
var _loc22_:Number = NaN;
var _loc34_:Number = NaN;
var _loc35_:Number = NaN;
var _loc42_:Number = NaN;
var _loc39_:Number = NaN;
super();
m_step.dt = param1.dt;
m_step.inv_dt = param1.inv_dt;
m_step.maxIterations = param1.maxIterations;
m_allocator = param4;
m_constraintCount = 0;
_loc28_ = 0;
while(_loc28_ < param3)
{
_loc14_ = param2[_loc28_];
m_constraintCount += _loc14_.m_manifoldCount;
_loc28_++;
}
_loc28_ = 0;
while(_loc28_ < m_constraintCount)
{
m_constraints[_loc28_] = new b2ContactConstraint();
_loc28_++;
}
var _loc27_:int = 0;
_loc28_ = 0;
while(_loc28_ < param3)
{
_loc14_ = param2[_loc28_];
_loc9_ = _loc14_.m_shape1.m_body;
_loc10_ = _loc14_.m_shape2.m_body;
_loc11_ = _loc14_.m_manifoldCount;
_loc6_ = _loc14_.GetManifolds();
_loc33_ = _loc14_.m_friction;
_loc37_ = _loc14_.m_restitution;
_loc46_ = _loc9_.m_linearVelocity.x;
_loc47_ = _loc9_.m_linearVelocity.y;
_loc21_ = _loc10_.m_linearVelocity.x;
_loc20_ = _loc10_.m_linearVelocity.y;
_loc18_ = _loc9_.m_angularVelocity;
_loc19_ = _loc10_.m_angularVelocity;
_loc29_ = 0;
while(_loc29_ < _loc11_)
{
_loc16_ = _loc6_[_loc29_];
_loc5_ = _loc16_.normal.x;
_loc7_ = _loc16_.normal.y;
_loc23_ = m_constraints[_loc27_];
_loc23_.body1 = _loc9_;
_loc23_.body2 = _loc10_;
_loc23_.manifold = _loc16_;
_loc23_.normal.x = _loc5_;
_loc23_.normal.y = _loc7_;
_loc23_.pointCount = _loc16_.pointCount;
_loc23_.friction = _loc33_;
_loc23_.restitution = _loc37_;
_loc31_ = 0;
while(_loc31_ < _loc23_.pointCount)
{
_loc32_ = _loc16_.points[_loc31_];
_loc12_ = _loc23_.points[_loc31_];
_loc12_.normalImpulse = _loc32_.normalImpulse;
_loc12_.tangentImpulse = _loc32_.tangentImpulse;
_loc12_.separation = _loc32_.separation;
_loc12_.positionImpulse = 0;
_loc12_.localAnchor1.SetV(_loc32_.localPoint1);
_loc12_.localAnchor2.SetV(_loc32_.localPoint2);
_loc44_ = _loc9_.m_xf.R;
_loc43_ = _loc32_.localPoint1.x - _loc9_.m_sweep.localCenter.x;
_loc45_ = _loc32_.localPoint1.y - _loc9_.m_sweep.localCenter.y;
_loc24_ = _loc44_.col1.x * _loc43_ + _loc44_.col2.x * _loc45_;
_loc45_ = _loc44_.col1.y * _loc43_ + _loc44_.col2.y * _loc45_;
_loc43_ = _loc24_;
_loc12_.r1.Set(_loc43_,_loc45_);
_loc44_ = _loc10_.m_xf.R;
_loc17_ = _loc32_.localPoint2.x - _loc10_.m_sweep.localCenter.x;
_loc15_ = _loc32_.localPoint2.y - _loc10_.m_sweep.localCenter.y;
_loc24_ = _loc44_.col1.x * _loc17_ + _loc44_.col2.x * _loc15_;
_loc15_ = _loc44_.col1.y * _loc17_ + _loc44_.col2.y * _loc15_;
_loc17_ = _loc24_;
_loc12_.r2.Set(_loc17_,_loc15_);
_loc8_ = _loc43_ * _loc43_ + _loc45_ * _loc45_;
_loc30_ = _loc17_ * _loc17_ + _loc15_ * _loc15_;
_loc38_ = _loc43_ * _loc5_ + _loc45_ * _loc7_;
_loc41_ = _loc17_ * _loc5_ + _loc15_ * _loc7_;
_loc13_ = _loc9_.m_invMass + _loc10_.m_invMass;
_loc13_ = _loc13_ + (_loc9_.m_invI * (_loc8_ - _loc38_ * _loc38_) + _loc10_.m_invI * (_loc30_ - _loc41_ * _loc41_));
_loc12_.normalMass = 1 / _loc13_;
_loc36_ = _loc9_.m_mass * _loc9_.m_invMass + _loc10_.m_mass * _loc10_.m_invMass;
_loc36_ = _loc36_ + (_loc9_.m_mass * _loc9_.m_invI * (_loc8_ - _loc38_ * _loc38_) + _loc10_.m_mass * _loc10_.m_invI * (_loc30_ - _loc41_ * _loc41_));
_loc12_.equalizedMass = 1 / _loc36_;
_loc26_ = _loc7_;
_loc22_ = -_loc5_;
_loc34_ = _loc43_ * _loc26_ + _loc45_ * _loc22_;
_loc35_ = _loc17_ * _loc26_ + _loc15_ * _loc22_;
_loc42_ = _loc9_.m_invMass + _loc10_.m_invMass;
_loc42_ = _loc42_ + (_loc9_.m_invI * (_loc8_ - _loc34_ * _loc34_) + _loc10_.m_invI * (_loc30_ - _loc35_ * _loc35_));
_loc12_.tangentMass = 1 / _loc42_;
_loc12_.velocityBias = 0;
if(_loc12_.separation > 0)
{
_loc12_.velocityBias = -60 * _loc12_.separation;
}
_loc24_ = _loc21_ + -_loc19_ * _loc15_ - _loc46_ - -_loc18_ * _loc45_;
_loc25_ = _loc20_ + _loc19_ * _loc17_ - _loc47_ - _loc18_ * _loc43_;
_loc39_ = _loc23_.normal.x * _loc24_ + _loc23_.normal.y * _loc25_;
if(_loc39_ < -1)
{
_loc12_.velocityBias += -_loc23_.restitution * _loc39_;
}
_loc31_++;
}
_loc27_++;
_loc29_++;
}
_loc28_++;
}
}
public function InitVelocityConstraints(param1:b2TimeStep) : void
{
var _loc21_:* = null;
var _loc22_:* = null;
var _loc23_:* = null;
var _loc13_:int = 0;
var _loc8_:b2ContactConstraint = null;
var _loc18_:b2Body = null;
var _loc19_:b2Body = null;
var _loc9_:Number = NaN;
var _loc5_:Number = NaN;
var _loc6_:Number = NaN;
var _loc3_:Number = NaN;
var _loc4_:Number = NaN;
var _loc7_:Number = NaN;
var _loc11_:Number = NaN;
var _loc2_:Number = NaN;
var _loc10_:Number = NaN;
var _loc15_:int = 0;
var _loc17_:int = 0;
var _loc20_:b2ContactConstraintPoint = null;
var _loc12_:Number = NaN;
var _loc14_:Number = NaN;
var _loc16_:b2ContactConstraintPoint = null;
_loc13_ = 0;
while(_loc13_ < m_constraintCount)
{
_loc8_ = m_constraints[_loc13_];
_loc18_ = _loc8_.body1;
_loc19_ = _loc8_.body2;
_loc9_ = _loc18_.m_invMass;
_loc5_ = _loc18_.m_invI;
_loc6_ = _loc19_.m_invMass;
_loc3_ = _loc19_.m_invI;
_loc4_ = _loc8_.normal.x;
_loc11_ = _loc7_ = _loc8_.normal.y;
_loc2_ = -_loc4_;
if(param1.warmStarting)
{
_loc17_ = _loc8_.pointCount;
_loc15_ = 0;
while(_loc15_ < _loc17_)
{
_loc20_ = _loc8_.points[_loc15_];
_loc20_.normalImpulse = _loc20_.normalImpulse * param1.dtRatio;
_loc20_.tangentImpulse *= param1.dtRatio;
_loc12_ = _loc20_.normalImpulse * _loc4_ + _loc20_.tangentImpulse * _loc11_;
_loc14_ = _loc20_.normalImpulse * _loc7_ + _loc20_.tangentImpulse * _loc2_;
_loc18_.m_angularVelocity -= _loc5_ * (_loc20_.r1.x * _loc14_ - _loc20_.r1.y * _loc12_);
_loc18_.m_linearVelocity.x -= _loc9_ * _loc12_;
_loc18_.m_linearVelocity.y -= _loc9_ * _loc14_;
_loc19_.m_angularVelocity += _loc3_ * (_loc20_.r2.x * _loc14_ - _loc20_.r2.y * _loc12_);
_loc19_.m_linearVelocity.x += _loc6_ * _loc12_;
_loc19_.m_linearVelocity.y += _loc6_ * _loc14_;
_loc15_++;
}
}
else
{
_loc17_ = _loc8_.pointCount;
_loc15_ = 0;
while(_loc15_ < _loc17_)
{
_loc16_ = _loc8_.points[_loc15_];
_loc16_.normalImpulse = 0;
_loc16_.tangentImpulse = 0;
_loc15_++;
}
}
_loc13_++;
}
}
public function SolveVelocityConstraints() : void
{
var _loc24_:int = 0;
var _loc14_:b2ContactConstraintPoint = null;
var _loc30_:Number = NaN;
var _loc34_:Number = NaN;
var _loc16_:Number = NaN;
var _loc15_:Number = NaN;
var _loc8_:Number = NaN;
var _loc7_:Number = NaN;
var _loc31_:Number = NaN;
var _loc38_:Number = NaN;
var _loc32_:Number = NaN;
var _loc27_:Number = NaN;
var _loc35_:Number = NaN;
var _loc28_:Number = NaN;
var _loc9_:Number = NaN;
var _loc11_:Number = NaN;
var _loc33_:* = null;
var _loc29_:* = null;
var _loc23_:int = 0;
var _loc20_:b2ContactConstraint = null;
var _loc12_:b2Body = null;
var _loc13_:b2Body = null;
var _loc17_:Number = NaN;
var _loc18_:Number = NaN;
var _loc36_:b2Vec2 = null;
var _loc37_:b2Vec2 = null;
var _loc6_:Number = NaN;
var _loc3_:Number = NaN;
var _loc4_:Number = NaN;
var _loc1_:Number = NaN;
var _loc2_:Number = NaN;
var _loc5_:Number = NaN;
var _loc22_:Number = NaN;
var _loc19_:Number = NaN;
var _loc26_:Number = NaN;
var _loc21_:Number = NaN;
var _loc25_:int = 0;
var _loc10_:Number = NaN;
_loc23_ = 0;
while(_loc23_ < m_constraintCount)
{
_loc20_ = m_constraints[_loc23_];
_loc12_ = _loc20_.body1;
_loc13_ = _loc20_.body2;
_loc17_ = _loc12_.m_angularVelocity;
_loc18_ = _loc13_.m_angularVelocity;
_loc36_ = _loc12_.m_linearVelocity;
_loc37_ = _loc13_.m_linearVelocity;
_loc6_ = _loc12_.m_invMass;
_loc3_ = _loc12_.m_invI;
_loc4_ = _loc13_.m_invMass;
_loc1_ = _loc13_.m_invI;
_loc2_ = _loc20_.normal.x;
_loc22_ = _loc5_ = _loc20_.normal.y;
_loc19_ = -_loc2_;
_loc26_ = _loc20_.friction;
_loc25_ = _loc20_.pointCount;
_loc24_ = 0;
while(_loc24_ < _loc25_)
{
_loc14_ = _loc20_.points[_loc24_];
_loc8_ = _loc37_.x + -_loc18_ * _loc14_.r2.y - _loc36_.x - -_loc17_ * _loc14_.r1.y;
_loc7_ = _loc37_.y + _loc18_ * _loc14_.r2.x - _loc36_.y - _loc17_ * _loc14_.r1.x;
_loc31_ = _loc8_ * _loc2_ + _loc7_ * _loc5_;
_loc32_ = -_loc14_.normalMass * (_loc31_ - _loc14_.velocityBias);
_loc38_ = _loc8_ * _loc22_ + _loc7_ * _loc19_;
_loc27_ = _loc14_.tangentMass * -_loc38_;
_loc35_ = b2Math.b2Max(_loc14_.normalImpulse + _loc32_,0);
_loc32_ = _loc35_ - _loc14_.normalImpulse;
_loc10_ = _loc26_ * _loc14_.normalImpulse;
_loc28_ = b2Math.b2Clamp(_loc14_.tangentImpulse + _loc27_,-_loc10_,_loc10_);
_loc27_ = _loc28_ - _loc14_.tangentImpulse;
_loc9_ = _loc32_ * _loc2_ + _loc27_ * _loc22_;
_loc11_ = _loc32_ * _loc5_ + _loc27_ * _loc19_;
_loc36_.x -= _loc6_ * _loc9_;
_loc36_.y -= _loc6_ * _loc11_;
_loc17_ -= _loc3_ * (_loc14_.r1.x * _loc11_ - _loc14_.r1.y * _loc9_);
_loc37_.x += _loc4_ * _loc9_;
_loc37_.y += _loc4_ * _loc11_;
_loc18_ += _loc1_ * (_loc14_.r2.x * _loc11_ - _loc14_.r2.y * _loc9_);
_loc14_.normalImpulse = _loc35_;
_loc14_.tangentImpulse = _loc28_;
_loc24_++;
}
_loc12_.m_angularVelocity = _loc17_;
_loc13_.m_angularVelocity = _loc18_;
_loc23_++;
}
}
public function FinalizeVelocityConstraints() : void
{
var _loc2_:int = 0;
var _loc1_:b2ContactConstraint = null;
var _loc4_:b2Manifold = null;
var _loc3_:int = 0;
var _loc5_:b2ManifoldPoint = null;
var _loc6_:b2ContactConstraintPoint = null;
_loc2_ = 0;
while(_loc2_ < m_constraintCount)
{
_loc1_ = m_constraints[_loc2_];
_loc4_ = _loc1_.manifold;
_loc3_ = 0;
while(_loc3_ < _loc1_.pointCount)
{
_loc5_ = _loc4_.points[_loc3_];
_loc6_ = _loc1_.points[_loc3_];
_loc5_.normalImpulse = _loc6_.normalImpulse;
_loc5_.tangentImpulse = _loc6_.tangentImpulse;
_loc3_++;
}
_loc2_++;
}
}
public function SolvePositionConstraints(param1:Number) : Boolean
{
var _loc35_:b2Mat22 = null;
var _loc32_:b2Vec2 = null;
var _loc29_:int = 0;
var _loc24_:b2ContactConstraint = null;
var _loc12_:b2Body = null;
var _loc13_:b2Body = null;
var _loc23_:b2Vec2 = null;
var _loc21_:Number = NaN;
var _loc26_:b2Vec2 = null;
var _loc19_:Number = NaN;
var _loc7_:Number = NaN;
var _loc4_:Number = NaN;
var _loc5_:Number = NaN;
var _loc2_:Number = NaN;
var _loc3_:Number = NaN;
var _loc6_:Number = NaN;
var _loc31_:int = 0;
var _loc30_:int = 0;
var _loc14_:b2ContactConstraintPoint = null;
var _loc34_:Number = NaN;
var _loc37_:Number = NaN;
var _loc20_:Number = NaN;
var _loc18_:Number = NaN;
var _loc25_:Number = NaN;
var _loc33_:Number = NaN;
var _loc36_:Number = NaN;
var _loc17_:Number = NaN;
var _loc16_:Number = NaN;
var _loc11_:Number = NaN;
var _loc9_:Number = NaN;
var _loc15_:Number = NaN;
var _loc8_:Number = NaN;
var _loc10_:Number = NaN;
var _loc38_:Number = NaN;
var _loc27_:Number = NaN;
var _loc22_:Number = NaN;
var _loc28_:Number = 0;
_loc29_ = 0;
while(_loc29_ < m_constraintCount)
{
_loc24_ = m_constraints[_loc29_];
_loc12_ = _loc24_.body1;
_loc13_ = _loc24_.body2;
_loc23_ = _loc12_.m_sweep.c;
_loc21_ = _loc12_.m_sweep.a;
_loc26_ = _loc13_.m_sweep.c;
_loc19_ = _loc13_.m_sweep.a;
_loc7_ = _loc12_.m_mass * _loc12_.m_invMass;
_loc4_ = _loc12_.m_mass * _loc12_.m_invI;
_loc5_ = _loc13_.m_mass * _loc13_.m_invMass;
_loc2_ = _loc13_.m_mass * _loc13_.m_invI;
_loc3_ = _loc24_.normal.x;
_loc6_ = _loc24_.normal.y;
_loc31_ = _loc24_.pointCount;
_loc30_ = 0;
while(_loc30_ < _loc31_)
{
_loc14_ = _loc24_.points[_loc30_];
_loc35_ = _loc12_.m_xf.R;
_loc32_ = _loc12_.m_sweep.localCenter;
_loc34_ = _loc14_.localAnchor1.x - _loc32_.x;
_loc37_ = _loc14_.localAnchor1.y - _loc32_.y;
_loc25_ = _loc35_.col1.x * _loc34_ + _loc35_.col2.x * _loc37_;
_loc37_ = _loc35_.col1.y * _loc34_ + _loc35_.col2.y * _loc37_;
_loc34_ = _loc25_;
_loc35_ = _loc13_.m_xf.R;
_loc32_ = _loc13_.m_sweep.localCenter;
_loc20_ = _loc14_.localAnchor2.x - _loc32_.x;
_loc18_ = _loc14_.localAnchor2.y - _loc32_.y;
_loc25_ = _loc35_.col1.x * _loc20_ + _loc35_.col2.x * _loc18_;
_loc18_ = _loc35_.col1.y * _loc20_ + _loc35_.col2.y * _loc18_;
_loc20_ = _loc25_;
_loc33_ = _loc23_.x + _loc34_;
_loc36_ = _loc23_.y + _loc37_;
_loc17_ = _loc26_.x + _loc20_;
_loc16_ = _loc26_.y + _loc18_;
_loc11_ = _loc17_ - _loc33_;
_loc9_ = _loc16_ - _loc36_;
_loc15_ = _loc11_ * _loc3_ + _loc9_ * _loc6_ + _loc14_.separation;
_loc28_ = b2Math.b2Min(_loc28_,_loc15_);
_loc8_ = param1 * b2Math.b2Clamp(_loc15_ + 0.005,-0.2,0);
_loc10_ = -_loc14_.equalizedMass * _loc8_;
_loc38_ = _loc14_.positionImpulse;
_loc14_.positionImpulse = b2Math.b2Max(_loc38_ + _loc10_,0);
_loc10_ = _loc14_.positionImpulse - _loc38_;
_loc27_ = _loc10_ * _loc3_;
_loc22_ = _loc10_ * _loc6_;
_loc23_.x -= _loc7_ * _loc27_;
_loc23_.y -= _loc7_ * _loc22_;
_loc21_ -= _loc4_ * (_loc34_ * _loc22_ - _loc37_ * _loc27_);
_loc12_.m_sweep.a = _loc21_;
_loc12_.SynchronizeTransform();
_loc26_.x += _loc5_ * _loc27_;
_loc26_.y += _loc5_ * _loc22_;
_loc19_ += _loc2_ * (_loc20_ * _loc22_ - _loc18_ * _loc27_);
_loc13_.m_sweep.a = _loc19_;
_loc13_.SynchronizeTransform();
_loc30_++;
}
_loc29_++;
}
return _loc28_ >= -1.5 * 0.005;
}
}
}
@@ -0,0 +1,23 @@
package Box2D.Dynamics.Contacts
{
import Box2D.Dynamics.b2ContactListener;
public class b2NullContact extends b2Contact
{
public function b2NullContact()
{
super();
}
override public function Evaluate(param1:b2ContactListener) : void
{
}
override public function GetManifolds() : Array
{
return null;
}
}
}
@@ -0,0 +1,147 @@
package Box2D.Dynamics.Contacts
{
import Box2D.Collision.*;
import Box2D.Collision.Shapes.*;
import Box2D.Common.*;
import Box2D.Common.Math.*;
import Box2D.Dynamics.*;
public class b2PolyAndCircleContact extends b2Contact
{
private static const s_evalCP:b2ContactPoint = new b2ContactPoint();
private var m_manifolds:Array = [new b2Manifold()];
public var m_manifold:b2Manifold;
private var m0:b2Manifold = new b2Manifold();
public function b2PolyAndCircleContact(param1:b2Shape, param2:b2Shape)
{
super(param1,param2);
m_manifold = m_manifolds[0];
b2Settings.b2Assert(m_shape1.m_type == 1);
b2Settings.b2Assert(m_shape2.m_type == 0);
m_manifold.pointCount = 0;
var _loc3_:b2ManifoldPoint = m_manifold.points[0];
_loc3_.normalImpulse = 0;
_loc3_.tangentImpulse = 0;
}
public static function Create(param1:b2Shape, param2:b2Shape, param3:*) : b2Contact
{
return new b2PolyAndCircleContact(param1,param2);
}
public static function Destroy(param1:b2Contact, param2:*) : void
{
}
override public function Evaluate(param1:b2ContactListener) : void
{
var _loc3_:int = 0;
var _loc11_:b2Vec2 = null;
var _loc13_:b2Vec2 = null;
var _loc5_:b2ManifoldPoint = null;
var _loc2_:b2ManifoldPoint = null;
var _loc10_:Boolean = false;
var _loc9_:* = 0;
var _loc4_:int = 0;
var _loc7_:b2Body = m_shape1.m_body;
var _loc8_:b2Body = m_shape2.m_body;
m0.Set(m_manifold);
b2Collision.b2CollidePolygonAndCircle(m_manifold,m_shape1 as b2PolygonShape,_loc7_.m_xf,m_shape2 as b2CircleShape,_loc8_.m_xf);
var _loc12_:Array = [false,false];
var _loc6_:b2ContactPoint = s_evalCP;
_loc6_.shape1 = m_shape1;
_loc6_.shape2 = m_shape2;
_loc6_.friction = m_friction;
_loc6_.restitution = m_restitution;
if(m_manifold.pointCount > 0)
{
_loc3_ = 0;
while(_loc3_ < m_manifold.pointCount)
{
_loc2_ = m_manifold.points[_loc3_];
_loc2_.normalImpulse = 0;
_loc2_.tangentImpulse = 0;
_loc10_ = false;
_loc9_ = _loc2_.id._key;
_loc4_ = 0;
while(_loc4_ < m0.pointCount)
{
if(_loc12_[_loc4_] != true)
{
_loc5_ = m0.points[_loc4_];
if(_loc5_.id._key == _loc9_)
{
_loc12_[_loc4_] = true;
_loc2_.normalImpulse = _loc5_.normalImpulse;
_loc2_.tangentImpulse = _loc5_.tangentImpulse;
_loc10_ = true;
if(param1 != null)
{
_loc6_.position = _loc7_.GetWorldPoint(_loc2_.localPoint1);
_loc11_ = _loc7_.GetLinearVelocityFromLocalPoint(_loc2_.localPoint1);
_loc13_ = _loc8_.GetLinearVelocityFromLocalPoint(_loc2_.localPoint2);
_loc6_.velocity.Set(_loc13_.x - _loc11_.x,_loc13_.y - _loc11_.y);
_loc6_.normal.SetV(m_manifold.normal);
_loc6_.separation = _loc2_.separation;
_loc6_.id.key = _loc9_;
param1.Persist(_loc6_);
}
break;
}
}
_loc4_++;
}
if(_loc10_ == false && param1 != null)
{
_loc6_.position = _loc7_.GetWorldPoint(_loc2_.localPoint1);
_loc11_ = _loc7_.GetLinearVelocityFromLocalPoint(_loc2_.localPoint1);
_loc13_ = _loc8_.GetLinearVelocityFromLocalPoint(_loc2_.localPoint2);
_loc6_.velocity.Set(_loc13_.x - _loc11_.x,_loc13_.y - _loc11_.y);
_loc6_.normal.SetV(m_manifold.normal);
_loc6_.separation = _loc2_.separation;
_loc6_.id.key = _loc9_;
param1.Add(_loc6_);
}
_loc3_++;
}
m_manifoldCount = 1;
}
else
{
m_manifoldCount = 0;
}
if(param1 == null)
{
return;
}
_loc3_ = 0;
while(_loc3_ < m0.pointCount)
{
if(!_loc12_[_loc3_])
{
_loc5_ = m0.points[_loc3_];
_loc6_.position = _loc7_.GetWorldPoint(_loc5_.localPoint1);
_loc11_ = _loc7_.GetLinearVelocityFromLocalPoint(_loc5_.localPoint1);
_loc13_ = _loc8_.GetLinearVelocityFromLocalPoint(_loc5_.localPoint2);
_loc6_.velocity.Set(_loc13_.x - _loc11_.x,_loc13_.y - _loc11_.y);
_loc6_.normal.SetV(m0.normal);
_loc6_.separation = _loc5_.separation;
_loc6_.id.key = _loc5_.id._key;
param1.Remove(_loc6_);
}
_loc3_++;
}
}
override public function GetManifolds() : Array
{
return m_manifolds;
}
}
}
@@ -0,0 +1,143 @@
package Box2D.Dynamics.Contacts
{
import Box2D.Collision.*;
import Box2D.Collision.Shapes.*;
import Box2D.Common.*;
import Box2D.Common.Math.*;
import Box2D.Dynamics.*;
public class b2PolygonContact extends b2Contact
{
private static const s_evalCP:b2ContactPoint = new b2ContactPoint();
private var m0:b2Manifold = new b2Manifold();
private var m_manifolds:Array = [new b2Manifold()];
public var m_manifold:b2Manifold;
public function b2PolygonContact(param1:b2Shape, param2:b2Shape)
{
super(param1,param2);
m_manifold = m_manifolds[0];
m_manifold.pointCount = 0;
}
public static function Create(param1:b2Shape, param2:b2Shape, param3:*) : b2Contact
{
return new b2PolygonContact(param1,param2);
}
public static function Destroy(param1:b2Contact, param2:*) : void
{
}
override public function Evaluate(param1:b2ContactListener) : void
{
var _loc11_:b2Vec2 = null;
var _loc13_:b2Vec2 = null;
var _loc5_:b2ManifoldPoint = null;
var _loc6_:b2ContactPoint = null;
var _loc3_:int = 0;
var _loc2_:b2ManifoldPoint = null;
var _loc10_:Boolean = false;
var _loc9_:* = 0;
var _loc4_:int = 0;
var _loc7_:b2Body = m_shape1.m_body;
var _loc8_:b2Body = m_shape2.m_body;
m0.Set(m_manifold);
b2Collision.b2CollidePolygons(m_manifold,m_shape1 as b2PolygonShape,_loc7_.m_xf,m_shape2 as b2PolygonShape,_loc8_.m_xf);
var _loc12_:Array = [false,false];
_loc6_ = s_evalCP;
_loc6_.shape1 = m_shape1;
_loc6_.shape2 = m_shape2;
_loc6_.friction = m_friction;
_loc6_.restitution = m_restitution;
if(m_manifold.pointCount > 0)
{
_loc3_ = 0;
while(_loc3_ < m_manifold.pointCount)
{
_loc2_ = m_manifold.points[_loc3_];
_loc2_.normalImpulse = 0;
_loc2_.tangentImpulse = 0;
_loc10_ = false;
_loc9_ = _loc2_.id._key;
_loc4_ = 0;
while(_loc4_ < m0.pointCount)
{
if(_loc12_[_loc4_] != true)
{
_loc5_ = m0.points[_loc4_];
if(_loc5_.id._key == _loc9_)
{
_loc12_[_loc4_] = true;
_loc2_.normalImpulse = _loc5_.normalImpulse;
_loc2_.tangentImpulse = _loc5_.tangentImpulse;
_loc10_ = true;
if(param1 != null)
{
_loc6_.position = _loc7_.GetWorldPoint(_loc2_.localPoint1);
_loc11_ = _loc7_.GetLinearVelocityFromLocalPoint(_loc2_.localPoint1);
_loc13_ = _loc8_.GetLinearVelocityFromLocalPoint(_loc2_.localPoint2);
_loc6_.velocity.Set(_loc13_.x - _loc11_.x,_loc13_.y - _loc11_.y);
_loc6_.normal.SetV(m_manifold.normal);
_loc6_.separation = _loc2_.separation;
_loc6_.id.key = _loc9_;
param1.Persist(_loc6_);
}
break;
}
}
_loc4_++;
}
if(_loc10_ == false && param1 != null)
{
_loc6_.position = _loc7_.GetWorldPoint(_loc2_.localPoint1);
_loc11_ = _loc7_.GetLinearVelocityFromLocalPoint(_loc2_.localPoint1);
_loc13_ = _loc8_.GetLinearVelocityFromLocalPoint(_loc2_.localPoint2);
_loc6_.velocity.Set(_loc13_.x - _loc11_.x,_loc13_.y - _loc11_.y);
_loc6_.normal.SetV(m_manifold.normal);
_loc6_.separation = _loc2_.separation;
_loc6_.id.key = _loc9_;
param1.Add(_loc6_);
}
_loc3_++;
}
m_manifoldCount = 1;
}
else
{
m_manifoldCount = 0;
}
if(param1 == null)
{
return;
}
_loc3_ = 0;
while(_loc3_ < m0.pointCount)
{
if(!_loc12_[_loc3_])
{
_loc5_ = m0.points[_loc3_];
_loc6_.position = _loc7_.GetWorldPoint(_loc5_.localPoint1);
_loc11_ = _loc7_.GetLinearVelocityFromLocalPoint(_loc5_.localPoint1);
_loc13_ = _loc8_.GetLinearVelocityFromLocalPoint(_loc5_.localPoint2);
_loc6_.velocity.Set(_loc13_.x - _loc11_.x,_loc13_.y - _loc11_.y);
_loc6_.normal.SetV(m0.normal);
_loc6_.separation = _loc5_.separation;
_loc6_.id.key = _loc5_.id._key;
param1.Remove(_loc6_);
}
_loc3_++;
}
}
override public function GetManifolds() : Array
{
return m_manifolds;
}
}
}