supernets.org/worms/external/Box2dWeb-2.1.a.3.js

10869 lines
420 KiB
JavaScript

/*
* Copyright (c) 2006-2007 Erin Catto http://www.gphysics.com
*
* This software is provided 'as-is', without any express or implied
* warranty. In no event will the authors be held liable for any damages
* arising from the use of this software.
* Permission is granted to anyone to use this software for any purpose,
* including commercial applications, and to alter it and redistribute it
* freely, subject to the following restrictions:
* 1. The origin of this software must not be misrepresented; you must not
* claim that you wrote the original software. If you use this software
* in a product, an acknowledgment in the product documentation would be
* appreciated but is not required.
* 2. Altered source versions must be plainly marked as such, and must not be
* misrepresented as being the original software.
* 3. This notice may not be removed or altered from any source distribution.
*/
var Box2D = {};
(function (a2j, undefined) {
if(!(Object.prototype.defineProperty instanceof Function)
&& Object.prototype.__defineGetter__ instanceof Function
&& Object.prototype.__defineSetter__ instanceof Function)
{
Object.defineProperty = function(obj, p, cfg) {
if(cfg.get instanceof Function)
obj.__defineGetter__(p, cfg.get);
if(cfg.set instanceof Function)
obj.__defineSetter__(p, cfg.set);
}
}
function emptyFn() {};
a2j.inherit = function(cls, base) {
var tmpCtr = cls;
emptyFn.prototype = base.prototype;
cls.prototype = new emptyFn;
cls.prototype.constructor = tmpCtr;
};
a2j.generateCallback = function generateCallback(context, cb) {
return function () {
cb.apply(context, arguments);
};
};
a2j.NVector = function NVector(length) {
if (length === undefined) length = 0;
var tmp = new Array(length || 0);
for (var i = 0; i < length; ++i)
tmp[i] = 0;
return tmp;
};
a2j.is = function is(o1, o2) {
if (o1 === null) return false;
if ((o2 instanceof Function) && (o1 instanceof o2)) return true;
if ((o1.constructor.__implements != undefined) && (o1.constructor.__implements[o2])) return true;
return false;
};
a2j.parseUInt = function(v) {
return Math.abs(parseInt(v));
}
})(Box2D);
//#TODO remove assignments from global namespace
var Vector = Array;
var Vector_a2j_Number = Box2D.NVector;
//package structure
if (typeof(Box2D) === "undefined") Box2D = {};
if (typeof(Box2D.Collision) === "undefined") Box2D.Collision = {};
if (typeof(Box2D.Collision.Shapes) === "undefined") Box2D.Collision.Shapes = {};
if (typeof(Box2D.Common) === "undefined") Box2D.Common = {};
if (typeof(Box2D.Common.Math) === "undefined") Box2D.Common.Math = {};
if (typeof(Box2D.Dynamics) === "undefined") Box2D.Dynamics = {};
if (typeof(Box2D.Dynamics.Contacts) === "undefined") Box2D.Dynamics.Contacts = {};
if (typeof(Box2D.Dynamics.Controllers) === "undefined") Box2D.Dynamics.Controllers = {};
if (typeof(Box2D.Dynamics.Joints) === "undefined") Box2D.Dynamics.Joints = {};
//pre-definitions
(function () {
Box2D.Collision.IBroadPhase = 'Box2D.Collision.IBroadPhase';
function b2AABB() {
b2AABB.b2AABB.apply(this, arguments);
};
Box2D.Collision.b2AABB = b2AABB;
function b2Bound() {
b2Bound.b2Bound.apply(this, arguments);
};
Box2D.Collision.b2Bound = b2Bound;
function b2BoundValues() {
b2BoundValues.b2BoundValues.apply(this, arguments);
if (this.constructor === b2BoundValues) this.b2BoundValues.apply(this, arguments);
};
Box2D.Collision.b2BoundValues = b2BoundValues;
function b2Collision() {
b2Collision.b2Collision.apply(this, arguments);
};
Box2D.Collision.b2Collision = b2Collision;
function b2ContactID() {
b2ContactID.b2ContactID.apply(this, arguments);
if (this.constructor === b2ContactID) this.b2ContactID.apply(this, arguments);
};
Box2D.Collision.b2ContactID = b2ContactID;
function b2ContactPoint() {
b2ContactPoint.b2ContactPoint.apply(this, arguments);
};
Box2D.Collision.b2ContactPoint = b2ContactPoint;
function b2Distance() {
b2Distance.b2Distance.apply(this, arguments);
};
Box2D.Collision.b2Distance = b2Distance;
function b2DistanceInput() {
b2DistanceInput.b2DistanceInput.apply(this, arguments);
};
Box2D.Collision.b2DistanceInput = b2DistanceInput;
function b2DistanceOutput() {
b2DistanceOutput.b2DistanceOutput.apply(this, arguments);
};
Box2D.Collision.b2DistanceOutput = b2DistanceOutput;
function b2DistanceProxy() {
b2DistanceProxy.b2DistanceProxy.apply(this, arguments);
};
Box2D.Collision.b2DistanceProxy = b2DistanceProxy;
function b2DynamicTree() {
b2DynamicTree.b2DynamicTree.apply(this, arguments);
if (this.constructor === b2DynamicTree) this.b2DynamicTree.apply(this, arguments);
};
Box2D.Collision.b2DynamicTree = b2DynamicTree;
function b2DynamicTreeBroadPhase() {
b2DynamicTreeBroadPhase.b2DynamicTreeBroadPhase.apply(this, arguments);
};
Box2D.Collision.b2DynamicTreeBroadPhase = b2DynamicTreeBroadPhase;
function b2DynamicTreeNode() {
b2DynamicTreeNode.b2DynamicTreeNode.apply(this, arguments);
};
Box2D.Collision.b2DynamicTreeNode = b2DynamicTreeNode;
function b2DynamicTreePair() {
b2DynamicTreePair.b2DynamicTreePair.apply(this, arguments);
};
Box2D.Collision.b2DynamicTreePair = b2DynamicTreePair;
function b2Manifold() {
b2Manifold.b2Manifold.apply(this, arguments);
if (this.constructor === b2Manifold) this.b2Manifold.apply(this, arguments);
};
Box2D.Collision.b2Manifold = b2Manifold;
function b2ManifoldPoint() {
b2ManifoldPoint.b2ManifoldPoint.apply(this, arguments);
if (this.constructor === b2ManifoldPoint) this.b2ManifoldPoint.apply(this, arguments);
};
Box2D.Collision.b2ManifoldPoint = b2ManifoldPoint;
function b2Point() {
b2Point.b2Point.apply(this, arguments);
};
Box2D.Collision.b2Point = b2Point;
function b2RayCastInput() {
b2RayCastInput.b2RayCastInput.apply(this, arguments);
if (this.constructor === b2RayCastInput) this.b2RayCastInput.apply(this, arguments);
};
Box2D.Collision.b2RayCastInput = b2RayCastInput;
function b2RayCastOutput() {
b2RayCastOutput.b2RayCastOutput.apply(this, arguments);
};
Box2D.Collision.b2RayCastOutput = b2RayCastOutput;
function b2Segment() {
b2Segment.b2Segment.apply(this, arguments);
};
Box2D.Collision.b2Segment = b2Segment;
function b2SeparationFunction() {
b2SeparationFunction.b2SeparationFunction.apply(this, arguments);
};
Box2D.Collision.b2SeparationFunction = b2SeparationFunction;
function b2Simplex() {
b2Simplex.b2Simplex.apply(this, arguments);
if (this.constructor === b2Simplex) this.b2Simplex.apply(this, arguments);
};
Box2D.Collision.b2Simplex = b2Simplex;
function b2SimplexCache() {
b2SimplexCache.b2SimplexCache.apply(this, arguments);
};
Box2D.Collision.b2SimplexCache = b2SimplexCache;
function b2SimplexVertex() {
b2SimplexVertex.b2SimplexVertex.apply(this, arguments);
};
Box2D.Collision.b2SimplexVertex = b2SimplexVertex;
function b2TimeOfImpact() {
b2TimeOfImpact.b2TimeOfImpact.apply(this, arguments);
};
Box2D.Collision.b2TimeOfImpact = b2TimeOfImpact;
function b2TOIInput() {
b2TOIInput.b2TOIInput.apply(this, arguments);
};
Box2D.Collision.b2TOIInput = b2TOIInput;
function b2WorldManifold() {
b2WorldManifold.b2WorldManifold.apply(this, arguments);
if (this.constructor === b2WorldManifold) this.b2WorldManifold.apply(this, arguments);
};
Box2D.Collision.b2WorldManifold = b2WorldManifold;
function ClipVertex() {
ClipVertex.ClipVertex.apply(this, arguments);
};
Box2D.Collision.ClipVertex = ClipVertex;
function Features() {
Features.Features.apply(this, arguments);
};
Box2D.Collision.Features = Features;
function b2CircleShape() {
b2CircleShape.b2CircleShape.apply(this, arguments);
if (this.constructor === b2CircleShape) this.b2CircleShape.apply(this, arguments);
};
Box2D.Collision.Shapes.b2CircleShape = b2CircleShape;
function b2EdgeChainDef() {
b2EdgeChainDef.b2EdgeChainDef.apply(this, arguments);
if (this.constructor === b2EdgeChainDef) this.b2EdgeChainDef.apply(this, arguments);
};
Box2D.Collision.Shapes.b2EdgeChainDef = b2EdgeChainDef;
function b2EdgeShape() {
b2EdgeShape.b2EdgeShape.apply(this, arguments);
if (this.constructor === b2EdgeShape) this.b2EdgeShape.apply(this, arguments);
};
Box2D.Collision.Shapes.b2EdgeShape = b2EdgeShape;
function b2MassData() {
b2MassData.b2MassData.apply(this, arguments);
};
Box2D.Collision.Shapes.b2MassData = b2MassData;
function b2PolygonShape() {
b2PolygonShape.b2PolygonShape.apply(this, arguments);
if (this.constructor === b2PolygonShape) this.b2PolygonShape.apply(this, arguments);
};
Box2D.Collision.Shapes.b2PolygonShape = b2PolygonShape;
function b2Shape() {
b2Shape.b2Shape.apply(this, arguments);
if (this.constructor === b2Shape) this.b2Shape.apply(this, arguments);
};
Box2D.Collision.Shapes.b2Shape = b2Shape;
Box2D.Common.b2internal = 'Box2D.Common.b2internal';
function b2Color() {
b2Color.b2Color.apply(this, arguments);
if (this.constructor === b2Color) this.b2Color.apply(this, arguments);
};
Box2D.Common.b2Color = b2Color;
function b2Settings() {
b2Settings.b2Settings.apply(this, arguments);
};
Box2D.Common.b2Settings = b2Settings;
function b2Mat22() {
b2Mat22.b2Mat22.apply(this, arguments);
if (this.constructor === b2Mat22) this.b2Mat22.apply(this, arguments);
};
Box2D.Common.Math.b2Mat22 = b2Mat22;
function b2Mat33() {
b2Mat33.b2Mat33.apply(this, arguments);
if (this.constructor === b2Mat33) this.b2Mat33.apply(this, arguments);
};
Box2D.Common.Math.b2Mat33 = b2Mat33;
function b2Math() {
b2Math.b2Math.apply(this, arguments);
};
Box2D.Common.Math.b2Math = b2Math;
function b2Sweep() {
b2Sweep.b2Sweep.apply(this, arguments);
};
Box2D.Common.Math.b2Sweep = b2Sweep;
function b2Transform() {
b2Transform.b2Transform.apply(this, arguments);
if (this.constructor === b2Transform) this.b2Transform.apply(this, arguments);
};
Box2D.Common.Math.b2Transform = b2Transform;
function b2Vec2() {
b2Vec2.b2Vec2.apply(this, arguments);
if (this.constructor === b2Vec2) this.b2Vec2.apply(this, arguments);
};
Box2D.Common.Math.b2Vec2 = b2Vec2;
function b2Vec3() {
b2Vec3.b2Vec3.apply(this, arguments);
if (this.constructor === b2Vec3) this.b2Vec3.apply(this, arguments);
};
Box2D.Common.Math.b2Vec3 = b2Vec3;
function b2Body() {
b2Body.b2Body.apply(this, arguments);
if (this.constructor === b2Body) this.b2Body.apply(this, arguments);
};
Box2D.Dynamics.b2Body = b2Body;
function b2BodyDef() {
b2BodyDef.b2BodyDef.apply(this, arguments);
if (this.constructor === b2BodyDef) this.b2BodyDef.apply(this, arguments);
};
Box2D.Dynamics.b2BodyDef = b2BodyDef;
function b2ContactFilter() {
b2ContactFilter.b2ContactFilter.apply(this, arguments);
};
Box2D.Dynamics.b2ContactFilter = b2ContactFilter;
function b2ContactImpulse() {
b2ContactImpulse.b2ContactImpulse.apply(this, arguments);
};
Box2D.Dynamics.b2ContactImpulse = b2ContactImpulse;
function b2ContactListener() {
b2ContactListener.b2ContactListener.apply(this, arguments);
};
Box2D.Dynamics.b2ContactListener = b2ContactListener;
function b2ContactManager() {
b2ContactManager.b2ContactManager.apply(this, arguments);
if (this.constructor === b2ContactManager) this.b2ContactManager.apply(this, arguments);
};
Box2D.Dynamics.b2ContactManager = b2ContactManager;
function b2DebugDraw() {
b2DebugDraw.b2DebugDraw.apply(this, arguments);
if (this.constructor === b2DebugDraw) this.b2DebugDraw.apply(this, arguments);
};
Box2D.Dynamics.b2DebugDraw = b2DebugDraw;
function b2DestructionListener() {
b2DestructionListener.b2DestructionListener.apply(this, arguments);
};
Box2D.Dynamics.b2DestructionListener = b2DestructionListener;
function b2FilterData() {
b2FilterData.b2FilterData.apply(this, arguments);
};
Box2D.Dynamics.b2FilterData = b2FilterData;
function b2Fixture() {
b2Fixture.b2Fixture.apply(this, arguments);
if (this.constructor === b2Fixture) this.b2Fixture.apply(this, arguments);
};
Box2D.Dynamics.b2Fixture = b2Fixture;
function b2FixtureDef() {
b2FixtureDef.b2FixtureDef.apply(this, arguments);
if (this.constructor === b2FixtureDef) this.b2FixtureDef.apply(this, arguments);
};
Box2D.Dynamics.b2FixtureDef = b2FixtureDef;
function b2Island() {
b2Island.b2Island.apply(this, arguments);
if (this.constructor === b2Island) this.b2Island.apply(this, arguments);
};
Box2D.Dynamics.b2Island = b2Island;
function b2TimeStep() {
b2TimeStep.b2TimeStep.apply(this, arguments);
};
Box2D.Dynamics.b2TimeStep = b2TimeStep;
function b2World() {
b2World.b2World.apply(this, arguments);
if (this.constructor === b2World) this.b2World.apply(this, arguments);
};
Box2D.Dynamics.b2World = b2World;
function b2CircleContact() {
b2CircleContact.b2CircleContact.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2CircleContact = b2CircleContact;
function b2Contact() {
b2Contact.b2Contact.apply(this, arguments);
if (this.constructor === b2Contact) this.b2Contact.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2Contact = b2Contact;
function b2ContactConstraint() {
b2ContactConstraint.b2ContactConstraint.apply(this, arguments);
if (this.constructor === b2ContactConstraint) this.b2ContactConstraint.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2ContactConstraint = b2ContactConstraint;
function b2ContactConstraintPoint() {
b2ContactConstraintPoint.b2ContactConstraintPoint.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2ContactConstraintPoint = b2ContactConstraintPoint;
function b2ContactEdge() {
b2ContactEdge.b2ContactEdge.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2ContactEdge = b2ContactEdge;
function b2ContactFactory() {
b2ContactFactory.b2ContactFactory.apply(this, arguments);
if (this.constructor === b2ContactFactory) this.b2ContactFactory.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2ContactFactory = b2ContactFactory;
function b2ContactRegister() {
b2ContactRegister.b2ContactRegister.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2ContactRegister = b2ContactRegister;
function b2ContactResult() {
b2ContactResult.b2ContactResult.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2ContactResult = b2ContactResult;
function b2ContactSolver() {
b2ContactSolver.b2ContactSolver.apply(this, arguments);
if (this.constructor === b2ContactSolver) this.b2ContactSolver.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2ContactSolver = b2ContactSolver;
function b2EdgeAndCircleContact() {
b2EdgeAndCircleContact.b2EdgeAndCircleContact.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2EdgeAndCircleContact = b2EdgeAndCircleContact;
function b2NullContact() {
b2NullContact.b2NullContact.apply(this, arguments);
if (this.constructor === b2NullContact) this.b2NullContact.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2NullContact = b2NullContact;
function b2PolyAndCircleContact() {
b2PolyAndCircleContact.b2PolyAndCircleContact.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2PolyAndCircleContact = b2PolyAndCircleContact;
function b2PolyAndEdgeContact() {
b2PolyAndEdgeContact.b2PolyAndEdgeContact.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2PolyAndEdgeContact = b2PolyAndEdgeContact;
function b2PolygonContact() {
b2PolygonContact.b2PolygonContact.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2PolygonContact = b2PolygonContact;
function b2PositionSolverManifold() {
b2PositionSolverManifold.b2PositionSolverManifold.apply(this, arguments);
if (this.constructor === b2PositionSolverManifold) this.b2PositionSolverManifold.apply(this, arguments);
};
Box2D.Dynamics.Contacts.b2PositionSolverManifold = b2PositionSolverManifold;
function b2BuoyancyController() {
b2BuoyancyController.b2BuoyancyController.apply(this, arguments);
};
Box2D.Dynamics.Controllers.b2BuoyancyController = b2BuoyancyController;
function b2ConstantAccelController() {
b2ConstantAccelController.b2ConstantAccelController.apply(this, arguments);
};
Box2D.Dynamics.Controllers.b2ConstantAccelController = b2ConstantAccelController;
function b2ConstantForceController() {
b2ConstantForceController.b2ConstantForceController.apply(this, arguments);
};
Box2D.Dynamics.Controllers.b2ConstantForceController = b2ConstantForceController;
function b2Controller() {
b2Controller.b2Controller.apply(this, arguments);
};
Box2D.Dynamics.Controllers.b2Controller = b2Controller;
function b2ControllerEdge() {
b2ControllerEdge.b2ControllerEdge.apply(this, arguments);
};
Box2D.Dynamics.Controllers.b2ControllerEdge = b2ControllerEdge;
function b2GravityController() {
b2GravityController.b2GravityController.apply(this, arguments);
};
Box2D.Dynamics.Controllers.b2GravityController = b2GravityController;
function b2TensorDampingController() {
b2TensorDampingController.b2TensorDampingController.apply(this, arguments);
};
Box2D.Dynamics.Controllers.b2TensorDampingController = b2TensorDampingController;
function b2DistanceJoint() {
b2DistanceJoint.b2DistanceJoint.apply(this, arguments);
if (this.constructor === b2DistanceJoint) this.b2DistanceJoint.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2DistanceJoint = b2DistanceJoint;
function b2DistanceJointDef() {
b2DistanceJointDef.b2DistanceJointDef.apply(this, arguments);
if (this.constructor === b2DistanceJointDef) this.b2DistanceJointDef.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2DistanceJointDef = b2DistanceJointDef;
function b2FrictionJoint() {
b2FrictionJoint.b2FrictionJoint.apply(this, arguments);
if (this.constructor === b2FrictionJoint) this.b2FrictionJoint.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2FrictionJoint = b2FrictionJoint;
function b2FrictionJointDef() {
b2FrictionJointDef.b2FrictionJointDef.apply(this, arguments);
if (this.constructor === b2FrictionJointDef) this.b2FrictionJointDef.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2FrictionJointDef = b2FrictionJointDef;
function b2GearJoint() {
b2GearJoint.b2GearJoint.apply(this, arguments);
if (this.constructor === b2GearJoint) this.b2GearJoint.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2GearJoint = b2GearJoint;
function b2GearJointDef() {
b2GearJointDef.b2GearJointDef.apply(this, arguments);
if (this.constructor === b2GearJointDef) this.b2GearJointDef.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2GearJointDef = b2GearJointDef;
function b2Jacobian() {
b2Jacobian.b2Jacobian.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2Jacobian = b2Jacobian;
function b2Joint() {
b2Joint.b2Joint.apply(this, arguments);
if (this.constructor === b2Joint) this.b2Joint.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2Joint = b2Joint;
function b2JointDef() {
b2JointDef.b2JointDef.apply(this, arguments);
if (this.constructor === b2JointDef) this.b2JointDef.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2JointDef = b2JointDef;
function b2JointEdge() {
b2JointEdge.b2JointEdge.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2JointEdge = b2JointEdge;
function b2LineJoint() {
b2LineJoint.b2LineJoint.apply(this, arguments);
if (this.constructor === b2LineJoint) this.b2LineJoint.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2LineJoint = b2LineJoint;
function b2LineJointDef() {
b2LineJointDef.b2LineJointDef.apply(this, arguments);
if (this.constructor === b2LineJointDef) this.b2LineJointDef.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2LineJointDef = b2LineJointDef;
function b2MouseJoint() {
b2MouseJoint.b2MouseJoint.apply(this, arguments);
if (this.constructor === b2MouseJoint) this.b2MouseJoint.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2MouseJoint = b2MouseJoint;
function b2MouseJointDef() {
b2MouseJointDef.b2MouseJointDef.apply(this, arguments);
if (this.constructor === b2MouseJointDef) this.b2MouseJointDef.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2MouseJointDef = b2MouseJointDef;
function b2PrismaticJoint() {
b2PrismaticJoint.b2PrismaticJoint.apply(this, arguments);
if (this.constructor === b2PrismaticJoint) this.b2PrismaticJoint.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2PrismaticJoint = b2PrismaticJoint;
function b2PrismaticJointDef() {
b2PrismaticJointDef.b2PrismaticJointDef.apply(this, arguments);
if (this.constructor === b2PrismaticJointDef) this.b2PrismaticJointDef.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2PrismaticJointDef = b2PrismaticJointDef;
function b2PulleyJoint() {
b2PulleyJoint.b2PulleyJoint.apply(this, arguments);
if (this.constructor === b2PulleyJoint) this.b2PulleyJoint.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2PulleyJoint = b2PulleyJoint;
function b2PulleyJointDef() {
b2PulleyJointDef.b2PulleyJointDef.apply(this, arguments);
if (this.constructor === b2PulleyJointDef) this.b2PulleyJointDef.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2PulleyJointDef = b2PulleyJointDef;
function b2RevoluteJoint() {
b2RevoluteJoint.b2RevoluteJoint.apply(this, arguments);
if (this.constructor === b2RevoluteJoint) this.b2RevoluteJoint.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2RevoluteJoint = b2RevoluteJoint;
function b2RevoluteJointDef() {
b2RevoluteJointDef.b2RevoluteJointDef.apply(this, arguments);
if (this.constructor === b2RevoluteJointDef) this.b2RevoluteJointDef.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2RevoluteJointDef = b2RevoluteJointDef;
function b2WeldJoint() {
b2WeldJoint.b2WeldJoint.apply(this, arguments);
if (this.constructor === b2WeldJoint) this.b2WeldJoint.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2WeldJoint = b2WeldJoint;
function b2WeldJointDef() {
b2WeldJointDef.b2WeldJointDef.apply(this, arguments);
if (this.constructor === b2WeldJointDef) this.b2WeldJointDef.apply(this, arguments);
};
Box2D.Dynamics.Joints.b2WeldJointDef = b2WeldJointDef;
})(); //definitions
Box2D.postDefs = [];
(function () {
var b2CircleShape = Box2D.Collision.Shapes.b2CircleShape,
b2EdgeChainDef = Box2D.Collision.Shapes.b2EdgeChainDef,
b2EdgeShape = Box2D.Collision.Shapes.b2EdgeShape,
b2MassData = Box2D.Collision.Shapes.b2MassData,
b2PolygonShape = Box2D.Collision.Shapes.b2PolygonShape,
b2Shape = Box2D.Collision.Shapes.b2Shape,
b2Color = Box2D.Common.b2Color,
b2internal = Box2D.Common.b2internal,
b2Settings = Box2D.Common.b2Settings,
b2Mat22 = Box2D.Common.Math.b2Mat22,
b2Mat33 = Box2D.Common.Math.b2Mat33,
b2Math = Box2D.Common.Math.b2Math,
b2Sweep = Box2D.Common.Math.b2Sweep,
b2Transform = Box2D.Common.Math.b2Transform,
b2Vec2 = Box2D.Common.Math.b2Vec2,
b2Vec3 = Box2D.Common.Math.b2Vec3,
b2AABB = Box2D.Collision.b2AABB,
b2Bound = Box2D.Collision.b2Bound,
b2BoundValues = Box2D.Collision.b2BoundValues,
b2Collision = Box2D.Collision.b2Collision,
b2ContactID = Box2D.Collision.b2ContactID,
b2ContactPoint = Box2D.Collision.b2ContactPoint,
b2Distance = Box2D.Collision.b2Distance,
b2DistanceInput = Box2D.Collision.b2DistanceInput,
b2DistanceOutput = Box2D.Collision.b2DistanceOutput,
b2DistanceProxy = Box2D.Collision.b2DistanceProxy,
b2DynamicTree = Box2D.Collision.b2DynamicTree,
b2DynamicTreeBroadPhase = Box2D.Collision.b2DynamicTreeBroadPhase,
b2DynamicTreeNode = Box2D.Collision.b2DynamicTreeNode,
b2DynamicTreePair = Box2D.Collision.b2DynamicTreePair,
b2Manifold = Box2D.Collision.b2Manifold,
b2ManifoldPoint = Box2D.Collision.b2ManifoldPoint,
b2Point = Box2D.Collision.b2Point,
b2RayCastInput = Box2D.Collision.b2RayCastInput,
b2RayCastOutput = Box2D.Collision.b2RayCastOutput,
b2Segment = Box2D.Collision.b2Segment,
b2SeparationFunction = Box2D.Collision.b2SeparationFunction,
b2Simplex = Box2D.Collision.b2Simplex,
b2SimplexCache = Box2D.Collision.b2SimplexCache,
b2SimplexVertex = Box2D.Collision.b2SimplexVertex,
b2TimeOfImpact = Box2D.Collision.b2TimeOfImpact,
b2TOIInput = Box2D.Collision.b2TOIInput,
b2WorldManifold = Box2D.Collision.b2WorldManifold,
ClipVertex = Box2D.Collision.ClipVertex,
Features = Box2D.Collision.Features,
IBroadPhase = Box2D.Collision.IBroadPhase;
b2AABB.b2AABB = function () {
this.lowerBound = new b2Vec2();
this.upperBound = new b2Vec2();
};
b2AABB.prototype.IsValid = function () {
var dX = this.upperBound.x - this.lowerBound.x;
var dY = this.upperBound.y - this.lowerBound.y;
var valid = dX >= 0.0 && dY >= 0.0;
valid = valid && this.lowerBound.IsValid() && this.upperBound.IsValid();
return valid;
}
b2AABB.prototype.GetCenter = function () {
return new b2Vec2((this.lowerBound.x + this.upperBound.x) / 2, (this.lowerBound.y + this.upperBound.y) / 2);
}
b2AABB.prototype.GetExtents = function () {
return new b2Vec2((this.upperBound.x - this.lowerBound.x) / 2, (this.upperBound.y - this.lowerBound.y) / 2);
}
b2AABB.prototype.Contains = function (aabb) {
var result = true;
result = result && this.lowerBound.x <= aabb.lowerBound.x;
result = result && this.lowerBound.y <= aabb.lowerBound.y;
result = result && aabb.upperBound.x <= this.upperBound.x;
result = result && aabb.upperBound.y <= this.upperBound.y;
return result;
}
b2AABB.prototype.RayCast = function (output, input) {
var tmin = (-Number.MAX_VALUE);
var tmax = Number.MAX_VALUE;
var pX = input.p1.x;
var pY = input.p1.y;
var dX = input.p2.x - input.p1.x;
var dY = input.p2.y - input.p1.y;
var absDX = Math.abs(dX);
var absDY = Math.abs(dY);
var normal = output.normal;
var inv_d = 0;
var t1 = 0;
var t2 = 0;
var t3 = 0;
var s = 0; {
if (absDX < Number.MIN_VALUE) {
if (pX < this.lowerBound.x || this.upperBound.x < pX) return false;
}
else {
inv_d = 1.0 / dX;
t1 = (this.lowerBound.x - pX) * inv_d;
t2 = (this.upperBound.x - pX) * inv_d;
s = (-1.0);
if (t1 > t2) {
t3 = t1;
t1 = t2;
t2 = t3;
s = 1.0;
}
if (t1 > tmin) {
normal.x = s;
normal.y = 0;
tmin = t1;
}
tmax = Math.min(tmax, t2);
if (tmin > tmax) return false;
}
} {
if (absDY < Number.MIN_VALUE) {
if (pY < this.lowerBound.y || this.upperBound.y < pY) return false;
}
else {
inv_d = 1.0 / dY;
t1 = (this.lowerBound.y - pY) * inv_d;
t2 = (this.upperBound.y - pY) * inv_d;
s = (-1.0);
if (t1 > t2) {
t3 = t1;
t1 = t2;
t2 = t3;
s = 1.0;
}
if (t1 > tmin) {
normal.y = s;
normal.x = 0;
tmin = t1;
}
tmax = Math.min(tmax, t2);
if (tmin > tmax) return false;
}
}
output.fraction = tmin;
return true;
}
b2AABB.prototype.TestOverlap = function (other) {
var d1X = other.lowerBound.x - this.upperBound.x;
var d1Y = other.lowerBound.y - this.upperBound.y;
var d2X = this.lowerBound.x - other.upperBound.x;
var d2Y = this.lowerBound.y - other.upperBound.y;
if (d1X > 0.0 || d1Y > 0.0) return false;
if (d2X > 0.0 || d2Y > 0.0) return false;
return true;
}
b2AABB.Combine = function (aabb1, aabb2) {
var aabb = new b2AABB();
aabb.Combine(aabb1, aabb2);
return aabb;
}
b2AABB.prototype.Combine = function (aabb1, aabb2) {
this.lowerBound.x = Math.min(aabb1.lowerBound.x, aabb2.lowerBound.x);
this.lowerBound.y = Math.min(aabb1.lowerBound.y, aabb2.lowerBound.y);
this.upperBound.x = Math.max(aabb1.upperBound.x, aabb2.upperBound.x);
this.upperBound.y = Math.max(aabb1.upperBound.y, aabb2.upperBound.y);
}
b2Bound.b2Bound = function () {};
b2Bound.prototype.IsLower = function () {
return (this.value & 1) == 0;
}
b2Bound.prototype.IsUpper = function () {
return (this.value & 1) == 1;
}
b2Bound.prototype.Swap = function (b) {
var tempValue = this.value;
var tempProxy = this.proxy;
var tempStabbingCount = this.stabbingCount;
this.value = b.value;
this.proxy = b.proxy;
this.stabbingCount = b.stabbingCount;
b.value = tempValue;
b.proxy = tempProxy;
b.stabbingCount = tempStabbingCount;
}
b2BoundValues.b2BoundValues = function () {};
b2BoundValues.prototype.b2BoundValues = function () {
this.lowerValues = new Vector_a2j_Number();
this.lowerValues[0] = 0.0;
this.lowerValues[1] = 0.0;
this.upperValues = new Vector_a2j_Number();
this.upperValues[0] = 0.0;
this.upperValues[1] = 0.0;
}
b2Collision.b2Collision = function () {};
b2Collision.ClipSegmentToLine = function (vOut, vIn, normal, offset) {
if (offset === undefined) offset = 0;
var cv;
var numOut = 0;
cv = vIn[0];
var vIn0 = cv.v;
cv = vIn[1];
var vIn1 = cv.v;
var distance0 = normal.x * vIn0.x + normal.y * vIn0.y - offset;
var distance1 = normal.x * vIn1.x + normal.y * vIn1.y - offset;
if (distance0 <= 0.0) vOut[numOut++].Set(vIn[0]);
if (distance1 <= 0.0) vOut[numOut++].Set(vIn[1]);
if (distance0 * distance1 < 0.0) {
var interp = distance0 / (distance0 - distance1);
cv = vOut[numOut];
var tVec = cv.v;
tVec.x = vIn0.x + interp * (vIn1.x - vIn0.x);
tVec.y = vIn0.y + interp * (vIn1.y - vIn0.y);
cv = vOut[numOut];
var cv2;
if (distance0 > 0.0) {
cv2 = vIn[0];
cv.id = cv2.id;
}
else {
cv2 = vIn[1];
cv.id = cv2.id;
}++numOut;
}
return numOut;
}
b2Collision.EdgeSeparation = function (poly1, xf1, edge1, poly2, xf2) {
if (edge1 === undefined) edge1 = 0;
var count1 = parseInt(poly1.m_vertexCount);
var vertices1 = poly1.m_vertices;
var normals1 = poly1.m_normals;
var count2 = parseInt(poly2.m_vertexCount);
var vertices2 = poly2.m_vertices;
var tMat;
var tVec;
tMat = xf1.R;
tVec = normals1[edge1];
var normal1WorldX = (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var normal1WorldY = (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tMat = xf2.R;
var normal1X = (tMat.col1.x * normal1WorldX + tMat.col1.y * normal1WorldY);
var normal1Y = (tMat.col2.x * normal1WorldX + tMat.col2.y * normal1WorldY);
var index = 0;
var minDot = Number.MAX_VALUE;
for (var i = 0; i < count2; ++i) {
tVec = vertices2[i];
var dot = tVec.x * normal1X + tVec.y * normal1Y;
if (dot < minDot) {
minDot = dot;
index = i;
}
}
tVec = vertices1[edge1];
tMat = xf1.R;
var v1X = xf1.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var v1Y = xf1.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tVec = vertices2[index];
tMat = xf2.R;
var v2X = xf2.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var v2Y = xf2.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
v2X -= v1X;
v2Y -= v1Y;
var separation = v2X * normal1WorldX + v2Y * normal1WorldY;
return separation;
}
b2Collision.FindMaxSeparation = function (edgeIndex, poly1, xf1, poly2, xf2) {
var count1 = parseInt(poly1.m_vertexCount);
var normals1 = poly1.m_normals;
var tVec;
var tMat;
tMat = xf2.R;
tVec = poly2.m_centroid;
var dX = xf2.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var dY = xf2.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tMat = xf1.R;
tVec = poly1.m_centroid;
dX -= xf1.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
dY -= xf1.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
var dLocal1X = (dX * xf1.R.col1.x + dY * xf1.R.col1.y);
var dLocal1Y = (dX * xf1.R.col2.x + dY * xf1.R.col2.y);
var edge = 0;
var maxDot = (-Number.MAX_VALUE);
for (var i = 0; i < count1; ++i) {
tVec = normals1[i];
var dot = (tVec.x * dLocal1X + tVec.y * dLocal1Y);
if (dot > maxDot) {
maxDot = dot;
edge = i;
}
}
var s = b2Collision.EdgeSeparation(poly1, xf1, edge, poly2, xf2);
var prevEdge = parseInt(edge - 1 >= 0 ? edge - 1 : count1 - 1);
var sPrev = b2Collision.EdgeSeparation(poly1, xf1, prevEdge, poly2, xf2);
var nextEdge = parseInt(edge + 1 < count1 ? edge + 1 : 0);
var sNext = b2Collision.EdgeSeparation(poly1, xf1, nextEdge, poly2, xf2);
var bestEdge = 0;
var bestSeparation = 0;
var increment = 0;
if (sPrev > s && sPrev > sNext) {
increment = (-1);
bestEdge = prevEdge;
bestSeparation = sPrev;
}
else if (sNext > s) {
increment = 1;
bestEdge = nextEdge;
bestSeparation = sNext;
}
else {
edgeIndex[0] = edge;
return s;
}
while (true) {
if (increment == (-1)) edge = bestEdge - 1 >= 0 ? bestEdge - 1 : count1 - 1;
else edge = bestEdge + 1 < count1 ? bestEdge + 1 : 0;s = b2Collision.EdgeSeparation(poly1, xf1, edge, poly2, xf2);
if (s > bestSeparation) {
bestEdge = edge;
bestSeparation = s;
}
else {
break;
}
}
edgeIndex[0] = bestEdge;
return bestSeparation;
}
b2Collision.FindIncidentEdge = function (c, poly1, xf1, edge1, poly2, xf2) {
if (edge1 === undefined) edge1 = 0;
var count1 = parseInt(poly1.m_vertexCount);
var normals1 = poly1.m_normals;
var count2 = parseInt(poly2.m_vertexCount);
var vertices2 = poly2.m_vertices;
var normals2 = poly2.m_normals;
var tMat;
var tVec;
tMat = xf1.R;
tVec = normals1[edge1];
var normal1X = (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var normal1Y = (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tMat = xf2.R;
var tX = (tMat.col1.x * normal1X + tMat.col1.y * normal1Y);
normal1Y = (tMat.col2.x * normal1X + tMat.col2.y * normal1Y);
normal1X = tX;
var index = 0;
var minDot = Number.MAX_VALUE;
for (var i = 0; i < count2; ++i) {
tVec = normals2[i];
var dot = (normal1X * tVec.x + normal1Y * tVec.y);
if (dot < minDot) {
minDot = dot;
index = i;
}
}
var tClip;
var i1 = parseInt(index);
var i2 = parseInt(i1 + 1 < count2 ? i1 + 1 : 0);
tClip = c[0];
tVec = vertices2[i1];
tMat = xf2.R;
tClip.v.x = xf2.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
tClip.v.y = xf2.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tClip.id.features.referenceEdge = edge1;
tClip.id.features.incidentEdge = i1;
tClip.id.features.incidentVertex = 0;
tClip = c[1];
tVec = vertices2[i2];
tMat = xf2.R;
tClip.v.x = xf2.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
tClip.v.y = xf2.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tClip.id.features.referenceEdge = edge1;
tClip.id.features.incidentEdge = i2;
tClip.id.features.incidentVertex = 1;
}
b2Collision.MakeClipPointVector = function () {
var r = new Vector(2);
r[0] = new ClipVertex();
r[1] = new ClipVertex();
return r;
}
b2Collision.CollidePolygons = function (manifold, polyA, xfA, polyB, xfB) {
var cv;
manifold.m_pointCount = 0;
var totalRadius = polyA.m_radius + polyB.m_radius;
var edgeA = 0;
b2Collision.s_edgeAO[0] = edgeA;
var separationA = b2Collision.FindMaxSeparation(b2Collision.s_edgeAO, polyA, xfA, polyB, xfB);
edgeA = b2Collision.s_edgeAO[0];
if (separationA > totalRadius) return;
var edgeB = 0;
b2Collision.s_edgeBO[0] = edgeB;
var separationB = b2Collision.FindMaxSeparation(b2Collision.s_edgeBO, polyB, xfB, polyA, xfA);
edgeB = b2Collision.s_edgeBO[0];
if (separationB > totalRadius) return;
var poly1;
var poly2;
var xf1;
var xf2;
var edge1 = 0;
var flip = 0;
var k_relativeTol = 0.98;
var k_absoluteTol = 0.001;
var tMat;
if (separationB > k_relativeTol * separationA + k_absoluteTol) {
poly1 = polyB;
poly2 = polyA;
xf1 = xfB;
xf2 = xfA;
edge1 = edgeB;
manifold.m_type = b2Manifold.e_faceB;
flip = 1;
}
else {
poly1 = polyA;
poly2 = polyB;
xf1 = xfA;
xf2 = xfB;
edge1 = edgeA;
manifold.m_type = b2Manifold.e_faceA;
flip = 0;
}
var incidentEdge = b2Collision.s_incidentEdge;
b2Collision.FindIncidentEdge(incidentEdge, poly1, xf1, edge1, poly2, xf2);
var count1 = parseInt(poly1.m_vertexCount);
var vertices1 = poly1.m_vertices;
var local_v11 = vertices1[edge1];
var local_v12;
if (edge1 + 1 < count1) {
local_v12 = vertices1[parseInt(edge1 + 1)];
}
else {
local_v12 = vertices1[0];
}
var localTangent = b2Collision.s_localTangent;
localTangent.Set(local_v12.x - local_v11.x, local_v12.y - local_v11.y);
localTangent.Normalize();
var localNormal = b2Collision.s_localNormal;
localNormal.x = localTangent.y;
localNormal.y = (-localTangent.x);
var planePoint = b2Collision.s_planePoint;
planePoint.Set(0.5 * (local_v11.x + local_v12.x), 0.5 * (local_v11.y + local_v12.y));
var tangent = b2Collision.s_tangent;
tMat = xf1.R;
tangent.x = (tMat.col1.x * localTangent.x + tMat.col2.x * localTangent.y);
tangent.y = (tMat.col1.y * localTangent.x + tMat.col2.y * localTangent.y);
var tangent2 = b2Collision.s_tangent2;
tangent2.x = (-tangent.x);
tangent2.y = (-tangent.y);
var normal = b2Collision.s_normal;
normal.x = tangent.y;
normal.y = (-tangent.x);
var v11 = b2Collision.s_v11;
var v12 = b2Collision.s_v12;
v11.x = xf1.position.x + (tMat.col1.x * local_v11.x + tMat.col2.x * local_v11.y);
v11.y = xf1.position.y + (tMat.col1.y * local_v11.x + tMat.col2.y * local_v11.y);
v12.x = xf1.position.x + (tMat.col1.x * local_v12.x + tMat.col2.x * local_v12.y);
v12.y = xf1.position.y + (tMat.col1.y * local_v12.x + tMat.col2.y * local_v12.y);
var frontOffset = normal.x * v11.x + normal.y * v11.y;
var sideOffset1 = (-tangent.x * v11.x) - tangent.y * v11.y + totalRadius;
var sideOffset2 = tangent.x * v12.x + tangent.y * v12.y + totalRadius;
var clipPoints1 = b2Collision.s_clipPoints1;
var clipPoints2 = b2Collision.s_clipPoints2;
var np = 0;
np = b2Collision.ClipSegmentToLine(clipPoints1, incidentEdge, tangent2, sideOffset1);
if (np < 2) return;
np = b2Collision.ClipSegmentToLine(clipPoints2, clipPoints1, tangent, sideOffset2);
if (np < 2) return;
manifold.m_localPlaneNormal.SetV(localNormal);
manifold.m_localPoint.SetV(planePoint);
var pointCount = 0;
for (var i = 0; i < b2Settings.b2_maxManifoldPoints; ++i) {
cv = clipPoints2[i];
var separation = normal.x * cv.v.x + normal.y * cv.v.y - frontOffset;
if (separation <= totalRadius) {
var cp = manifold.m_points[pointCount];
tMat = xf2.R;
var tX = cv.v.x - xf2.position.x;
var tY = cv.v.y - xf2.position.y;
cp.m_localPoint.x = (tX * tMat.col1.x + tY * tMat.col1.y);
cp.m_localPoint.y = (tX * tMat.col2.x + tY * tMat.col2.y);
cp.m_id.Set(cv.id);
cp.m_id.features.flip = flip;
++pointCount;
}
}
manifold.m_pointCount = pointCount;
}
b2Collision.CollideCircles = function (manifold, circle1, xf1, circle2, xf2) {
manifold.m_pointCount = 0;
var tMat;
var tVec;
tMat = xf1.R;
tVec = circle1.m_p;
var p1X = xf1.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var p1Y = xf1.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tMat = xf2.R;
tVec = circle2.m_p;
var p2X = xf2.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var p2Y = xf2.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
var dX = p2X - p1X;
var dY = p2Y - p1Y;
var distSqr = dX * dX + dY * dY;
var radius = circle1.m_radius + circle2.m_radius;
if (distSqr > radius * radius) {
return;
}
manifold.m_type = b2Manifold.e_circles;
manifold.m_localPoint.SetV(circle1.m_p);
manifold.m_localPlaneNormal.SetZero();
manifold.m_pointCount = 1;
manifold.m_points[0].m_localPoint.SetV(circle2.m_p);
manifold.m_points[0].m_id.key = 0;
}
b2Collision.CollidePolygonAndCircle = function (manifold, polygon, xf1, circle, xf2) {
manifold.m_pointCount = 0;
var tPoint;
var dX = 0;
var dY = 0;
var positionX = 0;
var positionY = 0;
var tVec;
var tMat;
tMat = xf2.R;
tVec = circle.m_p;
var cX = xf2.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var cY = xf2.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
dX = cX - xf1.position.x;
dY = cY - xf1.position.y;
tMat = xf1.R;
var cLocalX = (dX * tMat.col1.x + dY * tMat.col1.y);
var cLocalY = (dX * tMat.col2.x + dY * tMat.col2.y);
var dist = 0;
var normalIndex = 0;
var separation = (-Number.MAX_VALUE);
var radius = polygon.m_radius + circle.m_radius;
var vertexCount = parseInt(polygon.m_vertexCount);
var vertices = polygon.m_vertices;
var normals = polygon.m_normals;
for (var i = 0; i < vertexCount; ++i) {
tVec = vertices[i];
dX = cLocalX - tVec.x;
dY = cLocalY - tVec.y;
tVec = normals[i];
var s = tVec.x * dX + tVec.y * dY;
if (s > radius) {
return;
}
if (s > separation) {
separation = s;
normalIndex = i;
}
}
var vertIndex1 = parseInt(normalIndex);
var vertIndex2 = parseInt(vertIndex1 + 1 < vertexCount ? vertIndex1 + 1 : 0);
var v1 = vertices[vertIndex1];
var v2 = vertices[vertIndex2];
if (separation < Number.MIN_VALUE) {
manifold.m_pointCount = 1;
manifold.m_type = b2Manifold.e_faceA;
manifold.m_localPlaneNormal.SetV(normals[normalIndex]);
manifold.m_localPoint.x = 0.5 * (v1.x + v2.x);
manifold.m_localPoint.y = 0.5 * (v1.y + v2.y);
manifold.m_points[0].m_localPoint.SetV(circle.m_p);
manifold.m_points[0].m_id.key = 0;
return;
}
var u1 = (cLocalX - v1.x) * (v2.x - v1.x) + (cLocalY - v1.y) * (v2.y - v1.y);
var u2 = (cLocalX - v2.x) * (v1.x - v2.x) + (cLocalY - v2.y) * (v1.y - v2.y);
if (u1 <= 0.0) {
if ((cLocalX - v1.x) * (cLocalX - v1.x) + (cLocalY - v1.y) * (cLocalY - v1.y) > radius * radius) return;
manifold.m_pointCount = 1;
manifold.m_type = b2Manifold.e_faceA;
manifold.m_localPlaneNormal.x = cLocalX - v1.x;
manifold.m_localPlaneNormal.y = cLocalY - v1.y;
manifold.m_localPlaneNormal.Normalize();
manifold.m_localPoint.SetV(v1);
manifold.m_points[0].m_localPoint.SetV(circle.m_p);
manifold.m_points[0].m_id.key = 0;
}
else if (u2 <= 0) {
if ((cLocalX - v2.x) * (cLocalX - v2.x) + (cLocalY - v2.y) * (cLocalY - v2.y) > radius * radius) return;
manifold.m_pointCount = 1;
manifold.m_type = b2Manifold.e_faceA;
manifold.m_localPlaneNormal.x = cLocalX - v2.x;
manifold.m_localPlaneNormal.y = cLocalY - v2.y;
manifold.m_localPlaneNormal.Normalize();
manifold.m_localPoint.SetV(v2);
manifold.m_points[0].m_localPoint.SetV(circle.m_p);
manifold.m_points[0].m_id.key = 0;
}
else {
var faceCenterX = 0.5 * (v1.x + v2.x);
var faceCenterY = 0.5 * (v1.y + v2.y);
separation = (cLocalX - faceCenterX) * normals[vertIndex1].x + (cLocalY - faceCenterY) * normals[vertIndex1].y;
if (separation > radius) return;
manifold.m_pointCount = 1;
manifold.m_type = b2Manifold.e_faceA;
manifold.m_localPlaneNormal.x = normals[vertIndex1].x;
manifold.m_localPlaneNormal.y = normals[vertIndex1].y;
manifold.m_localPlaneNormal.Normalize();
manifold.m_localPoint.Set(faceCenterX, faceCenterY);
manifold.m_points[0].m_localPoint.SetV(circle.m_p);
manifold.m_points[0].m_id.key = 0;
}
}
b2Collision.TestOverlap = function (a, b) {
var t1 = b.lowerBound;
var t2 = a.upperBound;
var d1X = t1.x - t2.x;
var d1Y = t1.y - t2.y;
t1 = a.lowerBound;
t2 = b.upperBound;
var d2X = t1.x - t2.x;
var d2Y = t1.y - t2.y;
if (d1X > 0.0 || d1Y > 0.0) return false;
if (d2X > 0.0 || d2Y > 0.0) return false;
return true;
}
Box2D.postDefs.push(function () {
Box2D.Collision.b2Collision.s_incidentEdge = b2Collision.MakeClipPointVector();
Box2D.Collision.b2Collision.s_clipPoints1 = b2Collision.MakeClipPointVector();
Box2D.Collision.b2Collision.s_clipPoints2 = b2Collision.MakeClipPointVector();
Box2D.Collision.b2Collision.s_edgeAO = new Vector_a2j_Number(1);
Box2D.Collision.b2Collision.s_edgeBO = new Vector_a2j_Number(1);
Box2D.Collision.b2Collision.s_localTangent = new b2Vec2();
Box2D.Collision.b2Collision.s_localNormal = new b2Vec2();
Box2D.Collision.b2Collision.s_planePoint = new b2Vec2();
Box2D.Collision.b2Collision.s_normal = new b2Vec2();
Box2D.Collision.b2Collision.s_tangent = new b2Vec2();
Box2D.Collision.b2Collision.s_tangent2 = new b2Vec2();
Box2D.Collision.b2Collision.s_v11 = new b2Vec2();
Box2D.Collision.b2Collision.s_v12 = new b2Vec2();
Box2D.Collision.b2Collision.b2CollidePolyTempVec = new b2Vec2();
Box2D.Collision.b2Collision.b2_nullFeature = 0x000000ff;
});
b2ContactID.b2ContactID = function () {
this.features = new Features();
};
b2ContactID.prototype.b2ContactID = function () {
this.features._m_id = this;
}
b2ContactID.prototype.Set = function (id) {
this.key = id._key;
}
b2ContactID.prototype.Copy = function () {
var id = new b2ContactID();
id.key = this.key;
return id;
}
Object.defineProperty(b2ContactID.prototype, 'key', {
enumerable: false,
configurable: true,
get: function () {
return this._key;
}
});
Object.defineProperty(b2ContactID.prototype, 'key', {
enumerable: false,
configurable: true,
set: function (value) {
if (value === undefined) value = 0;
this._key = value;
this.features._referenceEdge = this._key & 0x000000ff;
this.features._incidentEdge = ((this._key & 0x0000ff00) >> 8) & 0x000000ff;
this.features._incidentVertex = ((this._key & 0x00ff0000) >> 16) & 0x000000ff;
this.features._flip = ((this._key & 0xff000000) >> 24) & 0x000000ff;
}
});
b2ContactPoint.b2ContactPoint = function () {
this.position = new b2Vec2();
this.velocity = new b2Vec2();
this.normal = new b2Vec2();
this.id = new b2ContactID();
};
b2Distance.b2Distance = function () {};
b2Distance.Distance = function (output, cache, input) {
++b2Distance.b2_gjkCalls;
var proxyA = input.proxyA;
var proxyB = input.proxyB;
var transformA = input.transformA;
var transformB = input.transformB;
var simplex = b2Distance.s_simplex;
simplex.ReadCache(cache, proxyA, transformA, proxyB, transformB);
var vertices = simplex.m_vertices;
var k_maxIters = 20;
var saveA = b2Distance.s_saveA;
var saveB = b2Distance.s_saveB;
var saveCount = 0;
var closestPoint = simplex.GetClosestPoint();
var distanceSqr1 = closestPoint.LengthSquared();
var distanceSqr2 = distanceSqr1;
var i = 0;
var p;
var iter = 0;
while (iter < k_maxIters) {
saveCount = simplex.m_count;
for (i = 0;
i < saveCount; i++) {
saveA[i] = vertices[i].indexA;
saveB[i] = vertices[i].indexB;
}
switch (simplex.m_count) {
case 1:
break;
case 2:
simplex.Solve2();
break;
case 3:
simplex.Solve3();
break;
default:
b2Settings.b2Assert(false);
}
if (simplex.m_count == 3) {
break;
}
p = simplex.GetClosestPoint();
distanceSqr2 = p.LengthSquared();
if (distanceSqr2 > distanceSqr1) {}
distanceSqr1 = distanceSqr2;
var d = simplex.GetSearchDirection();
if (d.LengthSquared() < Number.MIN_VALUE * Number.MIN_VALUE) {
break;
}
var vertex = vertices[simplex.m_count];
vertex.indexA = proxyA.GetSupport(b2Math.MulTMV(transformA.R, d.GetNegative()));
vertex.wA = b2Math.MulX(transformA, proxyA.GetVertex(vertex.indexA));
vertex.indexB = proxyB.GetSupport(b2Math.MulTMV(transformB.R, d));
vertex.wB = b2Math.MulX(transformB, proxyB.GetVertex(vertex.indexB));
vertex.w = b2Math.SubtractVV(vertex.wB, vertex.wA);
++iter;
++b2Distance.b2_gjkIters;
var duplicate = false;
for (i = 0;
i < saveCount; i++) {
if (vertex.indexA == saveA[i] && vertex.indexB == saveB[i]) {
duplicate = true;
break;
}
}
if (duplicate) {
break;
}++simplex.m_count;
}
b2Distance.b2_gjkMaxIters = b2Math.Max(b2Distance.b2_gjkMaxIters, iter);
simplex.GetWitnessPoints(output.pointA, output.pointB);
output.distance = b2Math.SubtractVV(output.pointA, output.pointB).Length();
output.iterations = iter;
simplex.WriteCache(cache);
if (input.useRadii) {
var rA = proxyA.m_radius;
var rB = proxyB.m_radius;
if (output.distance > rA + rB && output.distance > Number.MIN_VALUE) {
output.distance -= rA + rB;
var normal = b2Math.SubtractVV(output.pointB, output.pointA);
normal.Normalize();
output.pointA.x += rA * normal.x;
output.pointA.y += rA * normal.y;
output.pointB.x -= rB * normal.x;
output.pointB.y -= rB * normal.y;
}
else {
p = new b2Vec2();
p.x = .5 * (output.pointA.x + output.pointB.x);
p.y = .5 * (output.pointA.y + output.pointB.y);
output.pointA.x = output.pointB.x = p.x;
output.pointA.y = output.pointB.y = p.y;
output.distance = 0.0;
}
}
}
Box2D.postDefs.push(function () {
Box2D.Collision.b2Distance.s_simplex = new b2Simplex();
Box2D.Collision.b2Distance.s_saveA = new Vector_a2j_Number(3);
Box2D.Collision.b2Distance.s_saveB = new Vector_a2j_Number(3);
});
b2DistanceInput.b2DistanceInput = function () {};
b2DistanceOutput.b2DistanceOutput = function () {
this.pointA = new b2Vec2();
this.pointB = new b2Vec2();
};
b2DistanceProxy.b2DistanceProxy = function () {};
b2DistanceProxy.prototype.Set = function (shape) {
switch (shape.GetType()) {
case b2Shape.e_circleShape:
{
var circle = (shape instanceof b2CircleShape ? shape : null);
this.m_vertices = new Vector(1, true);
this.m_vertices[0] = circle.m_p;
this.m_count = 1;
this.m_radius = circle.m_radius;
}
break;
case b2Shape.e_polygonShape:
{
var polygon = (shape instanceof b2PolygonShape ? shape : null);
this.m_vertices = polygon.m_vertices;
this.m_count = polygon.m_vertexCount;
this.m_radius = polygon.m_radius;
}
break;
default:
b2Settings.b2Assert(false);
}
}
b2DistanceProxy.prototype.GetSupport = function (d) {
var bestIndex = 0;
var bestValue = this.m_vertices[0].x * d.x + this.m_vertices[0].y * d.y;
for (var i = 1; i < this.m_count; ++i) {
var value = this.m_vertices[i].x * d.x + this.m_vertices[i].y * d.y;
if (value > bestValue) {
bestIndex = i;
bestValue = value;
}
}
return bestIndex;
}
b2DistanceProxy.prototype.GetSupportVertex = function (d) {
var bestIndex = 0;
var bestValue = this.m_vertices[0].x * d.x + this.m_vertices[0].y * d.y;
for (var i = 1; i < this.m_count; ++i) {
var value = this.m_vertices[i].x * d.x + this.m_vertices[i].y * d.y;
if (value > bestValue) {
bestIndex = i;
bestValue = value;
}
}
return this.m_vertices[bestIndex];
}
b2DistanceProxy.prototype.GetVertexCount = function () {
return this.m_count;
}
b2DistanceProxy.prototype.GetVertex = function (index) {
if (index === undefined) index = 0;
b2Settings.b2Assert(0 <= index && index < this.m_count);
return this.m_vertices[index];
}
b2DynamicTree.b2DynamicTree = function () {};
b2DynamicTree.prototype.b2DynamicTree = function () {
this.m_root = null;
this.m_freeList = null;
this.m_path = 0;
this.m_insertionCount = 0;
}
b2DynamicTree.prototype.CreateProxy = function (aabb, userData) {
var node = this.AllocateNode();
var extendX = b2Settings.b2_aabbExtension;
var extendY = b2Settings.b2_aabbExtension;
node.aabb.lowerBound.x = aabb.lowerBound.x - extendX;
node.aabb.lowerBound.y = aabb.lowerBound.y - extendY;
node.aabb.upperBound.x = aabb.upperBound.x + extendX;
node.aabb.upperBound.y = aabb.upperBound.y + extendY;
node.userData = userData;
this.InsertLeaf(node);
return node;
}
b2DynamicTree.prototype.DestroyProxy = function (proxy) {
this.RemoveLeaf(proxy);
this.FreeNode(proxy);
}
b2DynamicTree.prototype.MoveProxy = function (proxy, aabb, displacement) {
b2Settings.b2Assert(proxy.IsLeaf());
if (proxy.aabb.Contains(aabb)) {
return false;
}
this.RemoveLeaf(proxy);
var extendX = b2Settings.b2_aabbExtension + b2Settings.b2_aabbMultiplier * (displacement.x > 0 ? displacement.x : (-displacement.x));
var extendY = b2Settings.b2_aabbExtension + b2Settings.b2_aabbMultiplier * (displacement.y > 0 ? displacement.y : (-displacement.y));
proxy.aabb.lowerBound.x = aabb.lowerBound.x - extendX;
proxy.aabb.lowerBound.y = aabb.lowerBound.y - extendY;
proxy.aabb.upperBound.x = aabb.upperBound.x + extendX;
proxy.aabb.upperBound.y = aabb.upperBound.y + extendY;
this.InsertLeaf(proxy);
return true;
}
b2DynamicTree.prototype.Rebalance = function (iterations) {
if (iterations === undefined) iterations = 0;
if (this.m_root == null) return;
for (var i = 0; i < iterations; i++) {
var node = this.m_root;
var bit = 0;
while (node.IsLeaf() == false) {
node = (this.m_path >> bit) & 1 ? node.child2 : node.child1;
bit = (bit + 1) & 31;
}++this.m_path;
this.RemoveLeaf(node);
this.InsertLeaf(node);
}
}
b2DynamicTree.prototype.GetFatAABB = function (proxy) {
return proxy.aabb;
}
b2DynamicTree.prototype.GetUserData = function (proxy) {
return proxy.userData;
}
b2DynamicTree.prototype.Query = function (callback, aabb) {
if (this.m_root == null) return;
var stack = new Vector();
var count = 0;
stack[count++] = this.m_root;
while (count > 0) {
var node = stack[--count];
if (node.aabb.TestOverlap(aabb)) {
if (node.IsLeaf()) {
var proceed = callback(node);
if (!proceed) return;
}
else {
stack[count++] = node.child1;
stack[count++] = node.child2;
}
}
}
}
b2DynamicTree.prototype.RayCast = function (callback, input) {
if (this.m_root == null) return;
var p1 = input.p1;
var p2 = input.p2;
var r = b2Math.SubtractVV(p1, p2);
r.Normalize();
var v = b2Math.CrossFV(1.0, r);
var abs_v = b2Math.AbsV(v);
var maxFraction = input.maxFraction;
var segmentAABB = new b2AABB();
var tX = 0;
var tY = 0; {
tX = p1.x + maxFraction * (p2.x - p1.x);
tY = p1.y + maxFraction * (p2.y - p1.y);
segmentAABB.lowerBound.x = Math.min(p1.x, tX);
segmentAABB.lowerBound.y = Math.min(p1.y, tY);
segmentAABB.upperBound.x = Math.max(p1.x, tX);
segmentAABB.upperBound.y = Math.max(p1.y, tY);
}
var stack = new Vector();
var count = 0;
stack[count++] = this.m_root;
while (count > 0) {
var node = stack[--count];
if (node.aabb.TestOverlap(segmentAABB) == false) {
continue;
}
var c = node.aabb.GetCenter();
var h = node.aabb.GetExtents();
var separation = Math.abs(v.x * (p1.x - c.x) + v.y * (p1.y - c.y)) - abs_v.x * h.x - abs_v.y * h.y;
if (separation > 0.0) continue;
if (node.IsLeaf()) {
var subInput = new b2RayCastInput();
subInput.p1 = input.p1;
subInput.p2 = input.p2;
subInput.maxFraction = input.maxFraction;
maxFraction = callback(subInput, node);
if (maxFraction == 0.0) return;
if (maxFraction > 0.0) {
tX = p1.x + maxFraction * (p2.x - p1.x);
tY = p1.y + maxFraction * (p2.y - p1.y);
segmentAABB.lowerBound.x = Math.min(p1.x, tX);
segmentAABB.lowerBound.y = Math.min(p1.y, tY);
segmentAABB.upperBound.x = Math.max(p1.x, tX);
segmentAABB.upperBound.y = Math.max(p1.y, tY);
}
}
else {
stack[count++] = node.child1;
stack[count++] = node.child2;
}
}
}
b2DynamicTree.prototype.AllocateNode = function () {
if (this.m_freeList) {
var node = this.m_freeList;
this.m_freeList = node.parent;
node.parent = null;
node.child1 = null;
node.child2 = null;
return node;
}
return new b2DynamicTreeNode();
}
b2DynamicTree.prototype.FreeNode = function (node) {
node.parent = this.m_freeList;
this.m_freeList = node;
}
b2DynamicTree.prototype.InsertLeaf = function (leaf) {
++this.m_insertionCount;
if (this.m_root == null) {
this.m_root = leaf;
this.m_root.parent = null;
return;
}
var center = leaf.aabb.GetCenter();
var sibling = this.m_root;
if (sibling.IsLeaf() == false) {
do {
var child1 = sibling.child1;
var child2 = sibling.child2;
var norm1 = Math.abs((child1.aabb.lowerBound.x + child1.aabb.upperBound.x) / 2 - center.x) + Math.abs((child1.aabb.lowerBound.y + child1.aabb.upperBound.y) / 2 - center.y);
var norm2 = Math.abs((child2.aabb.lowerBound.x + child2.aabb.upperBound.x) / 2 - center.x) + Math.abs((child2.aabb.lowerBound.y + child2.aabb.upperBound.y) / 2 - center.y);
if (norm1 < norm2) {
sibling = child1;
}
else {
sibling = child2;
}
}
while (sibling.IsLeaf() == false)
}
var node1 = sibling.parent;
var node2 = this.AllocateNode();
node2.parent = node1;
node2.userData = null;
node2.aabb.Combine(leaf.aabb, sibling.aabb);
if (node1) {
if (sibling.parent.child1 == sibling) {
node1.child1 = node2;
}
else {
node1.child2 = node2;
}
node2.child1 = sibling;
node2.child2 = leaf;
sibling.parent = node2;
leaf.parent = node2;
do {
if (node1.aabb.Contains(node2.aabb)) break;
node1.aabb.Combine(node1.child1.aabb, node1.child2.aabb);
node2 = node1;
node1 = node1.parent;
}
while (node1)
}
else {
node2.child1 = sibling;
node2.child2 = leaf;
sibling.parent = node2;
leaf.parent = node2;
this.m_root = node2;
}
}
b2DynamicTree.prototype.RemoveLeaf = function (leaf) {
if (leaf == this.m_root) {
this.m_root = null;
return;
}
var node2 = leaf.parent;
var node1 = node2.parent;
var sibling;
if (node2.child1 == leaf) {
sibling = node2.child2;
}
else {
sibling = node2.child1;
}
if (node1) {
if (node1.child1 == node2) {
node1.child1 = sibling;
}
else {
node1.child2 = sibling;
}
sibling.parent = node1;
this.FreeNode(node2);
while (node1) {
var oldAABB = node1.aabb;
node1.aabb = b2AABB.Combine(node1.child1.aabb, node1.child2.aabb);
if (oldAABB.Contains(node1.aabb)) break;
node1 = node1.parent;
}
}
else {
this.m_root = sibling;
sibling.parent = null;
this.FreeNode(node2);
}
}
b2DynamicTreeBroadPhase.b2DynamicTreeBroadPhase = function () {
this.m_tree = new b2DynamicTree();
this.m_moveBuffer = new Vector();
this.m_pairBuffer = new Vector();
this.m_pairCount = 0;
};
b2DynamicTreeBroadPhase.prototype.CreateProxy = function (aabb, userData) {
var proxy = this.m_tree.CreateProxy(aabb, userData);
++this.m_proxyCount;
this.BufferMove(proxy);
return proxy;
}
b2DynamicTreeBroadPhase.prototype.DestroyProxy = function (proxy) {
this.UnBufferMove(proxy);
--this.m_proxyCount;
this.m_tree.DestroyProxy(proxy);
}
b2DynamicTreeBroadPhase.prototype.MoveProxy = function (proxy, aabb, displacement) {
var buffer = this.m_tree.MoveProxy(proxy, aabb, displacement);
if (buffer) {
this.BufferMove(proxy);
}
}
b2DynamicTreeBroadPhase.prototype.TestOverlap = function (proxyA, proxyB) {
var aabbA = this.m_tree.GetFatAABB(proxyA);
var aabbB = this.m_tree.GetFatAABB(proxyB);
return aabbA.TestOverlap(aabbB);
}
b2DynamicTreeBroadPhase.prototype.GetUserData = function (proxy) {
return this.m_tree.GetUserData(proxy);
}
b2DynamicTreeBroadPhase.prototype.GetFatAABB = function (proxy) {
return this.m_tree.GetFatAABB(proxy);
}
b2DynamicTreeBroadPhase.prototype.GetProxyCount = function () {
return this.m_proxyCount;
}
b2DynamicTreeBroadPhase.prototype.UpdatePairs = function (callback) {
var __this = this;
__this.m_pairCount = 0;
var i = 0,
queryProxy;
for (i = 0;
i < __this.m_moveBuffer.length; ++i) {
queryProxy = __this.m_moveBuffer[i];
function QueryCallback(proxy) {
if (proxy == queryProxy) return true;
if (__this.m_pairCount == __this.m_pairBuffer.length) {
__this.m_pairBuffer[__this.m_pairCount] = new b2DynamicTreePair();
}
var pair = __this.m_pairBuffer[__this.m_pairCount];
pair.proxyA = proxy < queryProxy ? proxy : queryProxy;
pair.proxyB = proxy >= queryProxy ? proxy : queryProxy;++__this.m_pairCount;
return true;
};
var fatAABB = __this.m_tree.GetFatAABB(queryProxy);
__this.m_tree.Query(QueryCallback, fatAABB);
}
__this.m_moveBuffer.length = 0;
for (var i = 0; i < __this.m_pairCount;) {
var primaryPair = __this.m_pairBuffer[i];
var userDataA = __this.m_tree.GetUserData(primaryPair.proxyA);
var userDataB = __this.m_tree.GetUserData(primaryPair.proxyB);
callback(userDataA, userDataB);
++i;
while (i < __this.m_pairCount) {
var pair = __this.m_pairBuffer[i];
if (pair.proxyA != primaryPair.proxyA || pair.proxyB != primaryPair.proxyB) {
break;
}++i;
}
}
}
b2DynamicTreeBroadPhase.prototype.Query = function (callback, aabb) {
this.m_tree.Query(callback, aabb);
}
b2DynamicTreeBroadPhase.prototype.RayCast = function (callback, input) {
this.m_tree.RayCast(callback, input);
}
b2DynamicTreeBroadPhase.prototype.Validate = function () {}
b2DynamicTreeBroadPhase.prototype.Rebalance = function (iterations) {
if (iterations === undefined) iterations = 0;
this.m_tree.Rebalance(iterations);
}
b2DynamicTreeBroadPhase.prototype.BufferMove = function (proxy) {
this.m_moveBuffer[this.m_moveBuffer.length] = proxy;
}
b2DynamicTreeBroadPhase.prototype.UnBufferMove = function (proxy) {
var i = parseInt(this.m_moveBuffer.indexOf(proxy));
this.m_moveBuffer.splice(i, 1);
}
b2DynamicTreeBroadPhase.prototype.ComparePairs = function (pair1, pair2) {
return 0;
}
b2DynamicTreeBroadPhase.__implements = {};
b2DynamicTreeBroadPhase.__implements[IBroadPhase] = true;
b2DynamicTreeNode.b2DynamicTreeNode = function () {
this.aabb = new b2AABB();
};
b2DynamicTreeNode.prototype.IsLeaf = function () {
return this.child1 == null;
}
b2DynamicTreePair.b2DynamicTreePair = function () {};
b2Manifold.b2Manifold = function () {
this.m_pointCount = 0;
};
b2Manifold.prototype.b2Manifold = function () {
this.m_points = new Vector(b2Settings.b2_maxManifoldPoints);
for (var i = 0; i < b2Settings.b2_maxManifoldPoints; i++) {
this.m_points[i] = new b2ManifoldPoint();
}
this.m_localPlaneNormal = new b2Vec2();
this.m_localPoint = new b2Vec2();
}
b2Manifold.prototype.Reset = function () {
for (var i = 0; i < b2Settings.b2_maxManifoldPoints; i++) {
((this.m_points[i] instanceof b2ManifoldPoint ? this.m_points[i] : null)).Reset();
}
this.m_localPlaneNormal.SetZero();
this.m_localPoint.SetZero();
this.m_type = 0;
this.m_pointCount = 0;
}
b2Manifold.prototype.Set = function (m) {
this.m_pointCount = m.m_pointCount;
for (var i = 0; i < b2Settings.b2_maxManifoldPoints; i++) {
((this.m_points[i] instanceof b2ManifoldPoint ? this.m_points[i] : null)).Set(m.m_points[i]);
}
this.m_localPlaneNormal.SetV(m.m_localPlaneNormal);
this.m_localPoint.SetV(m.m_localPoint);
this.m_type = m.m_type;
}
b2Manifold.prototype.Copy = function () {
var copy = new b2Manifold();
copy.Set(this);
return copy;
}
Box2D.postDefs.push(function () {
Box2D.Collision.b2Manifold.e_circles = 0x0001;
Box2D.Collision.b2Manifold.e_faceA = 0x0002;
Box2D.Collision.b2Manifold.e_faceB = 0x0004;
});
b2ManifoldPoint.b2ManifoldPoint = function () {
this.m_localPoint = new b2Vec2();
this.m_id = new b2ContactID();
};
b2ManifoldPoint.prototype.b2ManifoldPoint = function () {
this.Reset();
}
b2ManifoldPoint.prototype.Reset = function () {
this.m_localPoint.SetZero();
this.m_normalImpulse = 0.0;
this.m_tangentImpulse = 0.0;
this.m_id.key = 0;
}
b2ManifoldPoint.prototype.Set = function (m) {
this.m_localPoint.SetV(m.m_localPoint);
this.m_normalImpulse = m.m_normalImpulse;
this.m_tangentImpulse = m.m_tangentImpulse;
this.m_id.Set(m.m_id);
}
b2Point.b2Point = function () {
this.p = new b2Vec2();
};
b2Point.prototype.Support = function (xf, vX, vY) {
if (vX === undefined) vX = 0;
if (vY === undefined) vY = 0;
return this.p;
}
b2Point.prototype.GetFirstVertex = function (xf) {
return this.p;
}
b2RayCastInput.b2RayCastInput = function () {
this.p1 = new b2Vec2();
this.p2 = new b2Vec2();
};
b2RayCastInput.prototype.b2RayCastInput = function (p1, p2, maxFraction) {
if (p1 === undefined) p1 = null;
if (p2 === undefined) p2 = null;
if (maxFraction === undefined) maxFraction = 1;
if (p1) this.p1.SetV(p1);
if (p2) this.p2.SetV(p2);
this.maxFraction = maxFraction;
}
b2RayCastOutput.b2RayCastOutput = function () {
this.normal = new b2Vec2();
};
b2Segment.b2Segment = function () {
this.p1 = new b2Vec2();
this.p2 = new b2Vec2();
};
b2Segment.prototype.TestSegment = function (lambda, normal, segment, maxLambda) {
if (maxLambda === undefined) maxLambda = 0;
var s = segment.p1;
var rX = segment.p2.x - s.x;
var rY = segment.p2.y - s.y;
var dX = this.p2.x - this.p1.x;
var dY = this.p2.y - this.p1.y;
var nX = dY;
var nY = (-dX);
var k_slop = 100.0 * Number.MIN_VALUE;
var denom = (-(rX * nX + rY * nY));
if (denom > k_slop) {
var bX = s.x - this.p1.x;
var bY = s.y - this.p1.y;
var a = (bX * nX + bY * nY);
if (0.0 <= a && a <= maxLambda * denom) {
var mu2 = (-rX * bY) + rY * bX;
if ((-k_slop * denom) <= mu2 && mu2 <= denom * (1.0 + k_slop)) {
a /= denom;
var nLen = Math.sqrt(nX * nX + nY * nY);
nX /= nLen;
nY /= nLen;
lambda[0] = a;
normal.Set(nX, nY);
return true;
}
}
}
return false;
}
b2Segment.prototype.Extend = function (aabb) {
this.ExtendForward(aabb);
this.ExtendBackward(aabb);
}
b2Segment.prototype.ExtendForward = function (aabb) {
var dX = this.p2.x - this.p1.x;
var dY = this.p2.y - this.p1.y;
var lambda = Math.min(dX > 0 ? (aabb.upperBound.x - this.p1.x) / dX : dX < 0 ? (aabb.lowerBound.x - this.p1.x) / dX : Number.POSITIVE_INFINITY,
dY > 0 ? (aabb.upperBound.y - this.p1.y) / dY : dY < 0 ? (aabb.lowerBound.y - this.p1.y) / dY : Number.POSITIVE_INFINITY);
this.p2.x = this.p1.x + dX * lambda;
this.p2.y = this.p1.y + dY * lambda;
}
b2Segment.prototype.ExtendBackward = function (aabb) {
var dX = (-this.p2.x) + this.p1.x;
var dY = (-this.p2.y) + this.p1.y;
var lambda = Math.min(dX > 0 ? (aabb.upperBound.x - this.p2.x) / dX : dX < 0 ? (aabb.lowerBound.x - this.p2.x) / dX : Number.POSITIVE_INFINITY,
dY > 0 ? (aabb.upperBound.y - this.p2.y) / dY : dY < 0 ? (aabb.lowerBound.y - this.p2.y) / dY : Number.POSITIVE_INFINITY);
this.p1.x = this.p2.x + dX * lambda;
this.p1.y = this.p2.y + dY * lambda;
}
b2SeparationFunction.b2SeparationFunction = function () {
this.m_localPoint = new b2Vec2();
this.m_axis = new b2Vec2();
};
b2SeparationFunction.prototype.Initialize = function (cache, proxyA, transformA, proxyB, transformB) {
this.m_proxyA = proxyA;
this.m_proxyB = proxyB;
var count = parseInt(cache.count);
b2Settings.b2Assert(0 < count && count < 3);
var localPointA;
var localPointA1;
var localPointA2;
var localPointB;
var localPointB1;
var localPointB2;
var pointAX = 0;
var pointAY = 0;
var pointBX = 0;
var pointBY = 0;
var normalX = 0;
var normalY = 0;
var tMat;
var tVec;
var s = 0;
var sgn = 0;
if (count == 1) {
this.m_type = b2SeparationFunction.e_points;
localPointA = this.m_proxyA.GetVertex(cache.indexA[0]);
localPointB = this.m_proxyB.GetVertex(cache.indexB[0]);
tVec = localPointA;
tMat = transformA.R;
pointAX = transformA.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
pointAY = transformA.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tVec = localPointB;
tMat = transformB.R;
pointBX = transformB.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
pointBY = transformB.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
this.m_axis.x = pointBX - pointAX;
this.m_axis.y = pointBY - pointAY;
this.m_axis.Normalize();
}
else if (cache.indexB[0] == cache.indexB[1]) {
this.m_type = b2SeparationFunction.e_faceA;
localPointA1 = this.m_proxyA.GetVertex(cache.indexA[0]);
localPointA2 = this.m_proxyA.GetVertex(cache.indexA[1]);
localPointB = this.m_proxyB.GetVertex(cache.indexB[0]);
this.m_localPoint.x = 0.5 * (localPointA1.x + localPointA2.x);
this.m_localPoint.y = 0.5 * (localPointA1.y + localPointA2.y);
this.m_axis = b2Math.CrossVF(b2Math.SubtractVV(localPointA2, localPointA1), 1.0);
this.m_axis.Normalize();
tVec = this.m_axis;
tMat = transformA.R;
normalX = tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
normalY = tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tVec = this.m_localPoint;
tMat = transformA.R;
pointAX = transformA.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
pointAY = transformA.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tVec = localPointB;
tMat = transformB.R;
pointBX = transformB.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
pointBY = transformB.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
s = (pointBX - pointAX) * normalX + (pointBY - pointAY) * normalY;
if (s < 0.0) {
this.m_axis.NegativeSelf();
}
}
else if (cache.indexA[0] == cache.indexA[0]) {
this.m_type = b2SeparationFunction.e_faceB;
localPointB1 = this.m_proxyB.GetVertex(cache.indexB[0]);
localPointB2 = this.m_proxyB.GetVertex(cache.indexB[1]);
localPointA = this.m_proxyA.GetVertex(cache.indexA[0]);
this.m_localPoint.x = 0.5 * (localPointB1.x + localPointB2.x);
this.m_localPoint.y = 0.5 * (localPointB1.y + localPointB2.y);
this.m_axis = b2Math.CrossVF(b2Math.SubtractVV(localPointB2, localPointB1), 1.0);
this.m_axis.Normalize();
tVec = this.m_axis;
tMat = transformB.R;
normalX = tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
normalY = tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tVec = this.m_localPoint;
tMat = transformB.R;
pointBX = transformB.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
pointBY = transformB.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tVec = localPointA;
tMat = transformA.R;
pointAX = transformA.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
pointAY = transformA.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
s = (pointAX - pointBX) * normalX + (pointAY - pointBY) * normalY;
if (s < 0.0) {
this.m_axis.NegativeSelf();
}
}
else {
localPointA1 = this.m_proxyA.GetVertex(cache.indexA[0]);
localPointA2 = this.m_proxyA.GetVertex(cache.indexA[1]);
localPointB1 = this.m_proxyB.GetVertex(cache.indexB[0]);
localPointB2 = this.m_proxyB.GetVertex(cache.indexB[1]);
var pA = b2Math.MulX(transformA, localPointA);
var dA = b2Math.MulMV(transformA.R, b2Math.SubtractVV(localPointA2, localPointA1));
var pB = b2Math.MulX(transformB, localPointB);
var dB = b2Math.MulMV(transformB.R, b2Math.SubtractVV(localPointB2, localPointB1));
var a = dA.x * dA.x + dA.y * dA.y;
var e = dB.x * dB.x + dB.y * dB.y;
var r = b2Math.SubtractVV(dB, dA);
var c = dA.x * r.x + dA.y * r.y;
var f = dB.x * r.x + dB.y * r.y;
var b = dA.x * dB.x + dA.y * dB.y;
var denom = a * e - b * b;
s = 0.0;
if (denom != 0.0) {
s = b2Math.Clamp((b * f - c * e) / denom, 0.0, 1.0);
}
var t = (b * s + f) / e;
if (t < 0.0) {
t = 0.0;
s = b2Math.Clamp((b - c) / a, 0.0, 1.0);
}
localPointA = new b2Vec2();
localPointA.x = localPointA1.x + s * (localPointA2.x - localPointA1.x);
localPointA.y = localPointA1.y + s * (localPointA2.y - localPointA1.y);
localPointB = new b2Vec2();
localPointB.x = localPointB1.x + s * (localPointB2.x - localPointB1.x);
localPointB.y = localPointB1.y + s * (localPointB2.y - localPointB1.y);
if (s == 0.0 || s == 1.0) {
this.m_type = b2SeparationFunction.e_faceB;
this.m_axis = b2Math.CrossVF(b2Math.SubtractVV(localPointB2, localPointB1), 1.0);
this.m_axis.Normalize();
this.m_localPoint = localPointB;
tVec = this.m_axis;
tMat = transformB.R;
normalX = tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
normalY = tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tVec = this.m_localPoint;
tMat = transformB.R;
pointBX = transformB.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
pointBY = transformB.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tVec = localPointA;
tMat = transformA.R;
pointAX = transformA.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
pointAY = transformA.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
sgn = (pointAX - pointBX) * normalX + (pointAY - pointBY) * normalY;
if (s < 0.0) {
this.m_axis.NegativeSelf();
}
}
else {
this.m_type = b2SeparationFunction.e_faceA;
this.m_axis = b2Math.CrossVF(b2Math.SubtractVV(localPointA2, localPointA1), 1.0);
this.m_localPoint = localPointA;
tVec = this.m_axis;
tMat = transformA.R;
normalX = tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
normalY = tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tVec = this.m_localPoint;
tMat = transformA.R;
pointAX = transformA.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
pointAY = transformA.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tVec = localPointB;
tMat = transformB.R;
pointBX = transformB.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
pointBY = transformB.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
sgn = (pointBX - pointAX) * normalX + (pointBY - pointAY) * normalY;
if (s < 0.0) {
this.m_axis.NegativeSelf();
}
}
}
}
b2SeparationFunction.prototype.Evaluate = function (transformA, transformB) {
var axisA;
var axisB;
var localPointA;
var localPointB;
var pointA;
var pointB;
var seperation = 0;
var normal;
switch (this.m_type) {
case b2SeparationFunction.e_points:
{
axisA = b2Math.MulTMV(transformA.R, this.m_axis);
axisB = b2Math.MulTMV(transformB.R, this.m_axis.GetNegative());
localPointA = this.m_proxyA.GetSupportVertex(axisA);
localPointB = this.m_proxyB.GetSupportVertex(axisB);
pointA = b2Math.MulX(transformA, localPointA);
pointB = b2Math.MulX(transformB, localPointB);
seperation = (pointB.x - pointA.x) * this.m_axis.x + (pointB.y - pointA.y) * this.m_axis.y;
return seperation;
}
case b2SeparationFunction.e_faceA:
{
normal = b2Math.MulMV(transformA.R, this.m_axis);
pointA = b2Math.MulX(transformA, this.m_localPoint);
axisB = b2Math.MulTMV(transformB.R, normal.GetNegative());
localPointB = this.m_proxyB.GetSupportVertex(axisB);
pointB = b2Math.MulX(transformB, localPointB);
seperation = (pointB.x - pointA.x) * normal.x + (pointB.y - pointA.y) * normal.y;
return seperation;
}
case b2SeparationFunction.e_faceB:
{
normal = b2Math.MulMV(transformB.R, this.m_axis);
pointB = b2Math.MulX(transformB, this.m_localPoint);
axisA = b2Math.MulTMV(transformA.R, normal.GetNegative());
localPointA = this.m_proxyA.GetSupportVertex(axisA);
pointA = b2Math.MulX(transformA, localPointA);
seperation = (pointA.x - pointB.x) * normal.x + (pointA.y - pointB.y) * normal.y;
return seperation;
}
default:
b2Settings.b2Assert(false);
return 0.0;
}
}
Box2D.postDefs.push(function () {
Box2D.Collision.b2SeparationFunction.e_points = 0x01;
Box2D.Collision.b2SeparationFunction.e_faceA = 0x02;
Box2D.Collision.b2SeparationFunction.e_faceB = 0x04;
});
b2Simplex.b2Simplex = function () {
this.m_v1 = new b2SimplexVertex();
this.m_v2 = new b2SimplexVertex();
this.m_v3 = new b2SimplexVertex();
this.m_vertices = new Vector(3);
};
b2Simplex.prototype.b2Simplex = function () {
this.m_vertices[0] = this.m_v1;
this.m_vertices[1] = this.m_v2;
this.m_vertices[2] = this.m_v3;
}
b2Simplex.prototype.ReadCache = function (cache, proxyA, transformA, proxyB, transformB) {
b2Settings.b2Assert(0 <= cache.count && cache.count <= 3);
var wALocal;
var wBLocal;
this.m_count = cache.count;
var vertices = this.m_vertices;
for (var i = 0; i < this.m_count; i++) {
var v = vertices[i];
v.indexA = cache.indexA[i];
v.indexB = cache.indexB[i];
wALocal = proxyA.GetVertex(v.indexA);
wBLocal = proxyB.GetVertex(v.indexB);
v.wA = b2Math.MulX(transformA, wALocal);
v.wB = b2Math.MulX(transformB, wBLocal);
v.w = b2Math.SubtractVV(v.wB, v.wA);
v.a = 0;
}
if (this.m_count > 1) {
var metric1 = cache.metric;
var metric2 = this.GetMetric();
if (metric2 < .5 * metric1 || 2.0 * metric1 < metric2 || metric2 < Number.MIN_VALUE) {
this.m_count = 0;
}
}
if (this.m_count == 0) {
v = vertices[0];
v.indexA = 0;
v.indexB = 0;
wALocal = proxyA.GetVertex(0);
wBLocal = proxyB.GetVertex(0);
v.wA = b2Math.MulX(transformA, wALocal);
v.wB = b2Math.MulX(transformB, wBLocal);
v.w = b2Math.SubtractVV(v.wB, v.wA);
this.m_count = 1;
}
}
b2Simplex.prototype.WriteCache = function (cache) {
cache.metric = this.GetMetric();
cache.count = Box2D.parseUInt(this.m_count);
var vertices = this.m_vertices;
for (var i = 0; i < this.m_count; i++) {
cache.indexA[i] = Box2D.parseUInt(vertices[i].indexA);
cache.indexB[i] = Box2D.parseUInt(vertices[i].indexB);
}
}
b2Simplex.prototype.GetSearchDirection = function () {
switch (this.m_count) {
case 1:
return this.m_v1.w.GetNegative();
case 2:
{
var e12 = b2Math.SubtractVV(this.m_v2.w, this.m_v1.w);
var sgn = b2Math.CrossVV(e12, this.m_v1.w.GetNegative());
if (sgn > 0.0) {
return b2Math.CrossFV(1.0, e12);
}
else {
return b2Math.CrossVF(e12, 1.0);
}
}
default:
b2Settings.b2Assert(false);
return new b2Vec2();
}
}
b2Simplex.prototype.GetClosestPoint = function () {
switch (this.m_count) {
case 0:
b2Settings.b2Assert(false);
return new b2Vec2();
case 1:
return this.m_v1.w;
case 2:
return new b2Vec2(this.m_v1.a * this.m_v1.w.x + this.m_v2.a * this.m_v2.w.x, this.m_v1.a * this.m_v1.w.y + this.m_v2.a * this.m_v2.w.y);
default:
b2Settings.b2Assert(false);
return new b2Vec2();
}
}
b2Simplex.prototype.GetWitnessPoints = function (pA, pB) {
switch (this.m_count) {
case 0:
b2Settings.b2Assert(false);
break;
case 1:
pA.SetV(this.m_v1.wA);
pB.SetV(this.m_v1.wB);
break;
case 2:
pA.x = this.m_v1.a * this.m_v1.wA.x + this.m_v2.a * this.m_v2.wA.x;
pA.y = this.m_v1.a * this.m_v1.wA.y + this.m_v2.a * this.m_v2.wA.y;
pB.x = this.m_v1.a * this.m_v1.wB.x + this.m_v2.a * this.m_v2.wB.x;
pB.y = this.m_v1.a * this.m_v1.wB.y + this.m_v2.a * this.m_v2.wB.y;
break;
case 3:
pB.x = pA.x = this.m_v1.a * this.m_v1.wA.x + this.m_v2.a * this.m_v2.wA.x + this.m_v3.a * this.m_v3.wA.x;
pB.y = pA.y = this.m_v1.a * this.m_v1.wA.y + this.m_v2.a * this.m_v2.wA.y + this.m_v3.a * this.m_v3.wA.y;
break;
default:
b2Settings.b2Assert(false);
break;
}
}
b2Simplex.prototype.GetMetric = function () {
switch (this.m_count) {
case 0:
b2Settings.b2Assert(false);
return 0.0;
case 1:
return 0.0;
case 2:
return b2Math.SubtractVV(this.m_v1.w, this.m_v2.w).Length();
case 3:
return b2Math.CrossVV(b2Math.SubtractVV(this.m_v2.w, this.m_v1.w), b2Math.SubtractVV(this.m_v3.w, this.m_v1.w));
default:
b2Settings.b2Assert(false);
return 0.0;
}
}
b2Simplex.prototype.Solve2 = function () {
var w1 = this.m_v1.w;
var w2 = this.m_v2.w;
var e12 = b2Math.SubtractVV(w2, w1);
var d12_2 = (-(w1.x * e12.x + w1.y * e12.y));
if (d12_2 <= 0.0) {
this.m_v1.a = 1.0;
this.m_count = 1;
return;
}
var d12_1 = (w2.x * e12.x + w2.y * e12.y);
if (d12_1 <= 0.0) {
this.m_v2.a = 1.0;
this.m_count = 1;
this.m_v1.Set(this.m_v2);
return;
}
var inv_d12 = 1.0 / (d12_1 + d12_2);
this.m_v1.a = d12_1 * inv_d12;
this.m_v2.a = d12_2 * inv_d12;
this.m_count = 2;
}
b2Simplex.prototype.Solve3 = function () {
var w1 = this.m_v1.w;
var w2 = this.m_v2.w;
var w3 = this.m_v3.w;
var e12 = b2Math.SubtractVV(w2, w1);
var w1e12 = b2Math.Dot(w1, e12);
var w2e12 = b2Math.Dot(w2, e12);
var d12_1 = w2e12;
var d12_2 = (-w1e12);
var e13 = b2Math.SubtractVV(w3, w1);
var w1e13 = b2Math.Dot(w1, e13);
var w3e13 = b2Math.Dot(w3, e13);
var d13_1 = w3e13;
var d13_2 = (-w1e13);
var e23 = b2Math.SubtractVV(w3, w2);
var w2e23 = b2Math.Dot(w2, e23);
var w3e23 = b2Math.Dot(w3, e23);
var d23_1 = w3e23;
var d23_2 = (-w2e23);
var n123 = b2Math.CrossVV(e12, e13);
var d123_1 = n123 * b2Math.CrossVV(w2, w3);
var d123_2 = n123 * b2Math.CrossVV(w3, w1);
var d123_3 = n123 * b2Math.CrossVV(w1, w2);
if (d12_2 <= 0.0 && d13_2 <= 0.0) {
this.m_v1.a = 1.0;
this.m_count = 1;
return;
}
if (d12_1 > 0.0 && d12_2 > 0.0 && d123_3 <= 0.0) {
var inv_d12 = 1.0 / (d12_1 + d12_2);
this.m_v1.a = d12_1 * inv_d12;
this.m_v2.a = d12_2 * inv_d12;
this.m_count = 2;
return;
}
if (d13_1 > 0.0 && d13_2 > 0.0 && d123_2 <= 0.0) {
var inv_d13 = 1.0 / (d13_1 + d13_2);
this.m_v1.a = d13_1 * inv_d13;
this.m_v3.a = d13_2 * inv_d13;
this.m_count = 2;
this.m_v2.Set(this.m_v3);
return;
}
if (d12_1 <= 0.0 && d23_2 <= 0.0) {
this.m_v2.a = 1.0;
this.m_count = 1;
this.m_v1.Set(this.m_v2);
return;
}
if (d13_1 <= 0.0 && d23_1 <= 0.0) {
this.m_v3.a = 1.0;
this.m_count = 1;
this.m_v1.Set(this.m_v3);
return;
}
if (d23_1 > 0.0 && d23_2 > 0.0 && d123_1 <= 0.0) {
var inv_d23 = 1.0 / (d23_1 + d23_2);
this.m_v2.a = d23_1 * inv_d23;
this.m_v3.a = d23_2 * inv_d23;
this.m_count = 2;
this.m_v1.Set(this.m_v3);
return;
}
var inv_d123 = 1.0 / (d123_1 + d123_2 + d123_3);
this.m_v1.a = d123_1 * inv_d123;
this.m_v2.a = d123_2 * inv_d123;
this.m_v3.a = d123_3 * inv_d123;
this.m_count = 3;
}
b2SimplexCache.b2SimplexCache = function () {
this.indexA = new Vector_a2j_Number(3);
this.indexB = new Vector_a2j_Number(3);
};
b2SimplexVertex.b2SimplexVertex = function () {};
b2SimplexVertex.prototype.Set = function (other) {
this.wA.SetV(other.wA);
this.wB.SetV(other.wB);
this.w.SetV(other.w);
this.a = other.a;
this.indexA = other.indexA;
this.indexB = other.indexB;
}
b2TimeOfImpact.b2TimeOfImpact = function () {};
b2TimeOfImpact.TimeOfImpact = function (input) {
++b2TimeOfImpact.b2_toiCalls;
var proxyA = input.proxyA;
var proxyB = input.proxyB;
var sweepA = input.sweepA;
var sweepB = input.sweepB;
b2Settings.b2Assert(sweepA.t0 == sweepB.t0);
b2Settings.b2Assert(1.0 - sweepA.t0 > Number.MIN_VALUE);
var radius = proxyA.m_radius + proxyB.m_radius;
var tolerance = input.tolerance;
var alpha = 0.0;
var k_maxIterations = 1000;
var iter = 0;
var target = 0.0;
b2TimeOfImpact.s_cache.count = 0;
b2TimeOfImpact.s_distanceInput.useRadii = false;
for (;;) {
sweepA.GetTransform(b2TimeOfImpact.s_xfA, alpha);
sweepB.GetTransform(b2TimeOfImpact.s_xfB, alpha);
b2TimeOfImpact.s_distanceInput.proxyA = proxyA;
b2TimeOfImpact.s_distanceInput.proxyB = proxyB;
b2TimeOfImpact.s_distanceInput.transformA = b2TimeOfImpact.s_xfA;
b2TimeOfImpact.s_distanceInput.transformB = b2TimeOfImpact.s_xfB;
b2Distance.Distance(b2TimeOfImpact.s_distanceOutput, b2TimeOfImpact.s_cache, b2TimeOfImpact.s_distanceInput);
if (b2TimeOfImpact.s_distanceOutput.distance <= 0.0) {
alpha = 1.0;
break;
}
b2TimeOfImpact.s_fcn.Initialize(b2TimeOfImpact.s_cache, proxyA, b2TimeOfImpact.s_xfA, proxyB, b2TimeOfImpact.s_xfB);
var separation = b2TimeOfImpact.s_fcn.Evaluate(b2TimeOfImpact.s_xfA, b2TimeOfImpact.s_xfB);
if (separation <= 0.0) {
alpha = 1.0;
break;
}
if (iter == 0) {
if (separation > radius) {
target = b2Math.Max(radius - tolerance, 0.75 * radius);
}
else {
target = b2Math.Max(separation - tolerance, 0.02 * radius);
}
}
if (separation - target < 0.5 * tolerance) {
if (iter == 0) {
alpha = 1.0;
break;
}
break;
}
var newAlpha = alpha; {
var x1 = alpha;
var x2 = 1.0;
var f1 = separation;
sweepA.GetTransform(b2TimeOfImpact.s_xfA, x2);
sweepB.GetTransform(b2TimeOfImpact.s_xfB, x2);
var f2 = b2TimeOfImpact.s_fcn.Evaluate(b2TimeOfImpact.s_xfA, b2TimeOfImpact.s_xfB);
if (f2 >= target) {
alpha = 1.0;
break;
}
var rootIterCount = 0;
for (;;) {
var x = 0;
if (rootIterCount & 1) {
x = x1 + (target - f1) * (x2 - x1) / (f2 - f1);
}
else {
x = 0.5 * (x1 + x2);
}
sweepA.GetTransform(b2TimeOfImpact.s_xfA, x);
sweepB.GetTransform(b2TimeOfImpact.s_xfB, x);
var f = b2TimeOfImpact.s_fcn.Evaluate(b2TimeOfImpact.s_xfA, b2TimeOfImpact.s_xfB);
if (b2Math.Abs(f - target) < 0.025 * tolerance) {
newAlpha = x;
break;
}
if (f > target) {
x1 = x;
f1 = f;
}
else {
x2 = x;
f2 = f;
}++rootIterCount;
++b2TimeOfImpact.b2_toiRootIters;
if (rootIterCount == 50) {
break;
}
}
b2TimeOfImpact.b2_toiMaxRootIters = b2Math.Max(b2TimeOfImpact.b2_toiMaxRootIters, rootIterCount);
}
if (newAlpha < (1.0 + 100.0 * Number.MIN_VALUE) * alpha) {
break;
}
alpha = newAlpha;
iter++;
++b2TimeOfImpact.b2_toiIters;
if (iter == k_maxIterations) {
break;
}
}
b2TimeOfImpact.b2_toiMaxIters = b2Math.Max(b2TimeOfImpact.b2_toiMaxIters, iter);
return alpha;
}
Box2D.postDefs.push(function () {
Box2D.Collision.b2TimeOfImpact.b2_toiCalls = 0;
Box2D.Collision.b2TimeOfImpact.b2_toiIters = 0;
Box2D.Collision.b2TimeOfImpact.b2_toiMaxIters = 0;
Box2D.Collision.b2TimeOfImpact.b2_toiRootIters = 0;
Box2D.Collision.b2TimeOfImpact.b2_toiMaxRootIters = 0;
Box2D.Collision.b2TimeOfImpact.s_cache = new b2SimplexCache();
Box2D.Collision.b2TimeOfImpact.s_distanceInput = new b2DistanceInput();
Box2D.Collision.b2TimeOfImpact.s_xfA = new b2Transform();
Box2D.Collision.b2TimeOfImpact.s_xfB = new b2Transform();
Box2D.Collision.b2TimeOfImpact.s_fcn = new b2SeparationFunction();
Box2D.Collision.b2TimeOfImpact.s_distanceOutput = new b2DistanceOutput();
});
b2TOIInput.b2TOIInput = function () {
this.proxyA = new b2DistanceProxy();
this.proxyB = new b2DistanceProxy();
this.sweepA = new b2Sweep();
this.sweepB = new b2Sweep();
};
b2WorldManifold.b2WorldManifold = function () {
this.m_normal = new b2Vec2();
};
b2WorldManifold.prototype.b2WorldManifold = function () {
this.m_points = new Vector(b2Settings.b2_maxManifoldPoints);
for (var i = 0; i < b2Settings.b2_maxManifoldPoints; i++) {
this.m_points[i] = new b2Vec2();
}
}
b2WorldManifold.prototype.Initialize = function (manifold, xfA, radiusA, xfB, radiusB) {
if (radiusA === undefined) radiusA = 0;
if (radiusB === undefined) radiusB = 0;
if (manifold.m_pointCount == 0) {
return;
}
var i = 0;
var tVec;
var tMat;
var normalX = 0;
var normalY = 0;
var planePointX = 0;
var planePointY = 0;
var clipPointX = 0;
var clipPointY = 0;
switch (manifold.m_type) {
case b2Manifold.e_circles:
{
tMat = xfA.R;
tVec = manifold.m_localPoint;
var pointAX = xfA.position.x + tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
var pointAY = xfA.position.y + tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tMat = xfB.R;
tVec = manifold.m_points[0].m_localPoint;
var pointBX = xfB.position.x + tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
var pointBY = xfB.position.y + tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
var dX = pointBX - pointAX;
var dY = pointBY - pointAY;
var d2 = dX * dX + dY * dY;
if (d2 > Number.MIN_VALUE * Number.MIN_VALUE) {
var d = Math.sqrt(d2);
this.m_normal.x = dX / d;
this.m_normal.y = dY / d;
}
else {
this.m_normal.x = 1;
this.m_normal.y = 0;
}
var cAX = pointAX + radiusA * this.m_normal.x;
var cAY = pointAY + radiusA * this.m_normal.y;
var cBX = pointBX - radiusB * this.m_normal.x;
var cBY = pointBY - radiusB * this.m_normal.y;
this.m_points[0].x = 0.5 * (cAX + cBX);
this.m_points[0].y = 0.5 * (cAY + cBY);
}
break;
case b2Manifold.e_faceA:
{
tMat = xfA.R;
tVec = manifold.m_localPlaneNormal;
normalX = tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
normalY = tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tMat = xfA.R;
tVec = manifold.m_localPoint;
planePointX = xfA.position.x + tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
planePointY = xfA.position.y + tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
this.m_normal.x = normalX;
this.m_normal.y = normalY;
for (i = 0;
i < manifold.m_pointCount; i++) {
tMat = xfB.R;
tVec = manifold.m_points[i].m_localPoint;
clipPointX = xfB.position.x + tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
clipPointY = xfB.position.y + tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
this.m_points[i].x = clipPointX + 0.5 * (radiusA - (clipPointX - planePointX) * normalX - (clipPointY - planePointY) * normalY - radiusB) * normalX;
this.m_points[i].y = clipPointY + 0.5 * (radiusA - (clipPointX - planePointX) * normalX - (clipPointY - planePointY) * normalY - radiusB) * normalY;
}
}
break;
case b2Manifold.e_faceB:
{
tMat = xfB.R;
tVec = manifold.m_localPlaneNormal;
normalX = tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
normalY = tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tMat = xfB.R;
tVec = manifold.m_localPoint;
planePointX = xfB.position.x + tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
planePointY = xfB.position.y + tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
this.m_normal.x = (-normalX);
this.m_normal.y = (-normalY);
for (i = 0;
i < manifold.m_pointCount; i++) {
tMat = xfA.R;
tVec = manifold.m_points[i].m_localPoint;
clipPointX = xfA.position.x + tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
clipPointY = xfA.position.y + tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
this.m_points[i].x = clipPointX + 0.5 * (radiusB - (clipPointX - planePointX) * normalX - (clipPointY - planePointY) * normalY - radiusA) * normalX;
this.m_points[i].y = clipPointY + 0.5 * (radiusB - (clipPointX - planePointX) * normalX - (clipPointY - planePointY) * normalY - radiusA) * normalY;
}
}
break;
}
}
ClipVertex.ClipVertex = function () {
this.v = new b2Vec2();
this.id = new b2ContactID();
};
ClipVertex.prototype.Set = function (other) {
this.v.SetV(other.v);
this.id.Set(other.id);
}
Features.Features = function () {};
Object.defineProperty(Features.prototype, 'referenceEdge', {
enumerable: false,
configurable: true,
get: function () {
return this._referenceEdge;
}
});
Object.defineProperty(Features.prototype, 'referenceEdge', {
enumerable: false,
configurable: true,
set: function (value) {
if (value === undefined) value = 0;
this._referenceEdge = value;
this._m_id._key = (this._m_id._key & 0xffffff00) | (this._referenceEdge & 0x000000ff);
}
});
Object.defineProperty(Features.prototype, 'incidentEdge', {
enumerable: false,
configurable: true,
get: function () {
return this._incidentEdge;
}
});
Object.defineProperty(Features.prototype, 'incidentEdge', {
enumerable: false,
configurable: true,
set: function (value) {
if (value === undefined) value = 0;
this._incidentEdge = value;
this._m_id._key = (this._m_id._key & 0xffff00ff) | ((this._incidentEdge << 8) & 0x0000ff00);
}
});
Object.defineProperty(Features.prototype, 'incidentVertex', {
enumerable: false,
configurable: true,
get: function () {
return this._incidentVertex;
}
});
Object.defineProperty(Features.prototype, 'incidentVertex', {
enumerable: false,
configurable: true,
set: function (value) {
if (value === undefined) value = 0;
this._incidentVertex = value;
this._m_id._key = (this._m_id._key & 0xff00ffff) | ((this._incidentVertex << 16) & 0x00ff0000);
}
});
Object.defineProperty(Features.prototype, 'flip', {
enumerable: false,
configurable: true,
get: function () {
return this._flip;
}
});
Object.defineProperty(Features.prototype, 'flip', {
enumerable: false,
configurable: true,
set: function (value) {
if (value === undefined) value = 0;
this._flip = value;
this._m_id._key = (this._m_id._key & 0x00ffffff) | ((this._flip << 24) & 0xff000000);
}
});
})();
(function () {
var b2Color = Box2D.Common.b2Color,
b2internal = Box2D.Common.b2internal,
b2Settings = Box2D.Common.b2Settings,
b2CircleShape = Box2D.Collision.Shapes.b2CircleShape,
b2EdgeChainDef = Box2D.Collision.Shapes.b2EdgeChainDef,
b2EdgeShape = Box2D.Collision.Shapes.b2EdgeShape,
b2MassData = Box2D.Collision.Shapes.b2MassData,
b2PolygonShape = Box2D.Collision.Shapes.b2PolygonShape,
b2Shape = Box2D.Collision.Shapes.b2Shape,
b2Mat22 = Box2D.Common.Math.b2Mat22,
b2Mat33 = Box2D.Common.Math.b2Mat33,
b2Math = Box2D.Common.Math.b2Math,
b2Sweep = Box2D.Common.Math.b2Sweep,
b2Transform = Box2D.Common.Math.b2Transform,
b2Vec2 = Box2D.Common.Math.b2Vec2,
b2Vec3 = Box2D.Common.Math.b2Vec3,
b2Body = Box2D.Dynamics.b2Body,
b2BodyDef = Box2D.Dynamics.b2BodyDef,
b2ContactFilter = Box2D.Dynamics.b2ContactFilter,
b2ContactImpulse = Box2D.Dynamics.b2ContactImpulse,
b2ContactListener = Box2D.Dynamics.b2ContactListener,
b2ContactManager = Box2D.Dynamics.b2ContactManager,
b2DebugDraw = Box2D.Dynamics.b2DebugDraw,
b2DestructionListener = Box2D.Dynamics.b2DestructionListener,
b2FilterData = Box2D.Dynamics.b2FilterData,
b2Fixture = Box2D.Dynamics.b2Fixture,
b2FixtureDef = Box2D.Dynamics.b2FixtureDef,
b2Island = Box2D.Dynamics.b2Island,
b2TimeStep = Box2D.Dynamics.b2TimeStep,
b2World = Box2D.Dynamics.b2World,
b2AABB = Box2D.Collision.b2AABB,
b2Bound = Box2D.Collision.b2Bound,
b2BoundValues = Box2D.Collision.b2BoundValues,
b2Collision = Box2D.Collision.b2Collision,
b2ContactID = Box2D.Collision.b2ContactID,
b2ContactPoint = Box2D.Collision.b2ContactPoint,
b2Distance = Box2D.Collision.b2Distance,
b2DistanceInput = Box2D.Collision.b2DistanceInput,
b2DistanceOutput = Box2D.Collision.b2DistanceOutput,
b2DistanceProxy = Box2D.Collision.b2DistanceProxy,
b2DynamicTree = Box2D.Collision.b2DynamicTree,
b2DynamicTreeBroadPhase = Box2D.Collision.b2DynamicTreeBroadPhase,
b2DynamicTreeNode = Box2D.Collision.b2DynamicTreeNode,
b2DynamicTreePair = Box2D.Collision.b2DynamicTreePair,
b2Manifold = Box2D.Collision.b2Manifold,
b2ManifoldPoint = Box2D.Collision.b2ManifoldPoint,
b2Point = Box2D.Collision.b2Point,
b2RayCastInput = Box2D.Collision.b2RayCastInput,
b2RayCastOutput = Box2D.Collision.b2RayCastOutput,
b2Segment = Box2D.Collision.b2Segment,
b2SeparationFunction = Box2D.Collision.b2SeparationFunction,
b2Simplex = Box2D.Collision.b2Simplex,
b2SimplexCache = Box2D.Collision.b2SimplexCache,
b2SimplexVertex = Box2D.Collision.b2SimplexVertex,
b2TimeOfImpact = Box2D.Collision.b2TimeOfImpact,
b2TOIInput = Box2D.Collision.b2TOIInput,
b2WorldManifold = Box2D.Collision.b2WorldManifold,
ClipVertex = Box2D.Collision.ClipVertex,
Features = Box2D.Collision.Features,
IBroadPhase = Box2D.Collision.IBroadPhase;
Box2D.inherit(b2CircleShape, Box2D.Collision.Shapes.b2Shape);
b2CircleShape.prototype.__super = Box2D.Collision.Shapes.b2Shape.prototype;
b2CircleShape.b2CircleShape = function () {
Box2D.Collision.Shapes.b2Shape.b2Shape.apply(this, arguments);
this.m_p = new b2Vec2();
};
b2CircleShape.prototype.Copy = function () {
var s = new b2CircleShape();
s.Set(this);
return s;
}
b2CircleShape.prototype.Set = function (other) {
this.__super.Set.call(this, other);
if (Box2D.is(other, b2CircleShape)) {
var other2 = (other instanceof b2CircleShape ? other : null);
this.m_p.SetV(other2.m_p);
}
}
b2CircleShape.prototype.TestPoint = function (transform, p) {
var tMat = transform.R;
var dX = transform.position.x + (tMat.col1.x * this.m_p.x + tMat.col2.x * this.m_p.y);
var dY = transform.position.y + (tMat.col1.y * this.m_p.x + tMat.col2.y * this.m_p.y);
dX = p.x - dX;
dY = p.y - dY;
return (dX * dX + dY * dY) <= this.m_radius * this.m_radius;
}
b2CircleShape.prototype.RayCast = function (output, input, transform) {
var tMat = transform.R;
var positionX = transform.position.x + (tMat.col1.x * this.m_p.x + tMat.col2.x * this.m_p.y);
var positionY = transform.position.y + (tMat.col1.y * this.m_p.x + tMat.col2.y * this.m_p.y);
var sX = input.p1.x - positionX;
var sY = input.p1.y - positionY;
var b = (sX * sX + sY * sY) - this.m_radius * this.m_radius;
var rX = input.p2.x - input.p1.x;
var rY = input.p2.y - input.p1.y;
var c = (sX * rX + sY * rY);
var rr = (rX * rX + rY * rY);
var sigma = c * c - rr * b;
if (sigma < 0.0 || rr < Number.MIN_VALUE) {
return false;
}
var a = (-(c + Math.sqrt(sigma)));
if (0.0 <= a && a <= input.maxFraction * rr) {
a /= rr;
output.fraction = a;
output.normal.x = sX + a * rX;
output.normal.y = sY + a * rY;
output.normal.Normalize();
return true;
}
return false;
}
b2CircleShape.prototype.ComputeAABB = function (aabb, transform) {
var tMat = transform.R;
var pX = transform.position.x + (tMat.col1.x * this.m_p.x + tMat.col2.x * this.m_p.y);
var pY = transform.position.y + (tMat.col1.y * this.m_p.x + tMat.col2.y * this.m_p.y);
aabb.lowerBound.Set(pX - this.m_radius, pY - this.m_radius);
aabb.upperBound.Set(pX + this.m_radius, pY + this.m_radius);
}
b2CircleShape.prototype.ComputeMass = function (massData, density) {
if (density === undefined) density = 0;
massData.mass = density * b2Settings.b2_pi * this.m_radius * this.m_radius;
massData.center.SetV(this.m_p);
massData.I = massData.mass * (0.5 * this.m_radius * this.m_radius + (this.m_p.x * this.m_p.x + this.m_p.y * this.m_p.y));
}
b2CircleShape.prototype.ComputeSubmergedArea = function (normal, offset, xf, c) {
if (offset === undefined) offset = 0;
var p = b2Math.MulX(xf, this.m_p);
var l = (-(b2Math.Dot(normal, p) - offset));
if (l < (-this.m_radius) + Number.MIN_VALUE) {
return 0;
}
if (l > this.m_radius) {
c.SetV(p);
return Math.PI * this.m_radius * this.m_radius;
}
var r2 = this.m_radius * this.m_radius;
var l2 = l * l;
var area = r2 * (Math.asin(l / this.m_radius) + Math.PI / 2) + l * Math.sqrt(r2 - l2);
var com = (-2 / 3 * Math.pow(r2 - l2, 1.5) / area);
c.x = p.x + normal.x * com;
c.y = p.y + normal.y * com;
return area;
}
b2CircleShape.prototype.GetLocalPosition = function () {
return this.m_p;
}
b2CircleShape.prototype.SetLocalPosition = function (position) {
this.m_p.SetV(position);
}
b2CircleShape.prototype.GetRadius = function () {
return this.m_radius;
}
b2CircleShape.prototype.SetRadius = function (radius) {
if (radius === undefined) radius = 0;
this.m_radius = radius;
}
b2CircleShape.prototype.b2CircleShape = function (radius) {
if (radius === undefined) radius = 0;
this.__super.b2Shape.call(this);
this.m_type = b2Shape.e_circleShape;
this.m_radius = radius;
}
b2EdgeChainDef.b2EdgeChainDef = function () {};
b2EdgeChainDef.prototype.b2EdgeChainDef = function () {
this.vertexCount = 0;
this.isALoop = true;
this.vertices = [];
}
Box2D.inherit(b2EdgeShape, Box2D.Collision.Shapes.b2Shape);
b2EdgeShape.prototype.__super = Box2D.Collision.Shapes.b2Shape.prototype;
b2EdgeShape.b2EdgeShape = function () {
Box2D.Collision.Shapes.b2Shape.b2Shape.apply(this, arguments);
this.s_supportVec = new b2Vec2();
this.m_v1 = new b2Vec2();
this.m_v2 = new b2Vec2();
this.m_coreV1 = new b2Vec2();
this.m_coreV2 = new b2Vec2();
this.m_normal = new b2Vec2();
this.m_direction = new b2Vec2();
this.m_cornerDir1 = new b2Vec2();
this.m_cornerDir2 = new b2Vec2();
};
b2EdgeShape.prototype.TestPoint = function (transform, p) {
return false;
}
b2EdgeShape.prototype.RayCast = function (output, input, transform) {
var tMat;
var rX = input.p2.x - input.p1.x;
var rY = input.p2.y - input.p1.y;
tMat = transform.R;
var v1X = transform.position.x + (tMat.col1.x * this.m_v1.x + tMat.col2.x * this.m_v1.y);
var v1Y = transform.position.y + (tMat.col1.y * this.m_v1.x + tMat.col2.y * this.m_v1.y);
var nX = transform.position.y + (tMat.col1.y * this.m_v2.x + tMat.col2.y * this.m_v2.y) - v1Y;
var nY = (-(transform.position.x + (tMat.col1.x * this.m_v2.x + tMat.col2.x * this.m_v2.y) - v1X));
var k_slop = 100.0 * Number.MIN_VALUE;
var denom = (-(rX * nX + rY * nY));
if (denom > k_slop) {
var bX = input.p1.x - v1X;
var bY = input.p1.y - v1Y;
var a = (bX * nX + bY * nY);
if (0.0 <= a && a <= input.maxFraction * denom) {
var mu2 = (-rX * bY) + rY * bX;
if ((-k_slop * denom) <= mu2 && mu2 <= denom * (1.0 + k_slop)) {
a /= denom;
output.fraction = a;
var nLen = Math.sqrt(nX * nX + nY * nY);
output.normal.x = nX / nLen;
output.normal.y = nY / nLen;
return true;
}
}
}
return false;
}
b2EdgeShape.prototype.ComputeAABB = function (aabb, transform) {
var tMat = transform.R;
var v1X = transform.position.x + (tMat.col1.x * this.m_v1.x + tMat.col2.x * this.m_v1.y);
var v1Y = transform.position.y + (tMat.col1.y * this.m_v1.x + tMat.col2.y * this.m_v1.y);
var v2X = transform.position.x + (tMat.col1.x * this.m_v2.x + tMat.col2.x * this.m_v2.y);
var v2Y = transform.position.y + (tMat.col1.y * this.m_v2.x + tMat.col2.y * this.m_v2.y);
if (v1X < v2X) {
aabb.lowerBound.x = v1X;
aabb.upperBound.x = v2X;
}
else {
aabb.lowerBound.x = v2X;
aabb.upperBound.x = v1X;
}
if (v1Y < v2Y) {
aabb.lowerBound.y = v1Y;
aabb.upperBound.y = v2Y;
}
else {
aabb.lowerBound.y = v2Y;
aabb.upperBound.y = v1Y;
}
}
b2EdgeShape.prototype.ComputeMass = function (massData, density) {
if (density === undefined) density = 0;
massData.mass = 0;
massData.center.SetV(this.m_v1);
massData.I = 0;
}
b2EdgeShape.prototype.ComputeSubmergedArea = function (normal, offset, xf, c) {
if (offset === undefined) offset = 0;
var v0 = new b2Vec2(normal.x * offset, normal.y * offset);
var v1 = b2Math.MulX(xf, this.m_v1);
var v2 = b2Math.MulX(xf, this.m_v2);
var d1 = b2Math.Dot(normal, v1) - offset;
var d2 = b2Math.Dot(normal, v2) - offset;
if (d1 > 0) {
if (d2 > 0) {
return 0;
}
else {
v1.x = (-d2 / (d1 - d2) * v1.x) + d1 / (d1 - d2) * v2.x;
v1.y = (-d2 / (d1 - d2) * v1.y) + d1 / (d1 - d2) * v2.y;
}
}
else {
if (d2 > 0) {
v2.x = (-d2 / (d1 - d2) * v1.x) + d1 / (d1 - d2) * v2.x;
v2.y = (-d2 / (d1 - d2) * v1.y) + d1 / (d1 - d2) * v2.y;
}
else {}
}
c.x = (v0.x + v1.x + v2.x) / 3;
c.y = (v0.y + v1.y + v2.y) / 3;
return 0.5 * ((v1.x - v0.x) * (v2.y - v0.y) - (v1.y - v0.y) * (v2.x - v0.x));
}
b2EdgeShape.prototype.GetLength = function () {
return this.m_length;
}
b2EdgeShape.prototype.GetVertex1 = function () {
return this.m_v1;
}
b2EdgeShape.prototype.GetVertex2 = function () {
return this.m_v2;
}
b2EdgeShape.prototype.GetCoreVertex1 = function () {
return this.m_coreV1;
}
b2EdgeShape.prototype.GetCoreVertex2 = function () {
return this.m_coreV2;
}
b2EdgeShape.prototype.GetNormalVector = function () {
return this.m_normal;
}
b2EdgeShape.prototype.GetDirectionVector = function () {
return this.m_direction;
}
b2EdgeShape.prototype.GetCorner1Vector = function () {
return this.m_cornerDir1;
}
b2EdgeShape.prototype.GetCorner2Vector = function () {
return this.m_cornerDir2;
}
b2EdgeShape.prototype.Corner1IsConvex = function () {
return this.m_cornerConvex1;
}
b2EdgeShape.prototype.Corner2IsConvex = function () {
return this.m_cornerConvex2;
}
b2EdgeShape.prototype.GetFirstVertex = function (xf) {
var tMat = xf.R;
return new b2Vec2(xf.position.x + (tMat.col1.x * this.m_coreV1.x + tMat.col2.x * this.m_coreV1.y), xf.position.y + (tMat.col1.y * this.m_coreV1.x + tMat.col2.y * this.m_coreV1.y));
}
b2EdgeShape.prototype.GetNextEdge = function () {
return this.m_nextEdge;
}
b2EdgeShape.prototype.GetPrevEdge = function () {
return this.m_prevEdge;
}
b2EdgeShape.prototype.Support = function (xf, dX, dY) {
if (dX === undefined) dX = 0;
if (dY === undefined) dY = 0;
var tMat = xf.R;
var v1X = xf.position.x + (tMat.col1.x * this.m_coreV1.x + tMat.col2.x * this.m_coreV1.y);
var v1Y = xf.position.y + (tMat.col1.y * this.m_coreV1.x + tMat.col2.y * this.m_coreV1.y);
var v2X = xf.position.x + (tMat.col1.x * this.m_coreV2.x + tMat.col2.x * this.m_coreV2.y);
var v2Y = xf.position.y + (tMat.col1.y * this.m_coreV2.x + tMat.col2.y * this.m_coreV2.y);
if ((v1X * dX + v1Y * dY) > (v2X * dX + v2Y * dY)) {
this.s_supportVec.x = v1X;
this.s_supportVec.y = v1Y;
}
else {
this.s_supportVec.x = v2X;
this.s_supportVec.y = v2Y;
}
return this.s_supportVec;
}
b2EdgeShape.prototype.b2EdgeShape = function (v1, v2) {
this.__super.b2Shape.call(this);
this.m_type = b2Shape.e_edgeShape;
this.m_prevEdge = null;
this.m_nextEdge = null;
this.m_v1 = v1;
this.m_v2 = v2;
this.m_direction.Set(this.m_v2.x - this.m_v1.x, this.m_v2.y - this.m_v1.y);
this.m_length = this.m_direction.Normalize();
this.m_normal.Set(this.m_direction.y, (-this.m_direction.x));
this.m_coreV1.Set((-b2Settings.b2_toiSlop * (this.m_normal.x - this.m_direction.x)) + this.m_v1.x, (-b2Settings.b2_toiSlop * (this.m_normal.y - this.m_direction.y)) + this.m_v1.y);
this.m_coreV2.Set((-b2Settings.b2_toiSlop * (this.m_normal.x + this.m_direction.x)) + this.m_v2.x, (-b2Settings.b2_toiSlop * (this.m_normal.y + this.m_direction.y)) + this.m_v2.y);
this.m_cornerDir1 = this.m_normal;
this.m_cornerDir2.Set((-this.m_normal.x), (-this.m_normal.y));
}
b2EdgeShape.prototype.SetPrevEdge = function (edge, core, cornerDir, convex) {
this.m_prevEdge = edge;
this.m_coreV1 = core;
this.m_cornerDir1 = cornerDir;
this.m_cornerConvex1 = convex;
}
b2EdgeShape.prototype.SetNextEdge = function (edge, core, cornerDir, convex) {
this.m_nextEdge = edge;
this.m_coreV2 = core;
this.m_cornerDir2 = cornerDir;
this.m_cornerConvex2 = convex;
}
b2MassData.b2MassData = function () {
this.mass = 0.0;
this.center = new b2Vec2(0, 0);
this.I = 0.0;
};
Box2D.inherit(b2PolygonShape, Box2D.Collision.Shapes.b2Shape);
b2PolygonShape.prototype.__super = Box2D.Collision.Shapes.b2Shape.prototype;
b2PolygonShape.b2PolygonShape = function () {
Box2D.Collision.Shapes.b2Shape.b2Shape.apply(this, arguments);
};
b2PolygonShape.prototype.Copy = function () {
var s = new b2PolygonShape();
s.Set(this);
return s;
}
b2PolygonShape.prototype.Set = function (other) {
this.__super.Set.call(this, other);
if (Box2D.is(other, b2PolygonShape)) {
var other2 = (other instanceof b2PolygonShape ? other : null);
this.m_centroid.SetV(other2.m_centroid);
this.m_vertexCount = other2.m_vertexCount;
this.Reserve(this.m_vertexCount);
for (var i = 0; i < this.m_vertexCount; i++) {
this.m_vertices[i].SetV(other2.m_vertices[i]);
this.m_normals[i].SetV(other2.m_normals[i]);
}
}
}
b2PolygonShape.prototype.SetAsArray = function (vertices, vertexCount) {
if (vertexCount === undefined) vertexCount = 0;
var v = new Vector();
var i = 0,
tVec;
for (i = 0;
i < vertices.length; ++i) {
tVec = vertices[i];
v.push(tVec);
}
this.SetAsVector(v, vertexCount);
}
b2PolygonShape.AsArray = function (vertices, vertexCount) {
if (vertexCount === undefined) vertexCount = 0;
var polygonShape = new b2PolygonShape();
polygonShape.SetAsArray(vertices, vertexCount);
return polygonShape;
}
b2PolygonShape.prototype.SetAsVector = function (vertices, vertexCount) {
if (vertexCount === undefined) vertexCount = 0;
if (vertexCount == 0) vertexCount = vertices.length;
b2Settings.b2Assert(2 <= vertexCount);
this.m_vertexCount = vertexCount;
this.Reserve(vertexCount);
var i = 0;
for (i = 0;
i < this.m_vertexCount; i++) {
this.m_vertices[i].SetV(vertices[i]);
}
for (i = 0;
i < this.m_vertexCount; ++i) {
var i1 = parseInt(i);
var i2 = parseInt(i + 1 < this.m_vertexCount ? i + 1 : 0);
var edge = b2Math.SubtractVV(this.m_vertices[i2], this.m_vertices[i1]);
b2Settings.b2Assert(edge.LengthSquared() > Number.MIN_VALUE);
this.m_normals[i].SetV(b2Math.CrossVF(edge, 1.0));
this.m_normals[i].Normalize();
}
this.m_centroid = b2PolygonShape.ComputeCentroid(this.m_vertices, this.m_vertexCount);
}
b2PolygonShape.AsVector = function (vertices, vertexCount) {
if (vertexCount === undefined) vertexCount = 0;
var polygonShape = new b2PolygonShape();
polygonShape.SetAsVector(vertices, vertexCount);
return polygonShape;
}
b2PolygonShape.prototype.SetAsBox = function (hx, hy) {
if (hx === undefined) hx = 0;
if (hy === undefined) hy = 0;
this.m_vertexCount = 4;
this.Reserve(4);
this.m_vertices[0].Set((-hx), (-hy));
this.m_vertices[1].Set(hx, (-hy));
this.m_vertices[2].Set(hx, hy);
this.m_vertices[3].Set((-hx), hy);
this.m_normals[0].Set(0.0, (-1.0));
this.m_normals[1].Set(1.0, 0.0);
this.m_normals[2].Set(0.0, 1.0);
this.m_normals[3].Set((-1.0), 0.0);
this.m_centroid.SetZero();
}
b2PolygonShape.AsBox = function (hx, hy) {
if (hx === undefined) hx = 0;
if (hy === undefined) hy = 0;
var polygonShape = new b2PolygonShape();
polygonShape.SetAsBox(hx, hy);
return polygonShape;
}
b2PolygonShape.prototype.SetAsOrientedBox = function (hx, hy, center, angle) {
if (hx === undefined) hx = 0;
if (hy === undefined) hy = 0;
if (center === undefined) center = null;
if (angle === undefined) angle = 0.0;
this.m_vertexCount = 4;
this.Reserve(4);
this.m_vertices[0].Set((-hx), (-hy));
this.m_vertices[1].Set(hx, (-hy));
this.m_vertices[2].Set(hx, hy);
this.m_vertices[3].Set((-hx), hy);
this.m_normals[0].Set(0.0, (-1.0));
this.m_normals[1].Set(1.0, 0.0);
this.m_normals[2].Set(0.0, 1.0);
this.m_normals[3].Set((-1.0), 0.0);
this.m_centroid = center;
var xf = new b2Transform();
xf.position = center;
xf.R.Set(angle);
for (var i = 0; i < this.m_vertexCount; ++i) {
this.m_vertices[i] = b2Math.MulX(xf, this.m_vertices[i]);
this.m_normals[i] = b2Math.MulMV(xf.R, this.m_normals[i]);
}
}
b2PolygonShape.AsOrientedBox = function (hx, hy, center, angle) {
if (hx === undefined) hx = 0;
if (hy === undefined) hy = 0;
if (center === undefined) center = null;
if (angle === undefined) angle = 0.0;
var polygonShape = new b2PolygonShape();
polygonShape.SetAsOrientedBox(hx, hy, center, angle);
return polygonShape;
}
b2PolygonShape.prototype.SetAsEdge = function (v1, v2) {
this.m_vertexCount = 2;
this.Reserve(2);
this.m_vertices[0].SetV(v1);
this.m_vertices[1].SetV(v2);
this.m_centroid.x = 0.5 * (v1.x + v2.x);
this.m_centroid.y = 0.5 * (v1.y + v2.y);
this.m_normals[0] = b2Math.CrossVF(b2Math.SubtractVV(v2, v1), 1.0);
this.m_normals[0].Normalize();
this.m_normals[1].x = (-this.m_normals[0].x);
this.m_normals[1].y = (-this.m_normals[0].y);
}
b2PolygonShape.AsEdge = function (v1, v2) {
var polygonShape = new b2PolygonShape();
polygonShape.SetAsEdge(v1, v2);
return polygonShape;
}
b2PolygonShape.prototype.TestPoint = function (xf, p) {
var tVec;
var tMat = xf.R;
var tX = p.x - xf.position.x;
var tY = p.y - xf.position.y;
var pLocalX = (tX * tMat.col1.x + tY * tMat.col1.y);
var pLocalY = (tX * tMat.col2.x + tY * tMat.col2.y);
for (var i = 0; i < this.m_vertexCount; ++i) {
tVec = this.m_vertices[i];
tX = pLocalX - tVec.x;
tY = pLocalY - tVec.y;
tVec = this.m_normals[i];
var dot = (tVec.x * tX + tVec.y * tY);
if (dot > 0.0) {
return false;
}
}
return true;
}
b2PolygonShape.prototype.RayCast = function (output, input, transform) {
var lower = 0.0;
var upper = input.maxFraction;
var tX = 0;
var tY = 0;
var tMat;
var tVec;
tX = input.p1.x - transform.position.x;
tY = input.p1.y - transform.position.y;
tMat = transform.R;
var p1X = (tX * tMat.col1.x + tY * tMat.col1.y);
var p1Y = (tX * tMat.col2.x + tY * tMat.col2.y);
tX = input.p2.x - transform.position.x;
tY = input.p2.y - transform.position.y;
tMat = transform.R;
var p2X = (tX * tMat.col1.x + tY * tMat.col1.y);
var p2Y = (tX * tMat.col2.x + tY * tMat.col2.y);
var dX = p2X - p1X;
var dY = p2Y - p1Y;
var index = parseInt((-1));
for (var i = 0; i < this.m_vertexCount; ++i) {
tVec = this.m_vertices[i];
tX = tVec.x - p1X;
tY = tVec.y - p1Y;
tVec = this.m_normals[i];
var numerator = (tVec.x * tX + tVec.y * tY);
var denominator = (tVec.x * dX + tVec.y * dY);
if (denominator == 0.0) {
if (numerator < 0.0) {
return false;
}
}
else {
if (denominator < 0.0 && numerator < lower * denominator) {
lower = numerator / denominator;
index = i;
}
else if (denominator > 0.0 && numerator < upper * denominator) {
upper = numerator / denominator;
}
}
if (upper < lower - Number.MIN_VALUE) {
return false;
}
}
if (index >= 0) {
output.fraction = lower;
tMat = transform.R;
tVec = this.m_normals[index];
output.normal.x = (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
output.normal.y = (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
return true;
}
return false;
}
b2PolygonShape.prototype.ComputeAABB = function (aabb, xf) {
var tMat = xf.R;
var tVec = this.m_vertices[0];
var lowerX = xf.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var lowerY = xf.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
var upperX = lowerX;
var upperY = lowerY;
for (var i = 1; i < this.m_vertexCount; ++i) {
tVec = this.m_vertices[i];
var vX = xf.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var vY = xf.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
lowerX = lowerX < vX ? lowerX : vX;
lowerY = lowerY < vY ? lowerY : vY;
upperX = upperX > vX ? upperX : vX;
upperY = upperY > vY ? upperY : vY;
}
aabb.lowerBound.x = lowerX - this.m_radius;
aabb.lowerBound.y = lowerY - this.m_radius;
aabb.upperBound.x = upperX + this.m_radius;
aabb.upperBound.y = upperY + this.m_radius;
}
b2PolygonShape.prototype.ComputeMass = function (massData, density) {
if (density === undefined) density = 0;
if (this.m_vertexCount == 2) {
massData.center.x = 0.5 * (this.m_vertices[0].x + this.m_vertices[1].x);
massData.center.y = 0.5 * (this.m_vertices[0].y + this.m_vertices[1].y);
massData.mass = 0.0;
massData.I = 0.0;
return;
}
var centerX = 0.0;
var centerY = 0.0;
var area = 0.0;
var I = 0.0;
var p1X = 0.0;
var p1Y = 0.0;
var k_inv3 = 1.0 / 3.0;
for (var i = 0; i < this.m_vertexCount; ++i) {
var p2 = this.m_vertices[i];
var p3 = i + 1 < this.m_vertexCount ? this.m_vertices[parseInt(i + 1)] : this.m_vertices[0];
var e1X = p2.x - p1X;
var e1Y = p2.y - p1Y;
var e2X = p3.x - p1X;
var e2Y = p3.y - p1Y;
var D = e1X * e2Y - e1Y * e2X;
var triangleArea = 0.5 * D;area += triangleArea;
centerX += triangleArea * k_inv3 * (p1X + p2.x + p3.x);
centerY += triangleArea * k_inv3 * (p1Y + p2.y + p3.y);
var px = p1X;
var py = p1Y;
var ex1 = e1X;
var ey1 = e1Y;
var ex2 = e2X;
var ey2 = e2Y;
var intx2 = k_inv3 * (0.25 * (ex1 * ex1 + ex2 * ex1 + ex2 * ex2) + (px * ex1 + px * ex2)) + 0.5 * px * px;
var inty2 = k_inv3 * (0.25 * (ey1 * ey1 + ey2 * ey1 + ey2 * ey2) + (py * ey1 + py * ey2)) + 0.5 * py * py;I += D * (intx2 + inty2);
}
massData.mass = density * area;
centerX *= 1.0 / area;
centerY *= 1.0 / area;
massData.center.Set(centerX, centerY);
massData.I = density * I;
}
b2PolygonShape.prototype.ComputeSubmergedArea = function (normal, offset, xf, c) {
if (offset === undefined) offset = 0;
var normalL = b2Math.MulTMV(xf.R, normal);
var offsetL = offset - b2Math.Dot(normal, xf.position);
var depths = new Vector_a2j_Number();
var diveCount = 0;
var intoIndex = parseInt((-1));
var outoIndex = parseInt((-1));
var lastSubmerged = false;
var i = 0;
for (i = 0;
i < this.m_vertexCount; ++i) {
depths[i] = b2Math.Dot(normalL, this.m_vertices[i]) - offsetL;
var isSubmerged = depths[i] < (-Number.MIN_VALUE);
if (i > 0) {
if (isSubmerged) {
if (!lastSubmerged) {
intoIndex = i - 1;
diveCount++;
}
}
else {
if (lastSubmerged) {
outoIndex = i - 1;
diveCount++;
}
}
}
lastSubmerged = isSubmerged;
}
switch (diveCount) {
case 0:
if (lastSubmerged) {
var md = new b2MassData();
this.ComputeMass(md, 1);
c.SetV(b2Math.MulX(xf, md.center));
return md.mass;
}
else {
return 0;
}
break;
case 1:
if (intoIndex == (-1)) {
intoIndex = this.m_vertexCount - 1;
}
else {
outoIndex = this.m_vertexCount - 1;
}
break;
}
var intoIndex2 = parseInt((intoIndex + 1) % this.m_vertexCount);
var outoIndex2 = parseInt((outoIndex + 1) % this.m_vertexCount);
var intoLamdda = (0 - depths[intoIndex]) / (depths[intoIndex2] - depths[intoIndex]);
var outoLamdda = (0 - depths[outoIndex]) / (depths[outoIndex2] - depths[outoIndex]);
var intoVec = new b2Vec2(this.m_vertices[intoIndex].x * (1 - intoLamdda) + this.m_vertices[intoIndex2].x * intoLamdda, this.m_vertices[intoIndex].y * (1 - intoLamdda) + this.m_vertices[intoIndex2].y * intoLamdda);
var outoVec = new b2Vec2(this.m_vertices[outoIndex].x * (1 - outoLamdda) + this.m_vertices[outoIndex2].x * outoLamdda, this.m_vertices[outoIndex].y * (1 - outoLamdda) + this.m_vertices[outoIndex2].y * outoLamdda);
var area = 0;
var center = new b2Vec2();
var p2 = this.m_vertices[intoIndex2];
var p3;
i = intoIndex2;
while (i != outoIndex2) {
i = (i + 1) % this.m_vertexCount;
if (i == outoIndex2) p3 = outoVec;
else p3 = this.m_vertices[i];
var triangleArea = 0.5 * ((p2.x - intoVec.x) * (p3.y - intoVec.y) - (p2.y - intoVec.y) * (p3.x - intoVec.x));
area += triangleArea;
center.x += triangleArea * (intoVec.x + p2.x + p3.x) / 3;
center.y += triangleArea * (intoVec.y + p2.y + p3.y) / 3;
p2 = p3;
}
center.Multiply(1 / area);
c.SetV(b2Math.MulX(xf, center));
return area;
}
b2PolygonShape.prototype.GetVertexCount = function () {
return this.m_vertexCount;
}
b2PolygonShape.prototype.GetVertices = function () {
return this.m_vertices;
}
b2PolygonShape.prototype.GetNormals = function () {
return this.m_normals;
}
b2PolygonShape.prototype.GetSupport = function (d) {
var bestIndex = 0;
var bestValue = this.m_vertices[0].x * d.x + this.m_vertices[0].y * d.y;
for (var i = 1; i < this.m_vertexCount; ++i) {
var value = this.m_vertices[i].x * d.x + this.m_vertices[i].y * d.y;
if (value > bestValue) {
bestIndex = i;
bestValue = value;
}
}
return bestIndex;
}
b2PolygonShape.prototype.GetSupportVertex = function (d) {
var bestIndex = 0;
var bestValue = this.m_vertices[0].x * d.x + this.m_vertices[0].y * d.y;
for (var i = 1; i < this.m_vertexCount; ++i) {
var value = this.m_vertices[i].x * d.x + this.m_vertices[i].y * d.y;
if (value > bestValue) {
bestIndex = i;
bestValue = value;
}
}
return this.m_vertices[bestIndex];
}
b2PolygonShape.prototype.Validate = function () {
return false;
}
b2PolygonShape.prototype.b2PolygonShape = function () {
this.__super.b2Shape.call(this);
this.m_type = b2Shape.e_polygonShape;
this.m_centroid = new b2Vec2();
this.m_vertices = new Vector();
this.m_normals = new Vector();
}
b2PolygonShape.prototype.Reserve = function (count) {
if (count === undefined) count = 0;
for (var i = parseInt(this.m_vertices.length); i < count; i++) {
this.m_vertices[i] = new b2Vec2();
this.m_normals[i] = new b2Vec2();
}
}
b2PolygonShape.ComputeCentroid = function (vs, count) {
if (count === undefined) count = 0;
var c = new b2Vec2();
var area = 0.0;
var p1X = 0.0;
var p1Y = 0.0;
var inv3 = 1.0 / 3.0;
for (var i = 0; i < count; ++i) {
var p2 = vs[i];
var p3 = i + 1 < count ? vs[parseInt(i + 1)] : vs[0];
var e1X = p2.x - p1X;
var e1Y = p2.y - p1Y;
var e2X = p3.x - p1X;
var e2Y = p3.y - p1Y;
var D = (e1X * e2Y - e1Y * e2X);
var triangleArea = 0.5 * D;area += triangleArea;
c.x += triangleArea * inv3 * (p1X + p2.x + p3.x);
c.y += triangleArea * inv3 * (p1Y + p2.y + p3.y);
}
c.x *= 1.0 / area;
c.y *= 1.0 / area;
return c;
}
b2PolygonShape.ComputeOBB = function (obb, vs, count) {
if (count === undefined) count = 0;
var i = 0;
var p = new Vector(count + 1);
for (i = 0;
i < count; ++i) {
p[i] = vs[i];
}
p[count] = p[0];
var minArea = Number.MAX_VALUE;
for (i = 1;
i <= count; ++i) {
var root = p[parseInt(i - 1)];
var uxX = p[i].x - root.x;
var uxY = p[i].y - root.y;
var length = Math.sqrt(uxX * uxX + uxY * uxY);
uxX /= length;
uxY /= length;
var uyX = (-uxY);
var uyY = uxX;
var lowerX = Number.MAX_VALUE;
var lowerY = Number.MAX_VALUE;
var upperX = (-Number.MAX_VALUE);
var upperY = (-Number.MAX_VALUE);
for (var j = 0; j < count; ++j) {
var dX = p[j].x - root.x;
var dY = p[j].y - root.y;
var rX = (uxX * dX + uxY * dY);
var rY = (uyX * dX + uyY * dY);
if (rX < lowerX) lowerX = rX;
if (rY < lowerY) lowerY = rY;
if (rX > upperX) upperX = rX;
if (rY > upperY) upperY = rY;
}
var area = (upperX - lowerX) * (upperY - lowerY);
if (area < 0.95 * minArea) {
minArea = area;
obb.R.col1.x = uxX;
obb.R.col1.y = uxY;
obb.R.col2.x = uyX;
obb.R.col2.y = uyY;
var centerX = 0.5 * (lowerX + upperX);
var centerY = 0.5 * (lowerY + upperY);
var tMat = obb.R;
obb.center.x = root.x + (tMat.col1.x * centerX + tMat.col2.x * centerY);
obb.center.y = root.y + (tMat.col1.y * centerX + tMat.col2.y * centerY);
obb.extents.x = 0.5 * (upperX - lowerX);
obb.extents.y = 0.5 * (upperY - lowerY);
}
}
}
Box2D.postDefs.push(function () {
Box2D.Collision.Shapes.b2PolygonShape.s_mat = new b2Mat22();
});
b2Shape.b2Shape = function () {};
b2Shape.prototype.Copy = function () {
return null;
}
b2Shape.prototype.Set = function (other) {
this.m_radius = other.m_radius;
}
b2Shape.prototype.GetType = function () {
return this.m_type;
}
b2Shape.prototype.TestPoint = function (xf, p) {
return false;
}
b2Shape.prototype.RayCast = function (output, input, transform) {
return false;
}
b2Shape.prototype.ComputeAABB = function (aabb, xf) {}
b2Shape.prototype.ComputeMass = function (massData, density) {
if (density === undefined) density = 0;
}
b2Shape.prototype.ComputeSubmergedArea = function (normal, offset, xf, c) {
if (offset === undefined) offset = 0;
return 0;
}
b2Shape.TestOverlap = function (shape1, transform1, shape2, transform2) {
var input = new b2DistanceInput();
input.proxyA = new b2DistanceProxy();
input.proxyA.Set(shape1);
input.proxyB = new b2DistanceProxy();
input.proxyB.Set(shape2);
input.transformA = transform1;
input.transformB = transform2;
input.useRadii = true;
var simplexCache = new b2SimplexCache();
simplexCache.count = 0;
var output = new b2DistanceOutput();
b2Distance.Distance(output, simplexCache, input);
return output.distance < 10.0 * Number.MIN_VALUE;
}
b2Shape.prototype.b2Shape = function () {
this.m_type = b2Shape.e_unknownShape;
this.m_radius = b2Settings.b2_linearSlop;
}
Box2D.postDefs.push(function () {
Box2D.Collision.Shapes.b2Shape.e_unknownShape = parseInt((-1));
Box2D.Collision.Shapes.b2Shape.e_circleShape = 0;
Box2D.Collision.Shapes.b2Shape.e_polygonShape = 1;
Box2D.Collision.Shapes.b2Shape.e_edgeShape = 2;
Box2D.Collision.Shapes.b2Shape.e_shapeTypeCount = 3;
Box2D.Collision.Shapes.b2Shape.e_hitCollide = 1;
Box2D.Collision.Shapes.b2Shape.e_missCollide = 0;
Box2D.Collision.Shapes.b2Shape.e_startsInsideCollide = parseInt((-1));
});
})();
(function () {
var b2Color = Box2D.Common.b2Color,
b2internal = Box2D.Common.b2internal,
b2Settings = Box2D.Common.b2Settings,
b2Mat22 = Box2D.Common.Math.b2Mat22,
b2Mat33 = Box2D.Common.Math.b2Mat33,
b2Math = Box2D.Common.Math.b2Math,
b2Sweep = Box2D.Common.Math.b2Sweep,
b2Transform = Box2D.Common.Math.b2Transform,
b2Vec2 = Box2D.Common.Math.b2Vec2,
b2Vec3 = Box2D.Common.Math.b2Vec3;
b2Color.b2Color = function () {
this._r = 0;
this._g = 0;
this._b = 0;
};
b2Color.prototype.b2Color = function (rr, gg, bb) {
if (rr === undefined) rr = 0;
if (gg === undefined) gg = 0;
if (bb === undefined) bb = 0;
this._r = Box2D.parseUInt(255 * b2Math.Clamp(rr, 0.0, 1.0));
this._g = Box2D.parseUInt(255 * b2Math.Clamp(gg, 0.0, 1.0));
this._b = Box2D.parseUInt(255 * b2Math.Clamp(bb, 0.0, 1.0));
}
b2Color.prototype.Set = function (rr, gg, bb) {
if (rr === undefined) rr = 0;
if (gg === undefined) gg = 0;
if (bb === undefined) bb = 0;
this._r = Box2D.parseUInt(255 * b2Math.Clamp(rr, 0.0, 1.0));
this._g = Box2D.parseUInt(255 * b2Math.Clamp(gg, 0.0, 1.0));
this._b = Box2D.parseUInt(255 * b2Math.Clamp(bb, 0.0, 1.0));
}
Object.defineProperty(b2Color.prototype, 'r', {
enumerable: false,
configurable: true,
set: function (rr) {
if (rr === undefined) rr = 0;
this._r = Box2D.parseUInt(255 * b2Math.Clamp(rr, 0.0, 1.0));
}
});
Object.defineProperty(b2Color.prototype, 'g', {
enumerable: false,
configurable: true,
set: function (gg) {
if (gg === undefined) gg = 0;
this._g = Box2D.parseUInt(255 * b2Math.Clamp(gg, 0.0, 1.0));
}
});
Object.defineProperty(b2Color.prototype, 'b', {
enumerable: false,
configurable: true,
set: function (bb) {
if (bb === undefined) bb = 0;
this._b = Box2D.parseUInt(255 * b2Math.Clamp(bb, 0.0, 1.0));
}
});
Object.defineProperty(b2Color.prototype, 'color', {
enumerable: false,
configurable: true,
get: function () {
return (this._r << 16) | (this._g << 8) | (this._b);
}
});
b2Settings.b2Settings = function () {};
b2Settings.b2MixFriction = function (friction1, friction2) {
if (friction1 === undefined) friction1 = 0;
if (friction2 === undefined) friction2 = 0;
return Math.sqrt(friction1 * friction2);
}
b2Settings.b2MixRestitution = function (restitution1, restitution2) {
if (restitution1 === undefined) restitution1 = 0;
if (restitution2 === undefined) restitution2 = 0;
return restitution1 > restitution2 ? restitution1 : restitution2;
}
b2Settings.b2Assert = function (a) {
if (!a) {
throw "Assertion Failed";
}
}
Box2D.postDefs.push(function () {
Box2D.Common.b2Settings.VERSION = "2.1alpha";
Box2D.Common.b2Settings.USHRT_MAX = 0x0000ffff;
Box2D.Common.b2Settings.b2_pi = Math.PI;
Box2D.Common.b2Settings.b2_maxManifoldPoints = 2;
Box2D.Common.b2Settings.b2_aabbExtension = 0.1;
Box2D.Common.b2Settings.b2_aabbMultiplier = 2.0;
Box2D.Common.b2Settings.b2_polygonRadius = 2.0 * b2Settings.b2_linearSlop;
Box2D.Common.b2Settings.b2_linearSlop = 0.005;
Box2D.Common.b2Settings.b2_angularSlop = 2.0 / 180.0 * b2Settings.b2_pi;
Box2D.Common.b2Settings.b2_toiSlop = 8.0 * b2Settings.b2_linearSlop;
Box2D.Common.b2Settings.b2_maxTOIContactsPerIsland = 32;
Box2D.Common.b2Settings.b2_maxTOIJointsPerIsland = 32;
Box2D.Common.b2Settings.b2_velocityThreshold = 1.0;
Box2D.Common.b2Settings.b2_maxLinearCorrection = 0.2;
Box2D.Common.b2Settings.b2_maxAngularCorrection = 8.0 / 180.0 * b2Settings.b2_pi;
Box2D.Common.b2Settings.b2_maxTranslation = 2.0;
Box2D.Common.b2Settings.b2_maxTranslationSquared = b2Settings.b2_maxTranslation * b2Settings.b2_maxTranslation;
Box2D.Common.b2Settings.b2_maxRotation = 0.5 * b2Settings.b2_pi;
Box2D.Common.b2Settings.b2_maxRotationSquared = b2Settings.b2_maxRotation * b2Settings.b2_maxRotation;
Box2D.Common.b2Settings.b2_contactBaumgarte = 0.2;
Box2D.Common.b2Settings.b2_timeToSleep = 0.5;
Box2D.Common.b2Settings.b2_linearSleepTolerance = 0.01;
Box2D.Common.b2Settings.b2_angularSleepTolerance = 2.0 / 180.0 * b2Settings.b2_pi;
});
})();
(function () {
var b2AABB = Box2D.Collision.b2AABB,
b2Color = Box2D.Common.b2Color,
b2internal = Box2D.Common.b2internal,
b2Settings = Box2D.Common.b2Settings,
b2Mat22 = Box2D.Common.Math.b2Mat22,
b2Mat33 = Box2D.Common.Math.b2Mat33,
b2Math = Box2D.Common.Math.b2Math,
b2Sweep = Box2D.Common.Math.b2Sweep,
b2Transform = Box2D.Common.Math.b2Transform,
b2Vec2 = Box2D.Common.Math.b2Vec2,
b2Vec3 = Box2D.Common.Math.b2Vec3;
b2Mat22.b2Mat22 = function () {
this.col1 = new b2Vec2();
this.col2 = new b2Vec2();
};
b2Mat22.prototype.b2Mat22 = function () {
this.SetIdentity();
}
b2Mat22.FromAngle = function (angle) {
if (angle === undefined) angle = 0;
var mat = new b2Mat22();
mat.Set(angle);
return mat;
}
b2Mat22.FromVV = function (c1, c2) {
var mat = new b2Mat22();
mat.SetVV(c1, c2);
return mat;
}
b2Mat22.prototype.Set = function (angle) {
if (angle === undefined) angle = 0;
var c = Math.cos(angle);
var s = Math.sin(angle);
this.col1.x = c;
this.col2.x = (-s);
this.col1.y = s;
this.col2.y = c;
}
b2Mat22.prototype.SetVV = function (c1, c2) {
this.col1.SetV(c1);
this.col2.SetV(c2);
}
b2Mat22.prototype.Copy = function () {
var mat = new b2Mat22();
mat.SetM(this);
return mat;
}
b2Mat22.prototype.SetM = function (m) {
this.col1.SetV(m.col1);
this.col2.SetV(m.col2);
}
b2Mat22.prototype.AddM = function (m) {
this.col1.x += m.col1.x;
this.col1.y += m.col1.y;
this.col2.x += m.col2.x;
this.col2.y += m.col2.y;
}
b2Mat22.prototype.SetIdentity = function () {
this.col1.x = 1.0;
this.col2.x = 0.0;
this.col1.y = 0.0;
this.col2.y = 1.0;
}
b2Mat22.prototype.SetZero = function () {
this.col1.x = 0.0;
this.col2.x = 0.0;
this.col1.y = 0.0;
this.col2.y = 0.0;
}
b2Mat22.prototype.GetAngle = function () {
return Math.atan2(this.col1.y, this.col1.x);
}
b2Mat22.prototype.GetInverse = function (out) {
var a = this.col1.x;
var b = this.col2.x;
var c = this.col1.y;
var d = this.col2.y;
var det = a * d - b * c;
if (det != 0.0) {
det = 1.0 / det;
}
out.col1.x = det * d;
out.col2.x = (-det * b);
out.col1.y = (-det * c);
out.col2.y = det * a;
return out;
}
b2Mat22.prototype.Solve = function (out, bX, bY) {
if (bX === undefined) bX = 0;
if (bY === undefined) bY = 0;
var a11 = this.col1.x;
var a12 = this.col2.x;
var a21 = this.col1.y;
var a22 = this.col2.y;
var det = a11 * a22 - a12 * a21;
if (det != 0.0) {
det = 1.0 / det;
}
out.x = det * (a22 * bX - a12 * bY);
out.y = det * (a11 * bY - a21 * bX);
return out;
}
b2Mat22.prototype.Abs = function () {
this.col1.Abs();
this.col2.Abs();
}
b2Mat33.b2Mat33 = function () {
this.col1 = new b2Vec3();
this.col2 = new b2Vec3();
this.col3 = new b2Vec3();
};
b2Mat33.prototype.b2Mat33 = function (c1, c2, c3) {
if (c1 === undefined) c1 = null;
if (c2 === undefined) c2 = null;
if (c3 === undefined) c3 = null;
if (!c1 && !c2 && !c3) {
this.col1.SetZero();
this.col2.SetZero();
this.col3.SetZero();
}
else {
this.col1.SetV(c1);
this.col2.SetV(c2);
this.col3.SetV(c3);
}
}
b2Mat33.prototype.SetVVV = function (c1, c2, c3) {
this.col1.SetV(c1);
this.col2.SetV(c2);
this.col3.SetV(c3);
}
b2Mat33.prototype.Copy = function () {
return new b2Mat33(this.col1, this.col2, this.col3);
}
b2Mat33.prototype.SetM = function (m) {
this.col1.SetV(m.col1);
this.col2.SetV(m.col2);
this.col3.SetV(m.col3);
}
b2Mat33.prototype.AddM = function (m) {
this.col1.x += m.col1.x;
this.col1.y += m.col1.y;
this.col1.z += m.col1.z;
this.col2.x += m.col2.x;
this.col2.y += m.col2.y;
this.col2.z += m.col2.z;
this.col3.x += m.col3.x;
this.col3.y += m.col3.y;
this.col3.z += m.col3.z;
}
b2Mat33.prototype.SetIdentity = function () {
this.col1.x = 1.0;
this.col2.x = 0.0;
this.col3.x = 0.0;
this.col1.y = 0.0;
this.col2.y = 1.0;
this.col3.y = 0.0;
this.col1.z = 0.0;
this.col2.z = 0.0;
this.col3.z = 1.0;
}
b2Mat33.prototype.SetZero = function () {
this.col1.x = 0.0;
this.col2.x = 0.0;
this.col3.x = 0.0;
this.col1.y = 0.0;
this.col2.y = 0.0;
this.col3.y = 0.0;
this.col1.z = 0.0;
this.col2.z = 0.0;
this.col3.z = 0.0;
}
b2Mat33.prototype.Solve22 = function (out, bX, bY) {
if (bX === undefined) bX = 0;
if (bY === undefined) bY = 0;
var a11 = this.col1.x;
var a12 = this.col2.x;
var a21 = this.col1.y;
var a22 = this.col2.y;
var det = a11 * a22 - a12 * a21;
if (det != 0.0) {
det = 1.0 / det;
}
out.x = det * (a22 * bX - a12 * bY);
out.y = det * (a11 * bY - a21 * bX);
return out;
}
b2Mat33.prototype.Solve33 = function (out, bX, bY, bZ) {
if (bX === undefined) bX = 0;
if (bY === undefined) bY = 0;
if (bZ === undefined) bZ = 0;
var a11 = this.col1.x;
var a21 = this.col1.y;
var a31 = this.col1.z;
var a12 = this.col2.x;
var a22 = this.col2.y;
var a32 = this.col2.z;
var a13 = this.col3.x;
var a23 = this.col3.y;
var a33 = this.col3.z;
var det = a11 * (a22 * a33 - a32 * a23) + a21 * (a32 * a13 - a12 * a33) + a31 * (a12 * a23 - a22 * a13);
if (det != 0.0) {
det = 1.0 / det;
}
out.x = det * (bX * (a22 * a33 - a32 * a23) + bY * (a32 * a13 - a12 * a33) + bZ * (a12 * a23 - a22 * a13));
out.y = det * (a11 * (bY * a33 - bZ * a23) + a21 * (bZ * a13 - bX * a33) + a31 * (bX * a23 - bY * a13));
out.z = det * (a11 * (a22 * bZ - a32 * bY) + a21 * (a32 * bX - a12 * bZ) + a31 * (a12 * bY - a22 * bX));
return out;
}
b2Math.b2Math = function () {};
b2Math.IsValid = function (x) {
if (x === undefined) x = 0;
return isFinite(x);
}
b2Math.Dot = function (a, b) {
return a.x * b.x + a.y * b.y;
}
b2Math.CrossVV = function (a, b) {
return a.x * b.y - a.y * b.x;
}
b2Math.CrossVF = function (a, s) {
if (s === undefined) s = 0;
var v = new b2Vec2(s * a.y, (-s * a.x));
return v;
}
b2Math.CrossFV = function (s, a) {
if (s === undefined) s = 0;
var v = new b2Vec2((-s * a.y), s * a.x);
return v;
}
b2Math.MulMV = function (A, v) {
var u = new b2Vec2(A.col1.x * v.x + A.col2.x * v.y, A.col1.y * v.x + A.col2.y * v.y);
return u;
}
b2Math.MulTMV = function (A, v) {
var u = new b2Vec2(b2Math.Dot(v, A.col1), b2Math.Dot(v, A.col2));
return u;
}
b2Math.MulX = function (T, v) {
var a = b2Math.MulMV(T.R, v);
a.x += T.position.x;
a.y += T.position.y;
return a;
}
b2Math.MulXT = function (T, v) {
var a = b2Math.SubtractVV(v, T.position);
var tX = (a.x * T.R.col1.x + a.y * T.R.col1.y);
a.y = (a.x * T.R.col2.x + a.y * T.R.col2.y);
a.x = tX;
return a;
}
b2Math.AddVV = function (a, b) {
var v = new b2Vec2(a.x + b.x, a.y + b.y);
return v;
}
b2Math.SubtractVV = function (a, b) {
var v = new b2Vec2(a.x - b.x, a.y - b.y);
return v;
}
b2Math.Distance = function (a, b) {
var cX = a.x - b.x;
var cY = a.y - b.y;
return Math.sqrt(cX * cX + cY * cY);
}
b2Math.DistanceSquared = function (a, b) {
var cX = a.x - b.x;
var cY = a.y - b.y;
return (cX * cX + cY * cY);
}
b2Math.MulFV = function (s, a) {
if (s === undefined) s = 0;
var v = new b2Vec2(s * a.x, s * a.y);
return v;
}
b2Math.AddMM = function (A, B) {
var C = b2Mat22.FromVV(b2Math.AddVV(A.col1, B.col1), b2Math.AddVV(A.col2, B.col2));
return C;
}
b2Math.MulMM = function (A, B) {
var C = b2Mat22.FromVV(b2Math.MulMV(A, B.col1), b2Math.MulMV(A, B.col2));
return C;
}
b2Math.MulTMM = function (A, B) {
var c1 = new b2Vec2(b2Math.Dot(A.col1, B.col1), b2Math.Dot(A.col2, B.col1));
var c2 = new b2Vec2(b2Math.Dot(A.col1, B.col2), b2Math.Dot(A.col2, B.col2));
var C = b2Mat22.FromVV(c1, c2);
return C;
}
b2Math.Abs = function (a) {
if (a === undefined) a = 0;
return a > 0.0 ? a : (-a);
}
b2Math.AbsV = function (a) {
var b = new b2Vec2(b2Math.Abs(a.x), b2Math.Abs(a.y));
return b;
}
b2Math.AbsM = function (A) {
var B = b2Mat22.FromVV(b2Math.AbsV(A.col1), b2Math.AbsV(A.col2));
return B;
}
b2Math.Min = function (a, b) {
if (a === undefined) a = 0;
if (b === undefined) b = 0;
return a < b ? a : b;
}
b2Math.MinV = function (a, b) {
var c = new b2Vec2(b2Math.Min(a.x, b.x), b2Math.Min(a.y, b.y));
return c;
}
b2Math.Max = function (a, b) {
if (a === undefined) a = 0;
if (b === undefined) b = 0;
return a > b ? a : b;
}
b2Math.MaxV = function (a, b) {
var c = new b2Vec2(b2Math.Max(a.x, b.x), b2Math.Max(a.y, b.y));
return c;
}
b2Math.Clamp = function (a, low, high) {
if (a === undefined) a = 0;
if (low === undefined) low = 0;
if (high === undefined) high = 0;
return a < low ? low : a > high ? high : a;
}
b2Math.ClampV = function (a, low, high) {
return b2Math.MaxV(low, b2Math.MinV(a, high));
}
b2Math.Swap = function (a, b) {
var tmp = a[0];
a[0] = b[0];
b[0] = tmp;
}
b2Math.Random = function () {
return Math.random() * 2 - 1;
}
b2Math.RandomRange = function (lo, hi) {
if (lo === undefined) lo = 0;
if (hi === undefined) hi = 0;
var r = Math.random();
r = (hi - lo) * r + lo;
return r;
}
b2Math.NextPowerOfTwo = function (x) {
if (x === undefined) x = 0;
x |= (x >> 1) & 0x7FFFFFFF;
x |= (x >> 2) & 0x3FFFFFFF;
x |= (x >> 4) & 0x0FFFFFFF;
x |= (x >> 8) & 0x00FFFFFF;
x |= (x >> 16) & 0x0000FFFF;
return x + 1;
}
b2Math.IsPowerOfTwo = function (x) {
if (x === undefined) x = 0;
var result = x > 0 && (x & (x - 1)) == 0;
return result;
}
Box2D.postDefs.push(function () {
Box2D.Common.Math.b2Math.b2Vec2_zero = new b2Vec2(0.0, 0.0);
Box2D.Common.Math.b2Math.b2Mat22_identity = b2Mat22.FromVV(new b2Vec2(1.0, 0.0), new b2Vec2(0.0, 1.0));
Box2D.Common.Math.b2Math.b2Transform_identity = new b2Transform(b2Math.b2Vec2_zero, b2Math.b2Mat22_identity);
});
b2Sweep.b2Sweep = function () {
this.localCenter = new b2Vec2();
this.c0 = new b2Vec2;
this.c = new b2Vec2();
};
b2Sweep.prototype.Set = function (other) {
this.localCenter.SetV(other.localCenter);
this.c0.SetV(other.c0);
this.c.SetV(other.c);
this.a0 = other.a0;
this.a = other.a;
this.t0 = other.t0;
}
b2Sweep.prototype.Copy = function () {
var copy = new b2Sweep();
copy.localCenter.SetV(this.localCenter);
copy.c0.SetV(this.c0);
copy.c.SetV(this.c);
copy.a0 = this.a0;
copy.a = this.a;
copy.t0 = this.t0;
return copy;
}
b2Sweep.prototype.GetTransform = function (xf, alpha) {
if (alpha === undefined) alpha = 0;
xf.position.x = (1.0 - alpha) * this.c0.x + alpha * this.c.x;
xf.position.y = (1.0 - alpha) * this.c0.y + alpha * this.c.y;
var angle = (1.0 - alpha) * this.a0 + alpha * this.a;
xf.R.Set(angle);
var tMat = xf.R;
xf.position.x -= (tMat.col1.x * this.localCenter.x + tMat.col2.x * this.localCenter.y);
xf.position.y -= (tMat.col1.y * this.localCenter.x + tMat.col2.y * this.localCenter.y);
}
b2Sweep.prototype.Advance = function (t) {
if (t === undefined) t = 0;
if (this.t0 < t && 1.0 - this.t0 > Number.MIN_VALUE) {
var alpha = (t - this.t0) / (1.0 - this.t0);
this.c0.x = (1.0 - alpha) * this.c0.x + alpha * this.c.x;
this.c0.y = (1.0 - alpha) * this.c0.y + alpha * this.c.y;
this.a0 = (1.0 - alpha) * this.a0 + alpha * this.a;
this.t0 = t;
}
}
b2Transform.b2Transform = function () {
this.position = new b2Vec2;
this.R = new b2Mat22();
};
b2Transform.prototype.b2Transform = function (pos, r) {
if (pos === undefined) pos = null;
if (r === undefined) r = null;
if (pos) {
this.position.SetV(pos);
this.R.SetM(r);
}
}
b2Transform.prototype.Initialize = function (pos, r) {
this.position.SetV(pos);
this.R.SetM(r);
}
b2Transform.prototype.SetIdentity = function () {
this.position.SetZero();
this.R.SetIdentity();
}
b2Transform.prototype.Set = function (x) {
this.position.SetV(x.position);
this.R.SetM(x.R);
}
b2Transform.prototype.GetAngle = function () {
return Math.atan2(this.R.col1.y, this.R.col1.x);
}
b2Vec2.b2Vec2 = function () {};
b2Vec2.prototype.b2Vec2 = function (x_, y_) {
if (x_ === undefined) x_ = 0;
if (y_ === undefined) y_ = 0;
this.x = x_;
this.y = y_;
}
b2Vec2.prototype.SetZero = function () {
this.x = 0.0;
this.y = 0.0;
}
b2Vec2.prototype.Set = function (x_, y_) {
if (x_ === undefined) x_ = 0;
if (y_ === undefined) y_ = 0;
this.x = x_;
this.y = y_;
}
b2Vec2.prototype.SetV = function (v) {
this.x = v.x;
this.y = v.y;
}
b2Vec2.prototype.GetNegative = function () {
return new b2Vec2((-this.x), (-this.y));
}
b2Vec2.prototype.NegativeSelf = function () {
this.x = (-this.x);
this.y = (-this.y);
}
b2Vec2.Make = function (x_, y_) {
if (x_ === undefined) x_ = 0;
if (y_ === undefined) y_ = 0;
return new b2Vec2(x_, y_);
}
b2Vec2.prototype.Copy = function () {
return new b2Vec2(this.x, this.y);
}
b2Vec2.prototype.Add = function (v) {
this.x += v.x;
this.y += v.y;
}
b2Vec2.prototype.Subtract = function (v) {
this.x -= v.x;
this.y -= v.y;
}
b2Vec2.prototype.Multiply = function (a) {
if (a === undefined) a = 0;
this.x *= a;
this.y *= a;
}
b2Vec2.prototype.MulM = function (A) {
var tX = this.x;
this.x = A.col1.x * tX + A.col2.x * this.y;
this.y = A.col1.y * tX + A.col2.y * this.y;
}
b2Vec2.prototype.MulTM = function (A) {
var tX = b2Math.Dot(this, A.col1);
this.y = b2Math.Dot(this, A.col2);
this.x = tX;
}
b2Vec2.prototype.CrossVF = function (s) {
if (s === undefined) s = 0;
var tX = this.x;
this.x = s * this.y;
this.y = (-s * tX);
}
b2Vec2.prototype.CrossFV = function (s) {
if (s === undefined) s = 0;
var tX = this.x;
this.x = (-s * this.y);
this.y = s * tX;
}
b2Vec2.prototype.MinV = function (b) {
this.x = this.x < b.x ? this.x : b.x;
this.y = this.y < b.y ? this.y : b.y;
}
b2Vec2.prototype.MaxV = function (b) {
this.x = this.x > b.x ? this.x : b.x;
this.y = this.y > b.y ? this.y : b.y;
}
b2Vec2.prototype.Abs = function () {
if (this.x < 0) this.x = (-this.x);
if (this.y < 0) this.y = (-this.y);
}
b2Vec2.prototype.Length = function () {
return Math.sqrt(this.x * this.x + this.y * this.y);
}
b2Vec2.prototype.LengthSquared = function () {
return (this.x * this.x + this.y * this.y);
}
b2Vec2.prototype.Normalize = function () {
var length = Math.sqrt(this.x * this.x + this.y * this.y);
if (length < Number.MIN_VALUE) {
return 0.0;
}
var invLength = 1.0 / length;
this.x *= invLength;
this.y *= invLength;
return length;
}
b2Vec2.prototype.IsValid = function () {
return b2Math.IsValid(this.x) && b2Math.IsValid(this.y);
}
b2Vec3.b2Vec3 = function () {};
b2Vec3.prototype.b2Vec3 = function (x, y, z) {
if (x === undefined) x = 0;
if (y === undefined) y = 0;
if (z === undefined) z = 0;
this.x = x;
this.y = y;
this.z = z;
}
b2Vec3.prototype.SetZero = function () {
this.x = this.y = this.z = 0.0;
}
b2Vec3.prototype.Set = function (x, y, z) {
if (x === undefined) x = 0;
if (y === undefined) y = 0;
if (z === undefined) z = 0;
this.x = x;
this.y = y;
this.z = z;
}
b2Vec3.prototype.SetV = function (v) {
this.x = v.x;
this.y = v.y;
this.z = v.z;
}
b2Vec3.prototype.GetNegative = function () {
return new b2Vec3((-this.x), (-this.y), (-this.z));
}
b2Vec3.prototype.NegativeSelf = function () {
this.x = (-this.x);
this.y = (-this.y);
this.z = (-this.z);
}
b2Vec3.prototype.Copy = function () {
return new b2Vec3(this.x, this.y, this.z);
}
b2Vec3.prototype.Add = function (v) {
this.x += v.x;
this.y += v.y;
this.z += v.z;
}
b2Vec3.prototype.Subtract = function (v) {
this.x -= v.x;
this.y -= v.y;
this.z -= v.z;
}
b2Vec3.prototype.Multiply = function (a) {
if (a === undefined) a = 0;
this.x *= a;
this.y *= a;
this.z *= a;
}
})();
(function () {
var b2ControllerEdge = Box2D.Dynamics.Controllers.b2ControllerEdge,
b2Mat22 = Box2D.Common.Math.b2Mat22,
b2Mat33 = Box2D.Common.Math.b2Mat33,
b2Math = Box2D.Common.Math.b2Math,
b2Sweep = Box2D.Common.Math.b2Sweep,
b2Transform = Box2D.Common.Math.b2Transform,
b2Vec2 = Box2D.Common.Math.b2Vec2,
b2Vec3 = Box2D.Common.Math.b2Vec3,
b2Color = Box2D.Common.b2Color,
b2internal = Box2D.Common.b2internal,
b2Settings = Box2D.Common.b2Settings,
b2AABB = Box2D.Collision.b2AABB,
b2Bound = Box2D.Collision.b2Bound,
b2BoundValues = Box2D.Collision.b2BoundValues,
b2Collision = Box2D.Collision.b2Collision,
b2ContactID = Box2D.Collision.b2ContactID,
b2ContactPoint = Box2D.Collision.b2ContactPoint,
b2Distance = Box2D.Collision.b2Distance,
b2DistanceInput = Box2D.Collision.b2DistanceInput,
b2DistanceOutput = Box2D.Collision.b2DistanceOutput,
b2DistanceProxy = Box2D.Collision.b2DistanceProxy,
b2DynamicTree = Box2D.Collision.b2DynamicTree,
b2DynamicTreeBroadPhase = Box2D.Collision.b2DynamicTreeBroadPhase,
b2DynamicTreeNode = Box2D.Collision.b2DynamicTreeNode,
b2DynamicTreePair = Box2D.Collision.b2DynamicTreePair,
b2Manifold = Box2D.Collision.b2Manifold,
b2ManifoldPoint = Box2D.Collision.b2ManifoldPoint,
b2Point = Box2D.Collision.b2Point,
b2RayCastInput = Box2D.Collision.b2RayCastInput,
b2RayCastOutput = Box2D.Collision.b2RayCastOutput,
b2Segment = Box2D.Collision.b2Segment,
b2SeparationFunction = Box2D.Collision.b2SeparationFunction,
b2Simplex = Box2D.Collision.b2Simplex,
b2SimplexCache = Box2D.Collision.b2SimplexCache,
b2SimplexVertex = Box2D.Collision.b2SimplexVertex,
b2TimeOfImpact = Box2D.Collision.b2TimeOfImpact,
b2TOIInput = Box2D.Collision.b2TOIInput,
b2WorldManifold = Box2D.Collision.b2WorldManifold,
ClipVertex = Box2D.Collision.ClipVertex,
Features = Box2D.Collision.Features,
IBroadPhase = Box2D.Collision.IBroadPhase,
b2CircleShape = Box2D.Collision.Shapes.b2CircleShape,
b2EdgeChainDef = Box2D.Collision.Shapes.b2EdgeChainDef,
b2EdgeShape = Box2D.Collision.Shapes.b2EdgeShape,
b2MassData = Box2D.Collision.Shapes.b2MassData,
b2PolygonShape = Box2D.Collision.Shapes.b2PolygonShape,
b2Shape = Box2D.Collision.Shapes.b2Shape,
b2Body = Box2D.Dynamics.b2Body,
b2BodyDef = Box2D.Dynamics.b2BodyDef,
b2ContactFilter = Box2D.Dynamics.b2ContactFilter,
b2ContactImpulse = Box2D.Dynamics.b2ContactImpulse,
b2ContactListener = Box2D.Dynamics.b2ContactListener,
b2ContactManager = Box2D.Dynamics.b2ContactManager,
b2DebugDraw = Box2D.Dynamics.b2DebugDraw,
b2DestructionListener = Box2D.Dynamics.b2DestructionListener,
b2FilterData = Box2D.Dynamics.b2FilterData,
b2Fixture = Box2D.Dynamics.b2Fixture,
b2FixtureDef = Box2D.Dynamics.b2FixtureDef,
b2Island = Box2D.Dynamics.b2Island,
b2TimeStep = Box2D.Dynamics.b2TimeStep,
b2World = Box2D.Dynamics.b2World,
b2CircleContact = Box2D.Dynamics.Contacts.b2CircleContact,
b2Contact = Box2D.Dynamics.Contacts.b2Contact,
b2ContactConstraint = Box2D.Dynamics.Contacts.b2ContactConstraint,
b2ContactConstraintPoint = Box2D.Dynamics.Contacts.b2ContactConstraintPoint,
b2ContactEdge = Box2D.Dynamics.Contacts.b2ContactEdge,
b2ContactFactory = Box2D.Dynamics.Contacts.b2ContactFactory,
b2ContactRegister = Box2D.Dynamics.Contacts.b2ContactRegister,
b2ContactResult = Box2D.Dynamics.Contacts.b2ContactResult,
b2ContactSolver = Box2D.Dynamics.Contacts.b2ContactSolver,
b2EdgeAndCircleContact = Box2D.Dynamics.Contacts.b2EdgeAndCircleContact,
b2NullContact = Box2D.Dynamics.Contacts.b2NullContact,
b2PolyAndCircleContact = Box2D.Dynamics.Contacts.b2PolyAndCircleContact,
b2PolyAndEdgeContact = Box2D.Dynamics.Contacts.b2PolyAndEdgeContact,
b2PolygonContact = Box2D.Dynamics.Contacts.b2PolygonContact,
b2PositionSolverManifold = Box2D.Dynamics.Contacts.b2PositionSolverManifold,
b2Controller = Box2D.Dynamics.Controllers.b2Controller,
b2DistanceJoint = Box2D.Dynamics.Joints.b2DistanceJoint,
b2DistanceJointDef = Box2D.Dynamics.Joints.b2DistanceJointDef,
b2FrictionJoint = Box2D.Dynamics.Joints.b2FrictionJoint,
b2FrictionJointDef = Box2D.Dynamics.Joints.b2FrictionJointDef,
b2GearJoint = Box2D.Dynamics.Joints.b2GearJoint,
b2GearJointDef = Box2D.Dynamics.Joints.b2GearJointDef,
b2Jacobian = Box2D.Dynamics.Joints.b2Jacobian,
b2Joint = Box2D.Dynamics.Joints.b2Joint,
b2JointDef = Box2D.Dynamics.Joints.b2JointDef,
b2JointEdge = Box2D.Dynamics.Joints.b2JointEdge,
b2LineJoint = Box2D.Dynamics.Joints.b2LineJoint,
b2LineJointDef = Box2D.Dynamics.Joints.b2LineJointDef,
b2MouseJoint = Box2D.Dynamics.Joints.b2MouseJoint,
b2MouseJointDef = Box2D.Dynamics.Joints.b2MouseJointDef,
b2PrismaticJoint = Box2D.Dynamics.Joints.b2PrismaticJoint,
b2PrismaticJointDef = Box2D.Dynamics.Joints.b2PrismaticJointDef,
b2PulleyJoint = Box2D.Dynamics.Joints.b2PulleyJoint,
b2PulleyJointDef = Box2D.Dynamics.Joints.b2PulleyJointDef,
b2RevoluteJoint = Box2D.Dynamics.Joints.b2RevoluteJoint,
b2RevoluteJointDef = Box2D.Dynamics.Joints.b2RevoluteJointDef,
b2WeldJoint = Box2D.Dynamics.Joints.b2WeldJoint,
b2WeldJointDef = Box2D.Dynamics.Joints.b2WeldJointDef;
b2Body.b2Body = function () {
this.m_xf = new b2Transform();
this.m_sweep = new b2Sweep();
this.m_linearVelocity = new b2Vec2();
this.m_force = new b2Vec2();
};
b2Body.prototype.connectEdges = function (s1, s2, angle1) {
if (angle1 === undefined) angle1 = 0;
var angle2 = Math.atan2(s2.GetDirectionVector().y, s2.GetDirectionVector().x);
var coreOffset = Math.tan((angle2 - angle1) * 0.5);
var core = b2Math.MulFV(coreOffset, s2.GetDirectionVector());
core = b2Math.SubtractVV(core, s2.GetNormalVector());
core = b2Math.MulFV(b2Settings.b2_toiSlop, core);
core = b2Math.AddVV(core, s2.GetVertex1());
var cornerDir = b2Math.AddVV(s1.GetDirectionVector(), s2.GetDirectionVector());
cornerDir.Normalize();
var convex = b2Math.Dot(s1.GetDirectionVector(), s2.GetNormalVector()) > 0.0;
s1.SetNextEdge(s2, core, cornerDir, convex);
s2.SetPrevEdge(s1, core, cornerDir, convex);
return angle2;
}
b2Body.prototype.CreateFixture = function (def) {
if (this.m_world.IsLocked() == true) {
return null;
}
var fixture = new b2Fixture();
fixture.Create(this, this.m_xf, def);
if (this.m_flags & b2Body.e_activeFlag) {
var broadPhase = this.m_world.m_contactManager.m_broadPhase;
fixture.CreateProxy(broadPhase, this.m_xf);
}
fixture.m_next = this.m_fixtureList;
this.m_fixtureList = fixture;
++this.m_fixtureCount;
fixture.m_body = this;
if (fixture.m_density > 0.0) {
this.ResetMassData();
}
this.m_world.m_flags |= b2World.e_newFixture;
return fixture;
}
b2Body.prototype.CreateFixture2 = function (shape, density) {
if (density === undefined) density = 0.0;
var def = new b2FixtureDef();
def.shape = shape;
def.density = density;
return this.CreateFixture(def);
}
b2Body.prototype.DestroyFixture = function (fixture) {
if (this.m_world.IsLocked() == true) {
return;
}
var node = this.m_fixtureList;
var ppF = null;
var found = false;
while (node != null) {
if (node == fixture) {
if (ppF) ppF.m_next = fixture.m_next;
else this.m_fixtureList = fixture.m_next;
found = true;
break;
}
ppF = node;
node = node.m_next;
}
var edge = this.m_contactList;
while (edge) {
var c = edge.contact;
edge = edge.next;
var fixtureA = c.GetFixtureA();
var fixtureB = c.GetFixtureB();
if (fixture == fixtureA || fixture == fixtureB) {
this.m_world.m_contactManager.Destroy(c);
}
}
if (this.m_flags & b2Body.e_activeFlag) {
var broadPhase = this.m_world.m_contactManager.m_broadPhase;
fixture.DestroyProxy(broadPhase);
}
else {}
fixture.Destroy();
fixture.m_body = null;
fixture.m_next = null;
--this.m_fixtureCount;
this.ResetMassData();
}
b2Body.prototype.SetPositionAndAngle = function (position, angle) {
if (angle === undefined) angle = 0;
var f;
if (this.m_world.IsLocked() == true) {
return;
}
this.m_xf.R.Set(angle);
this.m_xf.position.SetV(position);
var tMat = this.m_xf.R;
var tVec = this.m_sweep.localCenter;
this.m_sweep.c.x = (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
this.m_sweep.c.y = (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
this.m_sweep.c.x += this.m_xf.position.x;
this.m_sweep.c.y += this.m_xf.position.y;
this.m_sweep.c0.SetV(this.m_sweep.c);
this.m_sweep.a0 = this.m_sweep.a = angle;
var broadPhase = this.m_world.m_contactManager.m_broadPhase;
for (f = this.m_fixtureList;
f; f = f.m_next) {
f.Synchronize(broadPhase, this.m_xf, this.m_xf);
}
this.m_world.m_contactManager.FindNewContacts();
}
b2Body.prototype.SetTransform = function (xf) {
this.SetPositionAndAngle(xf.position, xf.GetAngle());
}
b2Body.prototype.GetTransform = function () {
return this.m_xf;
}
b2Body.prototype.GetPosition = function () {
return this.m_xf.position;
}
b2Body.prototype.SetPosition = function (position) {
this.SetPositionAndAngle(position, this.GetAngle());
}
b2Body.prototype.GetAngle = function () {
return this.m_sweep.a;
}
b2Body.prototype.SetAngle = function (angle) {
if (angle === undefined) angle = 0;
this.SetPositionAndAngle(this.GetPosition(), angle);
}
b2Body.prototype.GetWorldCenter = function () {
return this.m_sweep.c;
}
b2Body.prototype.GetLocalCenter = function () {
return this.m_sweep.localCenter;
}
b2Body.prototype.SetLinearVelocity = function (v) {
if (this.m_type == b2Body.b2_staticBody) {
return;
}
this.m_linearVelocity.SetV(v);
}
b2Body.prototype.GetLinearVelocity = function () {
return this.m_linearVelocity;
}
b2Body.prototype.SetAngularVelocity = function (omega) {
if (omega === undefined) omega = 0;
if (this.m_type == b2Body.b2_staticBody) {
return;
}
this.m_angularVelocity = omega;
}
b2Body.prototype.GetAngularVelocity = function () {
return this.m_angularVelocity;
}
b2Body.prototype.GetDefinition = function () {
var bd = new b2BodyDef();
bd.type = this.GetType();
bd.allowSleep = (this.m_flags & b2Body.e_allowSleepFlag) == b2Body.e_allowSleepFlag;
bd.angle = this.GetAngle();
bd.angularDamping = this.m_angularDamping;
bd.angularVelocity = this.m_angularVelocity;
bd.fixedRotation = (this.m_flags & b2Body.e_fixedRotationFlag) == b2Body.e_fixedRotationFlag;
bd.bullet = (this.m_flags & b2Body.e_bulletFlag) == b2Body.e_bulletFlag;
bd.awake = (this.m_flags & b2Body.e_awakeFlag) == b2Body.e_awakeFlag;
bd.linearDamping = this.m_linearDamping;
bd.linearVelocity.SetV(this.GetLinearVelocity());
bd.position = this.GetPosition();
bd.userData = this.GetUserData();
return bd;
}
b2Body.prototype.ApplyForce = function (force, point) {
if (this.m_type != b2Body.b2_dynamicBody) {
return;
}
if (this.IsAwake() == false) {
this.SetAwake(true);
}
this.m_force.x += force.x;
this.m_force.y += force.y;
this.m_torque += ((point.x - this.m_sweep.c.x) * force.y - (point.y - this.m_sweep.c.y) * force.x);
}
b2Body.prototype.ApplyTorque = function (torque) {
if (torque === undefined) torque = 0;
if (this.m_type != b2Body.b2_dynamicBody) {
return;
}
if (this.IsAwake() == false) {
this.SetAwake(true);
}
this.m_torque += torque;
}
b2Body.prototype.ApplyImpulse = function (impulse, point) {
if (this.m_type != b2Body.b2_dynamicBody) {
return;
}
if (this.IsAwake() == false) {
this.SetAwake(true);
}
this.m_linearVelocity.x += this.m_invMass * impulse.x;
this.m_linearVelocity.y += this.m_invMass * impulse.y;
this.m_angularVelocity += this.m_invI * ((point.x - this.m_sweep.c.x) * impulse.y - (point.y - this.m_sweep.c.y) * impulse.x);
}
b2Body.prototype.Split = function (callback) {
var linearVelocity = this.GetLinearVelocity().Copy();
var angularVelocity = this.GetAngularVelocity();
var center = this.GetWorldCenter();
var body1 = this;
var body2 = this.m_world.CreateBody(this.GetDefinition());
var prev;
for (var f = body1.m_fixtureList; f;) {
if (callback(f)) {
var next = f.m_next;
if (prev) {
prev.m_next = next;
}
else {
body1.m_fixtureList = next;
}
body1.m_fixtureCount--;
f.m_next = body2.m_fixtureList;
body2.m_fixtureList = f;
body2.m_fixtureCount++;
f.m_body = body2;
f = next;
}
else {
prev = f;
f = f.m_next;
}
}
body1.ResetMassData();
body2.ResetMassData();
var center1 = body1.GetWorldCenter();
var center2 = body2.GetWorldCenter();
var velocity1 = b2Math.AddVV(linearVelocity, b2Math.CrossFV(angularVelocity, b2Math.SubtractVV(center1, center)));
var velocity2 = b2Math.AddVV(linearVelocity, b2Math.CrossFV(angularVelocity, b2Math.SubtractVV(center2, center)));
body1.SetLinearVelocity(velocity1);
body2.SetLinearVelocity(velocity2);
body1.SetAngularVelocity(angularVelocity);
body2.SetAngularVelocity(angularVelocity);
body1.SynchronizeFixtures();
body2.SynchronizeFixtures();
return body2;
}
b2Body.prototype.Merge = function (other) {
var f;
for (f = other.m_fixtureList;
f;) {
var next = f.m_next;
other.m_fixtureCount--;
f.m_next = this.m_fixtureList;
this.m_fixtureList = f;
this.m_fixtureCount++;
f.m_body = body2;
f = next;
}
body1.m_fixtureCount = 0;
var body1 = this;
var body2 = other;
var center1 = body1.GetWorldCenter();
var center2 = body2.GetWorldCenter();
var velocity1 = body1.GetLinearVelocity().Copy();
var velocity2 = body2.GetLinearVelocity().Copy();
var angular1 = body1.GetAngularVelocity();
var angular = body2.GetAngularVelocity();
body1.ResetMassData();
this.SynchronizeFixtures();
}
b2Body.prototype.GetMass = function () {
return this.m_mass;
}
b2Body.prototype.GetInertia = function () {
return this.m_I;
}
b2Body.prototype.GetMassData = function (data) {
data.mass = this.m_mass;
data.I = this.m_I;
data.center.SetV(this.m_sweep.localCenter);
}
b2Body.prototype.SetMassData = function (massData) {
b2Settings.b2Assert(this.m_world.IsLocked() == false);
if (this.m_world.IsLocked() == true) {
return;
}
if (this.m_type != b2Body.b2_dynamicBody) {
return;
}
this.m_invMass = 0.0;
this.m_I = 0.0;
this.m_invI = 0.0;
this.m_mass = massData.mass;
if (this.m_mass <= 0.0) {
this.m_mass = 1.0;
}
this.m_invMass = 1.0 / this.m_mass;
if (massData.I > 0.0 && (this.m_flags & b2Body.e_fixedRotationFlag) == 0) {
this.m_I = massData.I - this.m_mass * (massData.center.x * massData.center.x + massData.center.y * massData.center.y);
this.m_invI = 1.0 / this.m_I;
}
var oldCenter = this.m_sweep.c.Copy();
this.m_sweep.localCenter.SetV(massData.center);
this.m_sweep.c0.SetV(b2Math.MulX(this.m_xf, this.m_sweep.localCenter));
this.m_sweep.c.SetV(this.m_sweep.c0);
this.m_linearVelocity.x += this.m_angularVelocity * (-(this.m_sweep.c.y - oldCenter.y));
this.m_linearVelocity.y += this.m_angularVelocity * (+(this.m_sweep.c.x - oldCenter.x));
}
b2Body.prototype.ResetMassData = function () {
this.m_mass = 0.0;
this.m_invMass = 0.0;
this.m_I = 0.0;
this.m_invI = 0.0;
this.m_sweep.localCenter.SetZero();
if (this.m_type == b2Body.b2_staticBody || this.m_type == b2Body.b2_kinematicBody) {
return;
}
var center = b2Vec2.Make(0, 0);
for (var f = this.m_fixtureList; f; f = f.m_next) {
if (f.m_density == 0.0) {
continue;
}
var massData = f.GetMassData();
this.m_mass += massData.mass;
center.x += massData.center.x * massData.mass;
center.y += massData.center.y * massData.mass;
this.m_I += massData.I;
}
if (this.m_mass > 0.0) {
this.m_invMass = 1.0 / this.m_mass;
center.x *= this.m_invMass;
center.y *= this.m_invMass;
}
else {
this.m_mass = 1.0;
this.m_invMass = 1.0;
}
if (this.m_I > 0.0 && (this.m_flags & b2Body.e_fixedRotationFlag) == 0) {
this.m_I -= this.m_mass * (center.x * center.x + center.y * center.y);
this.m_I *= this.m_inertiaScale;
b2Settings.b2Assert(this.m_I > 0);
this.m_invI = 1.0 / this.m_I;
}
else {
this.m_I = 0.0;
this.m_invI = 0.0;
}
var oldCenter = this.m_sweep.c.Copy();
this.m_sweep.localCenter.SetV(center);
this.m_sweep.c0.SetV(b2Math.MulX(this.m_xf, this.m_sweep.localCenter));
this.m_sweep.c.SetV(this.m_sweep.c0);
this.m_linearVelocity.x += this.m_angularVelocity * (-(this.m_sweep.c.y - oldCenter.y));
this.m_linearVelocity.y += this.m_angularVelocity * (+(this.m_sweep.c.x - oldCenter.x));
}
b2Body.prototype.GetWorldPoint = function (localPoint) {
var A = this.m_xf.R;
var u = new b2Vec2(A.col1.x * localPoint.x + A.col2.x * localPoint.y, A.col1.y * localPoint.x + A.col2.y * localPoint.y);
u.x += this.m_xf.position.x;
u.y += this.m_xf.position.y;
return u;
}
b2Body.prototype.GetWorldVector = function (localVector) {
return b2Math.MulMV(this.m_xf.R, localVector);
}
b2Body.prototype.GetLocalPoint = function (worldPoint) {
return b2Math.MulXT(this.m_xf, worldPoint);
}
b2Body.prototype.GetLocalVector = function (worldVector) {
return b2Math.MulTMV(this.m_xf.R, worldVector);
}
b2Body.prototype.GetLinearVelocityFromWorldPoint = function (worldPoint) {
return new b2Vec2(this.m_linearVelocity.x - this.m_angularVelocity * (worldPoint.y - this.m_sweep.c.y), this.m_linearVelocity.y + this.m_angularVelocity * (worldPoint.x - this.m_sweep.c.x));
}
b2Body.prototype.GetLinearVelocityFromLocalPoint = function (localPoint) {
var A = this.m_xf.R;
var worldPoint = new b2Vec2(A.col1.x * localPoint.x + A.col2.x * localPoint.y, A.col1.y * localPoint.x + A.col2.y * localPoint.y);
worldPoint.x += this.m_xf.position.x;
worldPoint.y += this.m_xf.position.y;
return new b2Vec2(this.m_linearVelocity.x - this.m_angularVelocity * (worldPoint.y - this.m_sweep.c.y), this.m_linearVelocity.y + this.m_angularVelocity * (worldPoint.x - this.m_sweep.c.x));
}
b2Body.prototype.GetLinearDamping = function () {
return this.m_linearDamping;
}
b2Body.prototype.SetLinearDamping = function (linearDamping) {
if (linearDamping === undefined) linearDamping = 0;
this.m_linearDamping = linearDamping;
}
b2Body.prototype.GetAngularDamping = function () {
return this.m_angularDamping;
}
b2Body.prototype.SetAngularDamping = function (angularDamping) {
if (angularDamping === undefined) angularDamping = 0;
this.m_angularDamping = angularDamping;
}
b2Body.prototype.SetType = function (type) {
if (type === undefined) type = 0;
if (this.m_type == type) {
return;
}
this.m_type = type;
this.ResetMassData();
if (this.m_type == b2Body.b2_staticBody) {
this.m_linearVelocity.SetZero();
this.m_angularVelocity = 0.0;
}
this.SetAwake(true);
this.m_force.SetZero();
this.m_torque = 0.0;
for (var ce = this.m_contactList; ce; ce = ce.next) {
ce.contact.FlagForFiltering();
}
}
b2Body.prototype.GetType = function () {
return this.m_type;
}
b2Body.prototype.SetBullet = function (flag) {
if (flag) {
this.m_flags |= b2Body.e_bulletFlag;
}
else {
this.m_flags &= ~b2Body.e_bulletFlag;
}
}
b2Body.prototype.IsBullet = function () {
return (this.m_flags & b2Body.e_bulletFlag) == b2Body.e_bulletFlag;
}
b2Body.prototype.SetSleepingAllowed = function (flag) {
if (flag) {
this.m_flags |= b2Body.e_allowSleepFlag;
}
else {
this.m_flags &= ~b2Body.e_allowSleepFlag;
this.SetAwake(true);
}
}
b2Body.prototype.SetAwake = function (flag) {
if (flag) {
this.m_flags |= b2Body.e_awakeFlag;
this.m_sleepTime = 0.0;
}
else {
this.m_flags &= ~b2Body.e_awakeFlag;
this.m_sleepTime = 0.0;
this.m_linearVelocity.SetZero();
this.m_angularVelocity = 0.0;
this.m_force.SetZero();
this.m_torque = 0.0;
}
}
b2Body.prototype.IsAwake = function () {
return (this.m_flags & b2Body.e_awakeFlag) == b2Body.e_awakeFlag;
}
b2Body.prototype.SetFixedRotation = function (fixed) {
if (fixed) {
this.m_flags |= b2Body.e_fixedRotationFlag;
}
else {
this.m_flags &= ~b2Body.e_fixedRotationFlag;
}
this.ResetMassData();
}
b2Body.prototype.IsFixedRotation = function () {
return (this.m_flags & b2Body.e_fixedRotationFlag) == b2Body.e_fixedRotationFlag;
}
b2Body.prototype.SetActive = function (flag) {
if (flag == this.IsActive()) {
return;
}
var broadPhase;
var f;
if (flag) {
this.m_flags |= b2Body.e_activeFlag;
broadPhase = this.m_world.m_contactManager.m_broadPhase;
for (f = this.m_fixtureList;
f; f = f.m_next) {
f.CreateProxy(broadPhase, this.m_xf);
}
}
else {
this.m_flags &= ~b2Body.e_activeFlag;
broadPhase = this.m_world.m_contactManager.m_broadPhase;
for (f = this.m_fixtureList;
f; f = f.m_next) {
f.DestroyProxy(broadPhase);
}
var ce = this.m_contactList;
while (ce) {
var ce0 = ce;
ce = ce.next;
this.m_world.m_contactManager.Destroy(ce0.contact);
}
this.m_contactList = null;
}
}
b2Body.prototype.IsActive = function () {
return (this.m_flags & b2Body.e_activeFlag) == b2Body.e_activeFlag;
}
b2Body.prototype.IsSleepingAllowed = function () {
return (this.m_flags & b2Body.e_allowSleepFlag) == b2Body.e_allowSleepFlag;
}
b2Body.prototype.GetFixtureList = function () {
return this.m_fixtureList;
}
b2Body.prototype.GetJointList = function () {
return this.m_jointList;
}
b2Body.prototype.GetControllerList = function () {
return this.m_controllerList;
}
b2Body.prototype.GetContactList = function () {
return this.m_contactList;
}
b2Body.prototype.GetNext = function () {
return this.m_next;
}
b2Body.prototype.GetUserData = function () {
return this.m_userData;
}
b2Body.prototype.SetUserData = function (data) {
this.m_userData = data;
}
b2Body.prototype.GetWorld = function () {
return this.m_world;
}
b2Body.prototype.b2Body = function (bd, world) {
this.m_flags = 0;
if (bd.bullet) {
this.m_flags |= b2Body.e_bulletFlag;
}
if (bd.fixedRotation) {
this.m_flags |= b2Body.e_fixedRotationFlag;
}
if (bd.allowSleep) {
this.m_flags |= b2Body.e_allowSleepFlag;
}
if (bd.awake) {
this.m_flags |= b2Body.e_awakeFlag;
}
if (bd.active) {
this.m_flags |= b2Body.e_activeFlag;
}
this.m_world = world;
this.m_xf.position.SetV(bd.position);
this.m_xf.R.Set(bd.angle);
this.m_sweep.localCenter.SetZero();
this.m_sweep.t0 = 1.0;
this.m_sweep.a0 = this.m_sweep.a = bd.angle;
var tMat = this.m_xf.R;
var tVec = this.m_sweep.localCenter;
this.m_sweep.c.x = (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
this.m_sweep.c.y = (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
this.m_sweep.c.x += this.m_xf.position.x;
this.m_sweep.c.y += this.m_xf.position.y;
this.m_sweep.c0.SetV(this.m_sweep.c);
this.m_jointList = null;
this.m_controllerList = null;
this.m_contactList = null;
this.m_controllerCount = 0;
this.m_prev = null;
this.m_next = null;
this.m_linearVelocity.SetV(bd.linearVelocity);
this.m_angularVelocity = bd.angularVelocity;
this.m_linearDamping = bd.linearDamping;
this.m_angularDamping = bd.angularDamping;
this.m_force.Set(0.0, 0.0);
this.m_torque = 0.0;
this.m_sleepTime = 0.0;
this.m_type = bd.type;
if (this.m_type == b2Body.b2_dynamicBody) {
this.m_mass = 1.0;
this.m_invMass = 1.0;
}
else {
this.m_mass = 0.0;
this.m_invMass = 0.0;
}
this.m_I = 0.0;
this.m_invI = 0.0;
this.m_inertiaScale = bd.inertiaScale;
this.m_userData = bd.userData;
this.m_fixtureList = null;
this.m_fixtureCount = 0;
}
b2Body.prototype.SynchronizeFixtures = function () {
var xf1 = b2Body.s_xf1;
xf1.R.Set(this.m_sweep.a0);
var tMat = xf1.R;
var tVec = this.m_sweep.localCenter;
xf1.position.x = this.m_sweep.c0.x - (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
xf1.position.y = this.m_sweep.c0.y - (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
var f;
var broadPhase = this.m_world.m_contactManager.m_broadPhase;
for (f = this.m_fixtureList;
f; f = f.m_next) {
f.Synchronize(broadPhase, xf1, this.m_xf);
}
}
b2Body.prototype.SynchronizeTransform = function () {
this.m_xf.R.Set(this.m_sweep.a);
var tMat = this.m_xf.R;
var tVec = this.m_sweep.localCenter;
this.m_xf.position.x = this.m_sweep.c.x - (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
this.m_xf.position.y = this.m_sweep.c.y - (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
}
b2Body.prototype.ShouldCollide = function (other) {
if (this.m_type != b2Body.b2_dynamicBody && other.m_type != b2Body.b2_dynamicBody) {
return false;
}
for (var jn = this.m_jointList; jn; jn = jn.next) {
if (jn.other == other) if (jn.joint.m_collideConnected == false) {
return false;
}
}
return true;
}
b2Body.prototype.Advance = function (t) {
if (t === undefined) t = 0;
this.m_sweep.Advance(t);
this.m_sweep.c.SetV(this.m_sweep.c0);
this.m_sweep.a = this.m_sweep.a0;
this.SynchronizeTransform();
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.b2Body.s_xf1 = new b2Transform();
Box2D.Dynamics.b2Body.e_islandFlag = 0x0001;
Box2D.Dynamics.b2Body.e_awakeFlag = 0x0002;
Box2D.Dynamics.b2Body.e_allowSleepFlag = 0x0004;
Box2D.Dynamics.b2Body.e_bulletFlag = 0x0008;
Box2D.Dynamics.b2Body.e_fixedRotationFlag = 0x0010;
Box2D.Dynamics.b2Body.e_activeFlag = 0x0020;
Box2D.Dynamics.b2Body.b2_staticBody = 0;
Box2D.Dynamics.b2Body.b2_kinematicBody = 1;
Box2D.Dynamics.b2Body.b2_dynamicBody = 2;
});
b2BodyDef.b2BodyDef = function () {
this.position = new b2Vec2();
this.linearVelocity = new b2Vec2();
};
b2BodyDef.prototype.b2BodyDef = function () {
this.userData = null;
this.position.Set(0.0, 0.0);
this.angle = 0.0;
this.linearVelocity.Set(0, 0);
this.angularVelocity = 0.0;
this.linearDamping = 0.0;
this.angularDamping = 0.0;
this.allowSleep = true;
this.awake = true;
this.fixedRotation = false;
this.bullet = false;
this.type = b2Body.b2_staticBody;
this.active = true;
this.inertiaScale = 1.0;
}
b2ContactFilter.b2ContactFilter = function () {};
b2ContactFilter.prototype.ShouldCollide = function (fixtureA, fixtureB) {
var filter1 = fixtureA.GetFilterData();
var filter2 = fixtureB.GetFilterData();
if (filter1.groupIndex == filter2.groupIndex && filter1.groupIndex != 0) {
return filter1.groupIndex > 0;
}
var collide = (filter1.maskBits & filter2.categoryBits) != 0 && (filter1.categoryBits & filter2.maskBits) != 0;
return collide;
}
b2ContactFilter.prototype.RayCollide = function (userData, fixture) {
if (!userData) return true;
return this.ShouldCollide((userData instanceof b2Fixture ? userData : null), fixture);
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.b2ContactFilter.b2_defaultFilter = new b2ContactFilter();
});
b2ContactImpulse.b2ContactImpulse = function () {
this.normalImpulses = new Vector_a2j_Number(b2Settings.b2_maxManifoldPoints);
this.tangentImpulses = new Vector_a2j_Number(b2Settings.b2_maxManifoldPoints);
};
b2ContactListener.b2ContactListener = function () {};
b2ContactListener.prototype.BeginContact = function (contact) {}
b2ContactListener.prototype.EndContact = function (contact) {}
b2ContactListener.prototype.PreSolve = function (contact, oldManifold) {}
b2ContactListener.prototype.PostSolve = function (contact, impulse) {}
Box2D.postDefs.push(function () {
Box2D.Dynamics.b2ContactListener.b2_defaultListener = new b2ContactListener();
});
b2ContactManager.b2ContactManager = function () {};
b2ContactManager.prototype.b2ContactManager = function () {
this.m_world = null;
this.m_contactCount = 0;
this.m_contactFilter = b2ContactFilter.b2_defaultFilter;
this.m_contactListener = b2ContactListener.b2_defaultListener;
this.m_contactFactory = new b2ContactFactory(this.m_allocator);
this.m_broadPhase = new b2DynamicTreeBroadPhase();
}
b2ContactManager.prototype.AddPair = function (proxyUserDataA, proxyUserDataB) {
var fixtureA = (proxyUserDataA instanceof b2Fixture ? proxyUserDataA : null);
var fixtureB = (proxyUserDataB instanceof b2Fixture ? proxyUserDataB : null);
var bodyA = fixtureA.GetBody();
var bodyB = fixtureB.GetBody();
if (bodyA == bodyB) return;
var edge = bodyB.GetContactList();
while (edge) {
if (edge.other == bodyA) {
var fA = edge.contact.GetFixtureA();
var fB = edge.contact.GetFixtureB();
if (fA == fixtureA && fB == fixtureB) return;
if (fA == fixtureB && fB == fixtureA) return;
}
edge = edge.next;
}
if (bodyB.ShouldCollide(bodyA) == false) {
return;
}
if (this.m_contactFilter.ShouldCollide(fixtureA, fixtureB) == false) {
return;
}
var c = this.m_contactFactory.Create(fixtureA, fixtureB);
fixtureA = c.GetFixtureA();
fixtureB = c.GetFixtureB();
bodyA = fixtureA.m_body;
bodyB = fixtureB.m_body;
c.m_prev = null;
c.m_next = this.m_world.m_contactList;
if (this.m_world.m_contactList != null) {
this.m_world.m_contactList.m_prev = c;
}
this.m_world.m_contactList = c;
c.m_nodeA.contact = c;
c.m_nodeA.other = bodyB;
c.m_nodeA.prev = null;
c.m_nodeA.next = bodyA.m_contactList;
if (bodyA.m_contactList != null) {
bodyA.m_contactList.prev = c.m_nodeA;
}
bodyA.m_contactList = c.m_nodeA;
c.m_nodeB.contact = c;
c.m_nodeB.other = bodyA;
c.m_nodeB.prev = null;
c.m_nodeB.next = bodyB.m_contactList;
if (bodyB.m_contactList != null) {
bodyB.m_contactList.prev = c.m_nodeB;
}
bodyB.m_contactList = c.m_nodeB;
++this.m_world.m_contactCount;
return;
}
b2ContactManager.prototype.FindNewContacts = function () {
this.m_broadPhase.UpdatePairs(Box2D.generateCallback(this, this.AddPair));
}
b2ContactManager.prototype.Destroy = function (c) {
var fixtureA = c.GetFixtureA();
var fixtureB = c.GetFixtureB();
var bodyA = fixtureA.GetBody();
var bodyB = fixtureB.GetBody();
if (c.IsTouching()) {
this.m_contactListener.EndContact(c);
}
if (c.m_prev) {
c.m_prev.m_next = c.m_next;
}
if (c.m_next) {
c.m_next.m_prev = c.m_prev;
}
if (c == this.m_world.m_contactList) {
this.m_world.m_contactList = c.m_next;
}
if (c.m_nodeA.prev) {
c.m_nodeA.prev.next = c.m_nodeA.next;
}
if (c.m_nodeA.next) {
c.m_nodeA.next.prev = c.m_nodeA.prev;
}
if (c.m_nodeA == bodyA.m_contactList) {
bodyA.m_contactList = c.m_nodeA.next;
}
if (c.m_nodeB.prev) {
c.m_nodeB.prev.next = c.m_nodeB.next;
}
if (c.m_nodeB.next) {
c.m_nodeB.next.prev = c.m_nodeB.prev;
}
if (c.m_nodeB == bodyB.m_contactList) {
bodyB.m_contactList = c.m_nodeB.next;
}
this.m_contactFactory.Destroy(c);
--this.m_contactCount;
}
b2ContactManager.prototype.Collide = function () {
var c = this.m_world.m_contactList;
while (c) {
var fixtureA = c.GetFixtureA();
var fixtureB = c.GetFixtureB();
var bodyA = fixtureA.GetBody();
var bodyB = fixtureB.GetBody();
if (bodyA.IsAwake() == false && bodyB.IsAwake() == false) {
c = c.GetNext();
continue;
}
if (c.m_flags & b2Contact.e_filterFlag) {
if (bodyB.ShouldCollide(bodyA) == false) {
var cNuke = c;
c = cNuke.GetNext();
this.Destroy(cNuke);
continue;
}
if (this.m_contactFilter.ShouldCollide(fixtureA, fixtureB) == false) {
cNuke = c;
c = cNuke.GetNext();
this.Destroy(cNuke);
continue;
}
c.m_flags &= ~b2Contact.e_filterFlag;
}
var proxyA = fixtureA.m_proxy;
var proxyB = fixtureB.m_proxy;
var overlap = this.m_broadPhase.TestOverlap(proxyA, proxyB);
if (overlap == false) {
cNuke = c;
c = cNuke.GetNext();
this.Destroy(cNuke);
continue;
}
c.Update(this.m_contactListener);
c = c.GetNext();
}
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.b2ContactManager.s_evalCP = new b2ContactPoint();
});
b2DebugDraw.b2DebugDraw = function () {};
b2DebugDraw.prototype.b2DebugDraw = function () {}
b2DebugDraw.prototype.SetFlags = function (flags) {
if (flags === undefined) flags = 0;
}
b2DebugDraw.prototype.GetFlags = function () {}
b2DebugDraw.prototype.AppendFlags = function (flags) {
if (flags === undefined) flags = 0;
}
b2DebugDraw.prototype.ClearFlags = function (flags) {
if (flags === undefined) flags = 0;
}
b2DebugDraw.prototype.SetSprite = function (sprite) {}
b2DebugDraw.prototype.GetSprite = function () {}
b2DebugDraw.prototype.SetDrawScale = function (drawScale) {
if (drawScale === undefined) drawScale = 0;
}
b2DebugDraw.prototype.GetDrawScale = function () {}
b2DebugDraw.prototype.SetLineThickness = function (lineThickness) {
if (lineThickness === undefined) lineThickness = 0;
}
b2DebugDraw.prototype.GetLineThickness = function () {}
b2DebugDraw.prototype.SetAlpha = function (alpha) {
if (alpha === undefined) alpha = 0;
}
b2DebugDraw.prototype.GetAlpha = function () {}
b2DebugDraw.prototype.SetFillAlpha = function (alpha) {
if (alpha === undefined) alpha = 0;
}
b2DebugDraw.prototype.GetFillAlpha = function () {}
b2DebugDraw.prototype.SetXFormScale = function (xformScale) {
if (xformScale === undefined) xformScale = 0;
}
b2DebugDraw.prototype.GetXFormScale = function () {}
b2DebugDraw.prototype.DrawPolygon = function (vertices, vertexCount, color) {
if (vertexCount === undefined) vertexCount = 0;
}
b2DebugDraw.prototype.DrawSolidPolygon = function (vertices, vertexCount, color) {
if (vertexCount === undefined) vertexCount = 0;
}
b2DebugDraw.prototype.DrawCircle = function (center, radius, color) {
if (radius === undefined) radius = 0;
}
b2DebugDraw.prototype.DrawSolidCircle = function (center, radius, axis, color) {
if (radius === undefined) radius = 0;
}
b2DebugDraw.prototype.DrawSegment = function (p1, p2, color) {}
b2DebugDraw.prototype.DrawTransform = function (xf) {}
Box2D.postDefs.push(function () {
Box2D.Dynamics.b2DebugDraw.e_shapeBit = 0x0001;
Box2D.Dynamics.b2DebugDraw.e_jointBit = 0x0002;
Box2D.Dynamics.b2DebugDraw.e_aabbBit = 0x0004;
Box2D.Dynamics.b2DebugDraw.e_pairBit = 0x0008;
Box2D.Dynamics.b2DebugDraw.e_centerOfMassBit = 0x0010;
Box2D.Dynamics.b2DebugDraw.e_controllerBit = 0x0020;
});
b2DestructionListener.b2DestructionListener = function () {};
b2DestructionListener.prototype.SayGoodbyeJoint = function (joint) {}
b2DestructionListener.prototype.SayGoodbyeFixture = function (fixture) {}
b2FilterData.b2FilterData = function () {
this.categoryBits = 0x0001;
this.maskBits = 0xFFFF;
this.groupIndex = 0;
};
b2FilterData.prototype.Copy = function () {
var copy = new b2FilterData();
copy.categoryBits = this.categoryBits;
copy.maskBits = this.maskBits;
copy.groupIndex = this.groupIndex;
return copy;
}
b2Fixture.b2Fixture = function () {
this.m_filter = new b2FilterData();
};
b2Fixture.prototype.GetType = function () {
return this.m_shape.GetType();
}
b2Fixture.prototype.GetShape = function () {
return this.m_shape;
}
b2Fixture.prototype.SetSensor = function (sensor) {
if (this.m_isSensor == sensor) return;
this.m_isSensor = sensor;
if (this.m_body == null) return;
var edge = this.m_body.GetContactList();
while (edge) {
var contact = edge.contact;
var fixtureA = contact.GetFixtureA();
var fixtureB = contact.GetFixtureB();
if (fixtureA == this || fixtureB == this) contact.SetSensor(fixtureA.IsSensor() || fixtureB.IsSensor());
edge = edge.next;
}
}
b2Fixture.prototype.IsSensor = function () {
return this.m_isSensor;
}
b2Fixture.prototype.SetFilterData = function (filter) {
this.m_filter = filter.Copy();
if (this.m_body) return;
var edge = this.m_body.GetContactList();
while (edge) {
var contact = edge.contact;
var fixtureA = contact.GetFixtureA();
var fixtureB = contact.GetFixtureB();
if (fixtureA == this || fixtureB == this) contact.FlagForFiltering();
edge = edge.next;
}
}
b2Fixture.prototype.GetFilterData = function () {
return this.m_filter.Copy();
}
b2Fixture.prototype.GetBody = function () {
return this.m_body;
}
b2Fixture.prototype.GetNext = function () {
return this.m_next;
}
b2Fixture.prototype.GetUserData = function () {
return this.m_userData;
}
b2Fixture.prototype.SetUserData = function (data) {
this.m_userData = data;
}
b2Fixture.prototype.TestPoint = function (p) {
return this.m_shape.TestPoint(this.m_body.GetTransform(), p);
}
b2Fixture.prototype.RayCast = function (output, input) {
return this.m_shape.RayCast(output, input, this.m_body.GetTransform());
}
b2Fixture.prototype.GetMassData = function (massData) {
if (massData === undefined) massData = null;
if (massData == null) {
massData = new b2MassData();
}
this.m_shape.ComputeMass(massData, this.m_density);
return massData;
}
b2Fixture.prototype.SetDensity = function (density) {
if (density === undefined) density = 0;
this.m_density = density;
}
b2Fixture.prototype.GetDensity = function () {
return this.m_density;
}
b2Fixture.prototype.GetFriction = function () {
return this.m_friction;
}
b2Fixture.prototype.SetFriction = function (friction) {
if (friction === undefined) friction = 0;
this.m_friction = friction;
}
b2Fixture.prototype.GetRestitution = function () {
return this.m_restitution;
}
b2Fixture.prototype.SetRestitution = function (restitution) {
if (restitution === undefined) restitution = 0;
this.m_restitution = restitution;
}
b2Fixture.prototype.GetAABB = function () {
return this.m_aabb;
}
b2Fixture.prototype.b2Fixture = function () {
this.m_aabb = new b2AABB();
this.m_userData = null;
this.m_body = null;
this.m_next = null;
this.m_shape = null;
this.m_density = 0.0;
this.m_friction = 0.0;
this.m_restitution = 0.0;
}
b2Fixture.prototype.Create = function (body, xf, def) {
this.m_userData = def.userData;
this.m_friction = def.friction;
this.m_restitution = def.restitution;
this.m_body = body;
this.m_next = null;
this.m_filter = def.filter.Copy();
this.m_isSensor = def.isSensor;
this.m_shape = def.shape.Copy();
this.m_density = def.density;
}
b2Fixture.prototype.Destroy = function () {
this.m_shape = null;
}
b2Fixture.prototype.CreateProxy = function (broadPhase, xf) {
this.m_shape.ComputeAABB(this.m_aabb, xf);
this.m_proxy = broadPhase.CreateProxy(this.m_aabb, this);
}
b2Fixture.prototype.DestroyProxy = function (broadPhase) {
if (this.m_proxy == null) {
return;
}
broadPhase.DestroyProxy(this.m_proxy);
this.m_proxy = null;
}
b2Fixture.prototype.Synchronize = function (broadPhase, transform1, transform2) {
if (!this.m_proxy) return;
var aabb1 = new b2AABB();
var aabb2 = new b2AABB();
this.m_shape.ComputeAABB(aabb1, transform1);
this.m_shape.ComputeAABB(aabb2, transform2);
this.m_aabb.Combine(aabb1, aabb2);
var displacement = b2Math.SubtractVV(transform2.position, transform1.position);
broadPhase.MoveProxy(this.m_proxy, this.m_aabb, displacement);
}
b2FixtureDef.b2FixtureDef = function () {
this.filter = new b2FilterData();
};
b2FixtureDef.prototype.b2FixtureDef = function () {
this.shape = null;
this.userData = null;
this.friction = 0.2;
this.restitution = 0.0;
this.density = 0.0;
this.filter.categoryBits = 0x0001;
this.filter.maskBits = 0xFFFF;
this.filter.groupIndex = 0;
this.isSensor = false;
}
b2Island.b2Island = function () {};
b2Island.prototype.b2Island = function () {
this.m_bodies = new Vector();
this.m_contacts = new Vector();
this.m_joints = new Vector();
}
b2Island.prototype.Initialize = function (bodyCapacity, contactCapacity, jointCapacity, allocator, listener, contactSolver) {
if (bodyCapacity === undefined) bodyCapacity = 0;
if (contactCapacity === undefined) contactCapacity = 0;
if (jointCapacity === undefined) jointCapacity = 0;
var i = 0;
this.m_bodyCapacity = bodyCapacity;
this.m_contactCapacity = contactCapacity;
this.m_jointCapacity = jointCapacity;
this.m_bodyCount = 0;
this.m_contactCount = 0;
this.m_jointCount = 0;
this.m_allocator = allocator;
this.m_listener = listener;
this.m_contactSolver = contactSolver;
for (i = this.m_bodies.length;
i < bodyCapacity; i++)
this.m_bodies[i] = null;
for (i = this.m_contacts.length;
i < contactCapacity; i++)
this.m_contacts[i] = null;
for (i = this.m_joints.length;
i < jointCapacity; i++)
this.m_joints[i] = null;
}
b2Island.prototype.Clear = function () {
this.m_bodyCount = 0;
this.m_contactCount = 0;
this.m_jointCount = 0;
}
b2Island.prototype.Solve = function (step, gravity, allowSleep) {
var i = 0;
var j = 0;
var b;
var joint;
for (i = 0;
i < this.m_bodyCount; ++i) {
b = this.m_bodies[i];
if (b.GetType() != b2Body.b2_dynamicBody) continue;
b.m_linearVelocity.x += step.dt * (gravity.x + b.m_invMass * b.m_force.x);
b.m_linearVelocity.y += step.dt * (gravity.y + b.m_invMass * b.m_force.y);
b.m_angularVelocity += step.dt * b.m_invI * b.m_torque;
b.m_linearVelocity.Multiply(b2Math.Clamp(1.0 - step.dt * b.m_linearDamping, 0.0, 1.0));
b.m_angularVelocity *= b2Math.Clamp(1.0 - step.dt * b.m_angularDamping, 0.0, 1.0);
}
this.m_contactSolver.Initialize(step, this.m_contacts, this.m_contactCount, this.m_allocator);
var contactSolver = this.m_contactSolver;
contactSolver.InitVelocityConstraints(step);
for (i = 0;
i < this.m_jointCount; ++i) {
joint = this.m_joints[i];
joint.InitVelocityConstraints(step);
}
for (i = 0;
i < step.velocityIterations; ++i) {
for (j = 0;
j < this.m_jointCount; ++j) {
joint = this.m_joints[j];
joint.SolveVelocityConstraints(step);
}
contactSolver.SolveVelocityConstraints();
}
for (i = 0;
i < this.m_jointCount; ++i) {
joint = this.m_joints[i];
joint.FinalizeVelocityConstraints();
}
contactSolver.FinalizeVelocityConstraints();
for (i = 0;
i < this.m_bodyCount; ++i) {
b = this.m_bodies[i];
if (b.GetType() == b2Body.b2_staticBody) continue;
var translationX = step.dt * b.m_linearVelocity.x;
var translationY = step.dt * b.m_linearVelocity.y;
if ((translationX * translationX + translationY * translationY) > b2Settings.b2_maxTranslationSquared) {
b.m_linearVelocity.Normalize();
b.m_linearVelocity.x *= b2Settings.b2_maxTranslation * step.inv_dt;
b.m_linearVelocity.y *= b2Settings.b2_maxTranslation * step.inv_dt;
}
var rotation = step.dt * b.m_angularVelocity;
if (rotation * rotation > b2Settings.b2_maxRotationSquared) {
if (b.m_angularVelocity < 0.0) {
b.m_angularVelocity = (-b2Settings.b2_maxRotation * step.inv_dt);
}
else {
b.m_angularVelocity = b2Settings.b2_maxRotation * step.inv_dt;
}
}
b.m_sweep.c0.SetV(b.m_sweep.c);
b.m_sweep.a0 = b.m_sweep.a;
b.m_sweep.c.x += step.dt * b.m_linearVelocity.x;
b.m_sweep.c.y += step.dt * b.m_linearVelocity.y;
b.m_sweep.a += step.dt * b.m_angularVelocity;
b.SynchronizeTransform();
}
for (i = 0;
i < step.positionIterations; ++i) {
var contactsOkay = contactSolver.SolvePositionConstraints(b2Settings.b2_contactBaumgarte);
var jointsOkay = true;
for (j = 0;
j < this.m_jointCount; ++j) {
joint = this.m_joints[j];
var jointOkay = joint.SolvePositionConstraints(b2Settings.b2_contactBaumgarte);
jointsOkay = jointsOkay && jointOkay;
}
if (contactsOkay && jointsOkay) {
break;
}
}
this.Report(contactSolver.m_constraints);
if (allowSleep) {
var minSleepTime = Number.MAX_VALUE;
var linTolSqr = b2Settings.b2_linearSleepTolerance * b2Settings.b2_linearSleepTolerance;
var angTolSqr = b2Settings.b2_angularSleepTolerance * b2Settings.b2_angularSleepTolerance;
for (i = 0;
i < this.m_bodyCount; ++i) {
b = this.m_bodies[i];
if (b.GetType() == b2Body.b2_staticBody) {
continue;
}
if ((b.m_flags & b2Body.e_allowSleepFlag) == 0) {
b.m_sleepTime = 0.0;
minSleepTime = 0.0;
}
if ((b.m_flags & b2Body.e_allowSleepFlag) == 0 || b.m_angularVelocity * b.m_angularVelocity > angTolSqr || b2Math.Dot(b.m_linearVelocity, b.m_linearVelocity) > linTolSqr) {
b.m_sleepTime = 0.0;
minSleepTime = 0.0;
}
else {
b.m_sleepTime += step.dt;
minSleepTime = b2Math.Min(minSleepTime, b.m_sleepTime);
}
}
if (minSleepTime >= b2Settings.b2_timeToSleep) {
for (i = 0;
i < this.m_bodyCount; ++i) {
b = this.m_bodies[i];
b.SetAwake(false);
}
}
}
}
b2Island.prototype.SolveTOI = function (subStep) {
var i = 0;
var j = 0;
this.m_contactSolver.Initialize(subStep, this.m_contacts, this.m_contactCount, this.m_allocator);
var contactSolver = this.m_contactSolver;
for (i = 0;
i < this.m_jointCount; ++i) {
this.m_joints[i].InitVelocityConstraints(subStep);
}
for (i = 0;
i < subStep.velocityIterations; ++i) {
contactSolver.SolveVelocityConstraints();
for (j = 0;
j < this.m_jointCount; ++j) {
this.m_joints[j].SolveVelocityConstraints(subStep);
}
}
for (i = 0;
i < this.m_bodyCount; ++i) {
var b = this.m_bodies[i];
if (b.GetType() == b2Body.b2_staticBody) continue;
var translationX = subStep.dt * b.m_linearVelocity.x;
var translationY = subStep.dt * b.m_linearVelocity.y;
if ((translationX * translationX + translationY * translationY) > b2Settings.b2_maxTranslationSquared) {
b.m_linearVelocity.Normalize();
b.m_linearVelocity.x *= b2Settings.b2_maxTranslation * subStep.inv_dt;
b.m_linearVelocity.y *= b2Settings.b2_maxTranslation * subStep.inv_dt;
}
var rotation = subStep.dt * b.m_angularVelocity;
if (rotation * rotation > b2Settings.b2_maxRotationSquared) {
if (b.m_angularVelocity < 0.0) {
b.m_angularVelocity = (-b2Settings.b2_maxRotation * subStep.inv_dt);
}
else {
b.m_angularVelocity = b2Settings.b2_maxRotation * subStep.inv_dt;
}
}
b.m_sweep.c0.SetV(b.m_sweep.c);
b.m_sweep.a0 = b.m_sweep.a;
b.m_sweep.c.x += subStep.dt * b.m_linearVelocity.x;
b.m_sweep.c.y += subStep.dt * b.m_linearVelocity.y;
b.m_sweep.a += subStep.dt * b.m_angularVelocity;
b.SynchronizeTransform();
}
var k_toiBaumgarte = 0.75;
for (i = 0;
i < subStep.positionIterations; ++i) {
var contactsOkay = contactSolver.SolvePositionConstraints(k_toiBaumgarte);
var jointsOkay = true;
for (j = 0;
j < this.m_jointCount; ++j) {
var jointOkay = this.m_joints[j].SolvePositionConstraints(b2Settings.b2_contactBaumgarte);
jointsOkay = jointsOkay && jointOkay;
}
if (contactsOkay && jointsOkay) {
break;
}
}
this.Report(contactSolver.m_constraints);
}
b2Island.prototype.Report = function (constraints) {
if (this.m_listener == null) {
return;
}
for (var i = 0; i < this.m_contactCount; ++i) {
var c = this.m_contacts[i];
var cc = constraints[i];
for (var j = 0; j < cc.pointCount; ++j) {
b2Island.s_impulse.normalImpulses[j] = cc.points[j].normalImpulse;
b2Island.s_impulse.tangentImpulses[j] = cc.points[j].tangentImpulse;
}
this.m_listener.PostSolve(c, b2Island.s_impulse);
}
}
b2Island.prototype.AddBody = function (body) {
body.m_islandIndex = this.m_bodyCount;
this.m_bodies[this.m_bodyCount++] = body;
}
b2Island.prototype.AddContact = function (contact) {
this.m_contacts[this.m_contactCount++] = contact;
}
b2Island.prototype.AddJoint = function (joint) {
this.m_joints[this.m_jointCount++] = joint;
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.b2Island.s_impulse = new b2ContactImpulse();
});
b2TimeStep.b2TimeStep = function () {};
b2TimeStep.prototype.Set = function (step) {
this.dt = step.dt;
this.inv_dt = step.inv_dt;
this.positionIterations = step.positionIterations;
this.velocityIterations = step.velocityIterations;
this.warmStarting = step.warmStarting;
}
b2World.b2World = function () {
this.s_stack = new Vector();
this.m_contactManager = new b2ContactManager();
this.m_contactSolver = new b2ContactSolver();
this.m_island = new b2Island();
};
b2World.prototype.b2World = function (gravity, doSleep) {
this.m_destructionListener = null;
this.m_debugDraw = null;
this.m_bodyList = null;
this.m_contactList = null;
this.m_jointList = null;
this.m_controllerList = null;
this.m_bodyCount = 0;
this.m_contactCount = 0;
this.m_jointCount = 0;
this.m_controllerCount = 0;
b2World.m_warmStarting = true;
b2World.m_continuousPhysics = true;
this.m_allowSleep = doSleep;
this.m_gravity = gravity;
this.m_inv_dt0 = 0.0;
this.m_contactManager.m_world = this;
var bd = new b2BodyDef();
this.m_groundBody = this.CreateBody(bd);
}
b2World.prototype.SetDestructionListener = function (listener) {
this.m_destructionListener = listener;
}
b2World.prototype.SetContactFilter = function (filter) {
this.m_contactManager.m_contactFilter = filter;
}
b2World.prototype.SetContactListener = function (listener) {
this.m_contactManager.m_contactListener = listener;
}
b2World.prototype.SetDebugDraw = function (debugDraw) {
this.m_debugDraw = debugDraw;
}
b2World.prototype.SetBroadPhase = function (broadPhase) {
var oldBroadPhase = this.m_contactManager.m_broadPhase;
this.m_contactManager.m_broadPhase = broadPhase;
for (var b = this.m_bodyList; b; b = b.m_next) {
for (var f = b.m_fixtureList; f; f = f.m_next) {
f.m_proxy = broadPhase.CreateProxy(oldBroadPhase.GetFatAABB(f.m_proxy), f);
}
}
}
b2World.prototype.Validate = function () {
this.m_contactManager.m_broadPhase.Validate();
}
b2World.prototype.GetProxyCount = function () {
return this.m_contactManager.m_broadPhase.GetProxyCount();
}
b2World.prototype.CreateBody = function (def) {
if (this.IsLocked() == true) {
return null;
}
var b = new b2Body(def, this);
b.m_prev = null;
b.m_next = this.m_bodyList;
if (this.m_bodyList) {
this.m_bodyList.m_prev = b;
}
this.m_bodyList = b;
++this.m_bodyCount;
return b;
}
b2World.prototype.DestroyBody = function (b) {
if (this.IsLocked() == true) {
return;
}
var jn = b.m_jointList;
while (jn) {
var jn0 = jn;
jn = jn.next;
if (this.m_destructionListener) {
this.m_destructionListener.SayGoodbyeJoint(jn0.joint);
}
this.DestroyJoint(jn0.joint);
}
var coe = b.m_controllerList;
while (coe) {
var coe0 = coe;
coe = coe.nextController;
coe0.controller.RemoveBody(b);
}
var ce = b.m_contactList;
while (ce) {
var ce0 = ce;
ce = ce.next;
this.m_contactManager.Destroy(ce0.contact);
}
b.m_contactList = null;
var f = b.m_fixtureList;
while (f) {
var f0 = f;
f = f.m_next;
if (this.m_destructionListener) {
this.m_destructionListener.SayGoodbyeFixture(f0);
}
f0.DestroyProxy(this.m_contactManager.m_broadPhase);
f0.Destroy();
}
b.m_fixtureList = null;
b.m_fixtureCount = 0;
if (b.m_prev) {
b.m_prev.m_next = b.m_next;
}
if (b.m_next) {
b.m_next.m_prev = b.m_prev;
}
if (b == this.m_bodyList) {
this.m_bodyList = b.m_next;
}--this.m_bodyCount;
}
b2World.prototype.CreateJoint = function (def) {
var j = b2Joint.Create(def, null);
j.m_prev = null;
j.m_next = this.m_jointList;
if (this.m_jointList) {
this.m_jointList.m_prev = j;
}
this.m_jointList = j;
++this.m_jointCount;
j.m_edgeA.joint = j;
j.m_edgeA.other = j.m_bodyB;
j.m_edgeA.prev = null;
j.m_edgeA.next = j.m_bodyA.m_jointList;
if (j.m_bodyA.m_jointList) j.m_bodyA.m_jointList.prev = j.m_edgeA;
j.m_bodyA.m_jointList = j.m_edgeA;
j.m_edgeB.joint = j;
j.m_edgeB.other = j.m_bodyA;
j.m_edgeB.prev = null;
j.m_edgeB.next = j.m_bodyB.m_jointList;
if (j.m_bodyB.m_jointList) j.m_bodyB.m_jointList.prev = j.m_edgeB;
j.m_bodyB.m_jointList = j.m_edgeB;
var bodyA = def.bodyA;
var bodyB = def.bodyB;
if (def.collideConnected == false) {
var edge = bodyB.GetContactList();
while (edge) {
if (edge.other == bodyA) {
edge.contact.FlagForFiltering();
}
edge = edge.next;
}
}
return j;
}
b2World.prototype.DestroyJoint = function (j) {
var collideConnected = j.m_collideConnected;
if (j.m_prev) {
j.m_prev.m_next = j.m_next;
}
if (j.m_next) {
j.m_next.m_prev = j.m_prev;
}
if (j == this.m_jointList) {
this.m_jointList = j.m_next;
}
var bodyA = j.m_bodyA;
var bodyB = j.m_bodyB;
bodyA.SetAwake(true);
bodyB.SetAwake(true);
if (j.m_edgeA.prev) {
j.m_edgeA.prev.next = j.m_edgeA.next;
}
if (j.m_edgeA.next) {
j.m_edgeA.next.prev = j.m_edgeA.prev;
}
if (j.m_edgeA == bodyA.m_jointList) {
bodyA.m_jointList = j.m_edgeA.next;
}
j.m_edgeA.prev = null;
j.m_edgeA.next = null;
if (j.m_edgeB.prev) {
j.m_edgeB.prev.next = j.m_edgeB.next;
}
if (j.m_edgeB.next) {
j.m_edgeB.next.prev = j.m_edgeB.prev;
}
if (j.m_edgeB == bodyB.m_jointList) {
bodyB.m_jointList = j.m_edgeB.next;
}
j.m_edgeB.prev = null;
j.m_edgeB.next = null;
b2Joint.Destroy(j, null);
--this.m_jointCount;
if (collideConnected == false) {
var edge = bodyB.GetContactList();
while (edge) {
if (edge.other == bodyA) {
edge.contact.FlagForFiltering();
}
edge = edge.next;
}
}
}
b2World.prototype.AddController = function (c) {
c.m_next = this.m_controllerList;
c.m_prev = null;
this.m_controllerList = c;
c.m_world = this;
this.m_controllerCount++;
return c;
}
b2World.prototype.RemoveController = function (c) {
if (c.m_prev) c.m_prev.m_next = c.m_next;
if (c.m_next) c.m_next.m_prev = c.m_prev;
if (this.m_controllerList == c) this.m_controllerList = c.m_next;
this.m_controllerCount--;
}
b2World.prototype.CreateController = function (controller) {
if (controller.m_world != this) throw new Error("Controller can only be a member of one world");
controller.m_next = this.m_controllerList;
controller.m_prev = null;
if (this.m_controllerList) this.m_controllerList.m_prev = controller;
this.m_controllerList = controller;
++this.m_controllerCount;
controller.m_world = this;
return controller;
}
b2World.prototype.DestroyController = function (controller) {
controller.Clear();
if (controller.m_next) controller.m_next.m_prev = controller.m_prev;
if (controller.m_prev) controller.m_prev.m_next = controller.m_next;
if (controller == this.m_controllerList) this.m_controllerList = controller.m_next;
--this.m_controllerCount;
}
b2World.prototype.SetWarmStarting = function (flag) {
b2World.m_warmStarting = flag;
}
b2World.prototype.SetContinuousPhysics = function (flag) {
b2World.m_continuousPhysics = flag;
}
b2World.prototype.GetBodyCount = function () {
return this.m_bodyCount;
}
b2World.prototype.GetJointCount = function () {
return this.m_jointCount;
}
b2World.prototype.GetContactCount = function () {
return this.m_contactCount;
}
b2World.prototype.SetGravity = function (gravity) {
this.m_gravity = gravity;
}
b2World.prototype.GetGravity = function () {
return this.m_gravity;
}
b2World.prototype.GetGroundBody = function () {
return this.m_groundBody;
}
b2World.prototype.Step = function (dt, velocityIterations, positionIterations) {
if (dt === undefined) dt = 0;
if (velocityIterations === undefined) velocityIterations = 0;
if (positionIterations === undefined) positionIterations = 0;
if (this.m_flags & b2World.e_newFixture) {
this.m_contactManager.FindNewContacts();
this.m_flags &= ~b2World.e_newFixture;
}
this.m_flags |= b2World.e_locked;
var step = b2World.s_timestep2;
step.dt = dt;
step.velocityIterations = velocityIterations;
step.positionIterations = positionIterations;
if (dt > 0.0) {
step.inv_dt = 1.0 / dt;
}
else {
step.inv_dt = 0.0;
}
step.dtRatio = this.m_inv_dt0 * dt;
step.warmStarting = b2World.m_warmStarting;
this.m_contactManager.Collide();
if (step.dt > 0.0) {
this.Solve(step);
}
if (b2World.m_continuousPhysics && step.dt > 0.0) {
this.SolveTOI(step);
}
if (step.dt > 0.0) {
this.m_inv_dt0 = step.inv_dt;
}
this.m_flags &= ~b2World.e_locked;
}
b2World.prototype.ClearForces = function () {
for (var body = this.m_bodyList; body; body = body.m_next) {
body.m_force.SetZero();
body.m_torque = 0.0;
}
}
b2World.prototype.DrawDebugData = function () {
if (this.m_debugDraw == null) {
return;
}
this.m_debugDraw.m_sprite.graphics.clear();
var flags = this.m_debugDraw.GetFlags();
var i = 0;
var b;
var f;
var s;
var j;
var bp;
var invQ = new b2Vec2;
var x1 = new b2Vec2;
var x2 = new b2Vec2;
var xf;
var b1 = new b2AABB();
var b2 = new b2AABB();
var vs = [new b2Vec2(), new b2Vec2(), new b2Vec2(), new b2Vec2()];
var color = new b2Color(0, 0, 0);
if (flags & b2DebugDraw.e_shapeBit) {
for (b = this.m_bodyList;
b; b = b.m_next) {
xf = b.m_xf;
for (f = b.GetFixtureList();
f; f = f.m_next) {
s = f.GetShape();
if (b.IsActive() == false) {
color.Set(0.5, 0.5, 0.3);
this.DrawShape(s, xf, color);
}
else if (b.GetType() == b2Body.b2_staticBody) {
color.Set(0.5, 0.9, 0.5);
this.DrawShape(s, xf, color);
}
else if (b.GetType() == b2Body.b2_kinematicBody) {
color.Set(0.5, 0.5, 0.9);
this.DrawShape(s, xf, color);
}
else if (b.IsAwake() == false) {
color.Set(0.6, 0.6, 0.6);
this.DrawShape(s, xf, color);
}
else {
color.Set(0.9, 0.7, 0.7);
this.DrawShape(s, xf, color);
}
}
}
}
if (flags & b2DebugDraw.e_jointBit) {
for (j = this.m_jointList;
j; j = j.m_next) {
this.DrawJoint(j);
}
}
if (flags & b2DebugDraw.e_controllerBit) {
for (var c = this.m_controllerList; c; c = c.m_next) {
c.Draw(this.m_debugDraw);
}
}
if (flags & b2DebugDraw.e_pairBit) {
color.Set(0.3, 0.9, 0.9);
for (var contact = this.m_contactManager.m_contactList; contact; contact = contact.GetNext()) {
var fixtureA = contact.GetFixtureA();
var fixtureB = contact.GetFixtureB();
var cA = fixtureA.GetAABB().GetCenter();
var cB = fixtureB.GetAABB().GetCenter();
this.m_debugDraw.DrawSegment(cA, cB, color);
}
}
if (flags & b2DebugDraw.e_aabbBit) {
bp = this.m_contactManager.m_broadPhase;
vs = [new b2Vec2(), new b2Vec2(), new b2Vec2(), new b2Vec2()];
for (b = this.m_bodyList;
b; b = b.GetNext()) {
if (b.IsActive() == false) {
continue;
}
for (f = b.GetFixtureList();
f; f = f.GetNext()) {
var aabb = bp.GetFatAABB(f.m_proxy);
vs[0].Set(aabb.lowerBound.x, aabb.lowerBound.y);
vs[1].Set(aabb.upperBound.x, aabb.lowerBound.y);
vs[2].Set(aabb.upperBound.x, aabb.upperBound.y);
vs[3].Set(aabb.lowerBound.x, aabb.upperBound.y);
this.m_debugDraw.DrawPolygon(vs, 4, color);
}
}
}
if (flags & b2DebugDraw.e_centerOfMassBit) {
for (b = this.m_bodyList;
b; b = b.m_next) {
xf = b2World.s_xf;
xf.R = b.m_xf.R;
xf.position = b.GetWorldCenter();
this.m_debugDraw.DrawTransform(xf);
}
}
}
b2World.prototype.QueryAABB = function (callback, aabb) {
var __this = this;
var broadPhase = __this.m_contactManager.m_broadPhase;
function WorldQueryWrapper(proxy) {
return callback(broadPhase.GetUserData(proxy));
};
broadPhase.Query(WorldQueryWrapper, aabb);
}
b2World.prototype.QueryShape = function (callback, shape, transform) {
var __this = this;
if (transform === undefined) transform = null;
if (transform == null) {
transform = new b2Transform();
transform.SetIdentity();
}
var broadPhase = __this.m_contactManager.m_broadPhase;
function WorldQueryWrapper(proxy) {
var fixture = (broadPhase.GetUserData(proxy) instanceof b2Fixture ? broadPhase.GetUserData(proxy) : null);
if (b2Shape.TestOverlap(shape, transform, fixture.GetShape(), fixture.GetBody().GetTransform())) return callback(fixture);
return true;
};
var aabb = new b2AABB();
shape.ComputeAABB(aabb, transform);
broadPhase.Query(WorldQueryWrapper, aabb);
}
b2World.prototype.QueryPoint = function (callback, p) {
var __this = this;
var broadPhase = __this.m_contactManager.m_broadPhase;
function WorldQueryWrapper(proxy) {
var fixture = (broadPhase.GetUserData(proxy) instanceof b2Fixture ? broadPhase.GetUserData(proxy) : null);
if (fixture.TestPoint(p)) return callback(fixture);
return true;
};
var aabb = new b2AABB();
aabb.lowerBound.Set(p.x - b2Settings.b2_linearSlop, p.y - b2Settings.b2_linearSlop);
aabb.upperBound.Set(p.x + b2Settings.b2_linearSlop, p.y + b2Settings.b2_linearSlop);
broadPhase.Query(WorldQueryWrapper, aabb);
}
b2World.prototype.RayCast = function (callback, point1, point2) {
var __this = this;
var broadPhase = __this.m_contactManager.m_broadPhase;
var output = new b2RayCastOutput;
function RayCastWrapper(input, proxy) {
var userData = broadPhase.GetUserData(proxy);
var fixture = (userData instanceof b2Fixture ? userData : null);
var hit = fixture.RayCast(output, input);
if (hit) {
var fraction = output.fraction;
var point = new b2Vec2((1.0 - fraction) * point1.x + fraction * point2.x, (1.0 - fraction) * point1.y + fraction * point2.y);
return callback(fixture, point, output.normal, fraction);
}
return input.maxFraction;
};
var input = new b2RayCastInput(point1, point2);
broadPhase.RayCast(RayCastWrapper, input);
}
b2World.prototype.RayCastOne = function (point1, point2) {
var __this = this;
var result;
function RayCastOneWrapper(fixture, point, normal, fraction) {
if (fraction === undefined) fraction = 0;
result = fixture;
return fraction;
};
__this.RayCast(RayCastOneWrapper, point1, point2);
return result;
}
b2World.prototype.RayCastAll = function (point1, point2) {
var __this = this;
var result = new Vector();
function RayCastAllWrapper(fixture, point, normal, fraction) {
if (fraction === undefined) fraction = 0;
result[result.length] = fixture;
return 1;
};
__this.RayCast(RayCastAllWrapper, point1, point2);
return result;
}
b2World.prototype.GetBodyList = function () {
return this.m_bodyList;
}
b2World.prototype.GetJointList = function () {
return this.m_jointList;
}
b2World.prototype.GetContactList = function () {
return this.m_contactList;
}
b2World.prototype.IsLocked = function () {
return (this.m_flags & b2World.e_locked) > 0;
}
b2World.prototype.Solve = function (step) {
var b;
for (var controller = this.m_controllerList; controller; controller = controller.m_next) {
controller.Step(step);
}
var island = this.m_island;
island.Initialize(this.m_bodyCount, this.m_contactCount, this.m_jointCount, null, this.m_contactManager.m_contactListener, this.m_contactSolver);
for (b = this.m_bodyList;
b; b = b.m_next) {
b.m_flags &= ~b2Body.e_islandFlag;
}
for (var c = this.m_contactList; c; c = c.m_next) {
c.m_flags &= ~b2Contact.e_islandFlag;
}
for (var j = this.m_jointList; j; j = j.m_next) {
j.m_islandFlag = false;
}
var stackSize = parseInt(this.m_bodyCount);
var stack = this.s_stack;
for (var seed = this.m_bodyList; seed; seed = seed.m_next) {
if (seed.m_flags & b2Body.e_islandFlag) {
continue;
}
if (seed.IsAwake() == false || seed.IsActive() == false) {
continue;
}
if (seed.GetType() == b2Body.b2_staticBody) {
continue;
}
island.Clear();
var stackCount = 0;
stack[stackCount++] = seed;
seed.m_flags |= b2Body.e_islandFlag;
while (stackCount > 0) {
b = stack[--stackCount];
island.AddBody(b);
if (b.IsAwake() == false) {
b.SetAwake(true);
}
if (b.GetType() == b2Body.b2_staticBody) {
continue;
}
var other;
for (var ce = b.m_contactList; ce; ce = ce.next) {
if (ce.contact.m_flags & b2Contact.e_islandFlag) {
continue;
}
if (ce.contact.IsSensor() == true || ce.contact.IsEnabled() == false || ce.contact.IsTouching() == false) {
continue;
}
island.AddContact(ce.contact);
ce.contact.m_flags |= b2Contact.e_islandFlag;
other = ce.other;
if (other.m_flags & b2Body.e_islandFlag) {
continue;
}
stack[stackCount++] = other;
other.m_flags |= b2Body.e_islandFlag;
}
for (var jn = b.m_jointList; jn; jn = jn.next) {
if (jn.joint.m_islandFlag == true) {
continue;
}
other = jn.other;
if (other.IsActive() == false) {
continue;
}
island.AddJoint(jn.joint);
jn.joint.m_islandFlag = true;
if (other.m_flags & b2Body.e_islandFlag) {
continue;
}
stack[stackCount++] = other;
other.m_flags |= b2Body.e_islandFlag;
}
}
island.Solve(step, this.m_gravity, this.m_allowSleep);
for (var i = 0; i < island.m_bodyCount; ++i) {
b = island.m_bodies[i];
if (b.GetType() == b2Body.b2_staticBody) {
b.m_flags &= ~b2Body.e_islandFlag;
}
}
}
for (i = 0;
i < stack.length; ++i) {
if (!stack[i]) break;
stack[i] = null;
}
for (b = this.m_bodyList;
b; b = b.m_next) {
if (b.IsAwake() == false || b.IsActive() == false) {
continue;
}
if (b.GetType() == b2Body.b2_staticBody) {
continue;
}
b.SynchronizeFixtures();
}
this.m_contactManager.FindNewContacts();
}
b2World.prototype.SolveTOI = function (step) {
var b;
var fA;
var fB;
var bA;
var bB;
var cEdge;
var j;
var island = this.m_island;
island.Initialize(this.m_bodyCount, b2Settings.b2_maxTOIContactsPerIsland, b2Settings.b2_maxTOIJointsPerIsland, null, this.m_contactManager.m_contactListener, this.m_contactSolver);
var queue = b2World.s_queue;
for (b = this.m_bodyList;
b; b = b.m_next) {
b.m_flags &= ~b2Body.e_islandFlag;
b.m_sweep.t0 = 0.0;
}
var c;
for (c = this.m_contactList;
c; c = c.m_next) {
c.m_flags &= ~ (b2Contact.e_toiFlag | b2Contact.e_islandFlag);
}
for (j = this.m_jointList;
j; j = j.m_next) {
j.m_islandFlag = false;
}
for (;;) {
var minContact = null;
var minTOI = 1.0;
for (c = this.m_contactList;
c; c = c.m_next) {
if (c.IsSensor() == true || c.IsEnabled() == false || c.IsContinuous() == false) {
continue;
}
var toi = 1.0;
if (c.m_flags & b2Contact.e_toiFlag) {
toi = c.m_toi;
}
else {
fA = c.m_fixtureA;
fB = c.m_fixtureB;
bA = fA.m_body;
bB = fB.m_body;
if ((bA.GetType() != b2Body.b2_dynamicBody || bA.IsAwake() == false) && (bB.GetType() != b2Body.b2_dynamicBody || bB.IsAwake() == false)) {
continue;
}
var t0 = bA.m_sweep.t0;
if (bA.m_sweep.t0 < bB.m_sweep.t0) {
t0 = bB.m_sweep.t0;
bA.m_sweep.Advance(t0);
}
else if (bB.m_sweep.t0 < bA.m_sweep.t0) {
t0 = bA.m_sweep.t0;
bB.m_sweep.Advance(t0);
}
toi = c.ComputeTOI(bA.m_sweep, bB.m_sweep);
b2Settings.b2Assert(0.0 <= toi && toi <= 1.0);
if (toi > 0.0 && toi < 1.0) {
toi = (1.0 - toi) * t0 + toi;
if (toi > 1) toi = 1;
}
c.m_toi = toi;
c.m_flags |= b2Contact.e_toiFlag;
}
if (Number.MIN_VALUE < toi && toi < minTOI) {
minContact = c;
minTOI = toi;
}
}
if (minContact == null || 1.0 - 100.0 * Number.MIN_VALUE < minTOI) {
break;
}
fA = minContact.m_fixtureA;
fB = minContact.m_fixtureB;
bA = fA.m_body;
bB = fB.m_body;
b2World.s_backupA.Set(bA.m_sweep);
b2World.s_backupB.Set(bB.m_sweep);
bA.Advance(minTOI);
bB.Advance(minTOI);
minContact.Update(this.m_contactManager.m_contactListener);
minContact.m_flags &= ~b2Contact.e_toiFlag;
if (minContact.IsSensor() == true || minContact.IsEnabled() == false) {
bA.m_sweep.Set(b2World.s_backupA);
bB.m_sweep.Set(b2World.s_backupB);
bA.SynchronizeTransform();
bB.SynchronizeTransform();
continue;
}
if (minContact.IsTouching() == false) {
continue;
}
var seed = bA;
if (seed.GetType() != b2Body.b2_dynamicBody) {
seed = bB;
}
island.Clear();
var queueStart = 0;
var queueSize = 0;
queue[queueStart + queueSize++] = seed;
seed.m_flags |= b2Body.e_islandFlag;
while (queueSize > 0) {
b = queue[queueStart++];
--queueSize;
island.AddBody(b);
if (b.IsAwake() == false) {
b.SetAwake(true);
}
if (b.GetType() != b2Body.b2_dynamicBody) {
continue;
}
for (cEdge = b.m_contactList;
cEdge; cEdge = cEdge.next) {
if (island.m_contactCount == island.m_contactCapacity) {
break;
}
if (cEdge.contact.m_flags & b2Contact.e_islandFlag) {
continue;
}
if (cEdge.contact.IsSensor() == true || cEdge.contact.IsEnabled() == false || cEdge.contact.IsTouching() == false) {
continue;
}
island.AddContact(cEdge.contact);
cEdge.contact.m_flags |= b2Contact.e_islandFlag;
var other = cEdge.other;
if (other.m_flags & b2Body.e_islandFlag) {
continue;
}
if (other.GetType() != b2Body.b2_staticBody) {
other.Advance(minTOI);
other.SetAwake(true);
}
queue[queueStart + queueSize] = other;
++queueSize;
other.m_flags |= b2Body.e_islandFlag;
}
for (var jEdge = b.m_jointList; jEdge; jEdge = jEdge.next) {
if (island.m_jointCount == island.m_jointCapacity) continue;
if (jEdge.joint.m_islandFlag == true) continue;
other = jEdge.other;
if (other.IsActive() == false) {
continue;
}
island.AddJoint(jEdge.joint);
jEdge.joint.m_islandFlag = true;
if (other.m_flags & b2Body.e_islandFlag) continue;
if (other.GetType() != b2Body.b2_staticBody) {
other.Advance(minTOI);
other.SetAwake(true);
}
queue[queueStart + queueSize] = other;
++queueSize;
other.m_flags |= b2Body.e_islandFlag;
}
}
var subStep = b2World.s_timestep;
subStep.warmStarting = false;
subStep.dt = (1.0 - minTOI) * step.dt;
subStep.inv_dt = 1.0 / subStep.dt;
subStep.dtRatio = 0.0;
subStep.velocityIterations = step.velocityIterations;
subStep.positionIterations = step.positionIterations;
island.SolveTOI(subStep);
var i = 0;
for (i = 0;
i < island.m_bodyCount; ++i) {
b = island.m_bodies[i];
b.m_flags &= ~b2Body.e_islandFlag;
if (b.IsAwake() == false) {
continue;
}
if (b.GetType() != b2Body.b2_dynamicBody) {
continue;
}
b.SynchronizeFixtures();
for (cEdge = b.m_contactList;
cEdge; cEdge = cEdge.next) {
cEdge.contact.m_flags &= ~b2Contact.e_toiFlag;
}
}
for (i = 0;
i < island.m_contactCount; ++i) {
c = island.m_contacts[i];
c.m_flags &= ~ (b2Contact.e_toiFlag | b2Contact.e_islandFlag);
}
for (i = 0;
i < island.m_jointCount; ++i) {
j = island.m_joints[i];
j.m_islandFlag = false;
}
this.m_contactManager.FindNewContacts();
}
}
b2World.prototype.DrawJoint = function (joint) {
var b1 = joint.GetBodyA();
var b2 = joint.GetBodyB();
var xf1 = b1.m_xf;
var xf2 = b2.m_xf;
var x1 = xf1.position;
var x2 = xf2.position;
var p1 = joint.GetAnchorA();
var p2 = joint.GetAnchorB();
var color = b2World.s_jointColor;
switch (joint.m_type) {
case b2Joint.e_distanceJoint:
this.m_debugDraw.DrawSegment(p1, p2, color);
break;
case b2Joint.e_pulleyJoint:
{
var pulley = ((joint instanceof b2PulleyJoint ? joint : null));
var s1 = pulley.GetGroundAnchorA();
var s2 = pulley.GetGroundAnchorB();
this.m_debugDraw.DrawSegment(s1, p1, color);
this.m_debugDraw.DrawSegment(s2, p2, color);
this.m_debugDraw.DrawSegment(s1, s2, color);
}
break;
case b2Joint.e_mouseJoint:
this.m_debugDraw.DrawSegment(p1, p2, color);
break;
default:
if (b1 != this.m_groundBody) this.m_debugDraw.DrawSegment(x1, p1, color);
this.m_debugDraw.DrawSegment(p1, p2, color);
if (b2 != this.m_groundBody) this.m_debugDraw.DrawSegment(x2, p2, color);
}
}
b2World.prototype.DrawShape = function (shape, xf, color) {
switch (shape.m_type) {
case b2Shape.e_circleShape:
{
var circle = ((shape instanceof b2CircleShape ? shape : null));
var center = b2Math.MulX(xf, circle.m_p);
var radius = circle.m_radius;
var axis = xf.R.col1;
this.m_debugDraw.DrawSolidCircle(center, radius, axis, color);
}
break;
case b2Shape.e_polygonShape:
{
var i = 0;
var poly = ((shape instanceof b2PolygonShape ? shape : null));
var vertexCount = parseInt(poly.GetVertexCount());
var localVertices = poly.GetVertices();
var vertices = new Vector(vertexCount);
for (i = 0;
i < vertexCount; ++i) {
vertices[i] = b2Math.MulX(xf, localVertices[i]);
}
this.m_debugDraw.DrawSolidPolygon(vertices, vertexCount, color);
}
break;
case b2Shape.e_edgeShape:
{
var edge = (shape instanceof b2EdgeShape ? shape : null);
this.m_debugDraw.DrawSegment(b2Math.MulX(xf, edge.GetVertex1()), b2Math.MulX(xf, edge.GetVertex2()), color);
}
break;
}
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.b2World.s_timestep2 = new b2TimeStep();
Box2D.Dynamics.b2World.s_xf = new b2Transform();
Box2D.Dynamics.b2World.s_backupA = new b2Sweep();
Box2D.Dynamics.b2World.s_backupB = new b2Sweep();
Box2D.Dynamics.b2World.s_timestep = new b2TimeStep();
Box2D.Dynamics.b2World.s_queue = new Vector();
Box2D.Dynamics.b2World.s_jointColor = new b2Color(0.5, 0.8, 0.8);
Box2D.Dynamics.b2World.e_newFixture = 0x0001;
Box2D.Dynamics.b2World.e_locked = 0x0002;
});
})();
(function () {
var b2CircleShape = Box2D.Collision.Shapes.b2CircleShape,
b2EdgeChainDef = Box2D.Collision.Shapes.b2EdgeChainDef,
b2EdgeShape = Box2D.Collision.Shapes.b2EdgeShape,
b2MassData = Box2D.Collision.Shapes.b2MassData,
b2PolygonShape = Box2D.Collision.Shapes.b2PolygonShape,
b2Shape = Box2D.Collision.Shapes.b2Shape,
b2CircleContact = Box2D.Dynamics.Contacts.b2CircleContact,
b2Contact = Box2D.Dynamics.Contacts.b2Contact,
b2ContactConstraint = Box2D.Dynamics.Contacts.b2ContactConstraint,
b2ContactConstraintPoint = Box2D.Dynamics.Contacts.b2ContactConstraintPoint,
b2ContactEdge = Box2D.Dynamics.Contacts.b2ContactEdge,
b2ContactFactory = Box2D.Dynamics.Contacts.b2ContactFactory,
b2ContactRegister = Box2D.Dynamics.Contacts.b2ContactRegister,
b2ContactResult = Box2D.Dynamics.Contacts.b2ContactResult,
b2ContactSolver = Box2D.Dynamics.Contacts.b2ContactSolver,
b2EdgeAndCircleContact = Box2D.Dynamics.Contacts.b2EdgeAndCircleContact,
b2NullContact = Box2D.Dynamics.Contacts.b2NullContact,
b2PolyAndCircleContact = Box2D.Dynamics.Contacts.b2PolyAndCircleContact,
b2PolyAndEdgeContact = Box2D.Dynamics.Contacts.b2PolyAndEdgeContact,
b2PolygonContact = Box2D.Dynamics.Contacts.b2PolygonContact,
b2PositionSolverManifold = Box2D.Dynamics.Contacts.b2PositionSolverManifold,
b2Body = Box2D.Dynamics.b2Body,
b2BodyDef = Box2D.Dynamics.b2BodyDef,
b2ContactFilter = Box2D.Dynamics.b2ContactFilter,
b2ContactImpulse = Box2D.Dynamics.b2ContactImpulse,
b2ContactListener = Box2D.Dynamics.b2ContactListener,
b2ContactManager = Box2D.Dynamics.b2ContactManager,
b2DebugDraw = Box2D.Dynamics.b2DebugDraw,
b2DestructionListener = Box2D.Dynamics.b2DestructionListener,
b2FilterData = Box2D.Dynamics.b2FilterData,
b2Fixture = Box2D.Dynamics.b2Fixture,
b2FixtureDef = Box2D.Dynamics.b2FixtureDef,
b2Island = Box2D.Dynamics.b2Island,
b2TimeStep = Box2D.Dynamics.b2TimeStep,
b2World = Box2D.Dynamics.b2World,
b2Color = Box2D.Common.b2Color,
b2internal = Box2D.Common.b2internal,
b2Settings = Box2D.Common.b2Settings,
b2Mat22 = Box2D.Common.Math.b2Mat22,
b2Mat33 = Box2D.Common.Math.b2Mat33,
b2Math = Box2D.Common.Math.b2Math,
b2Sweep = Box2D.Common.Math.b2Sweep,
b2Transform = Box2D.Common.Math.b2Transform,
b2Vec2 = Box2D.Common.Math.b2Vec2,
b2Vec3 = Box2D.Common.Math.b2Vec3,
b2AABB = Box2D.Collision.b2AABB,
b2Bound = Box2D.Collision.b2Bound,
b2BoundValues = Box2D.Collision.b2BoundValues,
b2Collision = Box2D.Collision.b2Collision,
b2ContactID = Box2D.Collision.b2ContactID,
b2ContactPoint = Box2D.Collision.b2ContactPoint,
b2Distance = Box2D.Collision.b2Distance,
b2DistanceInput = Box2D.Collision.b2DistanceInput,
b2DistanceOutput = Box2D.Collision.b2DistanceOutput,
b2DistanceProxy = Box2D.Collision.b2DistanceProxy,
b2DynamicTree = Box2D.Collision.b2DynamicTree,
b2DynamicTreeBroadPhase = Box2D.Collision.b2DynamicTreeBroadPhase,
b2DynamicTreeNode = Box2D.Collision.b2DynamicTreeNode,
b2DynamicTreePair = Box2D.Collision.b2DynamicTreePair,
b2Manifold = Box2D.Collision.b2Manifold,
b2ManifoldPoint = Box2D.Collision.b2ManifoldPoint,
b2Point = Box2D.Collision.b2Point,
b2RayCastInput = Box2D.Collision.b2RayCastInput,
b2RayCastOutput = Box2D.Collision.b2RayCastOutput,
b2Segment = Box2D.Collision.b2Segment,
b2SeparationFunction = Box2D.Collision.b2SeparationFunction,
b2Simplex = Box2D.Collision.b2Simplex,
b2SimplexCache = Box2D.Collision.b2SimplexCache,
b2SimplexVertex = Box2D.Collision.b2SimplexVertex,
b2TimeOfImpact = Box2D.Collision.b2TimeOfImpact,
b2TOIInput = Box2D.Collision.b2TOIInput,
b2WorldManifold = Box2D.Collision.b2WorldManifold,
ClipVertex = Box2D.Collision.ClipVertex,
Features = Box2D.Collision.Features,
IBroadPhase = Box2D.Collision.IBroadPhase;
Box2D.inherit(b2CircleContact, Box2D.Dynamics.Contacts.b2Contact);
b2CircleContact.prototype.__super = Box2D.Dynamics.Contacts.b2Contact.prototype;
b2CircleContact.b2CircleContact = function () {
Box2D.Dynamics.Contacts.b2Contact.b2Contact.apply(this, arguments);
};
b2CircleContact.Create = function (allocator) {
return new b2CircleContact();
}
b2CircleContact.Destroy = function (contact, allocator) {}
b2CircleContact.prototype.Reset = function (fixtureA, fixtureB) {
this.__super.Reset.call(this, fixtureA, fixtureB);
}
b2CircleContact.prototype.Evaluate = function () {
var bA = this.m_fixtureA.GetBody();
var bB = this.m_fixtureB.GetBody();
b2Collision.CollideCircles(this.m_manifold, (this.m_fixtureA.GetShape() instanceof b2CircleShape ? this.m_fixtureA.GetShape() : null), bA.m_xf, (this.m_fixtureB.GetShape() instanceof b2CircleShape ? this.m_fixtureB.GetShape() : null), bB.m_xf);
}
b2Contact.b2Contact = function () {
this.m_nodeA = new b2ContactEdge();
this.m_nodeB = new b2ContactEdge();
this.m_manifold = new b2Manifold();
this.m_oldManifold = new b2Manifold();
};
b2Contact.prototype.GetManifold = function () {
return this.m_manifold;
}
b2Contact.prototype.GetWorldManifold = function (worldManifold) {
var bodyA = this.m_fixtureA.GetBody();
var bodyB = this.m_fixtureB.GetBody();
var shapeA = this.m_fixtureA.GetShape();
var shapeB = this.m_fixtureB.GetShape();
worldManifold.Initialize(this.m_manifold, bodyA.GetTransform(), shapeA.m_radius, bodyB.GetTransform(), shapeB.m_radius);
}
b2Contact.prototype.IsTouching = function () {
return (this.m_flags & b2Contact.e_touchingFlag) == b2Contact.e_touchingFlag;
}
b2Contact.prototype.IsContinuous = function () {
return (this.m_flags & b2Contact.e_continuousFlag) == b2Contact.e_continuousFlag;
}
b2Contact.prototype.SetSensor = function (sensor) {
if (sensor) {
this.m_flags |= b2Contact.e_sensorFlag;
}
else {
this.m_flags &= ~b2Contact.e_sensorFlag;
}
}
b2Contact.prototype.IsSensor = function () {
return (this.m_flags & b2Contact.e_sensorFlag) == b2Contact.e_sensorFlag;
}
b2Contact.prototype.SetEnabled = function (flag) {
if (flag) {
this.m_flags |= b2Contact.e_enabledFlag;
}
else {
this.m_flags &= ~b2Contact.e_enabledFlag;
}
}
b2Contact.prototype.IsEnabled = function () {
return (this.m_flags & b2Contact.e_enabledFlag) == b2Contact.e_enabledFlag;
}
b2Contact.prototype.GetNext = function () {
return this.m_next;
}
b2Contact.prototype.GetFixtureA = function () {
return this.m_fixtureA;
}
b2Contact.prototype.GetFixtureB = function () {
return this.m_fixtureB;
}
b2Contact.prototype.FlagForFiltering = function () {
this.m_flags |= b2Contact.e_filterFlag;
}
b2Contact.prototype.b2Contact = function () {}
b2Contact.prototype.Reset = function (fixtureA, fixtureB) {
if (fixtureA === undefined) fixtureA = null;
if (fixtureB === undefined) fixtureB = null;
this.m_flags = b2Contact.e_enabledFlag;
if (!fixtureA || !fixtureB) {
this.m_fixtureA = null;
this.m_fixtureB = null;
return;
}
if (fixtureA.IsSensor() || fixtureB.IsSensor()) {
this.m_flags |= b2Contact.e_sensorFlag;
}
var bodyA = fixtureA.GetBody();
var bodyB = fixtureB.GetBody();
if (bodyA.GetType() != b2Body.b2_dynamicBody || bodyA.IsBullet() || bodyB.GetType() != b2Body.b2_dynamicBody || bodyB.IsBullet()) {
this.m_flags |= b2Contact.e_continuousFlag;
}
this.m_fixtureA = fixtureA;
this.m_fixtureB = fixtureB;
this.m_manifold.m_pointCount = 0;
this.m_prev = null;
this.m_next = null;
this.m_nodeA.contact = null;
this.m_nodeA.prev = null;
this.m_nodeA.next = null;
this.m_nodeA.other = null;
this.m_nodeB.contact = null;
this.m_nodeB.prev = null;
this.m_nodeB.next = null;
this.m_nodeB.other = null;
}
b2Contact.prototype.Update = function (listener) {
var tManifold = this.m_oldManifold;
this.m_oldManifold = this.m_manifold;
this.m_manifold = tManifold;
this.m_flags |= b2Contact.e_enabledFlag;
var touching = false;
var wasTouching = (this.m_flags & b2Contact.e_touchingFlag) == b2Contact.e_touchingFlag;
var bodyA = this.m_fixtureA.m_body;
var bodyB = this.m_fixtureB.m_body;
var aabbOverlap = this.m_fixtureA.m_aabb.TestOverlap(this.m_fixtureB.m_aabb);
if (this.m_flags & b2Contact.e_sensorFlag) {
if (aabbOverlap) {
var shapeA = this.m_fixtureA.GetShape();
var shapeB = this.m_fixtureB.GetShape();
var xfA = bodyA.GetTransform();
var xfB = bodyB.GetTransform();
touching = b2Shape.TestOverlap(shapeA, xfA, shapeB, xfB);
}
this.m_manifold.m_pointCount = 0;
}
else {
if (bodyA.GetType() != b2Body.b2_dynamicBody || bodyA.IsBullet() || bodyB.GetType() != b2Body.b2_dynamicBody || bodyB.IsBullet()) {
this.m_flags |= b2Contact.e_continuousFlag;
}
else {
this.m_flags &= ~b2Contact.e_continuousFlag;
}
if (aabbOverlap) {
this.Evaluate();
touching = this.m_manifold.m_pointCount > 0;
for (var i = 0; i < this.m_manifold.m_pointCount; ++i) {
var mp2 = this.m_manifold.m_points[i];
mp2.m_normalImpulse = 0.0;
mp2.m_tangentImpulse = 0.0;
var id2 = mp2.m_id;
for (var j = 0; j < this.m_oldManifold.m_pointCount; ++j) {
var mp1 = this.m_oldManifold.m_points[j];
if (mp1.m_id.key == id2.key) {
mp2.m_normalImpulse = mp1.m_normalImpulse;
mp2.m_tangentImpulse = mp1.m_tangentImpulse;
break;
}
}
}
}
else {
this.m_manifold.m_pointCount = 0;
}
if (touching != wasTouching) {
bodyA.SetAwake(true);
bodyB.SetAwake(true);
}
}
if (touching) {
this.m_flags |= b2Contact.e_touchingFlag;
}
else {
this.m_flags &= ~b2Contact.e_touchingFlag;
}
if (wasTouching == false && touching == true) {
listener.BeginContact(this);
}
if (wasTouching == true && touching == false) {
listener.EndContact(this);
}
if ((this.m_flags & b2Contact.e_sensorFlag) == 0) {
listener.PreSolve(this, this.m_oldManifold);
}
}
b2Contact.prototype.Evaluate = function () {}
b2Contact.prototype.ComputeTOI = function (sweepA, sweepB) {
b2Contact.s_input.proxyA.Set(this.m_fixtureA.GetShape());
b2Contact.s_input.proxyB.Set(this.m_fixtureB.GetShape());
b2Contact.s_input.sweepA = sweepA;
b2Contact.s_input.sweepB = sweepB;
b2Contact.s_input.tolerance = b2Settings.b2_linearSlop;
return b2TimeOfImpact.TimeOfImpact(b2Contact.s_input);
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.Contacts.b2Contact.e_sensorFlag = 0x0001;
Box2D.Dynamics.Contacts.b2Contact.e_continuousFlag = 0x0002;
Box2D.Dynamics.Contacts.b2Contact.e_islandFlag = 0x0004;
Box2D.Dynamics.Contacts.b2Contact.e_toiFlag = 0x0008;
Box2D.Dynamics.Contacts.b2Contact.e_touchingFlag = 0x0010;
Box2D.Dynamics.Contacts.b2Contact.e_enabledFlag = 0x0020;
Box2D.Dynamics.Contacts.b2Contact.e_filterFlag = 0x0040;
Box2D.Dynamics.Contacts.b2Contact.s_input = new b2TOIInput();
});
b2ContactConstraint.b2ContactConstraint = function () {
this.localPlaneNormal = new b2Vec2();
this.localPoint = new b2Vec2();
this.normal = new b2Vec2();
this.normalMass = new b2Mat22();
this.K = new b2Mat22();
};
b2ContactConstraint.prototype.b2ContactConstraint = function () {
this.points = new Vector(b2Settings.b2_maxManifoldPoints);
for (var i = 0; i < b2Settings.b2_maxManifoldPoints; i++) {
this.points[i] = new b2ContactConstraintPoint();
}
}
b2ContactConstraintPoint.b2ContactConstraintPoint = function () {
this.localPoint = new b2Vec2();
this.rA = new b2Vec2();
this.rB = new b2Vec2();
};
b2ContactEdge.b2ContactEdge = function () {};
b2ContactFactory.b2ContactFactory = function () {};
b2ContactFactory.prototype.b2ContactFactory = function (allocator) {
this.m_allocator = allocator;
this.InitializeRegisters();
}
b2ContactFactory.prototype.AddType = function (createFcn, destroyFcn, type1, type2) {
if (type1 === undefined) type1 = 0;
if (type2 === undefined) type2 = 0;
this.m_registers[type1][type2].createFcn = createFcn;
this.m_registers[type1][type2].destroyFcn = destroyFcn;
this.m_registers[type1][type2].primary = true;
if (type1 != type2) {
this.m_registers[type2][type1].createFcn = createFcn;
this.m_registers[type2][type1].destroyFcn = destroyFcn;
this.m_registers[type2][type1].primary = false;
}
}
b2ContactFactory.prototype.InitializeRegisters = function () {
this.m_registers = new Vector(b2Shape.e_shapeTypeCount);
for (var i = 0; i < b2Shape.e_shapeTypeCount; i++) {
this.m_registers[i] = new Vector(b2Shape.e_shapeTypeCount);
for (var j = 0; j < b2Shape.e_shapeTypeCount; j++) {
this.m_registers[i][j] = new b2ContactRegister();
}
}
this.AddType(b2CircleContact.Create, b2CircleContact.Destroy, b2Shape.e_circleShape, b2Shape.e_circleShape);
this.AddType(b2PolyAndCircleContact.Create, b2PolyAndCircleContact.Destroy, b2Shape.e_polygonShape, b2Shape.e_circleShape);
this.AddType(b2PolygonContact.Create, b2PolygonContact.Destroy, b2Shape.e_polygonShape, b2Shape.e_polygonShape);
this.AddType(b2EdgeAndCircleContact.Create, b2EdgeAndCircleContact.Destroy, b2Shape.e_edgeShape, b2Shape.e_circleShape);
this.AddType(b2PolyAndEdgeContact.Create, b2PolyAndEdgeContact.Destroy, b2Shape.e_polygonShape, b2Shape.e_edgeShape);
}
b2ContactFactory.prototype.Create = function (fixtureA, fixtureB) {
var type1 = parseInt(fixtureA.GetType());
var type2 = parseInt(fixtureB.GetType());
var reg = this.m_registers[type1][type2];
var c;
if (reg.pool) {
c = reg.pool;
reg.pool = c.m_next;
reg.poolCount--;
c.Reset(fixtureA, fixtureB);
return c;
}
var createFcn = reg.createFcn;
if (createFcn != null) {
if (reg.primary) {
c = createFcn(this.m_allocator);
c.Reset(fixtureA, fixtureB);
return c;
}
else {
c = createFcn(this.m_allocator);
c.Reset(fixtureB, fixtureA);
return c;
}
}
else {
return null;
}
}
b2ContactFactory.prototype.Destroy = function (contact) {
if (contact.m_manifold.m_pointCount > 0) {
contact.m_fixtureA.m_body.SetAwake(true);
contact.m_fixtureB.m_body.SetAwake(true);
}
var type1 = parseInt(contact.m_fixtureA.GetType());
var type2 = parseInt(contact.m_fixtureB.GetType());
var reg = this.m_registers[type1][type2];
if (true) {
reg.poolCount++;
contact.m_next = reg.pool;
reg.pool = contact;
}
var destroyFcn = reg.destroyFcn;
destroyFcn(contact, this.m_allocator);
}
b2ContactRegister.b2ContactRegister = function () {};
b2ContactResult.b2ContactResult = function () {
this.position = new b2Vec2();
this.normal = new b2Vec2();
this.id = new b2ContactID();
};
b2ContactSolver.b2ContactSolver = function () {
this.m_step = new b2TimeStep();
this.m_constraints = new Vector();
};
b2ContactSolver.prototype.b2ContactSolver = function () {}
b2ContactSolver.prototype.Initialize = function (step, contacts, contactCount, allocator) {
if (contactCount === undefined) contactCount = 0;
var contact;
this.m_step.Set(step);
this.m_allocator = allocator;
var i = 0;
var tVec;
var tMat;
this.m_constraintCount = contactCount;
while (this.m_constraints.length < this.m_constraintCount) {
this.m_constraints[this.m_constraints.length] = new b2ContactConstraint();
}
for (i = 0;
i < contactCount; ++i) {
contact = contacts[i];
var fixtureA = contact.m_fixtureA;
var fixtureB = contact.m_fixtureB;
var shapeA = fixtureA.m_shape;
var shapeB = fixtureB.m_shape;
var radiusA = shapeA.m_radius;
var radiusB = shapeB.m_radius;
var bodyA = fixtureA.m_body;
var bodyB = fixtureB.m_body;
var manifold = contact.GetManifold();
var friction = b2Settings.b2MixFriction(fixtureA.GetFriction(), fixtureB.GetFriction());
var restitution = b2Settings.b2MixRestitution(fixtureA.GetRestitution(), fixtureB.GetRestitution());
var vAX = bodyA.m_linearVelocity.x;
var vAY = bodyA.m_linearVelocity.y;
var vBX = bodyB.m_linearVelocity.x;
var vBY = bodyB.m_linearVelocity.y;
var wA = bodyA.m_angularVelocity;
var wB = bodyB.m_angularVelocity;
b2Settings.b2Assert(manifold.m_pointCount > 0);
b2ContactSolver.s_worldManifold.Initialize(manifold, bodyA.m_xf, radiusA, bodyB.m_xf, radiusB);
var normalX = b2ContactSolver.s_worldManifold.m_normal.x;
var normalY = b2ContactSolver.s_worldManifold.m_normal.y;
var cc = this.m_constraints[i];
cc.bodyA = bodyA;
cc.bodyB = bodyB;
cc.manifold = manifold;
cc.normal.x = normalX;
cc.normal.y = normalY;
cc.pointCount = manifold.m_pointCount;
cc.friction = friction;
cc.restitution = restitution;
cc.localPlaneNormal.x = manifold.m_localPlaneNormal.x;
cc.localPlaneNormal.y = manifold.m_localPlaneNormal.y;
cc.localPoint.x = manifold.m_localPoint.x;
cc.localPoint.y = manifold.m_localPoint.y;
cc.radius = radiusA + radiusB;
cc.type = manifold.m_type;
for (var k = 0; k < cc.pointCount; ++k) {
var cp = manifold.m_points[k];
var ccp = cc.points[k];
ccp.normalImpulse = cp.m_normalImpulse;
ccp.tangentImpulse = cp.m_tangentImpulse;
ccp.localPoint.SetV(cp.m_localPoint);
var rAX = ccp.rA.x = b2ContactSolver.s_worldManifold.m_points[k].x - bodyA.m_sweep.c.x;
var rAY = ccp.rA.y = b2ContactSolver.s_worldManifold.m_points[k].y - bodyA.m_sweep.c.y;
var rBX = ccp.rB.x = b2ContactSolver.s_worldManifold.m_points[k].x - bodyB.m_sweep.c.x;
var rBY = ccp.rB.y = b2ContactSolver.s_worldManifold.m_points[k].y - bodyB.m_sweep.c.y;
var rnA = rAX * normalY - rAY * normalX;
var rnB = rBX * normalY - rBY * normalX;
rnA *= rnA;
rnB *= rnB;
var kNormal = bodyA.m_invMass + bodyB.m_invMass + bodyA.m_invI * rnA + bodyB.m_invI * rnB;
ccp.normalMass = 1.0 / kNormal;
var kEqualized = bodyA.m_mass * bodyA.m_invMass + bodyB.m_mass * bodyB.m_invMass;
kEqualized += bodyA.m_mass * bodyA.m_invI * rnA + bodyB.m_mass * bodyB.m_invI * rnB;
ccp.equalizedMass = 1.0 / kEqualized;
var tangentX = normalY;
var tangentY = (-normalX);
var rtA = rAX * tangentY - rAY * tangentX;
var rtB = rBX * tangentY - rBY * tangentX;
rtA *= rtA;
rtB *= rtB;
var kTangent = bodyA.m_invMass + bodyB.m_invMass + bodyA.m_invI * rtA + bodyB.m_invI * rtB;
ccp.tangentMass = 1.0 / kTangent;
ccp.velocityBias = 0.0;
var tX = vBX + ((-wB * rBY)) - vAX - ((-wA * rAY));
var tY = vBY + (wB * rBX) - vAY - (wA * rAX);
var vRel = cc.normal.x * tX + cc.normal.y * tY;
if (vRel < (-b2Settings.b2_velocityThreshold)) {
ccp.velocityBias += (-cc.restitution * vRel);
}
}
if (cc.pointCount == 2) {
var ccp1 = cc.points[0];
var ccp2 = cc.points[1];
var invMassA = bodyA.m_invMass;
var invIA = bodyA.m_invI;
var invMassB = bodyB.m_invMass;
var invIB = bodyB.m_invI;
var rn1A = ccp1.rA.x * normalY - ccp1.rA.y * normalX;
var rn1B = ccp1.rB.x * normalY - ccp1.rB.y * normalX;
var rn2A = ccp2.rA.x * normalY - ccp2.rA.y * normalX;
var rn2B = ccp2.rB.x * normalY - ccp2.rB.y * normalX;
var k11 = invMassA + invMassB + invIA * rn1A * rn1A + invIB * rn1B * rn1B;
var k22 = invMassA + invMassB + invIA * rn2A * rn2A + invIB * rn2B * rn2B;
var k12 = invMassA + invMassB + invIA * rn1A * rn2A + invIB * rn1B * rn2B;
var k_maxConditionNumber = 100.0;
if (k11 * k11 < k_maxConditionNumber * (k11 * k22 - k12 * k12)) {
cc.K.col1.Set(k11, k12);
cc.K.col2.Set(k12, k22);
cc.K.GetInverse(cc.normalMass);
}
else {
cc.pointCount = 1;
}
}
}
}
b2ContactSolver.prototype.InitVelocityConstraints = function (step) {
var tVec;
var tVec2;
var tMat;
for (var i = 0; i < this.m_constraintCount; ++i) {
var c = this.m_constraints[i];
var bodyA = c.bodyA;
var bodyB = c.bodyB;
var invMassA = bodyA.m_invMass;
var invIA = bodyA.m_invI;
var invMassB = bodyB.m_invMass;
var invIB = bodyB.m_invI;
var normalX = c.normal.x;
var normalY = c.normal.y;
var tangentX = normalY;
var tangentY = (-normalX);
var tX = 0;
var j = 0;
var tCount = 0;
if (step.warmStarting) {
tCount = c.pointCount;
for (j = 0;
j < tCount; ++j) {
var ccp = c.points[j];
ccp.normalImpulse *= step.dtRatio;
ccp.tangentImpulse *= step.dtRatio;
var PX = ccp.normalImpulse * normalX + ccp.tangentImpulse * tangentX;
var PY = ccp.normalImpulse * normalY + ccp.tangentImpulse * tangentY;
bodyA.m_angularVelocity -= invIA * (ccp.rA.x * PY - ccp.rA.y * PX);
bodyA.m_linearVelocity.x -= invMassA * PX;
bodyA.m_linearVelocity.y -= invMassA * PY;
bodyB.m_angularVelocity += invIB * (ccp.rB.x * PY - ccp.rB.y * PX);
bodyB.m_linearVelocity.x += invMassB * PX;
bodyB.m_linearVelocity.y += invMassB * PY;
}
}
else {
tCount = c.pointCount;
for (j = 0;
j < tCount; ++j) {
var ccp2 = c.points[j];
ccp2.normalImpulse = 0.0;
ccp2.tangentImpulse = 0.0;
}
}
}
}
b2ContactSolver.prototype.SolveVelocityConstraints = function () {
var j = 0;
var ccp;
var rAX = 0;
var rAY = 0;
var rBX = 0;
var rBY = 0;
var dvX = 0;
var dvY = 0;
var vn = 0;
var vt = 0;
var lambda = 0;
var maxFriction = 0;
var newImpulse = 0;
var PX = 0;
var PY = 0;
var dX = 0;
var dY = 0;
var P1X = 0;
var P1Y = 0;
var P2X = 0;
var P2Y = 0;
var tMat;
var tVec;
for (var i = 0; i < this.m_constraintCount; ++i) {
var c = this.m_constraints[i];
var bodyA = c.bodyA;
var bodyB = c.bodyB;
var wA = bodyA.m_angularVelocity;
var wB = bodyB.m_angularVelocity;
var vA = bodyA.m_linearVelocity;
var vB = bodyB.m_linearVelocity;
var invMassA = bodyA.m_invMass;
var invIA = bodyA.m_invI;
var invMassB = bodyB.m_invMass;
var invIB = bodyB.m_invI;
var normalX = c.normal.x;
var normalY = c.normal.y;
var tangentX = normalY;
var tangentY = (-normalX);
var friction = c.friction;
var tX = 0;
for (j = 0;
j < c.pointCount; j++) {
ccp = c.points[j];
dvX = vB.x - wB * ccp.rB.y - vA.x + wA * ccp.rA.y;
dvY = vB.y + wB * ccp.rB.x - vA.y - wA * ccp.rA.x;
vt = dvX * tangentX + dvY * tangentY;
lambda = ccp.tangentMass * (-vt);
maxFriction = friction * ccp.normalImpulse;
newImpulse = b2Math.Clamp(ccp.tangentImpulse + lambda, (-maxFriction), maxFriction);
lambda = newImpulse - ccp.tangentImpulse;
PX = lambda * tangentX;
PY = lambda * tangentY;
vA.x -= invMassA * PX;
vA.y -= invMassA * PY;
wA -= invIA * (ccp.rA.x * PY - ccp.rA.y * PX);
vB.x += invMassB * PX;
vB.y += invMassB * PY;
wB += invIB * (ccp.rB.x * PY - ccp.rB.y * PX);
ccp.tangentImpulse = newImpulse;
}
var tCount = parseInt(c.pointCount);
if (c.pointCount == 1) {
ccp = c.points[0];
dvX = vB.x + ((-wB * ccp.rB.y)) - vA.x - ((-wA * ccp.rA.y));
dvY = vB.y + (wB * ccp.rB.x) - vA.y - (wA * ccp.rA.x);
vn = dvX * normalX + dvY * normalY;
lambda = (-ccp.normalMass * (vn - ccp.velocityBias));
newImpulse = ccp.normalImpulse + lambda;
newImpulse = newImpulse > 0 ? newImpulse : 0.0;
lambda = newImpulse - ccp.normalImpulse;
PX = lambda * normalX;
PY = lambda * normalY;
vA.x -= invMassA * PX;
vA.y -= invMassA * PY;
wA -= invIA * (ccp.rA.x * PY - ccp.rA.y * PX);
vB.x += invMassB * PX;
vB.y += invMassB * PY;
wB += invIB * (ccp.rB.x * PY - ccp.rB.y * PX);
ccp.normalImpulse = newImpulse;
}
else {
var cp1 = c.points[0];
var cp2 = c.points[1];
var aX = cp1.normalImpulse;
var aY = cp2.normalImpulse;
var dv1X = vB.x - wB * cp1.rB.y - vA.x + wA * cp1.rA.y;
var dv1Y = vB.y + wB * cp1.rB.x - vA.y - wA * cp1.rA.x;
var dv2X = vB.x - wB * cp2.rB.y - vA.x + wA * cp2.rA.y;
var dv2Y = vB.y + wB * cp2.rB.x - vA.y - wA * cp2.rA.x;
var vn1 = dv1X * normalX + dv1Y * normalY;
var vn2 = dv2X * normalX + dv2Y * normalY;
var bX = vn1 - cp1.velocityBias;
var bY = vn2 - cp2.velocityBias;
tMat = c.K;
bX -= tMat.col1.x * aX + tMat.col2.x * aY;
bY -= tMat.col1.y * aX + tMat.col2.y * aY;
var k_errorTol = 0.001;
for (;;) {
tMat = c.normalMass;
var xX = (-(tMat.col1.x * bX + tMat.col2.x * bY));
var xY = (-(tMat.col1.y * bX + tMat.col2.y * bY));
if (xX >= 0.0 && xY >= 0.0) {
dX = xX - aX;
dY = xY - aY;
P1X = dX * normalX;
P1Y = dX * normalY;
P2X = dY * normalX;
P2Y = dY * normalY;
vA.x -= invMassA * (P1X + P2X);
vA.y -= invMassA * (P1Y + P2Y);
wA -= invIA * (cp1.rA.x * P1Y - cp1.rA.y * P1X + cp2.rA.x * P2Y - cp2.rA.y * P2X);
vB.x += invMassB * (P1X + P2X);
vB.y += invMassB * (P1Y + P2Y);
wB += invIB * (cp1.rB.x * P1Y - cp1.rB.y * P1X + cp2.rB.x * P2Y - cp2.rB.y * P2X);
cp1.normalImpulse = xX;
cp2.normalImpulse = xY;
break;
}
xX = (-cp1.normalMass * bX);
xY = 0.0;
vn1 = 0.0;
vn2 = c.K.col1.y * xX + bY;
if (xX >= 0.0 && vn2 >= 0.0) {
dX = xX - aX;
dY = xY - aY;
P1X = dX * normalX;
P1Y = dX * normalY;
P2X = dY * normalX;
P2Y = dY * normalY;
vA.x -= invMassA * (P1X + P2X);
vA.y -= invMassA * (P1Y + P2Y);
wA -= invIA * (cp1.rA.x * P1Y - cp1.rA.y * P1X + cp2.rA.x * P2Y - cp2.rA.y * P2X);
vB.x += invMassB * (P1X + P2X);
vB.y += invMassB * (P1Y + P2Y);
wB += invIB * (cp1.rB.x * P1Y - cp1.rB.y * P1X + cp2.rB.x * P2Y - cp2.rB.y * P2X);
cp1.normalImpulse = xX;
cp2.normalImpulse = xY;
break;
}
xX = 0.0;
xY = (-cp2.normalMass * bY);
vn1 = c.K.col2.x * xY + bX;
vn2 = 0.0;
if (xY >= 0.0 && vn1 >= 0.0) {
dX = xX - aX;
dY = xY - aY;
P1X = dX * normalX;
P1Y = dX * normalY;
P2X = dY * normalX;
P2Y = dY * normalY;
vA.x -= invMassA * (P1X + P2X);
vA.y -= invMassA * (P1Y + P2Y);
wA -= invIA * (cp1.rA.x * P1Y - cp1.rA.y * P1X + cp2.rA.x * P2Y - cp2.rA.y * P2X);
vB.x += invMassB * (P1X + P2X);
vB.y += invMassB * (P1Y + P2Y);
wB += invIB * (cp1.rB.x * P1Y - cp1.rB.y * P1X + cp2.rB.x * P2Y - cp2.rB.y * P2X);
cp1.normalImpulse = xX;
cp2.normalImpulse = xY;
break;
}
xX = 0.0;
xY = 0.0;
vn1 = bX;
vn2 = bY;
if (vn1 >= 0.0 && vn2 >= 0.0) {
dX = xX - aX;
dY = xY - aY;
P1X = dX * normalX;
P1Y = dX * normalY;
P2X = dY * normalX;
P2Y = dY * normalY;
vA.x -= invMassA * (P1X + P2X);
vA.y -= invMassA * (P1Y + P2Y);
wA -= invIA * (cp1.rA.x * P1Y - cp1.rA.y * P1X + cp2.rA.x * P2Y - cp2.rA.y * P2X);
vB.x += invMassB * (P1X + P2X);
vB.y += invMassB * (P1Y + P2Y);
wB += invIB * (cp1.rB.x * P1Y - cp1.rB.y * P1X + cp2.rB.x * P2Y - cp2.rB.y * P2X);
cp1.normalImpulse = xX;
cp2.normalImpulse = xY;
break;
}
break;
}
}
bodyA.m_angularVelocity = wA;
bodyB.m_angularVelocity = wB;
}
}
b2ContactSolver.prototype.FinalizeVelocityConstraints = function () {
for (var i = 0; i < this.m_constraintCount; ++i) {
var c = this.m_constraints[i];
var m = c.manifold;
for (var j = 0; j < c.pointCount; ++j) {
var point1 = m.m_points[j];
var point2 = c.points[j];
point1.m_normalImpulse = point2.normalImpulse;
point1.m_tangentImpulse = point2.tangentImpulse;
}
}
}
b2ContactSolver.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
var minSeparation = 0.0;
for (var i = 0; i < this.m_constraintCount; i++) {
var c = this.m_constraints[i];
var bodyA = c.bodyA;
var bodyB = c.bodyB;
var invMassA = bodyA.m_mass * bodyA.m_invMass;
var invIA = bodyA.m_mass * bodyA.m_invI;
var invMassB = bodyB.m_mass * bodyB.m_invMass;
var invIB = bodyB.m_mass * bodyB.m_invI;
b2ContactSolver.s_psm.Initialize(c);
var normal = b2ContactSolver.s_psm.m_normal;
for (var j = 0; j < c.pointCount; j++) {
var ccp = c.points[j];
var point = b2ContactSolver.s_psm.m_points[j];
var separation = b2ContactSolver.s_psm.m_separations[j];
var rAX = point.x - bodyA.m_sweep.c.x;
var rAY = point.y - bodyA.m_sweep.c.y;
var rBX = point.x - bodyB.m_sweep.c.x;
var rBY = point.y - bodyB.m_sweep.c.y;
minSeparation = minSeparation < separation ? minSeparation : separation;
var C = b2Math.Clamp(baumgarte * (separation + b2Settings.b2_linearSlop), (-b2Settings.b2_maxLinearCorrection), 0.0);
var impulse = (-ccp.equalizedMass * C);
var PX = impulse * normal.x;
var PY = impulse * normal.y;bodyA.m_sweep.c.x -= invMassA * PX;
bodyA.m_sweep.c.y -= invMassA * PY;
bodyA.m_sweep.a -= invIA * (rAX * PY - rAY * PX);
bodyA.SynchronizeTransform();
bodyB.m_sweep.c.x += invMassB * PX;
bodyB.m_sweep.c.y += invMassB * PY;
bodyB.m_sweep.a += invIB * (rBX * PY - rBY * PX);
bodyB.SynchronizeTransform();
}
}
return minSeparation > (-1.5 * b2Settings.b2_linearSlop);
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.Contacts.b2ContactSolver.s_worldManifold = new b2WorldManifold();
Box2D.Dynamics.Contacts.b2ContactSolver.s_psm = new b2PositionSolverManifold();
});
Box2D.inherit(b2EdgeAndCircleContact, Box2D.Dynamics.Contacts.b2Contact);
b2EdgeAndCircleContact.prototype.__super = Box2D.Dynamics.Contacts.b2Contact.prototype;
b2EdgeAndCircleContact.b2EdgeAndCircleContact = function () {
Box2D.Dynamics.Contacts.b2Contact.b2Contact.apply(this, arguments);
};
b2EdgeAndCircleContact.Create = function (allocator) {
return new b2EdgeAndCircleContact();
}
b2EdgeAndCircleContact.Destroy = function (contact, allocator) {}
b2EdgeAndCircleContact.prototype.Reset = function (fixtureA, fixtureB) {
this.__super.Reset.call(this, fixtureA, fixtureB);
}
b2EdgeAndCircleContact.prototype.Evaluate = function () {
var bA = this.m_fixtureA.GetBody();
var bB = this.m_fixtureB.GetBody();
this.b2CollideEdgeAndCircle(this.m_manifold, (this.m_fixtureA.GetShape() instanceof b2EdgeShape ? this.m_fixtureA.GetShape() : null), bA.m_xf, (this.m_fixtureB.GetShape() instanceof b2CircleShape ? this.m_fixtureB.GetShape() : null), bB.m_xf);
}
b2EdgeAndCircleContact.prototype.b2CollideEdgeAndCircle = function (manifold, edge, xf1, circle, xf2) {}
Box2D.inherit(b2NullContact, Box2D.Dynamics.Contacts.b2Contact);
b2NullContact.prototype.__super = Box2D.Dynamics.Contacts.b2Contact.prototype;
b2NullContact.b2NullContact = function () {
Box2D.Dynamics.Contacts.b2Contact.b2Contact.apply(this, arguments);
};
b2NullContact.prototype.b2NullContact = function () {
this.__super.b2Contact.call(this);
}
b2NullContact.prototype.Evaluate = function () {}
Box2D.inherit(b2PolyAndCircleContact, Box2D.Dynamics.Contacts.b2Contact);
b2PolyAndCircleContact.prototype.__super = Box2D.Dynamics.Contacts.b2Contact.prototype;
b2PolyAndCircleContact.b2PolyAndCircleContact = function () {
Box2D.Dynamics.Contacts.b2Contact.b2Contact.apply(this, arguments);
};
b2PolyAndCircleContact.Create = function (allocator) {
return new b2PolyAndCircleContact();
}
b2PolyAndCircleContact.Destroy = function (contact, allocator) {}
b2PolyAndCircleContact.prototype.Reset = function (fixtureA, fixtureB) {
this.__super.Reset.call(this, fixtureA, fixtureB);
b2Settings.b2Assert(fixtureA.GetType() == b2Shape.e_polygonShape);
b2Settings.b2Assert(fixtureB.GetType() == b2Shape.e_circleShape);
}
b2PolyAndCircleContact.prototype.Evaluate = function () {
var bA = this.m_fixtureA.m_body;
var bB = this.m_fixtureB.m_body;
b2Collision.CollidePolygonAndCircle(this.m_manifold, (this.m_fixtureA.GetShape() instanceof b2PolygonShape ? this.m_fixtureA.GetShape() : null), bA.m_xf, (this.m_fixtureB.GetShape() instanceof b2CircleShape ? this.m_fixtureB.GetShape() : null), bB.m_xf);
}
Box2D.inherit(b2PolyAndEdgeContact, Box2D.Dynamics.Contacts.b2Contact);
b2PolyAndEdgeContact.prototype.__super = Box2D.Dynamics.Contacts.b2Contact.prototype;
b2PolyAndEdgeContact.b2PolyAndEdgeContact = function () {
Box2D.Dynamics.Contacts.b2Contact.b2Contact.apply(this, arguments);
};
b2PolyAndEdgeContact.Create = function (allocator) {
return new b2PolyAndEdgeContact();
}
b2PolyAndEdgeContact.Destroy = function (contact, allocator) {}
b2PolyAndEdgeContact.prototype.Reset = function (fixtureA, fixtureB) {
this.__super.Reset.call(this, fixtureA, fixtureB);
b2Settings.b2Assert(fixtureA.GetType() == b2Shape.e_polygonShape);
b2Settings.b2Assert(fixtureB.GetType() == b2Shape.e_edgeShape);
}
b2PolyAndEdgeContact.prototype.Evaluate = function () {
var bA = this.m_fixtureA.GetBody();
var bB = this.m_fixtureB.GetBody();
this.b2CollidePolyAndEdge(this.m_manifold, (this.m_fixtureA.GetShape() instanceof b2PolygonShape ? this.m_fixtureA.GetShape() : null), bA.m_xf, (this.m_fixtureB.GetShape() instanceof b2EdgeShape ? this.m_fixtureB.GetShape() : null), bB.m_xf);
}
b2PolyAndEdgeContact.prototype.b2CollidePolyAndEdge = function (manifold, polygon, xf1, edge, xf2) {}
Box2D.inherit(b2PolygonContact, Box2D.Dynamics.Contacts.b2Contact);
b2PolygonContact.prototype.__super = Box2D.Dynamics.Contacts.b2Contact.prototype;
b2PolygonContact.b2PolygonContact = function () {
Box2D.Dynamics.Contacts.b2Contact.b2Contact.apply(this, arguments);
};
b2PolygonContact.Create = function (allocator) {
return new b2PolygonContact();
}
b2PolygonContact.Destroy = function (contact, allocator) {}
b2PolygonContact.prototype.Reset = function (fixtureA, fixtureB) {
this.__super.Reset.call(this, fixtureA, fixtureB);
}
b2PolygonContact.prototype.Evaluate = function () {
var bA = this.m_fixtureA.GetBody();
var bB = this.m_fixtureB.GetBody();
b2Collision.CollidePolygons(this.m_manifold, (this.m_fixtureA.GetShape() instanceof b2PolygonShape ? this.m_fixtureA.GetShape() : null), bA.m_xf, (this.m_fixtureB.GetShape() instanceof b2PolygonShape ? this.m_fixtureB.GetShape() : null), bB.m_xf);
}
b2PositionSolverManifold.b2PositionSolverManifold = function () {};
b2PositionSolverManifold.prototype.b2PositionSolverManifold = function () {
this.m_normal = new b2Vec2();
this.m_separations = new Vector_a2j_Number(b2Settings.b2_maxManifoldPoints);
this.m_points = new Vector(b2Settings.b2_maxManifoldPoints);
for (var i = 0; i < b2Settings.b2_maxManifoldPoints; i++) {
this.m_points[i] = new b2Vec2();
}
}
b2PositionSolverManifold.prototype.Initialize = function (cc) {
b2Settings.b2Assert(cc.pointCount > 0);
var i = 0;
var clipPointX = 0;
var clipPointY = 0;
var tMat;
var tVec;
var planePointX = 0;
var planePointY = 0;
switch (cc.type) {
case b2Manifold.e_circles:
{
tMat = cc.bodyA.m_xf.R;
tVec = cc.localPoint;
var pointAX = cc.bodyA.m_xf.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var pointAY = cc.bodyA.m_xf.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tMat = cc.bodyB.m_xf.R;
tVec = cc.points[0].localPoint;
var pointBX = cc.bodyB.m_xf.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
var pointBY = cc.bodyB.m_xf.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
var dX = pointBX - pointAX;
var dY = pointBY - pointAY;
var d2 = dX * dX + dY * dY;
if (d2 > Number.MIN_VALUE * Number.MIN_VALUE) {
var d = Math.sqrt(d2);
this.m_normal.x = dX / d;
this.m_normal.y = dY / d;
}
else {
this.m_normal.x = 1.0;
this.m_normal.y = 0.0;
}
this.m_points[0].x = 0.5 * (pointAX + pointBX);
this.m_points[0].y = 0.5 * (pointAY + pointBY);
this.m_separations[0] = dX * this.m_normal.x + dY * this.m_normal.y - cc.radius;
}
break;
case b2Manifold.e_faceA:
{
tMat = cc.bodyA.m_xf.R;
tVec = cc.localPlaneNormal;
this.m_normal.x = tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
this.m_normal.y = tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tMat = cc.bodyA.m_xf.R;
tVec = cc.localPoint;
planePointX = cc.bodyA.m_xf.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
planePointY = cc.bodyA.m_xf.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tMat = cc.bodyB.m_xf.R;
for (i = 0;
i < cc.pointCount; ++i) {
tVec = cc.points[i].localPoint;
clipPointX = cc.bodyB.m_xf.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
clipPointY = cc.bodyB.m_xf.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
this.m_separations[i] = (clipPointX - planePointX) * this.m_normal.x + (clipPointY - planePointY) * this.m_normal.y - cc.radius;
this.m_points[i].x = clipPointX;
this.m_points[i].y = clipPointY;
}
}
break;
case b2Manifold.e_faceB:
{
tMat = cc.bodyB.m_xf.R;
tVec = cc.localPlaneNormal;
this.m_normal.x = tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
this.m_normal.y = tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tMat = cc.bodyB.m_xf.R;
tVec = cc.localPoint;
planePointX = cc.bodyB.m_xf.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
planePointY = cc.bodyB.m_xf.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
tMat = cc.bodyA.m_xf.R;
for (i = 0;
i < cc.pointCount; ++i) {
tVec = cc.points[i].localPoint;
clipPointX = cc.bodyA.m_xf.position.x + (tMat.col1.x * tVec.x + tMat.col2.x * tVec.y);
clipPointY = cc.bodyA.m_xf.position.y + (tMat.col1.y * tVec.x + tMat.col2.y * tVec.y);
this.m_separations[i] = (clipPointX - planePointX) * this.m_normal.x + (clipPointY - planePointY) * this.m_normal.y - cc.radius;
this.m_points[i].Set(clipPointX, clipPointY);
}
this.m_normal.x *= (-1);
this.m_normal.y *= (-1);
}
break;
}
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.Contacts.b2PositionSolverManifold.circlePointA = new b2Vec2();
Box2D.Dynamics.Contacts.b2PositionSolverManifold.circlePointB = new b2Vec2();
});
})();
(function () {
var b2Body = Box2D.Dynamics.b2Body,
b2BodyDef = Box2D.Dynamics.b2BodyDef,
b2ContactFilter = Box2D.Dynamics.b2ContactFilter,
b2ContactImpulse = Box2D.Dynamics.b2ContactImpulse,
b2ContactListener = Box2D.Dynamics.b2ContactListener,
b2ContactManager = Box2D.Dynamics.b2ContactManager,
b2DebugDraw = Box2D.Dynamics.b2DebugDraw,
b2DestructionListener = Box2D.Dynamics.b2DestructionListener,
b2FilterData = Box2D.Dynamics.b2FilterData,
b2Fixture = Box2D.Dynamics.b2Fixture,
b2FixtureDef = Box2D.Dynamics.b2FixtureDef,
b2Island = Box2D.Dynamics.b2Island,
b2TimeStep = Box2D.Dynamics.b2TimeStep,
b2World = Box2D.Dynamics.b2World,
b2Mat22 = Box2D.Common.Math.b2Mat22,
b2Mat33 = Box2D.Common.Math.b2Mat33,
b2Math = Box2D.Common.Math.b2Math,
b2Sweep = Box2D.Common.Math.b2Sweep,
b2Transform = Box2D.Common.Math.b2Transform,
b2Vec2 = Box2D.Common.Math.b2Vec2,
b2Vec3 = Box2D.Common.Math.b2Vec3,
b2Color = Box2D.Common.b2Color,
b2internal = Box2D.Common.b2internal,
b2Settings = Box2D.Common.b2Settings,
b2CircleShape = Box2D.Collision.Shapes.b2CircleShape,
b2EdgeChainDef = Box2D.Collision.Shapes.b2EdgeChainDef,
b2EdgeShape = Box2D.Collision.Shapes.b2EdgeShape,
b2MassData = Box2D.Collision.Shapes.b2MassData,
b2PolygonShape = Box2D.Collision.Shapes.b2PolygonShape,
b2Shape = Box2D.Collision.Shapes.b2Shape,
b2BuoyancyController = Box2D.Dynamics.Controllers.b2BuoyancyController,
b2ConstantAccelController = Box2D.Dynamics.Controllers.b2ConstantAccelController,
b2ConstantForceController = Box2D.Dynamics.Controllers.b2ConstantForceController,
b2Controller = Box2D.Dynamics.Controllers.b2Controller,
b2ControllerEdge = Box2D.Dynamics.Controllers.b2ControllerEdge,
b2GravityController = Box2D.Dynamics.Controllers.b2GravityController,
b2TensorDampingController = Box2D.Dynamics.Controllers.b2TensorDampingController;
Box2D.inherit(b2BuoyancyController, Box2D.Dynamics.Controllers.b2Controller);
b2BuoyancyController.prototype.__super = Box2D.Dynamics.Controllers.b2Controller.prototype;
b2BuoyancyController.b2BuoyancyController = function () {
Box2D.Dynamics.Controllers.b2Controller.b2Controller.apply(this, arguments);
this.normal = new b2Vec2(0, (-1));
this.offset = 0;
this.density = 0;
this.velocity = new b2Vec2(0, 0);
this.linearDrag = 2;
this.angularDrag = 1;
this.useDensity = false;
this.useWorldGravity = true;
this.gravity = null;
};
b2BuoyancyController.prototype.Step = function (step) {
if (!this.m_bodyList) return;
if (this.useWorldGravity) {
this.gravity = this.GetWorld().GetGravity().Copy();
}
for (var i = this.m_bodyList; i; i = i.nextBody) {
var body = i.body;
if (body.IsAwake() == false) {
continue;
}
var areac = new b2Vec2();
var massc = new b2Vec2();
var area = 0.0;
var mass = 0.0;
for (var fixture = body.GetFixtureList(); fixture; fixture = fixture.GetNext()) {
var sc = new b2Vec2();
var sarea = fixture.GetShape().ComputeSubmergedArea(this.normal, this.offset, body.GetTransform(), sc);
area += sarea;
areac.x += sarea * sc.x;
areac.y += sarea * sc.y;
var shapeDensity = 0;
if (this.useDensity) {
shapeDensity = 1;
}
else {
shapeDensity = 1;
}
mass += sarea * shapeDensity;
massc.x += sarea * sc.x * shapeDensity;
massc.y += sarea * sc.y * shapeDensity;
}
areac.x /= area;
areac.y /= area;
massc.x /= mass;
massc.y /= mass;
if (area < Number.MIN_VALUE) continue;
var buoyancyForce = this.gravity.GetNegative();
buoyancyForce.Multiply(this.density * area);
body.ApplyForce(buoyancyForce, massc);
var dragForce = body.GetLinearVelocityFromWorldPoint(areac);
dragForce.Subtract(this.velocity);
dragForce.Multiply((-this.linearDrag * area));
body.ApplyForce(dragForce, areac);
body.ApplyTorque((-body.GetInertia() / body.GetMass() * area * body.GetAngularVelocity() * this.angularDrag));
}
}
b2BuoyancyController.prototype.Draw = function (debugDraw) {
var r = 1000;
var p1 = new b2Vec2();
var p2 = new b2Vec2();
p1.x = this.normal.x * this.offset + this.normal.y * r;
p1.y = this.normal.y * this.offset - this.normal.x * r;
p2.x = this.normal.x * this.offset - this.normal.y * r;
p2.y = this.normal.y * this.offset + this.normal.x * r;
var color = new b2Color(0, 0, 1);
debugDraw.DrawSegment(p1, p2, color);
}
Box2D.inherit(b2ConstantAccelController, Box2D.Dynamics.Controllers.b2Controller);
b2ConstantAccelController.prototype.__super = Box2D.Dynamics.Controllers.b2Controller.prototype;
b2ConstantAccelController.b2ConstantAccelController = function () {
Box2D.Dynamics.Controllers.b2Controller.b2Controller.apply(this, arguments);
this.A = new b2Vec2(0, 0);
};
b2ConstantAccelController.prototype.Step = function (step) {
var smallA = new b2Vec2(this.A.x * step.dt, this.A.y * step.dt);
for (var i = this.m_bodyList; i; i = i.nextBody) {
var body = i.body;
if (!body.IsAwake()) continue;
body.SetLinearVelocity(new b2Vec2(body.GetLinearVelocity().x + smallA.x, body.GetLinearVelocity().y + smallA.y));
}
}
Box2D.inherit(b2ConstantForceController, Box2D.Dynamics.Controllers.b2Controller);
b2ConstantForceController.prototype.__super = Box2D.Dynamics.Controllers.b2Controller.prototype;
b2ConstantForceController.b2ConstantForceController = function () {
Box2D.Dynamics.Controllers.b2Controller.b2Controller.apply(this, arguments);
this.F = new b2Vec2(0, 0);
};
b2ConstantForceController.prototype.Step = function (step) {
for (var i = this.m_bodyList; i; i = i.nextBody) {
var body = i.body;
if (!body.IsAwake()) continue;
body.ApplyForce(this.F, body.GetWorldCenter());
}
}
b2Controller.b2Controller = function () {};
b2Controller.prototype.Step = function (step) {}
b2Controller.prototype.Draw = function (debugDraw) {}
b2Controller.prototype.AddBody = function (body) {
var edge = new b2ControllerEdge();
edge.controller = this;
edge.body = body;
edge.nextBody = this.m_bodyList;
edge.prevBody = null;
this.m_bodyList = edge;
if (edge.nextBody) edge.nextBody.prevBody = edge;
this.m_bodyCount++;
edge.nextController = body.m_controllerList;
edge.prevController = null;
body.m_controllerList = edge;
if (edge.nextController) edge.nextController.prevController = edge;
body.m_controllerCount++;
}
b2Controller.prototype.RemoveBody = function (body) {
var edge = body.m_controllerList;
while (edge && edge.controller != this)
edge = edge.nextController;
if (edge.prevBody) edge.prevBody.nextBody = edge.nextBody;
if (edge.nextBody) edge.nextBody.prevBody = edge.prevBody;
if (edge.nextController) edge.nextController.prevController = edge.prevController;
if (edge.prevController) edge.prevController.nextController = edge.nextController;
if (this.m_bodyList == edge) this.m_bodyList = edge.nextBody;
if (body.m_controllerList == edge) body.m_controllerList = edge.nextController;
body.m_controllerCount--;
this.m_bodyCount--;
}
b2Controller.prototype.Clear = function () {
while (this.m_bodyList)
this.RemoveBody(this.m_bodyList.body);
}
b2Controller.prototype.GetNext = function () {
return this.m_next;
}
b2Controller.prototype.GetWorld = function () {
return this.m_world;
}
b2Controller.prototype.GetBodyList = function () {
return this.m_bodyList;
}
b2ControllerEdge.b2ControllerEdge = function () {};
Box2D.inherit(b2GravityController, Box2D.Dynamics.Controllers.b2Controller);
b2GravityController.prototype.__super = Box2D.Dynamics.Controllers.b2Controller.prototype;
b2GravityController.b2GravityController = function () {
Box2D.Dynamics.Controllers.b2Controller.b2Controller.apply(this, arguments);
this.G = 1;
this.invSqr = true;
};
b2GravityController.prototype.Step = function (step) {
var i = null;
var body1 = null;
var p1 = null;
var mass1 = 0;
var j = null;
var body2 = null;
var p2 = null;
var dx = 0;
var dy = 0;
var r2 = 0;
var f = null;
if (this.invSqr) {
for (i = this.m_bodyList;
i; i = i.nextBody) {
body1 = i.body;
p1 = body1.GetWorldCenter();
mass1 = body1.GetMass();
for (j = this.m_bodyList;
j != i; j = j.nextBody) {
body2 = j.body;
p2 = body2.GetWorldCenter();
dx = p2.x - p1.x;
dy = p2.y - p1.y;
r2 = dx * dx + dy * dy;
if (r2 < Number.MIN_VALUE) continue;
f = new b2Vec2(dx, dy);
f.Multiply(this.G / r2 / Math.sqrt(r2) * mass1 * body2.GetMass());
if (body1.IsAwake()) body1.ApplyForce(f, p1);
f.Multiply((-1));
if (body2.IsAwake()) body2.ApplyForce(f, p2);
}
}
}
else {
for (i = this.m_bodyList;
i; i = i.nextBody) {
body1 = i.body;
p1 = body1.GetWorldCenter();
mass1 = body1.GetMass();
for (j = this.m_bodyList;
j != i; j = j.nextBody) {
body2 = j.body;
p2 = body2.GetWorldCenter();
dx = p2.x - p1.x;
dy = p2.y - p1.y;
r2 = dx * dx + dy * dy;
if (r2 < Number.MIN_VALUE) continue;
f = new b2Vec2(dx, dy);
f.Multiply(this.G / r2 * mass1 * body2.GetMass());
if (body1.IsAwake()) body1.ApplyForce(f, p1);
f.Multiply((-1));
if (body2.IsAwake()) body2.ApplyForce(f, p2);
}
}
}
}
Box2D.inherit(b2TensorDampingController, Box2D.Dynamics.Controllers.b2Controller);
b2TensorDampingController.prototype.__super = Box2D.Dynamics.Controllers.b2Controller.prototype;
b2TensorDampingController.b2TensorDampingController = function () {
Box2D.Dynamics.Controllers.b2Controller.b2Controller.apply(this, arguments);
this.T = new b2Mat22();
this.maxTimestep = 0;
};
b2TensorDampingController.prototype.SetAxisAligned = function (xDamping, yDamping) {
if (xDamping === undefined) xDamping = 0;
if (yDamping === undefined) yDamping = 0;
this.T.col1.x = (-xDamping);
this.T.col1.y = 0;
this.T.col2.x = 0;
this.T.col2.y = (-yDamping);
if (xDamping > 0 || yDamping > 0) {
this.maxTimestep = 1 / Math.max(xDamping, yDamping);
}
else {
this.maxTimestep = 0;
}
}
b2TensorDampingController.prototype.Step = function (step) {
var timestep = step.dt;
if (timestep <= Number.MIN_VALUE) return;
if (timestep > this.maxTimestep && this.maxTimestep > 0) timestep = this.maxTimestep;
for (var i = this.m_bodyList; i; i = i.nextBody) {
var body = i.body;
if (!body.IsAwake()) {
continue;
}
var damping = body.GetWorldVector(b2Math.MulMV(this.T, body.GetLocalVector(body.GetLinearVelocity())));
body.SetLinearVelocity(new b2Vec2(body.GetLinearVelocity().x + damping.x * timestep, body.GetLinearVelocity().y + damping.y * timestep));
}
}
})();
(function () {
var b2Color = Box2D.Common.b2Color,
b2internal = Box2D.Common.b2internal,
b2Settings = Box2D.Common.b2Settings,
b2Mat22 = Box2D.Common.Math.b2Mat22,
b2Mat33 = Box2D.Common.Math.b2Mat33,
b2Math = Box2D.Common.Math.b2Math,
b2Sweep = Box2D.Common.Math.b2Sweep,
b2Transform = Box2D.Common.Math.b2Transform,
b2Vec2 = Box2D.Common.Math.b2Vec2,
b2Vec3 = Box2D.Common.Math.b2Vec3,
b2DistanceJoint = Box2D.Dynamics.Joints.b2DistanceJoint,
b2DistanceJointDef = Box2D.Dynamics.Joints.b2DistanceJointDef,
b2FrictionJoint = Box2D.Dynamics.Joints.b2FrictionJoint,
b2FrictionJointDef = Box2D.Dynamics.Joints.b2FrictionJointDef,
b2GearJoint = Box2D.Dynamics.Joints.b2GearJoint,
b2GearJointDef = Box2D.Dynamics.Joints.b2GearJointDef,
b2Jacobian = Box2D.Dynamics.Joints.b2Jacobian,
b2Joint = Box2D.Dynamics.Joints.b2Joint,
b2JointDef = Box2D.Dynamics.Joints.b2JointDef,
b2JointEdge = Box2D.Dynamics.Joints.b2JointEdge,
b2LineJoint = Box2D.Dynamics.Joints.b2LineJoint,
b2LineJointDef = Box2D.Dynamics.Joints.b2LineJointDef,
b2MouseJoint = Box2D.Dynamics.Joints.b2MouseJoint,
b2MouseJointDef = Box2D.Dynamics.Joints.b2MouseJointDef,
b2PrismaticJoint = Box2D.Dynamics.Joints.b2PrismaticJoint,
b2PrismaticJointDef = Box2D.Dynamics.Joints.b2PrismaticJointDef,
b2PulleyJoint = Box2D.Dynamics.Joints.b2PulleyJoint,
b2PulleyJointDef = Box2D.Dynamics.Joints.b2PulleyJointDef,
b2RevoluteJoint = Box2D.Dynamics.Joints.b2RevoluteJoint,
b2RevoluteJointDef = Box2D.Dynamics.Joints.b2RevoluteJointDef,
b2WeldJoint = Box2D.Dynamics.Joints.b2WeldJoint,
b2WeldJointDef = Box2D.Dynamics.Joints.b2WeldJointDef,
b2Body = Box2D.Dynamics.b2Body,
b2BodyDef = Box2D.Dynamics.b2BodyDef,
b2ContactFilter = Box2D.Dynamics.b2ContactFilter,
b2ContactImpulse = Box2D.Dynamics.b2ContactImpulse,
b2ContactListener = Box2D.Dynamics.b2ContactListener,
b2ContactManager = Box2D.Dynamics.b2ContactManager,
b2DebugDraw = Box2D.Dynamics.b2DebugDraw,
b2DestructionListener = Box2D.Dynamics.b2DestructionListener,
b2FilterData = Box2D.Dynamics.b2FilterData,
b2Fixture = Box2D.Dynamics.b2Fixture,
b2FixtureDef = Box2D.Dynamics.b2FixtureDef,
b2Island = Box2D.Dynamics.b2Island,
b2TimeStep = Box2D.Dynamics.b2TimeStep,
b2World = Box2D.Dynamics.b2World;
Box2D.inherit(b2DistanceJoint, Box2D.Dynamics.Joints.b2Joint);
b2DistanceJoint.prototype.__super = Box2D.Dynamics.Joints.b2Joint.prototype;
b2DistanceJoint.b2DistanceJoint = function () {
Box2D.Dynamics.Joints.b2Joint.b2Joint.apply(this, arguments);
this.m_localAnchor1 = new b2Vec2();
this.m_localAnchor2 = new b2Vec2();
this.m_u = new b2Vec2();
};
b2DistanceJoint.prototype.GetAnchorA = function () {
return this.m_bodyA.GetWorldPoint(this.m_localAnchor1);
}
b2DistanceJoint.prototype.GetAnchorB = function () {
return this.m_bodyB.GetWorldPoint(this.m_localAnchor2);
}
b2DistanceJoint.prototype.GetReactionForce = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return new b2Vec2(inv_dt * this.m_impulse * this.m_u.x, inv_dt * this.m_impulse * this.m_u.y);
}
b2DistanceJoint.prototype.GetReactionTorque = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return 0.0;
}
b2DistanceJoint.prototype.GetLength = function () {
return this.m_length;
}
b2DistanceJoint.prototype.SetLength = function (length) {
if (length === undefined) length = 0;
this.m_length = length;
}
b2DistanceJoint.prototype.GetFrequency = function () {
return this.m_frequencyHz;
}
b2DistanceJoint.prototype.SetFrequency = function (hz) {
if (hz === undefined) hz = 0;
this.m_frequencyHz = hz;
}
b2DistanceJoint.prototype.GetDampingRatio = function () {
return this.m_dampingRatio;
}
b2DistanceJoint.prototype.SetDampingRatio = function (ratio) {
if (ratio === undefined) ratio = 0;
this.m_dampingRatio = ratio;
}
b2DistanceJoint.prototype.b2DistanceJoint = function (def) {
this.__super.b2Joint.call(this, def);
var tMat;
var tX = 0;
var tY = 0;
this.m_localAnchor1.SetV(def.localAnchorA);
this.m_localAnchor2.SetV(def.localAnchorB);
this.m_length = def.length;
this.m_frequencyHz = def.frequencyHz;
this.m_dampingRatio = def.dampingRatio;
this.m_impulse = 0.0;
this.m_gamma = 0.0;
this.m_bias = 0.0;
}
b2DistanceJoint.prototype.InitVelocityConstraints = function (step) {
var tMat;
var tX = 0;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
var r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
var r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
this.m_u.x = bB.m_sweep.c.x + r2X - bA.m_sweep.c.x - r1X;
this.m_u.y = bB.m_sweep.c.y + r2Y - bA.m_sweep.c.y - r1Y;
var length = Math.sqrt(this.m_u.x * this.m_u.x + this.m_u.y * this.m_u.y);
if (length > b2Settings.b2_linearSlop) {
this.m_u.Multiply(1.0 / length);
}
else {
this.m_u.SetZero();
}
var cr1u = (r1X * this.m_u.y - r1Y * this.m_u.x);
var cr2u = (r2X * this.m_u.y - r2Y * this.m_u.x);
var invMass = bA.m_invMass + bA.m_invI * cr1u * cr1u + bB.m_invMass + bB.m_invI * cr2u * cr2u;
this.m_mass = invMass != 0.0 ? 1.0 / invMass : 0.0;
if (this.m_frequencyHz > 0.0) {
var C = length - this.m_length;
var omega = 2.0 * Math.PI * this.m_frequencyHz;
var d = 2.0 * this.m_mass * this.m_dampingRatio * omega;
var k = this.m_mass * omega * omega;
this.m_gamma = step.dt * (d + step.dt * k);
this.m_gamma = this.m_gamma != 0.0 ? 1 / this.m_gamma : 0.0;
this.m_bias = C * step.dt * k * this.m_gamma;
this.m_mass = invMass + this.m_gamma;
this.m_mass = this.m_mass != 0.0 ? 1.0 / this.m_mass : 0.0;
}
if (step.warmStarting) {
this.m_impulse *= step.dtRatio;
var PX = this.m_impulse * this.m_u.x;
var PY = this.m_impulse * this.m_u.y;
bA.m_linearVelocity.x -= bA.m_invMass * PX;
bA.m_linearVelocity.y -= bA.m_invMass * PY;
bA.m_angularVelocity -= bA.m_invI * (r1X * PY - r1Y * PX);
bB.m_linearVelocity.x += bB.m_invMass * PX;
bB.m_linearVelocity.y += bB.m_invMass * PY;
bB.m_angularVelocity += bB.m_invI * (r2X * PY - r2Y * PX);
}
else {
this.m_impulse = 0.0;
}
}
b2DistanceJoint.prototype.SolveVelocityConstraints = function (step) {
var tMat;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
var r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
var tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
var r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var v1X = bA.m_linearVelocity.x + ((-bA.m_angularVelocity * r1Y));
var v1Y = bA.m_linearVelocity.y + (bA.m_angularVelocity * r1X);
var v2X = bB.m_linearVelocity.x + ((-bB.m_angularVelocity * r2Y));
var v2Y = bB.m_linearVelocity.y + (bB.m_angularVelocity * r2X);
var Cdot = (this.m_u.x * (v2X - v1X) + this.m_u.y * (v2Y - v1Y));
var impulse = (-this.m_mass * (Cdot + this.m_bias + this.m_gamma * this.m_impulse));
this.m_impulse += impulse;
var PX = impulse * this.m_u.x;
var PY = impulse * this.m_u.y;
bA.m_linearVelocity.x -= bA.m_invMass * PX;
bA.m_linearVelocity.y -= bA.m_invMass * PY;
bA.m_angularVelocity -= bA.m_invI * (r1X * PY - r1Y * PX);
bB.m_linearVelocity.x += bB.m_invMass * PX;
bB.m_linearVelocity.y += bB.m_invMass * PY;
bB.m_angularVelocity += bB.m_invI * (r2X * PY - r2Y * PX);
}
b2DistanceJoint.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
var tMat;
if (this.m_frequencyHz > 0.0) {
return true;
}
var bA = this.m_bodyA;
var bB = this.m_bodyB;
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
var r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
var tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
var r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var dX = bB.m_sweep.c.x + r2X - bA.m_sweep.c.x - r1X;
var dY = bB.m_sweep.c.y + r2Y - bA.m_sweep.c.y - r1Y;
var length = Math.sqrt(dX * dX + dY * dY);
dX /= length;
dY /= length;
var C = length - this.m_length;
C = b2Math.Clamp(C, (-b2Settings.b2_maxLinearCorrection), b2Settings.b2_maxLinearCorrection);
var impulse = (-this.m_mass * C);
this.m_u.Set(dX, dY);
var PX = impulse * this.m_u.x;
var PY = impulse * this.m_u.y;
bA.m_sweep.c.x -= bA.m_invMass * PX;
bA.m_sweep.c.y -= bA.m_invMass * PY;
bA.m_sweep.a -= bA.m_invI * (r1X * PY - r1Y * PX);
bB.m_sweep.c.x += bB.m_invMass * PX;
bB.m_sweep.c.y += bB.m_invMass * PY;
bB.m_sweep.a += bB.m_invI * (r2X * PY - r2Y * PX);
bA.SynchronizeTransform();
bB.SynchronizeTransform();
return b2Math.Abs(C) < b2Settings.b2_linearSlop;
}
Box2D.inherit(b2DistanceJointDef, Box2D.Dynamics.Joints.b2JointDef);
b2DistanceJointDef.prototype.__super = Box2D.Dynamics.Joints.b2JointDef.prototype;
b2DistanceJointDef.b2DistanceJointDef = function () {
Box2D.Dynamics.Joints.b2JointDef.b2JointDef.apply(this, arguments);
this.localAnchorA = new b2Vec2();
this.localAnchorB = new b2Vec2();
};
b2DistanceJointDef.prototype.b2DistanceJointDef = function () {
this.__super.b2JointDef.call(this);
this.type = b2Joint.e_distanceJoint;
this.length = 1.0;
this.frequencyHz = 0.0;
this.dampingRatio = 0.0;
}
b2DistanceJointDef.prototype.Initialize = function (bA, bB, anchorA, anchorB) {
this.bodyA = bA;
this.bodyB = bB;
this.localAnchorA.SetV(this.bodyA.GetLocalPoint(anchorA));
this.localAnchorB.SetV(this.bodyB.GetLocalPoint(anchorB));
var dX = anchorB.x - anchorA.x;
var dY = anchorB.y - anchorA.y;
this.length = Math.sqrt(dX * dX + dY * dY);
this.frequencyHz = 0.0;
this.dampingRatio = 0.0;
}
Box2D.inherit(b2FrictionJoint, Box2D.Dynamics.Joints.b2Joint);
b2FrictionJoint.prototype.__super = Box2D.Dynamics.Joints.b2Joint.prototype;
b2FrictionJoint.b2FrictionJoint = function () {
Box2D.Dynamics.Joints.b2Joint.b2Joint.apply(this, arguments);
this.m_localAnchorA = new b2Vec2();
this.m_localAnchorB = new b2Vec2();
this.m_linearMass = new b2Mat22();
this.m_linearImpulse = new b2Vec2();
};
b2FrictionJoint.prototype.GetAnchorA = function () {
return this.m_bodyA.GetWorldPoint(this.m_localAnchorA);
}
b2FrictionJoint.prototype.GetAnchorB = function () {
return this.m_bodyB.GetWorldPoint(this.m_localAnchorB);
}
b2FrictionJoint.prototype.GetReactionForce = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return new b2Vec2(inv_dt * this.m_linearImpulse.x, inv_dt * this.m_linearImpulse.y);
}
b2FrictionJoint.prototype.GetReactionTorque = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return inv_dt * this.m_angularImpulse;
}
b2FrictionJoint.prototype.SetMaxForce = function (force) {
if (force === undefined) force = 0;
this.m_maxForce = force;
}
b2FrictionJoint.prototype.GetMaxForce = function () {
return this.m_maxForce;
}
b2FrictionJoint.prototype.SetMaxTorque = function (torque) {
if (torque === undefined) torque = 0;
this.m_maxTorque = torque;
}
b2FrictionJoint.prototype.GetMaxTorque = function () {
return this.m_maxTorque;
}
b2FrictionJoint.prototype.b2FrictionJoint = function (def) {
this.__super.b2Joint.call(this, def);
this.m_localAnchorA.SetV(def.localAnchorA);
this.m_localAnchorB.SetV(def.localAnchorB);
this.m_linearMass.SetZero();
this.m_angularMass = 0.0;
this.m_linearImpulse.SetZero();
this.m_angularImpulse = 0.0;
this.m_maxForce = def.maxForce;
this.m_maxTorque = def.maxTorque;
}
b2FrictionJoint.prototype.InitVelocityConstraints = function (step) {
var tMat;
var tX = 0;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
tMat = bA.m_xf.R;
var rAX = this.m_localAnchorA.x - bA.m_sweep.localCenter.x;
var rAY = this.m_localAnchorA.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * rAX + tMat.col2.x * rAY);
rAY = (tMat.col1.y * rAX + tMat.col2.y * rAY);
rAX = tX;
tMat = bB.m_xf.R;
var rBX = this.m_localAnchorB.x - bB.m_sweep.localCenter.x;
var rBY = this.m_localAnchorB.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * rBX + tMat.col2.x * rBY);
rBY = (tMat.col1.y * rBX + tMat.col2.y * rBY);
rBX = tX;
var mA = bA.m_invMass;
var mB = bB.m_invMass;
var iA = bA.m_invI;
var iB = bB.m_invI;
var K = new b2Mat22();
K.col1.x = mA + mB;
K.col2.x = 0.0;
K.col1.y = 0.0;
K.col2.y = mA + mB;
K.col1.x += iA * rAY * rAY;
K.col2.x += (-iA * rAX * rAY);
K.col1.y += (-iA * rAX * rAY);
K.col2.y += iA * rAX * rAX;
K.col1.x += iB * rBY * rBY;
K.col2.x += (-iB * rBX * rBY);
K.col1.y += (-iB * rBX * rBY);
K.col2.y += iB * rBX * rBX;
K.GetInverse(this.m_linearMass);
this.m_angularMass = iA + iB;
if (this.m_angularMass > 0.0) {
this.m_angularMass = 1.0 / this.m_angularMass;
}
if (step.warmStarting) {
this.m_linearImpulse.x *= step.dtRatio;
this.m_linearImpulse.y *= step.dtRatio;
this.m_angularImpulse *= step.dtRatio;
var P = this.m_linearImpulse;
bA.m_linearVelocity.x -= mA * P.x;
bA.m_linearVelocity.y -= mA * P.y;
bA.m_angularVelocity -= iA * (rAX * P.y - rAY * P.x + this.m_angularImpulse);
bB.m_linearVelocity.x += mB * P.x;
bB.m_linearVelocity.y += mB * P.y;
bB.m_angularVelocity += iB * (rBX * P.y - rBY * P.x + this.m_angularImpulse);
}
else {
this.m_linearImpulse.SetZero();
this.m_angularImpulse = 0.0;
}
}
b2FrictionJoint.prototype.SolveVelocityConstraints = function (step) {
var tMat;
var tX = 0;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var vA = bA.m_linearVelocity;
var wA = bA.m_angularVelocity;
var vB = bB.m_linearVelocity;
var wB = bB.m_angularVelocity;
var mA = bA.m_invMass;
var mB = bB.m_invMass;
var iA = bA.m_invI;
var iB = bB.m_invI;
tMat = bA.m_xf.R;
var rAX = this.m_localAnchorA.x - bA.m_sweep.localCenter.x;
var rAY = this.m_localAnchorA.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * rAX + tMat.col2.x * rAY);
rAY = (tMat.col1.y * rAX + tMat.col2.y * rAY);
rAX = tX;
tMat = bB.m_xf.R;
var rBX = this.m_localAnchorB.x - bB.m_sweep.localCenter.x;
var rBY = this.m_localAnchorB.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * rBX + tMat.col2.x * rBY);
rBY = (tMat.col1.y * rBX + tMat.col2.y * rBY);
rBX = tX;
var maxImpulse = 0; {
var Cdot = wB - wA;
var impulse = (-this.m_angularMass * Cdot);
var oldImpulse = this.m_angularImpulse;
maxImpulse = step.dt * this.m_maxTorque;
this.m_angularImpulse = b2Math.Clamp(this.m_angularImpulse + impulse, (-maxImpulse), maxImpulse);
impulse = this.m_angularImpulse - oldImpulse;
wA -= iA * impulse;
wB += iB * impulse;
} {
var CdotX = vB.x - wB * rBY - vA.x + wA * rAY;
var CdotY = vB.y + wB * rBX - vA.y - wA * rAX;
var impulseV = b2Math.MulMV(this.m_linearMass, new b2Vec2((-CdotX), (-CdotY)));
var oldImpulseV = this.m_linearImpulse.Copy();
this.m_linearImpulse.Add(impulseV);
maxImpulse = step.dt * this.m_maxForce;
if (this.m_linearImpulse.LengthSquared() > maxImpulse * maxImpulse) {
this.m_linearImpulse.Normalize();
this.m_linearImpulse.Multiply(maxImpulse);
}
impulseV = b2Math.SubtractVV(this.m_linearImpulse, oldImpulseV);
vA.x -= mA * impulseV.x;
vA.y -= mA * impulseV.y;
wA -= iA * (rAX * impulseV.y - rAY * impulseV.x);
vB.x += mB * impulseV.x;
vB.y += mB * impulseV.y;
wB += iB * (rBX * impulseV.y - rBY * impulseV.x);
}
bA.m_angularVelocity = wA;
bB.m_angularVelocity = wB;
}
b2FrictionJoint.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
return true;
}
Box2D.inherit(b2FrictionJointDef, Box2D.Dynamics.Joints.b2JointDef);
b2FrictionJointDef.prototype.__super = Box2D.Dynamics.Joints.b2JointDef.prototype;
b2FrictionJointDef.b2FrictionJointDef = function () {
Box2D.Dynamics.Joints.b2JointDef.b2JointDef.apply(this, arguments);
this.localAnchorA = new b2Vec2();
this.localAnchorB = new b2Vec2();
};
b2FrictionJointDef.prototype.b2FrictionJointDef = function () {
this.__super.b2JointDef.call(this);
this.type = b2Joint.e_frictionJoint;
this.maxForce = 0.0;
this.maxTorque = 0.0;
}
b2FrictionJointDef.prototype.Initialize = function (bA, bB, anchor) {
this.bodyA = bA;
this.bodyB = bB;
this.localAnchorA.SetV(this.bodyA.GetLocalPoint(anchor));
this.localAnchorB.SetV(this.bodyB.GetLocalPoint(anchor));
}
Box2D.inherit(b2GearJoint, Box2D.Dynamics.Joints.b2Joint);
b2GearJoint.prototype.__super = Box2D.Dynamics.Joints.b2Joint.prototype;
b2GearJoint.b2GearJoint = function () {
Box2D.Dynamics.Joints.b2Joint.b2Joint.apply(this, arguments);
this.m_groundAnchor1 = new b2Vec2();
this.m_groundAnchor2 = new b2Vec2();
this.m_localAnchor1 = new b2Vec2();
this.m_localAnchor2 = new b2Vec2();
this.m_J = new b2Jacobian();
};
b2GearJoint.prototype.GetAnchorA = function () {
return this.m_bodyA.GetWorldPoint(this.m_localAnchor1);
}
b2GearJoint.prototype.GetAnchorB = function () {
return this.m_bodyB.GetWorldPoint(this.m_localAnchor2);
}
b2GearJoint.prototype.GetReactionForce = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return new b2Vec2(inv_dt * this.m_impulse * this.m_J.linearB.x, inv_dt * this.m_impulse * this.m_J.linearB.y);
}
b2GearJoint.prototype.GetReactionTorque = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
var tMat = this.m_bodyB.m_xf.R;
var rX = this.m_localAnchor1.x - this.m_bodyB.m_sweep.localCenter.x;
var rY = this.m_localAnchor1.y - this.m_bodyB.m_sweep.localCenter.y;
var tX = tMat.col1.x * rX + tMat.col2.x * rY;
rY = tMat.col1.y * rX + tMat.col2.y * rY;
rX = tX;
var PX = this.m_impulse * this.m_J.linearB.x;
var PY = this.m_impulse * this.m_J.linearB.y;
return inv_dt * (this.m_impulse * this.m_J.angularB - rX * PY + rY * PX);
}
b2GearJoint.prototype.GetRatio = function () {
return this.m_ratio;
}
b2GearJoint.prototype.SetRatio = function (ratio) {
if (ratio === undefined) ratio = 0;
this.m_ratio = ratio;
}
b2GearJoint.prototype.b2GearJoint = function (def) {
this.__super.b2Joint.call(this, def);
var type1 = parseInt(def.joint1.m_type);
var type2 = parseInt(def.joint2.m_type);
this.m_revolute1 = null;
this.m_prismatic1 = null;
this.m_revolute2 = null;
this.m_prismatic2 = null;
var coordinate1 = 0;
var coordinate2 = 0;
this.m_ground1 = def.joint1.GetBodyA();
this.m_bodyA = def.joint1.GetBodyB();
if (type1 == b2Joint.e_revoluteJoint) {
this.m_revolute1 = (def.joint1 instanceof b2RevoluteJoint ? def.joint1 : null);
this.m_groundAnchor1.SetV(this.m_revolute1.m_localAnchor1);
this.m_localAnchor1.SetV(this.m_revolute1.m_localAnchor2);
coordinate1 = this.m_revolute1.GetJointAngle();
}
else {
this.m_prismatic1 = (def.joint1 instanceof b2PrismaticJoint ? def.joint1 : null);
this.m_groundAnchor1.SetV(this.m_prismatic1.m_localAnchor1);
this.m_localAnchor1.SetV(this.m_prismatic1.m_localAnchor2);
coordinate1 = this.m_prismatic1.GetJointTranslation();
}
this.m_ground2 = def.joint2.GetBodyA();
this.m_bodyB = def.joint2.GetBodyB();
if (type2 == b2Joint.e_revoluteJoint) {
this.m_revolute2 = (def.joint2 instanceof b2RevoluteJoint ? def.joint2 : null);
this.m_groundAnchor2.SetV(this.m_revolute2.m_localAnchor1);
this.m_localAnchor2.SetV(this.m_revolute2.m_localAnchor2);
coordinate2 = this.m_revolute2.GetJointAngle();
}
else {
this.m_prismatic2 = (def.joint2 instanceof b2PrismaticJoint ? def.joint2 : null);
this.m_groundAnchor2.SetV(this.m_prismatic2.m_localAnchor1);
this.m_localAnchor2.SetV(this.m_prismatic2.m_localAnchor2);
coordinate2 = this.m_prismatic2.GetJointTranslation();
}
this.m_ratio = def.ratio;
this.m_constant = coordinate1 + this.m_ratio * coordinate2;
this.m_impulse = 0.0;
}
b2GearJoint.prototype.InitVelocityConstraints = function (step) {
var g1 = this.m_ground1;
var g2 = this.m_ground2;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var ugX = 0;
var ugY = 0;
var rX = 0;
var rY = 0;
var tMat;
var tVec;
var crug = 0;
var tX = 0;
var K = 0.0;
this.m_J.SetZero();
if (this.m_revolute1) {
this.m_J.angularA = (-1.0);
K += bA.m_invI;
}
else {
tMat = g1.m_xf.R;
tVec = this.m_prismatic1.m_localXAxis1;
ugX = tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
ugY = tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tMat = bA.m_xf.R;
rX = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
rY = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
tX = tMat.col1.x * rX + tMat.col2.x * rY;
rY = tMat.col1.y * rX + tMat.col2.y * rY;
rX = tX;
crug = rX * ugY - rY * ugX;
this.m_J.linearA.Set((-ugX), (-ugY));
this.m_J.angularA = (-crug);
K += bA.m_invMass + bA.m_invI * crug * crug;
}
if (this.m_revolute2) {
this.m_J.angularB = (-this.m_ratio);
K += this.m_ratio * this.m_ratio * bB.m_invI;
}
else {
tMat = g2.m_xf.R;
tVec = this.m_prismatic2.m_localXAxis1;
ugX = tMat.col1.x * tVec.x + tMat.col2.x * tVec.y;
ugY = tMat.col1.y * tVec.x + tMat.col2.y * tVec.y;
tMat = bB.m_xf.R;
rX = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
rY = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = tMat.col1.x * rX + tMat.col2.x * rY;
rY = tMat.col1.y * rX + tMat.col2.y * rY;
rX = tX;
crug = rX * ugY - rY * ugX;
this.m_J.linearB.Set((-this.m_ratio * ugX), (-this.m_ratio * ugY));
this.m_J.angularB = (-this.m_ratio * crug);
K += this.m_ratio * this.m_ratio * (bB.m_invMass + bB.m_invI * crug * crug);
}
this.m_mass = K > 0.0 ? 1.0 / K : 0.0;
if (step.warmStarting) {
bA.m_linearVelocity.x += bA.m_invMass * this.m_impulse * this.m_J.linearA.x;
bA.m_linearVelocity.y += bA.m_invMass * this.m_impulse * this.m_J.linearA.y;
bA.m_angularVelocity += bA.m_invI * this.m_impulse * this.m_J.angularA;
bB.m_linearVelocity.x += bB.m_invMass * this.m_impulse * this.m_J.linearB.x;
bB.m_linearVelocity.y += bB.m_invMass * this.m_impulse * this.m_J.linearB.y;
bB.m_angularVelocity += bB.m_invI * this.m_impulse * this.m_J.angularB;
}
else {
this.m_impulse = 0.0;
}
}
b2GearJoint.prototype.SolveVelocityConstraints = function (step) {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var Cdot = this.m_J.Compute(bA.m_linearVelocity, bA.m_angularVelocity, bB.m_linearVelocity, bB.m_angularVelocity);
var impulse = (-this.m_mass * Cdot);
this.m_impulse += impulse;
bA.m_linearVelocity.x += bA.m_invMass * impulse * this.m_J.linearA.x;
bA.m_linearVelocity.y += bA.m_invMass * impulse * this.m_J.linearA.y;
bA.m_angularVelocity += bA.m_invI * impulse * this.m_J.angularA;
bB.m_linearVelocity.x += bB.m_invMass * impulse * this.m_J.linearB.x;
bB.m_linearVelocity.y += bB.m_invMass * impulse * this.m_J.linearB.y;
bB.m_angularVelocity += bB.m_invI * impulse * this.m_J.angularB;
}
b2GearJoint.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
var linearError = 0.0;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var coordinate1 = 0;
var coordinate2 = 0;
if (this.m_revolute1) {
coordinate1 = this.m_revolute1.GetJointAngle();
}
else {
coordinate1 = this.m_prismatic1.GetJointTranslation();
}
if (this.m_revolute2) {
coordinate2 = this.m_revolute2.GetJointAngle();
}
else {
coordinate2 = this.m_prismatic2.GetJointTranslation();
}
var C = this.m_constant - (coordinate1 + this.m_ratio * coordinate2);
var impulse = (-this.m_mass * C);
bA.m_sweep.c.x += bA.m_invMass * impulse * this.m_J.linearA.x;
bA.m_sweep.c.y += bA.m_invMass * impulse * this.m_J.linearA.y;
bA.m_sweep.a += bA.m_invI * impulse * this.m_J.angularA;
bB.m_sweep.c.x += bB.m_invMass * impulse * this.m_J.linearB.x;
bB.m_sweep.c.y += bB.m_invMass * impulse * this.m_J.linearB.y;
bB.m_sweep.a += bB.m_invI * impulse * this.m_J.angularB;
bA.SynchronizeTransform();
bB.SynchronizeTransform();
return linearError < b2Settings.b2_linearSlop;
}
Box2D.inherit(b2GearJointDef, Box2D.Dynamics.Joints.b2JointDef);
b2GearJointDef.prototype.__super = Box2D.Dynamics.Joints.b2JointDef.prototype;
b2GearJointDef.b2GearJointDef = function () {
Box2D.Dynamics.Joints.b2JointDef.b2JointDef.apply(this, arguments);
};
b2GearJointDef.prototype.b2GearJointDef = function () {
this.__super.b2JointDef.call(this);
this.type = b2Joint.e_gearJoint;
this.joint1 = null;
this.joint2 = null;
this.ratio = 1.0;
}
b2Jacobian.b2Jacobian = function () {
this.linearA = new b2Vec2();
this.linearB = new b2Vec2();
};
b2Jacobian.prototype.SetZero = function () {
this.linearA.SetZero();
this.angularA = 0.0;
this.linearB.SetZero();
this.angularB = 0.0;
}
b2Jacobian.prototype.Set = function (x1, a1, x2, a2) {
if (a1 === undefined) a1 = 0;
if (a2 === undefined) a2 = 0;
this.linearA.SetV(x1);
this.angularA = a1;
this.linearB.SetV(x2);
this.angularB = a2;
}
b2Jacobian.prototype.Compute = function (x1, a1, x2, a2) {
if (a1 === undefined) a1 = 0;
if (a2 === undefined) a2 = 0;
return (this.linearA.x * x1.x + this.linearA.y * x1.y) + this.angularA * a1 + (this.linearB.x * x2.x + this.linearB.y * x2.y) + this.angularB * a2;
}
b2Joint.b2Joint = function () {
this.m_edgeA = new b2JointEdge();
this.m_edgeB = new b2JointEdge();
this.m_localCenterA = new b2Vec2();
this.m_localCenterB = new b2Vec2();
};
b2Joint.prototype.GetType = function () {
return this.m_type;
}
b2Joint.prototype.GetAnchorA = function () {
return null;
}
b2Joint.prototype.GetAnchorB = function () {
return null;
}
b2Joint.prototype.GetReactionForce = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return null;
}
b2Joint.prototype.GetReactionTorque = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return 0.0;
}
b2Joint.prototype.GetBodyA = function () {
return this.m_bodyA;
}
b2Joint.prototype.GetBodyB = function () {
return this.m_bodyB;
}
b2Joint.prototype.GetNext = function () {
return this.m_next;
}
b2Joint.prototype.GetUserData = function () {
return this.m_userData;
}
b2Joint.prototype.SetUserData = function (data) {
this.m_userData = data;
}
b2Joint.prototype.IsActive = function () {
return this.m_bodyA.IsActive() && this.m_bodyB.IsActive();
}
b2Joint.Create = function (def, allocator) {
var joint = null;
switch (def.type) {
case b2Joint.e_distanceJoint:
{
joint = new b2DistanceJoint((def instanceof b2DistanceJointDef ? def : null));
}
break;
case b2Joint.e_mouseJoint:
{
joint = new b2MouseJoint((def instanceof b2MouseJointDef ? def : null));
}
break;
case b2Joint.e_prismaticJoint:
{
joint = new b2PrismaticJoint((def instanceof b2PrismaticJointDef ? def : null));
}
break;
case b2Joint.e_revoluteJoint:
{
joint = new b2RevoluteJoint((def instanceof b2RevoluteJointDef ? def : null));
}
break;
case b2Joint.e_pulleyJoint:
{
joint = new b2PulleyJoint((def instanceof b2PulleyJointDef ? def : null));
}
break;
case b2Joint.e_gearJoint:
{
joint = new b2GearJoint((def instanceof b2GearJointDef ? def : null));
}
break;
case b2Joint.e_lineJoint:
{
joint = new b2LineJoint((def instanceof b2LineJointDef ? def : null));
}
break;
case b2Joint.e_weldJoint:
{
joint = new b2WeldJoint((def instanceof b2WeldJointDef ? def : null));
}
break;
case b2Joint.e_frictionJoint:
{
joint = new b2FrictionJoint((def instanceof b2FrictionJointDef ? def : null));
}
break;
default:
break;
}
return joint;
}
b2Joint.Destroy = function (joint, allocator) {}
b2Joint.prototype.b2Joint = function (def) {
b2Settings.b2Assert(def.bodyA != def.bodyB);
this.m_type = def.type;
this.m_prev = null;
this.m_next = null;
this.m_bodyA = def.bodyA;
this.m_bodyB = def.bodyB;
this.m_collideConnected = def.collideConnected;
this.m_islandFlag = false;
this.m_userData = def.userData;
}
b2Joint.prototype.InitVelocityConstraints = function (step) {}
b2Joint.prototype.SolveVelocityConstraints = function (step) {}
b2Joint.prototype.FinalizeVelocityConstraints = function () {}
b2Joint.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
return false;
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.Joints.b2Joint.e_unknownJoint = 0;
Box2D.Dynamics.Joints.b2Joint.e_revoluteJoint = 1;
Box2D.Dynamics.Joints.b2Joint.e_prismaticJoint = 2;
Box2D.Dynamics.Joints.b2Joint.e_distanceJoint = 3;
Box2D.Dynamics.Joints.b2Joint.e_pulleyJoint = 4;
Box2D.Dynamics.Joints.b2Joint.e_mouseJoint = 5;
Box2D.Dynamics.Joints.b2Joint.e_gearJoint = 6;
Box2D.Dynamics.Joints.b2Joint.e_lineJoint = 7;
Box2D.Dynamics.Joints.b2Joint.e_weldJoint = 8;
Box2D.Dynamics.Joints.b2Joint.e_frictionJoint = 9;
Box2D.Dynamics.Joints.b2Joint.e_inactiveLimit = 0;
Box2D.Dynamics.Joints.b2Joint.e_atLowerLimit = 1;
Box2D.Dynamics.Joints.b2Joint.e_atUpperLimit = 2;
Box2D.Dynamics.Joints.b2Joint.e_equalLimits = 3;
});
b2JointDef.b2JointDef = function () {};
b2JointDef.prototype.b2JointDef = function () {
this.type = b2Joint.e_unknownJoint;
this.userData = null;
this.bodyA = null;
this.bodyB = null;
this.collideConnected = false;
}
b2JointEdge.b2JointEdge = function () {};
Box2D.inherit(b2LineJoint, Box2D.Dynamics.Joints.b2Joint);
b2LineJoint.prototype.__super = Box2D.Dynamics.Joints.b2Joint.prototype;
b2LineJoint.b2LineJoint = function () {
Box2D.Dynamics.Joints.b2Joint.b2Joint.apply(this, arguments);
this.m_localAnchor1 = new b2Vec2();
this.m_localAnchor2 = new b2Vec2();
this.m_localXAxis1 = new b2Vec2();
this.m_localYAxis1 = new b2Vec2();
this.m_axis = new b2Vec2();
this.m_perp = new b2Vec2();
this.m_K = new b2Mat22();
this.m_impulse = new b2Vec2();
};
b2LineJoint.prototype.GetAnchorA = function () {
return this.m_bodyA.GetWorldPoint(this.m_localAnchor1);
}
b2LineJoint.prototype.GetAnchorB = function () {
return this.m_bodyB.GetWorldPoint(this.m_localAnchor2);
}
b2LineJoint.prototype.GetReactionForce = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return new b2Vec2(inv_dt * (this.m_impulse.x * this.m_perp.x + (this.m_motorImpulse + this.m_impulse.y) * this.m_axis.x), inv_dt * (this.m_impulse.x * this.m_perp.y + (this.m_motorImpulse + this.m_impulse.y) * this.m_axis.y));
}
b2LineJoint.prototype.GetReactionTorque = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return inv_dt * this.m_impulse.y;
}
b2LineJoint.prototype.GetJointTranslation = function () {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
var p1 = bA.GetWorldPoint(this.m_localAnchor1);
var p2 = bB.GetWorldPoint(this.m_localAnchor2);
var dX = p2.x - p1.x;
var dY = p2.y - p1.y;
var axis = bA.GetWorldVector(this.m_localXAxis1);
var translation = axis.x * dX + axis.y * dY;
return translation;
}
b2LineJoint.prototype.GetJointSpeed = function () {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
var r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
var tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
var r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var p1X = bA.m_sweep.c.x + r1X;
var p1Y = bA.m_sweep.c.y + r1Y;
var p2X = bB.m_sweep.c.x + r2X;
var p2Y = bB.m_sweep.c.y + r2Y;
var dX = p2X - p1X;
var dY = p2Y - p1Y;
var axis = bA.GetWorldVector(this.m_localXAxis1);
var v1 = bA.m_linearVelocity;
var v2 = bB.m_linearVelocity;
var w1 = bA.m_angularVelocity;
var w2 = bB.m_angularVelocity;
var speed = (dX * ((-w1 * axis.y)) + dY * (w1 * axis.x)) + (axis.x * (((v2.x + ((-w2 * r2Y))) - v1.x) - ((-w1 * r1Y))) + axis.y * (((v2.y + (w2 * r2X)) - v1.y) - (w1 * r1X)));
return speed;
}
b2LineJoint.prototype.IsLimitEnabled = function () {
return this.m_enableLimit;
}
b2LineJoint.prototype.EnableLimit = function (flag) {
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_enableLimit = flag;
}
b2LineJoint.prototype.GetLowerLimit = function () {
return this.m_lowerTranslation;
}
b2LineJoint.prototype.GetUpperLimit = function () {
return this.m_upperTranslation;
}
b2LineJoint.prototype.SetLimits = function (lower, upper) {
if (lower === undefined) lower = 0;
if (upper === undefined) upper = 0;
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_lowerTranslation = lower;
this.m_upperTranslation = upper;
}
b2LineJoint.prototype.IsMotorEnabled = function () {
return this.m_enableMotor;
}
b2LineJoint.prototype.EnableMotor = function (flag) {
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_enableMotor = flag;
}
b2LineJoint.prototype.SetMotorSpeed = function (speed) {
if (speed === undefined) speed = 0;
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_motorSpeed = speed;
}
b2LineJoint.prototype.GetMotorSpeed = function () {
return this.m_motorSpeed;
}
b2LineJoint.prototype.SetMaxMotorForce = function (force) {
if (force === undefined) force = 0;
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_maxMotorForce = force;
}
b2LineJoint.prototype.GetMaxMotorForce = function () {
return this.m_maxMotorForce;
}
b2LineJoint.prototype.GetMotorForce = function () {
return this.m_motorImpulse;
}
b2LineJoint.prototype.b2LineJoint = function (def) {
this.__super.b2Joint.call(this, def);
var tMat;
var tX = 0;
var tY = 0;
this.m_localAnchor1.SetV(def.localAnchorA);
this.m_localAnchor2.SetV(def.localAnchorB);
this.m_localXAxis1.SetV(def.localAxisA);
this.m_localYAxis1.x = (-this.m_localXAxis1.y);
this.m_localYAxis1.y = this.m_localXAxis1.x;
this.m_impulse.SetZero();
this.m_motorMass = 0.0;
this.m_motorImpulse = 0.0;
this.m_lowerTranslation = def.lowerTranslation;
this.m_upperTranslation = def.upperTranslation;
this.m_maxMotorForce = def.maxMotorForce;
this.m_motorSpeed = def.motorSpeed;
this.m_enableLimit = def.enableLimit;
this.m_enableMotor = def.enableMotor;
this.m_limitState = b2Joint.e_inactiveLimit;
this.m_axis.SetZero();
this.m_perp.SetZero();
}
b2LineJoint.prototype.InitVelocityConstraints = function (step) {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
var tX = 0;
this.m_localCenterA.SetV(bA.GetLocalCenter());
this.m_localCenterB.SetV(bB.GetLocalCenter());
var xf1 = bA.GetTransform();
var xf2 = bB.GetTransform();
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - this.m_localCenterA.x;
var r1Y = this.m_localAnchor1.y - this.m_localCenterA.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - this.m_localCenterB.x;
var r2Y = this.m_localAnchor2.y - this.m_localCenterB.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var dX = bB.m_sweep.c.x + r2X - bA.m_sweep.c.x - r1X;
var dY = bB.m_sweep.c.y + r2Y - bA.m_sweep.c.y - r1Y;
this.m_invMassA = bA.m_invMass;
this.m_invMassB = bB.m_invMass;
this.m_invIA = bA.m_invI;
this.m_invIB = bB.m_invI; {
this.m_axis.SetV(b2Math.MulMV(xf1.R, this.m_localXAxis1));
this.m_a1 = (dX + r1X) * this.m_axis.y - (dY + r1Y) * this.m_axis.x;
this.m_a2 = r2X * this.m_axis.y - r2Y * this.m_axis.x;
this.m_motorMass = this.m_invMassA + this.m_invMassB + this.m_invIA * this.m_a1 * this.m_a1 + this.m_invIB * this.m_a2 * this.m_a2;
this.m_motorMass = this.m_motorMass > Number.MIN_VALUE ? 1.0 / this.m_motorMass : 0.0;
} {
this.m_perp.SetV(b2Math.MulMV(xf1.R, this.m_localYAxis1));
this.m_s1 = (dX + r1X) * this.m_perp.y - (dY + r1Y) * this.m_perp.x;
this.m_s2 = r2X * this.m_perp.y - r2Y * this.m_perp.x;
var m1 = this.m_invMassA;
var m2 = this.m_invMassB;
var i1 = this.m_invIA;
var i2 = this.m_invIB;
this.m_K.col1.x = m1 + m2 + i1 * this.m_s1 * this.m_s1 + i2 * this.m_s2 * this.m_s2;
this.m_K.col1.y = i1 * this.m_s1 * this.m_a1 + i2 * this.m_s2 * this.m_a2;
this.m_K.col2.x = this.m_K.col1.y;
this.m_K.col2.y = m1 + m2 + i1 * this.m_a1 * this.m_a1 + i2 * this.m_a2 * this.m_a2;
}
if (this.m_enableLimit) {
var jointTransition = this.m_axis.x * dX + this.m_axis.y * dY;
if (b2Math.Abs(this.m_upperTranslation - this.m_lowerTranslation) < 2.0 * b2Settings.b2_linearSlop) {
this.m_limitState = b2Joint.e_equalLimits;
}
else if (jointTransition <= this.m_lowerTranslation) {
if (this.m_limitState != b2Joint.e_atLowerLimit) {
this.m_limitState = b2Joint.e_atLowerLimit;
this.m_impulse.y = 0.0;
}
}
else if (jointTransition >= this.m_upperTranslation) {
if (this.m_limitState != b2Joint.e_atUpperLimit) {
this.m_limitState = b2Joint.e_atUpperLimit;
this.m_impulse.y = 0.0;
}
}
else {
this.m_limitState = b2Joint.e_inactiveLimit;
this.m_impulse.y = 0.0;
}
}
else {
this.m_limitState = b2Joint.e_inactiveLimit;
}
if (this.m_enableMotor == false) {
this.m_motorImpulse = 0.0;
}
if (step.warmStarting) {
this.m_impulse.x *= step.dtRatio;
this.m_impulse.y *= step.dtRatio;
this.m_motorImpulse *= step.dtRatio;
var PX = this.m_impulse.x * this.m_perp.x + (this.m_motorImpulse + this.m_impulse.y) * this.m_axis.x;
var PY = this.m_impulse.x * this.m_perp.y + (this.m_motorImpulse + this.m_impulse.y) * this.m_axis.y;
var L1 = this.m_impulse.x * this.m_s1 + (this.m_motorImpulse + this.m_impulse.y) * this.m_a1;
var L2 = this.m_impulse.x * this.m_s2 + (this.m_motorImpulse + this.m_impulse.y) * this.m_a2;
bA.m_linearVelocity.x -= this.m_invMassA * PX;
bA.m_linearVelocity.y -= this.m_invMassA * PY;
bA.m_angularVelocity -= this.m_invIA * L1;
bB.m_linearVelocity.x += this.m_invMassB * PX;
bB.m_linearVelocity.y += this.m_invMassB * PY;
bB.m_angularVelocity += this.m_invIB * L2;
}
else {
this.m_impulse.SetZero();
this.m_motorImpulse = 0.0;
}
}
b2LineJoint.prototype.SolveVelocityConstraints = function (step) {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var v1 = bA.m_linearVelocity;
var w1 = bA.m_angularVelocity;
var v2 = bB.m_linearVelocity;
var w2 = bB.m_angularVelocity;
var PX = 0;
var PY = 0;
var L1 = 0;
var L2 = 0;
if (this.m_enableMotor && this.m_limitState != b2Joint.e_equalLimits) {
var Cdot = this.m_axis.x * (v2.x - v1.x) + this.m_axis.y * (v2.y - v1.y) + this.m_a2 * w2 - this.m_a1 * w1;
var impulse = this.m_motorMass * (this.m_motorSpeed - Cdot);
var oldImpulse = this.m_motorImpulse;
var maxImpulse = step.dt * this.m_maxMotorForce;
this.m_motorImpulse = b2Math.Clamp(this.m_motorImpulse + impulse, (-maxImpulse), maxImpulse);
impulse = this.m_motorImpulse - oldImpulse;
PX = impulse * this.m_axis.x;
PY = impulse * this.m_axis.y;
L1 = impulse * this.m_a1;
L2 = impulse * this.m_a2;
v1.x -= this.m_invMassA * PX;
v1.y -= this.m_invMassA * PY;
w1 -= this.m_invIA * L1;
v2.x += this.m_invMassB * PX;
v2.y += this.m_invMassB * PY;
w2 += this.m_invIB * L2;
}
var Cdot1 = this.m_perp.x * (v2.x - v1.x) + this.m_perp.y * (v2.y - v1.y) + this.m_s2 * w2 - this.m_s1 * w1;
if (this.m_enableLimit && this.m_limitState != b2Joint.e_inactiveLimit) {
var Cdot2 = this.m_axis.x * (v2.x - v1.x) + this.m_axis.y * (v2.y - v1.y) + this.m_a2 * w2 - this.m_a1 * w1;
var f1 = this.m_impulse.Copy();
var df = this.m_K.Solve(new b2Vec2(), (-Cdot1), (-Cdot2));
this.m_impulse.Add(df);
if (this.m_limitState == b2Joint.e_atLowerLimit) {
this.m_impulse.y = b2Math.Max(this.m_impulse.y, 0.0);
}
else if (this.m_limitState == b2Joint.e_atUpperLimit) {
this.m_impulse.y = b2Math.Min(this.m_impulse.y, 0.0);
}
var b = (-Cdot1) - (this.m_impulse.y - f1.y) * this.m_K.col2.x;
var f2r = 0;
if (this.m_K.col1.x != 0.0) {
f2r = b / this.m_K.col1.x + f1.x;
}
else {
f2r = f1.x;
}
this.m_impulse.x = f2r;
df.x = this.m_impulse.x - f1.x;
df.y = this.m_impulse.y - f1.y;
PX = df.x * this.m_perp.x + df.y * this.m_axis.x;
PY = df.x * this.m_perp.y + df.y * this.m_axis.y;
L1 = df.x * this.m_s1 + df.y * this.m_a1;
L2 = df.x * this.m_s2 + df.y * this.m_a2;
v1.x -= this.m_invMassA * PX;
v1.y -= this.m_invMassA * PY;
w1 -= this.m_invIA * L1;
v2.x += this.m_invMassB * PX;
v2.y += this.m_invMassB * PY;
w2 += this.m_invIB * L2;
}
else {
var df2 = 0;
if (this.m_K.col1.x != 0.0) {
df2 = ((-Cdot1)) / this.m_K.col1.x;
}
else {
df2 = 0.0;
}
this.m_impulse.x += df2;
PX = df2 * this.m_perp.x;
PY = df2 * this.m_perp.y;
L1 = df2 * this.m_s1;
L2 = df2 * this.m_s2;
v1.x -= this.m_invMassA * PX;
v1.y -= this.m_invMassA * PY;
w1 -= this.m_invIA * L1;
v2.x += this.m_invMassB * PX;
v2.y += this.m_invMassB * PY;
w2 += this.m_invIB * L2;
}
bA.m_linearVelocity.SetV(v1);
bA.m_angularVelocity = w1;
bB.m_linearVelocity.SetV(v2);
bB.m_angularVelocity = w2;
}
b2LineJoint.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
var limitC = 0;
var oldLimitImpulse = 0;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var c1 = bA.m_sweep.c;
var a1 = bA.m_sweep.a;
var c2 = bB.m_sweep.c;
var a2 = bB.m_sweep.a;
var tMat;
var tX = 0;
var m1 = 0;
var m2 = 0;
var i1 = 0;
var i2 = 0;
var linearError = 0.0;
var angularError = 0.0;
var active = false;
var C2 = 0.0;
var R1 = b2Mat22.FromAngle(a1);
var R2 = b2Mat22.FromAngle(a2);
tMat = R1;
var r1X = this.m_localAnchor1.x - this.m_localCenterA.x;
var r1Y = this.m_localAnchor1.y - this.m_localCenterA.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = R2;
var r2X = this.m_localAnchor2.x - this.m_localCenterB.x;
var r2Y = this.m_localAnchor2.y - this.m_localCenterB.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var dX = c2.x + r2X - c1.x - r1X;
var dY = c2.y + r2Y - c1.y - r1Y;
if (this.m_enableLimit) {
this.m_axis = b2Math.MulMV(R1, this.m_localXAxis1);
this.m_a1 = (dX + r1X) * this.m_axis.y - (dY + r1Y) * this.m_axis.x;
this.m_a2 = r2X * this.m_axis.y - r2Y * this.m_axis.x;
var translation = this.m_axis.x * dX + this.m_axis.y * dY;
if (b2Math.Abs(this.m_upperTranslation - this.m_lowerTranslation) < 2.0 * b2Settings.b2_linearSlop) {
C2 = b2Math.Clamp(translation, (-b2Settings.b2_maxLinearCorrection), b2Settings.b2_maxLinearCorrection);
linearError = b2Math.Abs(translation);
active = true;
}
else if (translation <= this.m_lowerTranslation) {
C2 = b2Math.Clamp(translation - this.m_lowerTranslation + b2Settings.b2_linearSlop, (-b2Settings.b2_maxLinearCorrection), 0.0);
linearError = this.m_lowerTranslation - translation;
active = true;
}
else if (translation >= this.m_upperTranslation) {
C2 = b2Math.Clamp(translation - this.m_upperTranslation + b2Settings.b2_linearSlop, 0.0, b2Settings.b2_maxLinearCorrection);
linearError = translation - this.m_upperTranslation;
active = true;
}
}
this.m_perp = b2Math.MulMV(R1, this.m_localYAxis1);
this.m_s1 = (dX + r1X) * this.m_perp.y - (dY + r1Y) * this.m_perp.x;
this.m_s2 = r2X * this.m_perp.y - r2Y * this.m_perp.x;
var impulse = new b2Vec2();
var C1 = this.m_perp.x * dX + this.m_perp.y * dY;
linearError = b2Math.Max(linearError, b2Math.Abs(C1));
angularError = 0.0;
if (active) {
m1 = this.m_invMassA;
m2 = this.m_invMassB;
i1 = this.m_invIA;
i2 = this.m_invIB;
this.m_K.col1.x = m1 + m2 + i1 * this.m_s1 * this.m_s1 + i2 * this.m_s2 * this.m_s2;
this.m_K.col1.y = i1 * this.m_s1 * this.m_a1 + i2 * this.m_s2 * this.m_a2;
this.m_K.col2.x = this.m_K.col1.y;
this.m_K.col2.y = m1 + m2 + i1 * this.m_a1 * this.m_a1 + i2 * this.m_a2 * this.m_a2;
this.m_K.Solve(impulse, (-C1), (-C2));
}
else {
m1 = this.m_invMassA;
m2 = this.m_invMassB;
i1 = this.m_invIA;
i2 = this.m_invIB;
var k11 = m1 + m2 + i1 * this.m_s1 * this.m_s1 + i2 * this.m_s2 * this.m_s2;
var impulse1 = 0;
if (k11 != 0.0) {
impulse1 = ((-C1)) / k11;
}
else {
impulse1 = 0.0;
}
impulse.x = impulse1;
impulse.y = 0.0;
}
var PX = impulse.x * this.m_perp.x + impulse.y * this.m_axis.x;
var PY = impulse.x * this.m_perp.y + impulse.y * this.m_axis.y;
var L1 = impulse.x * this.m_s1 + impulse.y * this.m_a1;
var L2 = impulse.x * this.m_s2 + impulse.y * this.m_a2;
c1.x -= this.m_invMassA * PX;
c1.y -= this.m_invMassA * PY;
a1 -= this.m_invIA * L1;
c2.x += this.m_invMassB * PX;
c2.y += this.m_invMassB * PY;
a2 += this.m_invIB * L2;
bA.m_sweep.a = a1;
bB.m_sweep.a = a2;
bA.SynchronizeTransform();
bB.SynchronizeTransform();
return linearError <= b2Settings.b2_linearSlop && angularError <= b2Settings.b2_angularSlop;
}
Box2D.inherit(b2LineJointDef, Box2D.Dynamics.Joints.b2JointDef);
b2LineJointDef.prototype.__super = Box2D.Dynamics.Joints.b2JointDef.prototype;
b2LineJointDef.b2LineJointDef = function () {
Box2D.Dynamics.Joints.b2JointDef.b2JointDef.apply(this, arguments);
this.localAnchorA = new b2Vec2();
this.localAnchorB = new b2Vec2();
this.localAxisA = new b2Vec2();
};
b2LineJointDef.prototype.b2LineJointDef = function () {
this.__super.b2JointDef.call(this);
this.type = b2Joint.e_lineJoint;
this.localAxisA.Set(1.0, 0.0);
this.enableLimit = false;
this.lowerTranslation = 0.0;
this.upperTranslation = 0.0;
this.enableMotor = false;
this.maxMotorForce = 0.0;
this.motorSpeed = 0.0;
}
b2LineJointDef.prototype.Initialize = function (bA, bB, anchor, axis) {
this.bodyA = bA;
this.bodyB = bB;
this.localAnchorA = this.bodyA.GetLocalPoint(anchor);
this.localAnchorB = this.bodyB.GetLocalPoint(anchor);
this.localAxisA = this.bodyA.GetLocalVector(axis);
}
Box2D.inherit(b2MouseJoint, Box2D.Dynamics.Joints.b2Joint);
b2MouseJoint.prototype.__super = Box2D.Dynamics.Joints.b2Joint.prototype;
b2MouseJoint.b2MouseJoint = function () {
Box2D.Dynamics.Joints.b2Joint.b2Joint.apply(this, arguments);
this.K = new b2Mat22();
this.K1 = new b2Mat22();
this.K2 = new b2Mat22();
this.m_localAnchor = new b2Vec2();
this.m_target = new b2Vec2();
this.m_impulse = new b2Vec2();
this.m_mass = new b2Mat22();
this.m_C = new b2Vec2();
};
b2MouseJoint.prototype.GetAnchorA = function () {
return this.m_target;
}
b2MouseJoint.prototype.GetAnchorB = function () {
return this.m_bodyB.GetWorldPoint(this.m_localAnchor);
}
b2MouseJoint.prototype.GetReactionForce = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return new b2Vec2(inv_dt * this.m_impulse.x, inv_dt * this.m_impulse.y);
}
b2MouseJoint.prototype.GetReactionTorque = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return 0.0;
}
b2MouseJoint.prototype.GetTarget = function () {
return this.m_target;
}
b2MouseJoint.prototype.SetTarget = function (target) {
if (this.m_bodyB.IsAwake() == false) {
this.m_bodyB.SetAwake(true);
}
this.m_target = target;
}
b2MouseJoint.prototype.GetMaxForce = function () {
return this.m_maxForce;
}
b2MouseJoint.prototype.SetMaxForce = function (maxForce) {
if (maxForce === undefined) maxForce = 0;
this.m_maxForce = maxForce;
}
b2MouseJoint.prototype.GetFrequency = function () {
return this.m_frequencyHz;
}
b2MouseJoint.prototype.SetFrequency = function (hz) {
if (hz === undefined) hz = 0;
this.m_frequencyHz = hz;
}
b2MouseJoint.prototype.GetDampingRatio = function () {
return this.m_dampingRatio;
}
b2MouseJoint.prototype.SetDampingRatio = function (ratio) {
if (ratio === undefined) ratio = 0;
this.m_dampingRatio = ratio;
}
b2MouseJoint.prototype.b2MouseJoint = function (def) {
this.__super.b2Joint.call(this, def);
this.m_target.SetV(def.target);
var tX = this.m_target.x - this.m_bodyB.m_xf.position.x;
var tY = this.m_target.y - this.m_bodyB.m_xf.position.y;
var tMat = this.m_bodyB.m_xf.R;
this.m_localAnchor.x = (tX * tMat.col1.x + tY * tMat.col1.y);
this.m_localAnchor.y = (tX * tMat.col2.x + tY * tMat.col2.y);
this.m_maxForce = def.maxForce;
this.m_impulse.SetZero();
this.m_frequencyHz = def.frequencyHz;
this.m_dampingRatio = def.dampingRatio;
this.m_beta = 0.0;
this.m_gamma = 0.0;
}
b2MouseJoint.prototype.InitVelocityConstraints = function (step) {
var b = this.m_bodyB;
var mass = b.GetMass();
var omega = 2.0 * Math.PI * this.m_frequencyHz;
var d = 2.0 * mass * this.m_dampingRatio * omega;
var k = mass * omega * omega;
this.m_gamma = step.dt * (d + step.dt * k);
this.m_gamma = this.m_gamma != 0 ? 1 / this.m_gamma : 0.0;
this.m_beta = step.dt * k * this.m_gamma;
var tMat;tMat = b.m_xf.R;
var rX = this.m_localAnchor.x - b.m_sweep.localCenter.x;
var rY = this.m_localAnchor.y - b.m_sweep.localCenter.y;
var tX = (tMat.col1.x * rX + tMat.col2.x * rY);rY = (tMat.col1.y * rX + tMat.col2.y * rY);
rX = tX;
var invMass = b.m_invMass;
var invI = b.m_invI;this.K1.col1.x = invMass;
this.K1.col2.x = 0.0;
this.K1.col1.y = 0.0;
this.K1.col2.y = invMass;
this.K2.col1.x = invI * rY * rY;
this.K2.col2.x = (-invI * rX * rY);
this.K2.col1.y = (-invI * rX * rY);
this.K2.col2.y = invI * rX * rX;
this.K.SetM(this.K1);
this.K.AddM(this.K2);
this.K.col1.x += this.m_gamma;
this.K.col2.y += this.m_gamma;
this.K.GetInverse(this.m_mass);
this.m_C.x = b.m_sweep.c.x + rX - this.m_target.x;
this.m_C.y = b.m_sweep.c.y + rY - this.m_target.y;
b.m_angularVelocity *= 0.98;
this.m_impulse.x *= step.dtRatio;
this.m_impulse.y *= step.dtRatio;
b.m_linearVelocity.x += invMass * this.m_impulse.x;
b.m_linearVelocity.y += invMass * this.m_impulse.y;
b.m_angularVelocity += invI * (rX * this.m_impulse.y - rY * this.m_impulse.x);
}
b2MouseJoint.prototype.SolveVelocityConstraints = function (step) {
var b = this.m_bodyB;
var tMat;
var tX = 0;
var tY = 0;
tMat = b.m_xf.R;
var rX = this.m_localAnchor.x - b.m_sweep.localCenter.x;
var rY = this.m_localAnchor.y - b.m_sweep.localCenter.y;
tX = (tMat.col1.x * rX + tMat.col2.x * rY);
rY = (tMat.col1.y * rX + tMat.col2.y * rY);
rX = tX;
var CdotX = b.m_linearVelocity.x + ((-b.m_angularVelocity * rY));
var CdotY = b.m_linearVelocity.y + (b.m_angularVelocity * rX);
tMat = this.m_mass;
tX = CdotX + this.m_beta * this.m_C.x + this.m_gamma * this.m_impulse.x;
tY = CdotY + this.m_beta * this.m_C.y + this.m_gamma * this.m_impulse.y;
var impulseX = (-(tMat.col1.x * tX + tMat.col2.x * tY));
var impulseY = (-(tMat.col1.y * tX + tMat.col2.y * tY));
var oldImpulseX = this.m_impulse.x;
var oldImpulseY = this.m_impulse.y;
this.m_impulse.x += impulseX;
this.m_impulse.y += impulseY;
var maxImpulse = step.dt * this.m_maxForce;
if (this.m_impulse.LengthSquared() > maxImpulse * maxImpulse) {
this.m_impulse.Multiply(maxImpulse / this.m_impulse.Length());
}
impulseX = this.m_impulse.x - oldImpulseX;
impulseY = this.m_impulse.y - oldImpulseY;
b.m_linearVelocity.x += b.m_invMass * impulseX;
b.m_linearVelocity.y += b.m_invMass * impulseY;
b.m_angularVelocity += b.m_invI * (rX * impulseY - rY * impulseX);
}
b2MouseJoint.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
return true;
}
Box2D.inherit(b2MouseJointDef, Box2D.Dynamics.Joints.b2JointDef);
b2MouseJointDef.prototype.__super = Box2D.Dynamics.Joints.b2JointDef.prototype;
b2MouseJointDef.b2MouseJointDef = function () {
Box2D.Dynamics.Joints.b2JointDef.b2JointDef.apply(this, arguments);
this.target = new b2Vec2();
};
b2MouseJointDef.prototype.b2MouseJointDef = function () {
this.__super.b2JointDef.call(this);
this.type = b2Joint.e_mouseJoint;
this.maxForce = 0.0;
this.frequencyHz = 5.0;
this.dampingRatio = 0.7;
}
Box2D.inherit(b2PrismaticJoint, Box2D.Dynamics.Joints.b2Joint);
b2PrismaticJoint.prototype.__super = Box2D.Dynamics.Joints.b2Joint.prototype;
b2PrismaticJoint.b2PrismaticJoint = function () {
Box2D.Dynamics.Joints.b2Joint.b2Joint.apply(this, arguments);
this.m_localAnchor1 = new b2Vec2();
this.m_localAnchor2 = new b2Vec2();
this.m_localXAxis1 = new b2Vec2();
this.m_localYAxis1 = new b2Vec2();
this.m_axis = new b2Vec2();
this.m_perp = new b2Vec2();
this.m_K = new b2Mat33();
this.m_impulse = new b2Vec3();
};
b2PrismaticJoint.prototype.GetAnchorA = function () {
return this.m_bodyA.GetWorldPoint(this.m_localAnchor1);
}
b2PrismaticJoint.prototype.GetAnchorB = function () {
return this.m_bodyB.GetWorldPoint(this.m_localAnchor2);
}
b2PrismaticJoint.prototype.GetReactionForce = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return new b2Vec2(inv_dt * (this.m_impulse.x * this.m_perp.x + (this.m_motorImpulse + this.m_impulse.z) * this.m_axis.x), inv_dt * (this.m_impulse.x * this.m_perp.y + (this.m_motorImpulse + this.m_impulse.z) * this.m_axis.y));
}
b2PrismaticJoint.prototype.GetReactionTorque = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return inv_dt * this.m_impulse.y;
}
b2PrismaticJoint.prototype.GetJointTranslation = function () {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
var p1 = bA.GetWorldPoint(this.m_localAnchor1);
var p2 = bB.GetWorldPoint(this.m_localAnchor2);
var dX = p2.x - p1.x;
var dY = p2.y - p1.y;
var axis = bA.GetWorldVector(this.m_localXAxis1);
var translation = axis.x * dX + axis.y * dY;
return translation;
}
b2PrismaticJoint.prototype.GetJointSpeed = function () {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
var r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
var tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
var r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var p1X = bA.m_sweep.c.x + r1X;
var p1Y = bA.m_sweep.c.y + r1Y;
var p2X = bB.m_sweep.c.x + r2X;
var p2Y = bB.m_sweep.c.y + r2Y;
var dX = p2X - p1X;
var dY = p2Y - p1Y;
var axis = bA.GetWorldVector(this.m_localXAxis1);
var v1 = bA.m_linearVelocity;
var v2 = bB.m_linearVelocity;
var w1 = bA.m_angularVelocity;
var w2 = bB.m_angularVelocity;
var speed = (dX * ((-w1 * axis.y)) + dY * (w1 * axis.x)) + (axis.x * (((v2.x + ((-w2 * r2Y))) - v1.x) - ((-w1 * r1Y))) + axis.y * (((v2.y + (w2 * r2X)) - v1.y) - (w1 * r1X)));
return speed;
}
b2PrismaticJoint.prototype.IsLimitEnabled = function () {
return this.m_enableLimit;
}
b2PrismaticJoint.prototype.EnableLimit = function (flag) {
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_enableLimit = flag;
}
b2PrismaticJoint.prototype.GetLowerLimit = function () {
return this.m_lowerTranslation;
}
b2PrismaticJoint.prototype.GetUpperLimit = function () {
return this.m_upperTranslation;
}
b2PrismaticJoint.prototype.SetLimits = function (lower, upper) {
if (lower === undefined) lower = 0;
if (upper === undefined) upper = 0;
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_lowerTranslation = lower;
this.m_upperTranslation = upper;
}
b2PrismaticJoint.prototype.IsMotorEnabled = function () {
return this.m_enableMotor;
}
b2PrismaticJoint.prototype.EnableMotor = function (flag) {
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_enableMotor = flag;
}
b2PrismaticJoint.prototype.SetMotorSpeed = function (speed) {
if (speed === undefined) speed = 0;
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_motorSpeed = speed;
}
b2PrismaticJoint.prototype.GetMotorSpeed = function () {
return this.m_motorSpeed;
}
b2PrismaticJoint.prototype.SetMaxMotorForce = function (force) {
if (force === undefined) force = 0;
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_maxMotorForce = force;
}
b2PrismaticJoint.prototype.GetMotorForce = function () {
return this.m_motorImpulse;
}
b2PrismaticJoint.prototype.b2PrismaticJoint = function (def) {
this.__super.b2Joint.call(this, def);
var tMat;
var tX = 0;
var tY = 0;
this.m_localAnchor1.SetV(def.localAnchorA);
this.m_localAnchor2.SetV(def.localAnchorB);
this.m_localXAxis1.SetV(def.localAxisA);
this.m_localYAxis1.x = (-this.m_localXAxis1.y);
this.m_localYAxis1.y = this.m_localXAxis1.x;
this.m_refAngle = def.referenceAngle;
this.m_impulse.SetZero();
this.m_motorMass = 0.0;
this.m_motorImpulse = 0.0;
this.m_lowerTranslation = def.lowerTranslation;
this.m_upperTranslation = def.upperTranslation;
this.m_maxMotorForce = def.maxMotorForce;
this.m_motorSpeed = def.motorSpeed;
this.m_enableLimit = def.enableLimit;
this.m_enableMotor = def.enableMotor;
this.m_limitState = b2Joint.e_inactiveLimit;
this.m_axis.SetZero();
this.m_perp.SetZero();
}
b2PrismaticJoint.prototype.InitVelocityConstraints = function (step) {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
var tX = 0;
this.m_localCenterA.SetV(bA.GetLocalCenter());
this.m_localCenterB.SetV(bB.GetLocalCenter());
var xf1 = bA.GetTransform();
var xf2 = bB.GetTransform();
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - this.m_localCenterA.x;
var r1Y = this.m_localAnchor1.y - this.m_localCenterA.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - this.m_localCenterB.x;
var r2Y = this.m_localAnchor2.y - this.m_localCenterB.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var dX = bB.m_sweep.c.x + r2X - bA.m_sweep.c.x - r1X;
var dY = bB.m_sweep.c.y + r2Y - bA.m_sweep.c.y - r1Y;
this.m_invMassA = bA.m_invMass;
this.m_invMassB = bB.m_invMass;
this.m_invIA = bA.m_invI;
this.m_invIB = bB.m_invI; {
this.m_axis.SetV(b2Math.MulMV(xf1.R, this.m_localXAxis1));
this.m_a1 = (dX + r1X) * this.m_axis.y - (dY + r1Y) * this.m_axis.x;
this.m_a2 = r2X * this.m_axis.y - r2Y * this.m_axis.x;
this.m_motorMass = this.m_invMassA + this.m_invMassB + this.m_invIA * this.m_a1 * this.m_a1 + this.m_invIB * this.m_a2 * this.m_a2;
if (this.m_motorMass > Number.MIN_VALUE) this.m_motorMass = 1.0 / this.m_motorMass;
} {
this.m_perp.SetV(b2Math.MulMV(xf1.R, this.m_localYAxis1));
this.m_s1 = (dX + r1X) * this.m_perp.y - (dY + r1Y) * this.m_perp.x;
this.m_s2 = r2X * this.m_perp.y - r2Y * this.m_perp.x;
var m1 = this.m_invMassA;
var m2 = this.m_invMassB;
var i1 = this.m_invIA;
var i2 = this.m_invIB;
this.m_K.col1.x = m1 + m2 + i1 * this.m_s1 * this.m_s1 + i2 * this.m_s2 * this.m_s2;
this.m_K.col1.y = i1 * this.m_s1 + i2 * this.m_s2;
this.m_K.col1.z = i1 * this.m_s1 * this.m_a1 + i2 * this.m_s2 * this.m_a2;
this.m_K.col2.x = this.m_K.col1.y;
this.m_K.col2.y = i1 + i2;
this.m_K.col2.z = i1 * this.m_a1 + i2 * this.m_a2;
this.m_K.col3.x = this.m_K.col1.z;
this.m_K.col3.y = this.m_K.col2.z;
this.m_K.col3.z = m1 + m2 + i1 * this.m_a1 * this.m_a1 + i2 * this.m_a2 * this.m_a2;
}
if (this.m_enableLimit) {
var jointTransition = this.m_axis.x * dX + this.m_axis.y * dY;
if (b2Math.Abs(this.m_upperTranslation - this.m_lowerTranslation) < 2.0 * b2Settings.b2_linearSlop) {
this.m_limitState = b2Joint.e_equalLimits;
}
else if (jointTransition <= this.m_lowerTranslation) {
if (this.m_limitState != b2Joint.e_atLowerLimit) {
this.m_limitState = b2Joint.e_atLowerLimit;
this.m_impulse.z = 0.0;
}
}
else if (jointTransition >= this.m_upperTranslation) {
if (this.m_limitState != b2Joint.e_atUpperLimit) {
this.m_limitState = b2Joint.e_atUpperLimit;
this.m_impulse.z = 0.0;
}
}
else {
this.m_limitState = b2Joint.e_inactiveLimit;
this.m_impulse.z = 0.0;
}
}
else {
this.m_limitState = b2Joint.e_inactiveLimit;
}
if (this.m_enableMotor == false) {
this.m_motorImpulse = 0.0;
}
if (step.warmStarting) {
this.m_impulse.x *= step.dtRatio;
this.m_impulse.y *= step.dtRatio;
this.m_motorImpulse *= step.dtRatio;
var PX = this.m_impulse.x * this.m_perp.x + (this.m_motorImpulse + this.m_impulse.z) * this.m_axis.x;
var PY = this.m_impulse.x * this.m_perp.y + (this.m_motorImpulse + this.m_impulse.z) * this.m_axis.y;
var L1 = this.m_impulse.x * this.m_s1 + this.m_impulse.y + (this.m_motorImpulse + this.m_impulse.z) * this.m_a1;
var L2 = this.m_impulse.x * this.m_s2 + this.m_impulse.y + (this.m_motorImpulse + this.m_impulse.z) * this.m_a2;
bA.m_linearVelocity.x -= this.m_invMassA * PX;
bA.m_linearVelocity.y -= this.m_invMassA * PY;
bA.m_angularVelocity -= this.m_invIA * L1;
bB.m_linearVelocity.x += this.m_invMassB * PX;
bB.m_linearVelocity.y += this.m_invMassB * PY;
bB.m_angularVelocity += this.m_invIB * L2;
}
else {
this.m_impulse.SetZero();
this.m_motorImpulse = 0.0;
}
}
b2PrismaticJoint.prototype.SolveVelocityConstraints = function (step) {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var v1 = bA.m_linearVelocity;
var w1 = bA.m_angularVelocity;
var v2 = bB.m_linearVelocity;
var w2 = bB.m_angularVelocity;
var PX = 0;
var PY = 0;
var L1 = 0;
var L2 = 0;
if (this.m_enableMotor && this.m_limitState != b2Joint.e_equalLimits) {
var Cdot = this.m_axis.x * (v2.x - v1.x) + this.m_axis.y * (v2.y - v1.y) + this.m_a2 * w2 - this.m_a1 * w1;
var impulse = this.m_motorMass * (this.m_motorSpeed - Cdot);
var oldImpulse = this.m_motorImpulse;
var maxImpulse = step.dt * this.m_maxMotorForce;
this.m_motorImpulse = b2Math.Clamp(this.m_motorImpulse + impulse, (-maxImpulse), maxImpulse);
impulse = this.m_motorImpulse - oldImpulse;
PX = impulse * this.m_axis.x;
PY = impulse * this.m_axis.y;
L1 = impulse * this.m_a1;
L2 = impulse * this.m_a2;
v1.x -= this.m_invMassA * PX;
v1.y -= this.m_invMassA * PY;
w1 -= this.m_invIA * L1;
v2.x += this.m_invMassB * PX;
v2.y += this.m_invMassB * PY;
w2 += this.m_invIB * L2;
}
var Cdot1X = this.m_perp.x * (v2.x - v1.x) + this.m_perp.y * (v2.y - v1.y) + this.m_s2 * w2 - this.m_s1 * w1;
var Cdot1Y = w2 - w1;
if (this.m_enableLimit && this.m_limitState != b2Joint.e_inactiveLimit) {
var Cdot2 = this.m_axis.x * (v2.x - v1.x) + this.m_axis.y * (v2.y - v1.y) + this.m_a2 * w2 - this.m_a1 * w1;
var f1 = this.m_impulse.Copy();
var df = this.m_K.Solve33(new b2Vec3(), (-Cdot1X), (-Cdot1Y), (-Cdot2));
this.m_impulse.Add(df);
if (this.m_limitState == b2Joint.e_atLowerLimit) {
this.m_impulse.z = b2Math.Max(this.m_impulse.z, 0.0);
}
else if (this.m_limitState == b2Joint.e_atUpperLimit) {
this.m_impulse.z = b2Math.Min(this.m_impulse.z, 0.0);
}
var bX = (-Cdot1X) - (this.m_impulse.z - f1.z) * this.m_K.col3.x;
var bY = (-Cdot1Y) - (this.m_impulse.z - f1.z) * this.m_K.col3.y;
var f2r = this.m_K.Solve22(new b2Vec2(), bX, bY);
f2r.x += f1.x;
f2r.y += f1.y;
this.m_impulse.x = f2r.x;
this.m_impulse.y = f2r.y;
df.x = this.m_impulse.x - f1.x;
df.y = this.m_impulse.y - f1.y;
df.z = this.m_impulse.z - f1.z;
PX = df.x * this.m_perp.x + df.z * this.m_axis.x;
PY = df.x * this.m_perp.y + df.z * this.m_axis.y;
L1 = df.x * this.m_s1 + df.y + df.z * this.m_a1;
L2 = df.x * this.m_s2 + df.y + df.z * this.m_a2;
v1.x -= this.m_invMassA * PX;
v1.y -= this.m_invMassA * PY;
w1 -= this.m_invIA * L1;
v2.x += this.m_invMassB * PX;
v2.y += this.m_invMassB * PY;
w2 += this.m_invIB * L2;
}
else {
var df2 = this.m_K.Solve22(new b2Vec2(), (-Cdot1X), (-Cdot1Y));
this.m_impulse.x += df2.x;
this.m_impulse.y += df2.y;
PX = df2.x * this.m_perp.x;
PY = df2.x * this.m_perp.y;
L1 = df2.x * this.m_s1 + df2.y;
L2 = df2.x * this.m_s2 + df2.y;
v1.x -= this.m_invMassA * PX;
v1.y -= this.m_invMassA * PY;
w1 -= this.m_invIA * L1;
v2.x += this.m_invMassB * PX;
v2.y += this.m_invMassB * PY;
w2 += this.m_invIB * L2;
}
bA.m_linearVelocity.SetV(v1);
bA.m_angularVelocity = w1;
bB.m_linearVelocity.SetV(v2);
bB.m_angularVelocity = w2;
}
b2PrismaticJoint.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
var limitC = 0;
var oldLimitImpulse = 0;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var c1 = bA.m_sweep.c;
var a1 = bA.m_sweep.a;
var c2 = bB.m_sweep.c;
var a2 = bB.m_sweep.a;
var tMat;
var tX = 0;
var m1 = 0;
var m2 = 0;
var i1 = 0;
var i2 = 0;
var linearError = 0.0;
var angularError = 0.0;
var active = false;
var C2 = 0.0;
var R1 = b2Mat22.FromAngle(a1);
var R2 = b2Mat22.FromAngle(a2);
tMat = R1;
var r1X = this.m_localAnchor1.x - this.m_localCenterA.x;
var r1Y = this.m_localAnchor1.y - this.m_localCenterA.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = R2;
var r2X = this.m_localAnchor2.x - this.m_localCenterB.x;
var r2Y = this.m_localAnchor2.y - this.m_localCenterB.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var dX = c2.x + r2X - c1.x - r1X;
var dY = c2.y + r2Y - c1.y - r1Y;
if (this.m_enableLimit) {
this.m_axis = b2Math.MulMV(R1, this.m_localXAxis1);
this.m_a1 = (dX + r1X) * this.m_axis.y - (dY + r1Y) * this.m_axis.x;
this.m_a2 = r2X * this.m_axis.y - r2Y * this.m_axis.x;
var translation = this.m_axis.x * dX + this.m_axis.y * dY;
if (b2Math.Abs(this.m_upperTranslation - this.m_lowerTranslation) < 2.0 * b2Settings.b2_linearSlop) {
C2 = b2Math.Clamp(translation, (-b2Settings.b2_maxLinearCorrection), b2Settings.b2_maxLinearCorrection);
linearError = b2Math.Abs(translation);
active = true;
}
else if (translation <= this.m_lowerTranslation) {
C2 = b2Math.Clamp(translation - this.m_lowerTranslation + b2Settings.b2_linearSlop, (-b2Settings.b2_maxLinearCorrection), 0.0);
linearError = this.m_lowerTranslation - translation;
active = true;
}
else if (translation >= this.m_upperTranslation) {
C2 = b2Math.Clamp(translation - this.m_upperTranslation + b2Settings.b2_linearSlop, 0.0, b2Settings.b2_maxLinearCorrection);
linearError = translation - this.m_upperTranslation;
active = true;
}
}
this.m_perp = b2Math.MulMV(R1, this.m_localYAxis1);
this.m_s1 = (dX + r1X) * this.m_perp.y - (dY + r1Y) * this.m_perp.x;
this.m_s2 = r2X * this.m_perp.y - r2Y * this.m_perp.x;
var impulse = new b2Vec3();
var C1X = this.m_perp.x * dX + this.m_perp.y * dY;
var C1Y = a2 - a1 - this.m_refAngle;
linearError = b2Math.Max(linearError, b2Math.Abs(C1X));
angularError = b2Math.Abs(C1Y);
if (active) {
m1 = this.m_invMassA;
m2 = this.m_invMassB;
i1 = this.m_invIA;
i2 = this.m_invIB;
this.m_K.col1.x = m1 + m2 + i1 * this.m_s1 * this.m_s1 + i2 * this.m_s2 * this.m_s2;
this.m_K.col1.y = i1 * this.m_s1 + i2 * this.m_s2;
this.m_K.col1.z = i1 * this.m_s1 * this.m_a1 + i2 * this.m_s2 * this.m_a2;
this.m_K.col2.x = this.m_K.col1.y;
this.m_K.col2.y = i1 + i2;
this.m_K.col2.z = i1 * this.m_a1 + i2 * this.m_a2;
this.m_K.col3.x = this.m_K.col1.z;
this.m_K.col3.y = this.m_K.col2.z;
this.m_K.col3.z = m1 + m2 + i1 * this.m_a1 * this.m_a1 + i2 * this.m_a2 * this.m_a2;
this.m_K.Solve33(impulse, (-C1X), (-C1Y), (-C2));
}
else {
m1 = this.m_invMassA;
m2 = this.m_invMassB;
i1 = this.m_invIA;
i2 = this.m_invIB;
var k11 = m1 + m2 + i1 * this.m_s1 * this.m_s1 + i2 * this.m_s2 * this.m_s2;
var k12 = i1 * this.m_s1 + i2 * this.m_s2;
var k22 = i1 + i2;
this.m_K.col1.Set(k11, k12, 0.0);
this.m_K.col2.Set(k12, k22, 0.0);
var impulse1 = this.m_K.Solve22(new b2Vec2(), (-C1X), (-C1Y));
impulse.x = impulse1.x;
impulse.y = impulse1.y;
impulse.z = 0.0;
}
var PX = impulse.x * this.m_perp.x + impulse.z * this.m_axis.x;
var PY = impulse.x * this.m_perp.y + impulse.z * this.m_axis.y;
var L1 = impulse.x * this.m_s1 + impulse.y + impulse.z * this.m_a1;
var L2 = impulse.x * this.m_s2 + impulse.y + impulse.z * this.m_a2;
c1.x -= this.m_invMassA * PX;
c1.y -= this.m_invMassA * PY;
a1 -= this.m_invIA * L1;
c2.x += this.m_invMassB * PX;
c2.y += this.m_invMassB * PY;
a2 += this.m_invIB * L2;
bA.m_sweep.a = a1;
bB.m_sweep.a = a2;
bA.SynchronizeTransform();
bB.SynchronizeTransform();
return linearError <= b2Settings.b2_linearSlop && angularError <= b2Settings.b2_angularSlop;
}
Box2D.inherit(b2PrismaticJointDef, Box2D.Dynamics.Joints.b2JointDef);
b2PrismaticJointDef.prototype.__super = Box2D.Dynamics.Joints.b2JointDef.prototype;
b2PrismaticJointDef.b2PrismaticJointDef = function () {
Box2D.Dynamics.Joints.b2JointDef.b2JointDef.apply(this, arguments);
this.localAnchorA = new b2Vec2();
this.localAnchorB = new b2Vec2();
this.localAxisA = new b2Vec2();
};
b2PrismaticJointDef.prototype.b2PrismaticJointDef = function () {
this.__super.b2JointDef.call(this);
this.type = b2Joint.e_prismaticJoint;
this.localAxisA.Set(1.0, 0.0);
this.referenceAngle = 0.0;
this.enableLimit = false;
this.lowerTranslation = 0.0;
this.upperTranslation = 0.0;
this.enableMotor = false;
this.maxMotorForce = 0.0;
this.motorSpeed = 0.0;
}
b2PrismaticJointDef.prototype.Initialize = function (bA, bB, anchor, axis) {
this.bodyA = bA;
this.bodyB = bB;
this.localAnchorA = this.bodyA.GetLocalPoint(anchor);
this.localAnchorB = this.bodyB.GetLocalPoint(anchor);
this.localAxisA = this.bodyA.GetLocalVector(axis);
this.referenceAngle = this.bodyB.GetAngle() - this.bodyA.GetAngle();
}
Box2D.inherit(b2PulleyJoint, Box2D.Dynamics.Joints.b2Joint);
b2PulleyJoint.prototype.__super = Box2D.Dynamics.Joints.b2Joint.prototype;
b2PulleyJoint.b2PulleyJoint = function () {
Box2D.Dynamics.Joints.b2Joint.b2Joint.apply(this, arguments);
this.m_groundAnchor1 = new b2Vec2();
this.m_groundAnchor2 = new b2Vec2();
this.m_localAnchor1 = new b2Vec2();
this.m_localAnchor2 = new b2Vec2();
this.m_u1 = new b2Vec2();
this.m_u2 = new b2Vec2();
};
b2PulleyJoint.prototype.GetAnchorA = function () {
return this.m_bodyA.GetWorldPoint(this.m_localAnchor1);
}
b2PulleyJoint.prototype.GetAnchorB = function () {
return this.m_bodyB.GetWorldPoint(this.m_localAnchor2);
}
b2PulleyJoint.prototype.GetReactionForce = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return new b2Vec2(inv_dt * this.m_impulse * this.m_u2.x, inv_dt * this.m_impulse * this.m_u2.y);
}
b2PulleyJoint.prototype.GetReactionTorque = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return 0.0;
}
b2PulleyJoint.prototype.GetGroundAnchorA = function () {
var a = this.m_ground.m_xf.position.Copy();
a.Add(this.m_groundAnchor1);
return a;
}
b2PulleyJoint.prototype.GetGroundAnchorB = function () {
var a = this.m_ground.m_xf.position.Copy();
a.Add(this.m_groundAnchor2);
return a;
}
b2PulleyJoint.prototype.GetLength1 = function () {
var p = this.m_bodyA.GetWorldPoint(this.m_localAnchor1);
var sX = this.m_ground.m_xf.position.x + this.m_groundAnchor1.x;
var sY = this.m_ground.m_xf.position.y + this.m_groundAnchor1.y;
var dX = p.x - sX;
var dY = p.y - sY;
return Math.sqrt(dX * dX + dY * dY);
}
b2PulleyJoint.prototype.GetLength2 = function () {
var p = this.m_bodyB.GetWorldPoint(this.m_localAnchor2);
var sX = this.m_ground.m_xf.position.x + this.m_groundAnchor2.x;
var sY = this.m_ground.m_xf.position.y + this.m_groundAnchor2.y;
var dX = p.x - sX;
var dY = p.y - sY;
return Math.sqrt(dX * dX + dY * dY);
}
b2PulleyJoint.prototype.GetRatio = function () {
return this.m_ratio;
}
b2PulleyJoint.prototype.b2PulleyJoint = function (def) {
this.__super.b2Joint.call(this, def);
var tMat;
var tX = 0;
var tY = 0;
this.m_ground = this.m_bodyA.m_world.m_groundBody;
this.m_groundAnchor1.x = def.groundAnchorA.x - this.m_ground.m_xf.position.x;
this.m_groundAnchor1.y = def.groundAnchorA.y - this.m_ground.m_xf.position.y;
this.m_groundAnchor2.x = def.groundAnchorB.x - this.m_ground.m_xf.position.x;
this.m_groundAnchor2.y = def.groundAnchorB.y - this.m_ground.m_xf.position.y;
this.m_localAnchor1.SetV(def.localAnchorA);
this.m_localAnchor2.SetV(def.localAnchorB);
this.m_ratio = def.ratio;
this.m_constant = def.lengthA + this.m_ratio * def.lengthB;
this.m_maxLength1 = b2Math.Min(def.maxLengthA, this.m_constant - this.m_ratio * b2PulleyJoint.b2_minPulleyLength);
this.m_maxLength2 = b2Math.Min(def.maxLengthB, (this.m_constant - b2PulleyJoint.b2_minPulleyLength) / this.m_ratio);
this.m_impulse = 0.0;
this.m_limitImpulse1 = 0.0;
this.m_limitImpulse2 = 0.0;
}
b2PulleyJoint.prototype.InitVelocityConstraints = function (step) {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
var r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
var tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
var r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var p1X = bA.m_sweep.c.x + r1X;
var p1Y = bA.m_sweep.c.y + r1Y;
var p2X = bB.m_sweep.c.x + r2X;
var p2Y = bB.m_sweep.c.y + r2Y;
var s1X = this.m_ground.m_xf.position.x + this.m_groundAnchor1.x;
var s1Y = this.m_ground.m_xf.position.y + this.m_groundAnchor1.y;
var s2X = this.m_ground.m_xf.position.x + this.m_groundAnchor2.x;
var s2Y = this.m_ground.m_xf.position.y + this.m_groundAnchor2.y;
this.m_u1.Set(p1X - s1X, p1Y - s1Y);
this.m_u2.Set(p2X - s2X, p2Y - s2Y);
var length1 = this.m_u1.Length();
var length2 = this.m_u2.Length();
if (length1 > b2Settings.b2_linearSlop) {
this.m_u1.Multiply(1.0 / length1);
}
else {
this.m_u1.SetZero();
}
if (length2 > b2Settings.b2_linearSlop) {
this.m_u2.Multiply(1.0 / length2);
}
else {
this.m_u2.SetZero();
}
var C = this.m_constant - length1 - this.m_ratio * length2;
if (C > 0.0) {
this.m_state = b2Joint.e_inactiveLimit;
this.m_impulse = 0.0;
}
else {
this.m_state = b2Joint.e_atUpperLimit;
}
if (length1 < this.m_maxLength1) {
this.m_limitState1 = b2Joint.e_inactiveLimit;
this.m_limitImpulse1 = 0.0;
}
else {
this.m_limitState1 = b2Joint.e_atUpperLimit;
}
if (length2 < this.m_maxLength2) {
this.m_limitState2 = b2Joint.e_inactiveLimit;
this.m_limitImpulse2 = 0.0;
}
else {
this.m_limitState2 = b2Joint.e_atUpperLimit;
}
var cr1u1 = r1X * this.m_u1.y - r1Y * this.m_u1.x;
var cr2u2 = r2X * this.m_u2.y - r2Y * this.m_u2.x;
this.m_limitMass1 = bA.m_invMass + bA.m_invI * cr1u1 * cr1u1;
this.m_limitMass2 = bB.m_invMass + bB.m_invI * cr2u2 * cr2u2;
this.m_pulleyMass = this.m_limitMass1 + this.m_ratio * this.m_ratio * this.m_limitMass2;
this.m_limitMass1 = 1.0 / this.m_limitMass1;
this.m_limitMass2 = 1.0 / this.m_limitMass2;
this.m_pulleyMass = 1.0 / this.m_pulleyMass;
if (step.warmStarting) {
this.m_impulse *= step.dtRatio;
this.m_limitImpulse1 *= step.dtRatio;
this.m_limitImpulse2 *= step.dtRatio;
var P1X = ((-this.m_impulse) - this.m_limitImpulse1) * this.m_u1.x;
var P1Y = ((-this.m_impulse) - this.m_limitImpulse1) * this.m_u1.y;
var P2X = ((-this.m_ratio * this.m_impulse) - this.m_limitImpulse2) * this.m_u2.x;
var P2Y = ((-this.m_ratio * this.m_impulse) - this.m_limitImpulse2) * this.m_u2.y;
bA.m_linearVelocity.x += bA.m_invMass * P1X;
bA.m_linearVelocity.y += bA.m_invMass * P1Y;
bA.m_angularVelocity += bA.m_invI * (r1X * P1Y - r1Y * P1X);
bB.m_linearVelocity.x += bB.m_invMass * P2X;
bB.m_linearVelocity.y += bB.m_invMass * P2Y;
bB.m_angularVelocity += bB.m_invI * (r2X * P2Y - r2Y * P2X);
}
else {
this.m_impulse = 0.0;
this.m_limitImpulse1 = 0.0;
this.m_limitImpulse2 = 0.0;
}
}
b2PulleyJoint.prototype.SolveVelocityConstraints = function (step) {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
var r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
var tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
var r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var v1X = 0;
var v1Y = 0;
var v2X = 0;
var v2Y = 0;
var P1X = 0;
var P1Y = 0;
var P2X = 0;
var P2Y = 0;
var Cdot = 0;
var impulse = 0;
var oldImpulse = 0;
if (this.m_state == b2Joint.e_atUpperLimit) {
v1X = bA.m_linearVelocity.x + ((-bA.m_angularVelocity * r1Y));
v1Y = bA.m_linearVelocity.y + (bA.m_angularVelocity * r1X);
v2X = bB.m_linearVelocity.x + ((-bB.m_angularVelocity * r2Y));
v2Y = bB.m_linearVelocity.y + (bB.m_angularVelocity * r2X);
Cdot = (-(this.m_u1.x * v1X + this.m_u1.y * v1Y)) - this.m_ratio * (this.m_u2.x * v2X + this.m_u2.y * v2Y);
impulse = this.m_pulleyMass * ((-Cdot));
oldImpulse = this.m_impulse;
this.m_impulse = b2Math.Max(0.0, this.m_impulse + impulse);
impulse = this.m_impulse - oldImpulse;
P1X = (-impulse * this.m_u1.x);
P1Y = (-impulse * this.m_u1.y);
P2X = (-this.m_ratio * impulse * this.m_u2.x);
P2Y = (-this.m_ratio * impulse * this.m_u2.y);
bA.m_linearVelocity.x += bA.m_invMass * P1X;
bA.m_linearVelocity.y += bA.m_invMass * P1Y;
bA.m_angularVelocity += bA.m_invI * (r1X * P1Y - r1Y * P1X);
bB.m_linearVelocity.x += bB.m_invMass * P2X;
bB.m_linearVelocity.y += bB.m_invMass * P2Y;
bB.m_angularVelocity += bB.m_invI * (r2X * P2Y - r2Y * P2X);
}
if (this.m_limitState1 == b2Joint.e_atUpperLimit) {
v1X = bA.m_linearVelocity.x + ((-bA.m_angularVelocity * r1Y));
v1Y = bA.m_linearVelocity.y + (bA.m_angularVelocity * r1X);
Cdot = (-(this.m_u1.x * v1X + this.m_u1.y * v1Y));
impulse = (-this.m_limitMass1 * Cdot);
oldImpulse = this.m_limitImpulse1;
this.m_limitImpulse1 = b2Math.Max(0.0, this.m_limitImpulse1 + impulse);
impulse = this.m_limitImpulse1 - oldImpulse;
P1X = (-impulse * this.m_u1.x);
P1Y = (-impulse * this.m_u1.y);
bA.m_linearVelocity.x += bA.m_invMass * P1X;
bA.m_linearVelocity.y += bA.m_invMass * P1Y;
bA.m_angularVelocity += bA.m_invI * (r1X * P1Y - r1Y * P1X);
}
if (this.m_limitState2 == b2Joint.e_atUpperLimit) {
v2X = bB.m_linearVelocity.x + ((-bB.m_angularVelocity * r2Y));
v2Y = bB.m_linearVelocity.y + (bB.m_angularVelocity * r2X);
Cdot = (-(this.m_u2.x * v2X + this.m_u2.y * v2Y));
impulse = (-this.m_limitMass2 * Cdot);
oldImpulse = this.m_limitImpulse2;
this.m_limitImpulse2 = b2Math.Max(0.0, this.m_limitImpulse2 + impulse);
impulse = this.m_limitImpulse2 - oldImpulse;
P2X = (-impulse * this.m_u2.x);
P2Y = (-impulse * this.m_u2.y);
bB.m_linearVelocity.x += bB.m_invMass * P2X;
bB.m_linearVelocity.y += bB.m_invMass * P2Y;
bB.m_angularVelocity += bB.m_invI * (r2X * P2Y - r2Y * P2X);
}
}
b2PulleyJoint.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
var s1X = this.m_ground.m_xf.position.x + this.m_groundAnchor1.x;
var s1Y = this.m_ground.m_xf.position.y + this.m_groundAnchor1.y;
var s2X = this.m_ground.m_xf.position.x + this.m_groundAnchor2.x;
var s2Y = this.m_ground.m_xf.position.y + this.m_groundAnchor2.y;
var r1X = 0;
var r1Y = 0;
var r2X = 0;
var r2Y = 0;
var p1X = 0;
var p1Y = 0;
var p2X = 0;
var p2Y = 0;
var length1 = 0;
var length2 = 0;
var C = 0;
var impulse = 0;
var oldImpulse = 0;
var oldLimitPositionImpulse = 0;
var tX = 0;
var linearError = 0.0;
if (this.m_state == b2Joint.e_atUpperLimit) {
tMat = bA.m_xf.R;
r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
p1X = bA.m_sweep.c.x + r1X;
p1Y = bA.m_sweep.c.y + r1Y;
p2X = bB.m_sweep.c.x + r2X;
p2Y = bB.m_sweep.c.y + r2Y;
this.m_u1.Set(p1X - s1X, p1Y - s1Y);
this.m_u2.Set(p2X - s2X, p2Y - s2Y);
length1 = this.m_u1.Length();
length2 = this.m_u2.Length();
if (length1 > b2Settings.b2_linearSlop) {
this.m_u1.Multiply(1.0 / length1);
}
else {
this.m_u1.SetZero();
}
if (length2 > b2Settings.b2_linearSlop) {
this.m_u2.Multiply(1.0 / length2);
}
else {
this.m_u2.SetZero();
}
C = this.m_constant - length1 - this.m_ratio * length2;
linearError = b2Math.Max(linearError, (-C));
C = b2Math.Clamp(C + b2Settings.b2_linearSlop, (-b2Settings.b2_maxLinearCorrection), 0.0);
impulse = (-this.m_pulleyMass * C);
p1X = (-impulse * this.m_u1.x);
p1Y = (-impulse * this.m_u1.y);
p2X = (-this.m_ratio * impulse * this.m_u2.x);
p2Y = (-this.m_ratio * impulse * this.m_u2.y);
bA.m_sweep.c.x += bA.m_invMass * p1X;
bA.m_sweep.c.y += bA.m_invMass * p1Y;
bA.m_sweep.a += bA.m_invI * (r1X * p1Y - r1Y * p1X);
bB.m_sweep.c.x += bB.m_invMass * p2X;
bB.m_sweep.c.y += bB.m_invMass * p2Y;
bB.m_sweep.a += bB.m_invI * (r2X * p2Y - r2Y * p2X);
bA.SynchronizeTransform();
bB.SynchronizeTransform();
}
if (this.m_limitState1 == b2Joint.e_atUpperLimit) {
tMat = bA.m_xf.R;
r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
p1X = bA.m_sweep.c.x + r1X;
p1Y = bA.m_sweep.c.y + r1Y;
this.m_u1.Set(p1X - s1X, p1Y - s1Y);
length1 = this.m_u1.Length();
if (length1 > b2Settings.b2_linearSlop) {
this.m_u1.x *= 1.0 / length1;
this.m_u1.y *= 1.0 / length1;
}
else {
this.m_u1.SetZero();
}
C = this.m_maxLength1 - length1;
linearError = b2Math.Max(linearError, (-C));
C = b2Math.Clamp(C + b2Settings.b2_linearSlop, (-b2Settings.b2_maxLinearCorrection), 0.0);
impulse = (-this.m_limitMass1 * C);
p1X = (-impulse * this.m_u1.x);
p1Y = (-impulse * this.m_u1.y);
bA.m_sweep.c.x += bA.m_invMass * p1X;
bA.m_sweep.c.y += bA.m_invMass * p1Y;
bA.m_sweep.a += bA.m_invI * (r1X * p1Y - r1Y * p1X);
bA.SynchronizeTransform();
}
if (this.m_limitState2 == b2Joint.e_atUpperLimit) {
tMat = bB.m_xf.R;
r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
p2X = bB.m_sweep.c.x + r2X;
p2Y = bB.m_sweep.c.y + r2Y;
this.m_u2.Set(p2X - s2X, p2Y - s2Y);
length2 = this.m_u2.Length();
if (length2 > b2Settings.b2_linearSlop) {
this.m_u2.x *= 1.0 / length2;
this.m_u2.y *= 1.0 / length2;
}
else {
this.m_u2.SetZero();
}
C = this.m_maxLength2 - length2;
linearError = b2Math.Max(linearError, (-C));
C = b2Math.Clamp(C + b2Settings.b2_linearSlop, (-b2Settings.b2_maxLinearCorrection), 0.0);
impulse = (-this.m_limitMass2 * C);
p2X = (-impulse * this.m_u2.x);
p2Y = (-impulse * this.m_u2.y);
bB.m_sweep.c.x += bB.m_invMass * p2X;
bB.m_sweep.c.y += bB.m_invMass * p2Y;
bB.m_sweep.a += bB.m_invI * (r2X * p2Y - r2Y * p2X);
bB.SynchronizeTransform();
}
return linearError < b2Settings.b2_linearSlop;
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.Joints.b2PulleyJoint.b2_minPulleyLength = 2.0;
});
Box2D.inherit(b2PulleyJointDef, Box2D.Dynamics.Joints.b2JointDef);
b2PulleyJointDef.prototype.__super = Box2D.Dynamics.Joints.b2JointDef.prototype;
b2PulleyJointDef.b2PulleyJointDef = function () {
Box2D.Dynamics.Joints.b2JointDef.b2JointDef.apply(this, arguments);
this.groundAnchorA = new b2Vec2();
this.groundAnchorB = new b2Vec2();
this.localAnchorA = new b2Vec2();
this.localAnchorB = new b2Vec2();
};
b2PulleyJointDef.prototype.b2PulleyJointDef = function () {
this.__super.b2JointDef.call(this);
this.type = b2Joint.e_pulleyJoint;
this.groundAnchorA.Set((-1.0), 1.0);
this.groundAnchorB.Set(1.0, 1.0);
this.localAnchorA.Set((-1.0), 0.0);
this.localAnchorB.Set(1.0, 0.0);
this.lengthA = 0.0;
this.maxLengthA = 0.0;
this.lengthB = 0.0;
this.maxLengthB = 0.0;
this.ratio = 1.0;
this.collideConnected = true;
}
b2PulleyJointDef.prototype.Initialize = function (bA, bB, gaA, gaB, anchorA, anchorB, r) {
if (r === undefined) r = 0;
this.bodyA = bA;
this.bodyB = bB;
this.groundAnchorA.SetV(gaA);
this.groundAnchorB.SetV(gaB);
this.localAnchorA = this.bodyA.GetLocalPoint(anchorA);
this.localAnchorB = this.bodyB.GetLocalPoint(anchorB);
var d1X = anchorA.x - gaA.x;
var d1Y = anchorA.y - gaA.y;
this.lengthA = Math.sqrt(d1X * d1X + d1Y * d1Y);
var d2X = anchorB.x - gaB.x;
var d2Y = anchorB.y - gaB.y;
this.lengthB = Math.sqrt(d2X * d2X + d2Y * d2Y);
this.ratio = r;
var C = this.lengthA + this.ratio * this.lengthB;
this.maxLengthA = C - this.ratio * b2PulleyJoint.b2_minPulleyLength;
this.maxLengthB = (C - b2PulleyJoint.b2_minPulleyLength) / this.ratio;
}
Box2D.inherit(b2RevoluteJoint, Box2D.Dynamics.Joints.b2Joint);
b2RevoluteJoint.prototype.__super = Box2D.Dynamics.Joints.b2Joint.prototype;
b2RevoluteJoint.b2RevoluteJoint = function () {
Box2D.Dynamics.Joints.b2Joint.b2Joint.apply(this, arguments);
this.K = new b2Mat22();
this.K1 = new b2Mat22();
this.K2 = new b2Mat22();
this.K3 = new b2Mat22();
this.impulse3 = new b2Vec3();
this.impulse2 = new b2Vec2();
this.reduced = new b2Vec2();
this.m_localAnchor1 = new b2Vec2();
this.m_localAnchor2 = new b2Vec2();
this.m_impulse = new b2Vec3();
this.m_mass = new b2Mat33();
};
b2RevoluteJoint.prototype.GetAnchorA = function () {
return this.m_bodyA.GetWorldPoint(this.m_localAnchor1);
}
b2RevoluteJoint.prototype.GetAnchorB = function () {
return this.m_bodyB.GetWorldPoint(this.m_localAnchor2);
}
b2RevoluteJoint.prototype.GetReactionForce = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return new b2Vec2(inv_dt * this.m_impulse.x, inv_dt * this.m_impulse.y);
}
b2RevoluteJoint.prototype.GetReactionTorque = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return inv_dt * this.m_impulse.z;
}
b2RevoluteJoint.prototype.GetJointAngle = function () {
return this.m_bodyB.m_sweep.a - this.m_bodyA.m_sweep.a - this.m_referenceAngle;
}
b2RevoluteJoint.prototype.GetJointSpeed = function () {
return this.m_bodyB.m_angularVelocity - this.m_bodyA.m_angularVelocity;
}
b2RevoluteJoint.prototype.IsLimitEnabled = function () {
return this.m_enableLimit;
}
b2RevoluteJoint.prototype.EnableLimit = function (flag) {
this.m_enableLimit = flag;
}
b2RevoluteJoint.prototype.GetLowerLimit = function () {
return this.m_lowerAngle;
}
b2RevoluteJoint.prototype.GetUpperLimit = function () {
return this.m_upperAngle;
}
b2RevoluteJoint.prototype.SetLimits = function (lower, upper) {
if (lower === undefined) lower = 0;
if (upper === undefined) upper = 0;
this.m_lowerAngle = lower;
this.m_upperAngle = upper;
}
b2RevoluteJoint.prototype.IsMotorEnabled = function () {
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
return this.m_enableMotor;
}
b2RevoluteJoint.prototype.EnableMotor = function (flag) {
this.m_enableMotor = flag;
}
b2RevoluteJoint.prototype.SetMotorSpeed = function (speed) {
if (speed === undefined) speed = 0;
this.m_bodyA.SetAwake(true);
this.m_bodyB.SetAwake(true);
this.m_motorSpeed = speed;
}
b2RevoluteJoint.prototype.GetMotorSpeed = function () {
return this.m_motorSpeed;
}
b2RevoluteJoint.prototype.SetMaxMotorTorque = function (torque) {
if (torque === undefined) torque = 0;
this.m_maxMotorTorque = torque;
}
b2RevoluteJoint.prototype.GetMotorTorque = function () {
return this.m_maxMotorTorque;
}
b2RevoluteJoint.prototype.b2RevoluteJoint = function (def) {
this.__super.b2Joint.call(this, def);
this.m_localAnchor1.SetV(def.localAnchorA);
this.m_localAnchor2.SetV(def.localAnchorB);
this.m_referenceAngle = def.referenceAngle;
this.m_impulse.SetZero();
this.m_motorImpulse = 0.0;
this.m_lowerAngle = def.lowerAngle;
this.m_upperAngle = def.upperAngle;
this.m_maxMotorTorque = def.maxMotorTorque;
this.m_motorSpeed = def.motorSpeed;
this.m_enableLimit = def.enableLimit;
this.m_enableMotor = def.enableMotor;
this.m_limitState = b2Joint.e_inactiveLimit;
}
b2RevoluteJoint.prototype.InitVelocityConstraints = function (step) {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
var tX = 0;
if (this.m_enableMotor || this.m_enableLimit) {}
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
var r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
var r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var m1 = bA.m_invMass;
var m2 = bB.m_invMass;
var i1 = bA.m_invI;
var i2 = bB.m_invI;
this.m_mass.col1.x = m1 + m2 + r1Y * r1Y * i1 + r2Y * r2Y * i2;
this.m_mass.col2.x = (-r1Y * r1X * i1) - r2Y * r2X * i2;
this.m_mass.col3.x = (-r1Y * i1) - r2Y * i2;
this.m_mass.col1.y = this.m_mass.col2.x;
this.m_mass.col2.y = m1 + m2 + r1X * r1X * i1 + r2X * r2X * i2;
this.m_mass.col3.y = r1X * i1 + r2X * i2;
this.m_mass.col1.z = this.m_mass.col3.x;
this.m_mass.col2.z = this.m_mass.col3.y;
this.m_mass.col3.z = i1 + i2;
this.m_motorMass = 1.0 / (i1 + i2);
if (this.m_enableMotor == false) {
this.m_motorImpulse = 0.0;
}
if (this.m_enableLimit) {
var jointAngle = bB.m_sweep.a - bA.m_sweep.a - this.m_referenceAngle;
if (b2Math.Abs(this.m_upperAngle - this.m_lowerAngle) < 2.0 * b2Settings.b2_angularSlop) {
this.m_limitState = b2Joint.e_equalLimits;
}
else if (jointAngle <= this.m_lowerAngle) {
if (this.m_limitState != b2Joint.e_atLowerLimit) {
this.m_impulse.z = 0.0;
}
this.m_limitState = b2Joint.e_atLowerLimit;
}
else if (jointAngle >= this.m_upperAngle) {
if (this.m_limitState != b2Joint.e_atUpperLimit) {
this.m_impulse.z = 0.0;
}
this.m_limitState = b2Joint.e_atUpperLimit;
}
else {
this.m_limitState = b2Joint.e_inactiveLimit;
this.m_impulse.z = 0.0;
}
}
else {
this.m_limitState = b2Joint.e_inactiveLimit;
}
if (step.warmStarting) {
this.m_impulse.x *= step.dtRatio;
this.m_impulse.y *= step.dtRatio;
this.m_motorImpulse *= step.dtRatio;
var PX = this.m_impulse.x;
var PY = this.m_impulse.y;
bA.m_linearVelocity.x -= m1 * PX;
bA.m_linearVelocity.y -= m1 * PY;
bA.m_angularVelocity -= i1 * ((r1X * PY - r1Y * PX) + this.m_motorImpulse + this.m_impulse.z);
bB.m_linearVelocity.x += m2 * PX;
bB.m_linearVelocity.y += m2 * PY;
bB.m_angularVelocity += i2 * ((r2X * PY - r2Y * PX) + this.m_motorImpulse + this.m_impulse.z);
}
else {
this.m_impulse.SetZero();
this.m_motorImpulse = 0.0;
}
}
b2RevoluteJoint.prototype.SolveVelocityConstraints = function (step) {
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var tMat;
var tX = 0;
var newImpulse = 0;
var r1X = 0;
var r1Y = 0;
var r2X = 0;
var r2Y = 0;
var v1 = bA.m_linearVelocity;
var w1 = bA.m_angularVelocity;
var v2 = bB.m_linearVelocity;
var w2 = bB.m_angularVelocity;
var m1 = bA.m_invMass;
var m2 = bB.m_invMass;
var i1 = bA.m_invI;
var i2 = bB.m_invI;
if (this.m_enableMotor && this.m_limitState != b2Joint.e_equalLimits) {
var Cdot = w2 - w1 - this.m_motorSpeed;
var impulse = this.m_motorMass * ((-Cdot));
var oldImpulse = this.m_motorImpulse;
var maxImpulse = step.dt * this.m_maxMotorTorque;
this.m_motorImpulse = b2Math.Clamp(this.m_motorImpulse + impulse, (-maxImpulse), maxImpulse);
impulse = this.m_motorImpulse - oldImpulse;
w1 -= i1 * impulse;
w2 += i2 * impulse;
}
if (this.m_enableLimit && this.m_limitState != b2Joint.e_inactiveLimit) {
tMat = bA.m_xf.R;
r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var Cdot1X = v2.x + ((-w2 * r2Y)) - v1.x - ((-w1 * r1Y));
var Cdot1Y = v2.y + (w2 * r2X) - v1.y - (w1 * r1X);
var Cdot2 = w2 - w1;
this.m_mass.Solve33(this.impulse3, (-Cdot1X), (-Cdot1Y), (-Cdot2));
if (this.m_limitState == b2Joint.e_equalLimits) {
this.m_impulse.Add(this.impulse3);
}
else if (this.m_limitState == b2Joint.e_atLowerLimit) {
newImpulse = this.m_impulse.z + this.impulse3.z;
if (newImpulse < 0.0) {
this.m_mass.Solve22(this.reduced, (-Cdot1X), (-Cdot1Y));
this.impulse3.x = this.reduced.x;
this.impulse3.y = this.reduced.y;
this.impulse3.z = (-this.m_impulse.z);
this.m_impulse.x += this.reduced.x;
this.m_impulse.y += this.reduced.y;
this.m_impulse.z = 0.0;
}
}
else if (this.m_limitState == b2Joint.e_atUpperLimit) {
newImpulse = this.m_impulse.z + this.impulse3.z;
if (newImpulse > 0.0) {
this.m_mass.Solve22(this.reduced, (-Cdot1X), (-Cdot1Y));
this.impulse3.x = this.reduced.x;
this.impulse3.y = this.reduced.y;
this.impulse3.z = (-this.m_impulse.z);
this.m_impulse.x += this.reduced.x;
this.m_impulse.y += this.reduced.y;
this.m_impulse.z = 0.0;
}
}
v1.x -= m1 * this.impulse3.x;
v1.y -= m1 * this.impulse3.y;
w1 -= i1 * (r1X * this.impulse3.y - r1Y * this.impulse3.x + this.impulse3.z);
v2.x += m2 * this.impulse3.x;
v2.y += m2 * this.impulse3.y;
w2 += i2 * (r2X * this.impulse3.y - r2Y * this.impulse3.x + this.impulse3.z);
}
else {
tMat = bA.m_xf.R;
r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var CdotX = v2.x + ((-w2 * r2Y)) - v1.x - ((-w1 * r1Y));
var CdotY = v2.y + (w2 * r2X) - v1.y - (w1 * r1X);
this.m_mass.Solve22(this.impulse2, (-CdotX), (-CdotY));
this.m_impulse.x += this.impulse2.x;
this.m_impulse.y += this.impulse2.y;
v1.x -= m1 * this.impulse2.x;
v1.y -= m1 * this.impulse2.y;
w1 -= i1 * (r1X * this.impulse2.y - r1Y * this.impulse2.x);
v2.x += m2 * this.impulse2.x;
v2.y += m2 * this.impulse2.y;
w2 += i2 * (r2X * this.impulse2.y - r2Y * this.impulse2.x);
}
bA.m_linearVelocity.SetV(v1);
bA.m_angularVelocity = w1;
bB.m_linearVelocity.SetV(v2);
bB.m_angularVelocity = w2;
}
b2RevoluteJoint.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
var oldLimitImpulse = 0;
var C = 0;
var tMat;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var angularError = 0.0;
var positionError = 0.0;
var tX = 0;
var impulseX = 0;
var impulseY = 0;
if (this.m_enableLimit && this.m_limitState != b2Joint.e_inactiveLimit) {
var angle = bB.m_sweep.a - bA.m_sweep.a - this.m_referenceAngle;
var limitImpulse = 0.0;
if (this.m_limitState == b2Joint.e_equalLimits) {
C = b2Math.Clamp(angle - this.m_lowerAngle, (-b2Settings.b2_maxAngularCorrection), b2Settings.b2_maxAngularCorrection);
limitImpulse = (-this.m_motorMass * C);
angularError = b2Math.Abs(C);
}
else if (this.m_limitState == b2Joint.e_atLowerLimit) {
C = angle - this.m_lowerAngle;
angularError = (-C);
C = b2Math.Clamp(C + b2Settings.b2_angularSlop, (-b2Settings.b2_maxAngularCorrection), 0.0);
limitImpulse = (-this.m_motorMass * C);
}
else if (this.m_limitState == b2Joint.e_atUpperLimit) {
C = angle - this.m_upperAngle;
angularError = C;
C = b2Math.Clamp(C - b2Settings.b2_angularSlop, 0.0, b2Settings.b2_maxAngularCorrection);
limitImpulse = (-this.m_motorMass * C);
}
bA.m_sweep.a -= bA.m_invI * limitImpulse;
bB.m_sweep.a += bB.m_invI * limitImpulse;
bA.SynchronizeTransform();
bB.SynchronizeTransform();
} {
tMat = bA.m_xf.R;
var r1X = this.m_localAnchor1.x - bA.m_sweep.localCenter.x;
var r1Y = this.m_localAnchor1.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * r1X + tMat.col2.x * r1Y);
r1Y = (tMat.col1.y * r1X + tMat.col2.y * r1Y);
r1X = tX;
tMat = bB.m_xf.R;
var r2X = this.m_localAnchor2.x - bB.m_sweep.localCenter.x;
var r2Y = this.m_localAnchor2.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * r2X + tMat.col2.x * r2Y);
r2Y = (tMat.col1.y * r2X + tMat.col2.y * r2Y);
r2X = tX;
var CX = bB.m_sweep.c.x + r2X - bA.m_sweep.c.x - r1X;
var CY = bB.m_sweep.c.y + r2Y - bA.m_sweep.c.y - r1Y;
var CLengthSquared = CX * CX + CY * CY;
var CLength = Math.sqrt(CLengthSquared);
positionError = CLength;
var invMass1 = bA.m_invMass;
var invMass2 = bB.m_invMass;
var invI1 = bA.m_invI;
var invI2 = bB.m_invI;
var k_allowedStretch = 10.0 * b2Settings.b2_linearSlop;
if (CLengthSquared > k_allowedStretch * k_allowedStretch) {
var uX = CX / CLength;
var uY = CY / CLength;
var k = invMass1 + invMass2;
var m = 1.0 / k;
impulseX = m * ((-CX));
impulseY = m * ((-CY));
var k_beta = 0.5;
bA.m_sweep.c.x -= k_beta * invMass1 * impulseX;
bA.m_sweep.c.y -= k_beta * invMass1 * impulseY;
bB.m_sweep.c.x += k_beta * invMass2 * impulseX;
bB.m_sweep.c.y += k_beta * invMass2 * impulseY;
CX = bB.m_sweep.c.x + r2X - bA.m_sweep.c.x - r1X;
CY = bB.m_sweep.c.y + r2Y - bA.m_sweep.c.y - r1Y;
}
this.K1.col1.x = invMass1 + invMass2;
this.K1.col2.x = 0.0;
this.K1.col1.y = 0.0;
this.K1.col2.y = invMass1 + invMass2;
this.K2.col1.x = invI1 * r1Y * r1Y;
this.K2.col2.x = (-invI1 * r1X * r1Y);
this.K2.col1.y = (-invI1 * r1X * r1Y);
this.K2.col2.y = invI1 * r1X * r1X;
this.K3.col1.x = invI2 * r2Y * r2Y;
this.K3.col2.x = (-invI2 * r2X * r2Y);
this.K3.col1.y = (-invI2 * r2X * r2Y);
this.K3.col2.y = invI2 * r2X * r2X;
this.K.SetM(this.K1);
this.K.AddM(this.K2);
this.K.AddM(this.K3);
this.K.Solve(b2RevoluteJoint.tImpulse, (-CX), (-CY));
impulseX = b2RevoluteJoint.tImpulse.x;
impulseY = b2RevoluteJoint.tImpulse.y;
bA.m_sweep.c.x -= bA.m_invMass * impulseX;
bA.m_sweep.c.y -= bA.m_invMass * impulseY;
bA.m_sweep.a -= bA.m_invI * (r1X * impulseY - r1Y * impulseX);
bB.m_sweep.c.x += bB.m_invMass * impulseX;
bB.m_sweep.c.y += bB.m_invMass * impulseY;
bB.m_sweep.a += bB.m_invI * (r2X * impulseY - r2Y * impulseX);
bA.SynchronizeTransform();
bB.SynchronizeTransform();
}
return positionError <= b2Settings.b2_linearSlop && angularError <= b2Settings.b2_angularSlop;
}
Box2D.postDefs.push(function () {
Box2D.Dynamics.Joints.b2RevoluteJoint.tImpulse = new b2Vec2();
});
Box2D.inherit(b2RevoluteJointDef, Box2D.Dynamics.Joints.b2JointDef);
b2RevoluteJointDef.prototype.__super = Box2D.Dynamics.Joints.b2JointDef.prototype;
b2RevoluteJointDef.b2RevoluteJointDef = function () {
Box2D.Dynamics.Joints.b2JointDef.b2JointDef.apply(this, arguments);
this.localAnchorA = new b2Vec2();
this.localAnchorB = new b2Vec2();
};
b2RevoluteJointDef.prototype.b2RevoluteJointDef = function () {
this.__super.b2JointDef.call(this);
this.type = b2Joint.e_revoluteJoint;
this.localAnchorA.Set(0.0, 0.0);
this.localAnchorB.Set(0.0, 0.0);
this.referenceAngle = 0.0;
this.lowerAngle = 0.0;
this.upperAngle = 0.0;
this.maxMotorTorque = 0.0;
this.motorSpeed = 0.0;
this.enableLimit = false;
this.enableMotor = false;
}
b2RevoluteJointDef.prototype.Initialize = function (bA, bB, anchor) {
this.bodyA = bA;
this.bodyB = bB;
this.localAnchorA = this.bodyA.GetLocalPoint(anchor);
this.localAnchorB = this.bodyB.GetLocalPoint(anchor);
this.referenceAngle = this.bodyB.GetAngle() - this.bodyA.GetAngle();
}
Box2D.inherit(b2WeldJoint, Box2D.Dynamics.Joints.b2Joint);
b2WeldJoint.prototype.__super = Box2D.Dynamics.Joints.b2Joint.prototype;
b2WeldJoint.b2WeldJoint = function () {
Box2D.Dynamics.Joints.b2Joint.b2Joint.apply(this, arguments);
this.m_localAnchorA = new b2Vec2();
this.m_localAnchorB = new b2Vec2();
this.m_impulse = new b2Vec3();
this.m_mass = new b2Mat33();
};
b2WeldJoint.prototype.GetAnchorA = function () {
return this.m_bodyA.GetWorldPoint(this.m_localAnchorA);
}
b2WeldJoint.prototype.GetAnchorB = function () {
return this.m_bodyB.GetWorldPoint(this.m_localAnchorB);
}
b2WeldJoint.prototype.GetReactionForce = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return new b2Vec2(inv_dt * this.m_impulse.x, inv_dt * this.m_impulse.y);
}
b2WeldJoint.prototype.GetReactionTorque = function (inv_dt) {
if (inv_dt === undefined) inv_dt = 0;
return inv_dt * this.m_impulse.z;
}
b2WeldJoint.prototype.b2WeldJoint = function (def) {
this.__super.b2Joint.call(this, def);
this.m_localAnchorA.SetV(def.localAnchorA);
this.m_localAnchorB.SetV(def.localAnchorB);
this.m_referenceAngle = def.referenceAngle;
this.m_impulse.SetZero();
this.m_mass = new b2Mat33();
}
b2WeldJoint.prototype.InitVelocityConstraints = function (step) {
var tMat;
var tX = 0;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
tMat = bA.m_xf.R;
var rAX = this.m_localAnchorA.x - bA.m_sweep.localCenter.x;
var rAY = this.m_localAnchorA.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * rAX + tMat.col2.x * rAY);
rAY = (tMat.col1.y * rAX + tMat.col2.y * rAY);
rAX = tX;
tMat = bB.m_xf.R;
var rBX = this.m_localAnchorB.x - bB.m_sweep.localCenter.x;
var rBY = this.m_localAnchorB.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * rBX + tMat.col2.x * rBY);
rBY = (tMat.col1.y * rBX + tMat.col2.y * rBY);
rBX = tX;
var mA = bA.m_invMass;
var mB = bB.m_invMass;
var iA = bA.m_invI;
var iB = bB.m_invI;
this.m_mass.col1.x = mA + mB + rAY * rAY * iA + rBY * rBY * iB;
this.m_mass.col2.x = (-rAY * rAX * iA) - rBY * rBX * iB;
this.m_mass.col3.x = (-rAY * iA) - rBY * iB;
this.m_mass.col1.y = this.m_mass.col2.x;
this.m_mass.col2.y = mA + mB + rAX * rAX * iA + rBX * rBX * iB;
this.m_mass.col3.y = rAX * iA + rBX * iB;
this.m_mass.col1.z = this.m_mass.col3.x;
this.m_mass.col2.z = this.m_mass.col3.y;
this.m_mass.col3.z = iA + iB;
if (step.warmStarting) {
this.m_impulse.x *= step.dtRatio;
this.m_impulse.y *= step.dtRatio;
this.m_impulse.z *= step.dtRatio;
bA.m_linearVelocity.x -= mA * this.m_impulse.x;
bA.m_linearVelocity.y -= mA * this.m_impulse.y;
bA.m_angularVelocity -= iA * (rAX * this.m_impulse.y - rAY * this.m_impulse.x + this.m_impulse.z);
bB.m_linearVelocity.x += mB * this.m_impulse.x;
bB.m_linearVelocity.y += mB * this.m_impulse.y;
bB.m_angularVelocity += iB * (rBX * this.m_impulse.y - rBY * this.m_impulse.x + this.m_impulse.z);
}
else {
this.m_impulse.SetZero();
}
}
b2WeldJoint.prototype.SolveVelocityConstraints = function (step) {
var tMat;
var tX = 0;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
var vA = bA.m_linearVelocity;
var wA = bA.m_angularVelocity;
var vB = bB.m_linearVelocity;
var wB = bB.m_angularVelocity;
var mA = bA.m_invMass;
var mB = bB.m_invMass;
var iA = bA.m_invI;
var iB = bB.m_invI;
tMat = bA.m_xf.R;
var rAX = this.m_localAnchorA.x - bA.m_sweep.localCenter.x;
var rAY = this.m_localAnchorA.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * rAX + tMat.col2.x * rAY);
rAY = (tMat.col1.y * rAX + tMat.col2.y * rAY);
rAX = tX;
tMat = bB.m_xf.R;
var rBX = this.m_localAnchorB.x - bB.m_sweep.localCenter.x;
var rBY = this.m_localAnchorB.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * rBX + tMat.col2.x * rBY);
rBY = (tMat.col1.y * rBX + tMat.col2.y * rBY);
rBX = tX;
var Cdot1X = vB.x - wB * rBY - vA.x + wA * rAY;
var Cdot1Y = vB.y + wB * rBX - vA.y - wA * rAX;
var Cdot2 = wB - wA;
var impulse = new b2Vec3();
this.m_mass.Solve33(impulse, (-Cdot1X), (-Cdot1Y), (-Cdot2));
this.m_impulse.Add(impulse);
vA.x -= mA * impulse.x;
vA.y -= mA * impulse.y;
wA -= iA * (rAX * impulse.y - rAY * impulse.x + impulse.z);
vB.x += mB * impulse.x;
vB.y += mB * impulse.y;
wB += iB * (rBX * impulse.y - rBY * impulse.x + impulse.z);
bA.m_angularVelocity = wA;
bB.m_angularVelocity = wB;
}
b2WeldJoint.prototype.SolvePositionConstraints = function (baumgarte) {
if (baumgarte === undefined) baumgarte = 0;
var tMat;
var tX = 0;
var bA = this.m_bodyA;
var bB = this.m_bodyB;
tMat = bA.m_xf.R;
var rAX = this.m_localAnchorA.x - bA.m_sweep.localCenter.x;
var rAY = this.m_localAnchorA.y - bA.m_sweep.localCenter.y;
tX = (tMat.col1.x * rAX + tMat.col2.x * rAY);
rAY = (tMat.col1.y * rAX + tMat.col2.y * rAY);
rAX = tX;
tMat = bB.m_xf.R;
var rBX = this.m_localAnchorB.x - bB.m_sweep.localCenter.x;
var rBY = this.m_localAnchorB.y - bB.m_sweep.localCenter.y;
tX = (tMat.col1.x * rBX + tMat.col2.x * rBY);
rBY = (tMat.col1.y * rBX + tMat.col2.y * rBY);
rBX = tX;
var mA = bA.m_invMass;
var mB = bB.m_invMass;
var iA = bA.m_invI;
var iB = bB.m_invI;
var C1X = bB.m_sweep.c.x + rBX - bA.m_sweep.c.x - rAX;
var C1Y = bB.m_sweep.c.y + rBY - bA.m_sweep.c.y - rAY;
var C2 = bB.m_sweep.a - bA.m_sweep.a - this.m_referenceAngle;
var k_allowedStretch = 10.0 * b2Settings.b2_linearSlop;
var positionError = Math.sqrt(C1X * C1X + C1Y * C1Y);
var angularError = b2Math.Abs(C2);
if (positionError > k_allowedStretch) {
iA *= 1.0;
iB *= 1.0;
}
this.m_mass.col1.x = mA + mB + rAY * rAY * iA + rBY * rBY * iB;
this.m_mass.col2.x = (-rAY * rAX * iA) - rBY * rBX * iB;
this.m_mass.col3.x = (-rAY * iA) - rBY * iB;
this.m_mass.col1.y = this.m_mass.col2.x;
this.m_mass.col2.y = mA + mB + rAX * rAX * iA + rBX * rBX * iB;
this.m_mass.col3.y = rAX * iA + rBX * iB;
this.m_mass.col1.z = this.m_mass.col3.x;
this.m_mass.col2.z = this.m_mass.col3.y;
this.m_mass.col3.z = iA + iB;
var impulse = new b2Vec3();
this.m_mass.Solve33(impulse, (-C1X), (-C1Y), (-C2));
bA.m_sweep.c.x -= mA * impulse.x;
bA.m_sweep.c.y -= mA * impulse.y;
bA.m_sweep.a -= iA * (rAX * impulse.y - rAY * impulse.x + impulse.z);
bB.m_sweep.c.x += mB * impulse.x;
bB.m_sweep.c.y += mB * impulse.y;
bB.m_sweep.a += iB * (rBX * impulse.y - rBY * impulse.x + impulse.z);
bA.SynchronizeTransform();
bB.SynchronizeTransform();
return positionError <= b2Settings.b2_linearSlop && angularError <= b2Settings.b2_angularSlop;
}
Box2D.inherit(b2WeldJointDef, Box2D.Dynamics.Joints.b2JointDef);
b2WeldJointDef.prototype.__super = Box2D.Dynamics.Joints.b2JointDef.prototype;
b2WeldJointDef.b2WeldJointDef = function () {
Box2D.Dynamics.Joints.b2JointDef.b2JointDef.apply(this, arguments);
this.localAnchorA = new b2Vec2();
this.localAnchorB = new b2Vec2();
};
b2WeldJointDef.prototype.b2WeldJointDef = function () {
this.__super.b2JointDef.call(this);
this.type = b2Joint.e_weldJoint;
this.referenceAngle = 0.0;
}
b2WeldJointDef.prototype.Initialize = function (bA, bB, anchor) {
this.bodyA = bA;
this.bodyB = bB;
this.localAnchorA.SetV(this.bodyA.GetLocalPoint(anchor));
this.localAnchorB.SetV(this.bodyB.GetLocalPoint(anchor));
this.referenceAngle = this.bodyB.GetAngle() - this.bodyA.GetAngle();
}
})();
(function () {
var b2DebugDraw = Box2D.Dynamics.b2DebugDraw;
b2DebugDraw.b2DebugDraw = function () {
this.m_drawScale = 1.0;
this.m_lineThickness = 1.0;
this.m_alpha = 1.0;
this.m_fillAlpha = 1.0;
this.m_xformScale = 1.0;
var __this = this;
//#WORKAROUND
this.m_sprite = {
graphics: {
clear: function ()
{
//__this.m_ctx.clearRect(0, 0, __this.m_ctx.canvas.width, __this.m_ctx.canvas.height)
//__this.m_ctx.translate(100, 100);
}
}
};
};
b2DebugDraw.prototype._color = function (color, alpha) {
return "rgba(" + ((color & 0xFF0000) >> 16) + "," + ((color & 0xFF00) >> 8) + "," + (color & 0xFF) + "," + alpha + ")";
};
b2DebugDraw.prototype.b2DebugDraw = function () {
this.m_drawFlags = 0;
};
b2DebugDraw.prototype.SetFlags = function (flags) {
if (flags === undefined) flags = 0;
this.m_drawFlags = flags;
};
b2DebugDraw.prototype.GetFlags = function () {
return this.m_drawFlags;
};
b2DebugDraw.prototype.AppendFlags = function (flags) {
if (flags === undefined) flags = 0;
this.m_drawFlags |= flags;
};
b2DebugDraw.prototype.ClearFlags = function (flags) {
if (flags === undefined) flags = 0;
this.m_drawFlags &= ~flags;
};
b2DebugDraw.prototype.SetSprite = function (sprite) {
this.m_ctx = sprite;
};
b2DebugDraw.prototype.GetSprite = function () {
return this.m_ctx;
};
b2DebugDraw.prototype.SetDrawScale = function (drawScale) {
if (drawScale === undefined) drawScale = 0;
this.m_drawScale = drawScale;
};
b2DebugDraw.prototype.GetDrawScale = function () {
return this.m_drawScale;
};
b2DebugDraw.prototype.SetLineThickness = function (lineThickness) {
if (lineThickness === undefined) lineThickness = 0;
this.m_lineThickness = lineThickness;
this.m_ctx.strokeWidth = lineThickness;
};
b2DebugDraw.prototype.GetLineThickness = function () {
return this.m_lineThickness;
};
b2DebugDraw.prototype.SetAlpha = function (alpha) {
if (alpha === undefined) alpha = 0;
this.m_alpha = alpha;
};
b2DebugDraw.prototype.GetAlpha = function () {
return this.m_alpha;
};
b2DebugDraw.prototype.SetFillAlpha = function (alpha) {
if (alpha === undefined) alpha = 0;
this.m_fillAlpha = alpha;
};
b2DebugDraw.prototype.GetFillAlpha = function () {
return this.m_fillAlpha;
};
b2DebugDraw.prototype.SetXFormScale = function (xformScale) {
if (xformScale === undefined) xformScale = 0;
this.m_xformScale = xformScale;
};
b2DebugDraw.prototype.GetXFormScale = function () {
return this.m_xformScale;
};
b2DebugDraw.prototype.DrawPolygon = function (vertices, vertexCount, color) {
if (!vertexCount) return;
var s = this.m_ctx;
var drawScale = this.m_drawScale;
s.beginPath();
s.strokeStyle = this._color(color.color, this.m_alpha);
s.moveTo(vertices[0].x * drawScale, vertices[0].y * drawScale);
for (var i = 1; i < vertexCount; i++) {
s.lineTo(vertices[i].x * drawScale, vertices[i].y * drawScale);
}
s.lineTo(vertices[0].x * drawScale, vertices[0].y * drawScale);
s.closePath();
s.stroke();
};
b2DebugDraw.prototype.DrawSolidPolygon = function (vertices, vertexCount, color) {
if (!vertexCount) return;
var s = this.m_ctx;
var drawScale = this.m_drawScale;
s.beginPath();
s.strokeStyle = this._color(color.color, this.m_alpha);
s.fillStyle = this._color(color.color, this.m_fillAlpha);
s.moveTo(vertices[0].x * drawScale, vertices[0].y * drawScale);
for (var i = 1; i < vertexCount; i++) {
s.lineTo(vertices[i].x * drawScale, vertices[i].y * drawScale);
}
s.lineTo(vertices[0].x * drawScale, vertices[0].y * drawScale);
s.closePath();
s.fill();
s.stroke();
};
b2DebugDraw.prototype.DrawCircle = function (center, radius, color) {
if (!radius) return;
var s = this.m_ctx;
var drawScale = this.m_drawScale;
s.beginPath();
s.strokeStyle = this._color(color.color, this.m_alpha);
s.arc(center.x * drawScale, center.y * drawScale, radius * drawScale, 0, Math.PI * 2, true);
s.closePath();
s.stroke();
};
b2DebugDraw.prototype.DrawSolidCircle = function (center, radius, axis, color) {
if (!radius) return;
var s = this.m_ctx,
drawScale = this.m_drawScale,
cx = center.x * drawScale,
cy = center.y * drawScale;
s.moveTo(0, 0);
s.beginPath();
s.strokeStyle = this._color(color.color, this.m_alpha);
s.fillStyle = this._color(color.color, this.m_fillAlpha);
s.arc(cx, cy, radius * drawScale, 0, Math.PI * 2, true);
s.moveTo(cx, cy);
s.lineTo((center.x + axis.x * radius) * drawScale, (center.y + axis.y * radius) * drawScale);
s.closePath();
s.fill();
s.stroke();
};
b2DebugDraw.prototype.DrawSegment = function (p1, p2, color) {
var s = this.m_ctx,
drawScale = this.m_drawScale;
s.strokeStyle = this._color(color.color, this.m_alpha);
s.beginPath();
s.moveTo(p1.x * drawScale, p1.y * drawScale);
s.lineTo(p2.x * drawScale, p2.y * drawScale);
s.closePath();
s.stroke();
};
b2DebugDraw.prototype.DrawTransform = function (xf) {
var s = this.m_ctx,
drawScale = this.m_drawScale;
s.beginPath();
s.strokeStyle = this._color(0xff0000, this.m_alpha);
s.moveTo(xf.position.x * drawScale, xf.position.y * drawScale);
s.lineTo((xf.position.x + this.m_xformScale * xf.R.col1.x) * drawScale, (xf.position.y + this.m_xformScale * xf.R.col1.y) * drawScale);
s.strokeStyle = this._color(0xff00, this.m_alpha);
s.moveTo(xf.position.x * drawScale, xf.position.y * drawScale);
s.lineTo((xf.position.x + this.m_xformScale * xf.R.col2.x) * drawScale, (xf.position.y + this.m_xformScale * xf.R.col2.y) * drawScale);
s.closePath();
s.stroke();
};
})(); //post-definitions
var i;
for (i = 0; i < Box2D.postDefs.length; ++i) Box2D.postDefs[i]();
delete Box2D.postDefs;