public SphereStack()
{
{
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
}
{
b2CircleShape shape = new b2CircleShape();
shape.Radius = 1.0f;
for (int i = 0; i < e_count; ++i)
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(0.0f, 4.0f + 3.0f * i);
m_bodies[i] = m_world.CreateBody(bd);
m_bodies[i].CreateFixture(shape, 1.0f);
m_bodies[i].LinearVelocity = new b2Vec2(0.0f, -50.0f);
}
}
}
/// Compute the collision manifold between an edge and a circle.
public static void b2CollideEdgeAndPolygon(b2Manifold manifold, b2EdgeShape edgeA, ref b2Transform xfA, b2PolygonShape polygonB, ref b2Transform xfB)
{
b2EPCollider b = b2EPCollider.Create();
b.Collide(manifold, edgeA, ref xfA, polygonB, ref xfB);
b.Free();
}
public VaryingRestitution()
{
{
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
}
{
b2CircleShape shape = new b2CircleShape();
shape.Radius = 1.0f;
b2FixtureDef fd = new b2FixtureDef();
fd.shape = shape;
fd.density = 1.0f;
float[] restitution = { 0.0f, 0.1f, 0.3f, 0.5f, 0.75f, 0.9f, 1.0f };
for (int i = 0; i < 7; ++i)
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(-10.0f + 3.0f * i, 20.0f);
b2Body body = m_world.CreateBody(bd);
fd.restitution = restitution[i];
body.CreateFixture(fd);
}
}
}
/// Get a child edge.
public void GetChildEdge(b2EdgeShape edge, int index)
{
Debug.Assert(0 <= index && index < m_count - 1);
edge.m_type = b2Shape.Type.e_edge;
edge.m_radius = m_radius;
edge.m_vertex1 = m_vertices[index + 0];
edge.m_vertex2 = m_vertices[index + 1];
if (index > 0)
{
edge.m_vertex0 = m_vertices[index - 1];
edge.m_hasVertex0 = true;
}
else
{
edge.m_vertex0 = m_prevVertex;
edge.m_hasVertex0 = m_hasPrevVertex;
}
if (index < m_count - 2)
{
edge.m_vertex3 = m_vertices[index + 2];
edge.m_hasVertex3 = true;
}
else
{
edge.m_vertex3 = m_nextVertex;
edge.m_hasVertex3 = m_hasNextVertex;
}
}
/// Compute the collision manifold between an edge and a circle.
public static void b2CollideEdgeAndPolygon(ref b2Manifold manifold,
b2EdgeShape edgeA, ref b2Transform xfA,
b2PolygonShape polygonB, ref b2Transform xfB)
{
b2EPCollider b = new b2EPCollider();
b.Collide(ref manifold, edgeA, ref xfA, polygonB, ref xfB);
}
public Breakable()
{
// Ground body
{
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
}
// Breakable dynamic body
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position = new b2Vec2(0.0f, 40.0f);
bd.angle = 0.25f * b2Settings.b2_pi;
m_body1 = m_world.CreateBody(bd);
m_shape1.SetAsBox(0.5f, 0.5f, new b2Vec2(-0.5f, 0.0f), 0.0f);
m_piece1 = m_body1.CreateFixture(m_shape1, 1.0f);
m_shape2.SetAsBox(0.5f, 0.5f, new b2Vec2(0.5f, 0.0f), 0.0f);
m_piece2 = m_body1.CreateFixture(m_shape2, 1.0f);
}
m_break = false;
m_broke = false;
}
public ShapeEditing()
{
{
b2BodyDef bd1 = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd1);
b2EdgeShape shape1 = new b2EdgeShape();
shape1.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape1, 0.0f);
}
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(0.0f, 10.0f);
m_body = m_world.CreateBody(bd);
b2PolygonShape shape = new b2PolygonShape();
shape.SetAsBox(4.0f, 4.0f, new b2Vec2(0.0f, 0.0f), 0.0f);
m_fixture1 = m_body.CreateFixture(shape, 10.0f);
m_fixture2 = null;
m_sensor = false;
}
public void Set(b2Shape shape, int index)
{
switch (shape.ShapeType)
{
case b2ShapeType.e_circle:
{
b2CircleShape circle = (b2CircleShape)shape;
m_buffer[0] = circle.Position;
m_vertices = m_buffer;
m_count = 1;
m_radius = circle.Radius;
}
break;
case b2ShapeType.e_polygon:
{
b2PolygonShape polygon = (b2PolygonShape)shape;
m_vertices = polygon.Vertices;
m_count = polygon.VertexCount;
m_radius = polygon.Radius;
}
break;
case b2ShapeType.e_chain:
{
b2ChainShape chain = (b2ChainShape)shape;
Debug.Assert(0 <= index && index < chain.Count);
m_buffer[0] = chain.Vertices[index];
if (index + 1 < chain.Count)
{
m_buffer[1] = chain.Vertices[index + 1];
}
else
{
m_buffer[1] = chain.Vertices[0];
}
m_vertices = m_buffer;
m_count = 2;
m_radius = chain.Radius;
}
break;
case b2ShapeType.e_edge:
{
b2EdgeShape edge = (b2EdgeShape)shape;
m_buffer[0] = edge.Vertex1;
m_buffer[1] = edge.Vertex2;
m_vertices = m_buffer;
m_count = 2;
m_radius = edge.Radius;
}
break;
default:
Debug.Assert(false);
break;
}
}
public PolyShapes()
{
// Ground body
{
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
}
{
b2Vec2[] vertices = new b2Vec2[3];
vertices[0].Set(-0.5f, 0.0f);
vertices[1].Set(0.5f, 0.0f);
vertices[2].Set(0.0f, 1.5f);
m_polygons[0] = new b2PolygonShape();
m_polygons[0].Set(vertices, 3);
}
{
b2Vec2[] vertices = new b2Vec2[3];
vertices[0].Set(-0.1f, 0.0f);
vertices[1].Set(0.1f, 0.0f);
vertices[2].Set(0.0f, 1.5f);
m_polygons[1] = new b2PolygonShape();
m_polygons[1].Set(vertices, 3);
}
{
float w = 1.0f;
float b = w / (2.0f + b2Math.b2Sqrt(2.0f));
float s = b2Math.b2Sqrt(2.0f) * b;
b2Vec2[] vertices = new b2Vec2[8];
vertices[0].Set(0.5f * s, 0.0f);
vertices[1].Set(0.5f * w, b);
vertices[2].Set(0.5f * w, b + s);
vertices[3].Set(0.5f * s, w);
vertices[4].Set(-0.5f * s, w);
vertices[5].Set(-0.5f * w, b + s);
vertices[6].Set(-0.5f * w, b);
vertices[7].Set(-0.5f * s, 0.0f);
m_polygons[2] = new b2PolygonShape();
m_polygons[2].Set(vertices, 8);
}
{
m_polygons[3] = new b2PolygonShape();
m_polygons[3].SetAsBox(0.5f, 0.5f);
}
{
m_circle.Radius = 0.5f;
}
m_bodyIndex = 0;
}
void InitPhysics()
{
CCSize size = Layer.VisibleBoundsWorldspace.Size;
var gravity = new b2Vec2(0.0f, -10.0f);
world = new b2World(gravity);
world.SetAllowSleeping(true);
world.SetContinuousPhysics(true);
var def = new b2BodyDef();
def.allowSleep = true;
def.position = b2Vec2.Zero;
def.type = b2BodyType.b2_staticBody;
b2Body groundBody = world.CreateBody(def);
groundBody.SetActive(true);
b2EdgeShape groundBox = new b2EdgeShape();
groundBox.Set(b2Vec2.Zero, new b2Vec2(size.Width / PTM_RATIO, 0));
b2FixtureDef fd = new b2FixtureDef();
fd.shape = groundBox;
groundBody.CreateFixture(fd);
}
void InitPhysics()
{
var gravity = new b2Vec2(0.0f, -10.0f);
world = new b2World(gravity);
world.SetAllowSleeping(true);
world.SetContinuousPhysics(true);
var def = new b2BodyDef();
def.allowSleep = true;
def.position = b2Vec2.Zero;
def.type = b2BodyType.b2_staticBody;
b2Body groundBody = world.CreateBody(def);
groundBody.SetActive(true);
b2EdgeShape groundBox = new b2EdgeShape();
groundBox.Set(b2Vec2.Zero, new b2Vec2(900, 100));
b2FixtureDef fd = new b2FixtureDef();
fd.friction = 0.3f;
fd.restitution = 0.1f;
fd.shape = groundBox;
groundBody.CreateFixture(fd);
}
public override void Evaluate(b2Manifold manifold, b2Transform xfA, b2Transform xfB)
{
b2ChainShape chain = (b2ChainShape)m_fixtureA.GetShape();
b2EdgeShape edge = new b2EdgeShape();
chain.GetChildEdge(edge, m_indexA);
Utils.b2CollideEdgeAndPolygon(manifold, edge, xfA, (b2PolygonShape)m_fixtureB.GetShape(), xfB);
}
public static void b2CollideEdgeAndPolygon(b2Manifold manifold, b2EdgeShape edgeA, b2Transform xfA, b2PolygonShape circleB, b2Transform xfB)
{
Box2DPINVOKE.b2CollideEdgeAndPolygon(b2Manifold.getCPtr(manifold), b2EdgeShape.getCPtr(edgeA), b2Transform.getCPtr(xfA), b2PolygonShape.getCPtr(circleB), b2Transform.getCPtr(xfB));
if (Box2DPINVOKE.SWIGPendingException.Pending)
{
throw Box2DPINVOKE.SWIGPendingException.Retrieve();
}
}
/// Initialize the proxy using the given shape. The shape
/// must remain in scope while the proxy is in use.
public void Set(b2Shape shape, int index)
{
switch (shape.GetType())
{
case b2Shape.Type.e_circle:
{
b2CircleShape circle = (b2CircleShape)shape;
m_vertices = new [] { circle.m_p };
m_count = 1;
m_radius = circle.m_radius;
}
break;
case b2Shape.Type.e_polygon:
{
b2PolygonShape polygon = (b2PolygonShape)shape;
m_vertices = (b2Vec2[])polygon.m_vertices.Clone();
m_count = polygon.m_count;
m_radius = polygon.m_radius;
}
break;
case b2Shape.Type.e_chain:
{
b2ChainShape chain = (b2ChainShape)shape;
Debug.Assert(0 <= index && index < chain.m_count);
m_buffer[0] = chain.m_vertices[index];
if (index + 1 < chain.m_count)
{
m_buffer[1] = chain.m_vertices[index + 1];
}
else
{
m_buffer[1] = chain.m_vertices[0];
}
m_vertices = m_buffer;
m_count = 2;
m_radius = chain.m_radius;
}
break;
case b2Shape.Type.e_edge:
{
b2EdgeShape edge = (b2EdgeShape)shape;
m_vertices = new [] { edge.m_vertex1, edge.m_vertex2 };
m_count = 2;
m_radius = edge.m_radius;
}
break;
default:
Debug.Assert(false);
break;
}
}
public ContinuousTest()
{
{
b2BodyDef bd = new b2BodyDef();
bd.position.Set(0.0f, 0.0f);
b2Body body = m_world.CreateBody(bd);
b2EdgeShape edge = new b2EdgeShape();
edge.Set(new b2Vec2(-10.0f, 0.0f), new b2Vec2(10.0f, 0.0f));
body.CreateFixture(edge, 0.0f);
b2PolygonShape shape = new b2PolygonShape();
shape.SetAsBox(0.2f, 1.0f, new b2Vec2(0.5f, 1.0f), 0.0f);
body.CreateFixture(shape, 0.0f);
}
#if true
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(0.0f, 20.0f);
//bd.angle = 0.1f;
b2PolygonShape shape = new b2PolygonShape();
shape.SetAsBox(2.0f, 0.1f);
m_body = m_world.CreateBody(bd);
m_body.CreateFixture(shape, 1.0f);
m_angularVelocity = Rand.RandomFloat(-50.0f, 50.0f);
//m_angularVelocity = 46.661274f;
m_body.LinearVelocity = new b2Vec2(0.0f, -100.0f);
m_body.AngularVelocity = m_angularVelocity;
}
#else
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(0.0f, 2.0f);
b2Body body = m_world.CreateBody(bd);
b2CircleShape shape = new b2CircleShape();
shape.Position = b2Vec2.Zero;
shape.Radius = 0.5f;
body.CreateFixture(shape, 1.0f);
bd.bullet = true;
bd.position.Set(0.0f, 10.0f);
body = m_world.CreateBody(bd);
body.CreateFixture(shape, 1.0f);
body.LinearVelocity = new b2Vec2(0.0f, -100.0f);
}
#endif
}
/// Implement b2Shape.
public override b2Shape Clone()
{
b2EdgeShape clone = new b2EdgeShape();
clone.m_vertex1 = m_vertex1;
clone.m_vertex2 = m_vertex2;
clone.m_vertex3 = m_vertex3;
clone.m_vertex0 = m_vertex0;
clone.m_hasVertex0 = m_hasVertex0;
clone.m_hasVertex3 = m_hasVertex3;
return(clone);
}
public Pulleys()
{
float y = 16.0f;
float L = 12.0f;
float a = 1.0f;
float b = 2.0f;
b2Body ground = null;
{
b2BodyDef bd = new b2BodyDef();
ground = m_world.CreateBody(bd);
b2EdgeShape edge = new b2EdgeShape();
edge.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
//ground->CreateFixture(&shape, 0.0f);
b2CircleShape circle = new b2CircleShape();
circle.Radius = 2.0f;
circle.Position = new b2Vec2(-10.0f, y + b + L);
ground.CreateFixture(circle, 0.0f);
circle.Position = new b2Vec2(10.0f, y + b + L);
ground.CreateFixture(circle, 0.0f);
}
{
b2PolygonShape shape = new b2PolygonShape();
shape.SetAsBox(a, b);
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
//bd.fixedRotation = true;
bd.position.Set(-10.0f, y);
b2Body body1 = m_world.CreateBody(bd);
body1.CreateFixture(shape, 5.0f);
bd.position.Set(10.0f, y);
b2Body body2 = m_world.CreateBody(bd);
body2.CreateFixture(shape, 5.0f);
b2PulleyJointDef pulleyDef = new b2PulleyJointDef();
b2Vec2 anchor1 = new b2Vec2(-10.0f, y + b);
b2Vec2 anchor2 = new b2Vec2(10.0f, y + b);
b2Vec2 groundAnchor1 = new b2Vec2(-10.0f, y + b + L);
b2Vec2 groundAnchor2 = new b2Vec2(10.0f, y + b + L);
pulleyDef.Initialize(body1, body2, groundAnchor1, groundAnchor2, anchor1, anchor2, 1.5f);
m_joint1 = (b2PulleyJoint)m_world.CreateJoint(pulleyDef);
}
}
public Confined()
{
{
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
// Floor
shape.Set(new b2Vec2(-10.0f, 0.0f), new b2Vec2(10.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
// Left wall
shape.Set(new b2Vec2(-10.0f, 0.0f), new b2Vec2(-10.0f, 20.0f));
ground.CreateFixture(shape, 0.0f);
// Right wall
shape.Set(new b2Vec2(10.0f, 0.0f), new b2Vec2(10.0f, 20.0f));
ground.CreateFixture(shape, 0.0f);
// Roof
shape.Set(new b2Vec2(-10.0f, 20.0f), new b2Vec2(10.0f, 20.0f));
ground.CreateFixture(shape, 0.0f);
}
float radius = 0.5f;
b2CircleShape shape1 = new b2CircleShape();
shape1.Position = b2Vec2.Zero;
shape1.Radius = radius;
b2FixtureDef fd = new b2FixtureDef();
fd.shape = shape1;
fd.density = 1.0f;
fd.friction = 0.1f;
for (int j = 0; j < e_columnCount; ++j)
{
for (int i = 0; i < e_rowCount; ++i)
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(-10.0f + (2.1f * j + 1.0f + 0.01f * i) * radius, (2.0f * i + 1.0f) * radius);
b2Body body = m_world.CreateBody(bd);
body.CreateFixture(fd);
}
}
m_world.Gravity = new b2Vec2(0.0f, 0.0f);
}
public SensorTest()
{
{
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
{
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
}
#if false
{
b2FixtureDef sd = new b2FixtureDef();
sd.SetAsBox(10.0f, 2.0f, new b2Vec2(0.0f, 20.0f), 0.0f);
sd.isSensor = true;
m_sensor = ground.CreateFixture(sd);
}
#else
{
b2CircleShape shape = new b2CircleShape();
shape.Radius = 5.0f;
shape.Position = new b2Vec2(0.0f, 10.0f);
b2FixtureDef fd = new b2FixtureDef();
fd.shape = shape;
fd.isSensor = true;
m_sensor = ground.CreateFixture(fd);
}
#endif
}
{
b2CircleShape shape = new b2CircleShape();
shape.Radius = 1.0f;
for (int i = 0; i < e_count; ++i)
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(-10.0f + 3.0f * i, 20.0f);
bd.userData = i; // m_touching[i];
m_touching[i] = false;
m_bodies[i] = m_world.CreateBody(bd);
m_bodies[i].CreateFixture(shape, 1.0f);
}
}
}
//public const int e_columnCount = 1;
//public const int e_rowCount = 1;
public VerticalStack()
{
{
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
shape.Set(new b2Vec2(20.0f, 0.0f), new b2Vec2(20.0f, 20.0f));
ground.CreateFixture(shape, 0.0f);
}
float[] xs = { 0.0f, -10.0f, -5.0f, 5.0f, 10.0f };
for (int j = 0; j < e_columnCount; ++j)
{
b2PolygonShape shape = new b2PolygonShape();
shape.SetAsBox(0.5f, 0.5f);
b2FixtureDef fd = new b2FixtureDef();
fd.shape = shape;
fd.density = 1.0f;
fd.friction = 0.3f;
for (int i = 0; i < e_rowCount; ++i)
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
int n = j * e_rowCount + i;
Debug.Assert(n < e_rowCount * e_columnCount);
m_indices[n] = n;
bd.userData = m_indices[n];
float x = 0.0f;
//float32 x = RandomFloat(-0.02f, 0.02f);
//float32 x = i % 2 == 0 ? -0.025f : 0.025f;
bd.position.Set(xs[j] + x, 0.752f + 1.54f * i);
b2Body body = m_world.CreateBody(bd);
m_bodies[n] = body;
body.CreateFixture(fd);
}
}
m_bullet = null;
}
public Prismatic()
{
b2Body ground = null;
{
b2BodyDef bd = new b2BodyDef();
ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
}
{
b2PolygonShape shape = new b2PolygonShape();
shape.SetAsBox(2.0f, 0.5f);
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(-10.0f, 10.0f);
bd.angle = 0.5f * b2Settings.b2_pi;
bd.allowSleep = false;
b2Body body = m_world.CreateBody(bd);
body.CreateFixture(shape, 5.0f);
b2PrismaticJointDef pjd = new b2PrismaticJointDef();
// Bouncy limit
b2Vec2 axis = new b2Vec2(2.0f, 1.0f);
axis.Normalize();
pjd.Initialize(ground, body, new b2Vec2(0.0f, 0.0f), axis);
// Non-bouncy limit
//pjd.Initialize(ground, body, b2Vec2(-10.0f, 10.0f), b2Vec2(1.0f, 0.0f));
pjd.motorSpeed = 10.0f;
pjd.maxMotorForce = 10000.0f;
pjd.enableMotor = true;
pjd.lowerTranslation = 0.0f;
pjd.upperTranslation = 20.0f;
pjd.enableLimit = true;
m_joint = (b2PrismaticJoint)m_world.CreateJoint(pjd);
}
}
public OneSidedPlatform()
{
// Ground
{
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-20.0f, 0.0f), new b2Vec2(20.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
}
// Platform
{
b2BodyDef bd = new b2BodyDef();
bd.position.Set(0.0f, 10.0f);
b2Body body = m_world.CreateBody(bd);
b2PolygonShape shape = new b2PolygonShape();
shape.SetAsBox(3.0f, 0.5f);
m_platform = body.CreateFixture(shape, 0.0f);
m_bottom = 10.0f - 0.5f;
m_top = 10.0f + 0.5f;
}
// Actor
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(0.0f, 12.0f);
b2Body body = m_world.CreateBody(bd);
m_radius = 0.5f;
b2CircleShape shape = new b2CircleShape();
shape.Radius = m_radius;
m_character = body.CreateFixture(shape, 20.0f);
body.LinearVelocity = new b2Vec2(0.0f, -50.0f);
m_state = State.e_unknown;
}
}
/// Implement b2Shape.
public override bool RayCast(b2RayCastOutput output, b2RayCastInput input, b2Transform xf, int childIndex)
{
Debug.Assert(childIndex < m_count);
b2EdgeShape edgeShape = new b2EdgeShape();
int i1 = childIndex;
int i2 = childIndex + 1;
if (i2 == m_count)
{
i2 = 0;
}
edgeShape.m_vertex1 = m_vertices[i1];
edgeShape.m_vertex2 = m_vertices[i2];
return(edgeShape.RayCast(output, input, xf, 0));
}
public CircleBenchmarkTest()
{
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
// Floor
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
// Left wall
shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(-40.0f, 45.0f));
ground.CreateFixture(shape, 0.0f);
// Right wall
shape = new b2EdgeShape();
shape.Set(new b2Vec2(40.0f, 0.0f), new b2Vec2(40.0f, 45.0f));
ground.CreateFixture(shape, 0.0f);
// Roof
shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 45.0f), new b2Vec2(40.0f, 45.0f));
ground.CreateFixture(shape, 0.0f);
var sphere = new b2CircleShape();
sphere.Radius = 1.0f;
for (int i = 0; i < XCount; i++)
{
for (int j = 0; j < YCount; ++j)
{
bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(-38f + 2.1f * i, 2.0f + 2.0f * j);
var body = m_world.CreateBody(bd);
body.CreateFixture(sphere, 1.0f);
}
}
}
public Chain()
{
b2Body ground = null;
{
b2BodyDef bd = new b2BodyDef();
ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
}
{
b2PolygonShape shape = new b2PolygonShape();
shape.SetAsBox(0.6f, 0.125f);
b2FixtureDef fd = new b2FixtureDef();
fd.shape = shape;
fd.density = 20.0f;
fd.friction = 0.2f;
b2RevoluteJointDef jd = new b2RevoluteJointDef();
jd.CollideConnected = false;
const float y = 25.0f;
b2Body prevBody = ground;
for (int i = 0; i < 30; ++i)
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(0.5f + i, y);
b2Body body = m_world.CreateBody(bd);
body.CreateFixture(fd);
b2Vec2 anchor = new b2Vec2(i, y);
jd.Initialize(prevBody, body, anchor);
m_world.CreateJoint(jd);
prevBody = body;
}
}
}
public BulletTest()
{
{
b2BodyDef bd = new b2BodyDef();
bd.position.Set(0.0f, 0.0f);
b2Body body = m_world.CreateBody(bd);
b2EdgeShape edge = new b2EdgeShape();
edge.Set(new b2Vec2(-10.0f, 0.0f), new b2Vec2(10.0f, 0.0f));
body.CreateFixture(edge, 0.0f);
b2PolygonShape shape = new b2PolygonShape();
shape.SetAsBox(0.2f, 1.0f, new b2Vec2(0.5f, 1.0f), 0.0f);
body.CreateFixture(shape, 0.0f);
}
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(0.0f, 4.0f);
b2PolygonShape box = new b2PolygonShape();
box.SetAsBox(2.0f, 0.1f);
m_body = m_world.CreateBody(bd);
m_body.CreateFixture(box, 1.0f);
box.SetAsBox(0.25f, 0.25f);
//m_x = RandomFloat(-1.0f, 1.0f);
m_x = 0.20352793f;
bd.position.Set(m_x, 10.0f);
bd.bullet = true;
m_bullet = m_world.CreateBody(bd);
m_bullet.CreateFixture(box, 100.0f);
m_bullet.LinearVelocity = new b2Vec2(0.0f, -50.0f);
}
}
public Pyramid()
{
{
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
}
{
float a = 0.5f;
b2PolygonShape shape = new b2PolygonShape();
shape.SetAsBox(a, a);
b2Vec2 x = new b2Vec2(-7.0f, 0.75f);
b2Vec2 y;
b2Vec2 deltaX = new b2Vec2(0.5625f, 1.25f);
b2Vec2 deltaY = new b2Vec2(1.125f, 0.0f);
for (int i = 0; i < e_count; ++i)
{
y = x;
for (int j = i; j < e_count; ++j)
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position = y;
b2Body body = m_world.CreateBody(bd);
body.CreateFixture(shape, 5.0f);
y += deltaY;
}
x += deltaX;
}
}
}
public Gears()
{
b2Body ground = null;
{
b2BodyDef bd = new b2BodyDef();
ground = m_world.CreateBody(bd);
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(50.0f, 0.0f), new b2Vec2(-50.0f, 0.0f));
ground.CreateFixture(shape, 0.0f);
}
// Gears co
{
b2CircleShape circle1 = new b2CircleShape();
circle1.Radius = 1.0f;
b2PolygonShape box = new b2PolygonShape();
box.SetAsBox(0.5f, 5.0f);
b2CircleShape circle2 = new b2CircleShape();
circle2.Radius = 2.0f;
b2BodyDef bd1 = new b2BodyDef();
bd1.type = b2BodyType.b2_staticBody;
bd1.position.Set(10.0f, 9.0f);
b2Body body1 = m_world.CreateBody(bd1);
body1.CreateFixture(circle1, 0.0f);
b2BodyDef bd2 = new b2BodyDef();
bd2.type = b2BodyType.b2_dynamicBody;
bd2.position.Set(10.0f, 8.0f);
b2Body body2 = m_world.CreateBody(bd2);
body2.CreateFixture(box, 5.0f);
b2BodyDef bd3 = new b2BodyDef();
bd3.type = b2BodyType.b2_dynamicBody;
bd3.position.Set(10.0f, 6.0f);
b2Body body3 = m_world.CreateBody(bd3);
body3.CreateFixture(circle2, 5.0f);
b2RevoluteJointDef jd1 = new b2RevoluteJointDef();
jd1.Initialize(body2, body1, bd1.position);
b2Joint joint1 = m_world.CreateJoint(jd1);
b2RevoluteJointDef jd2 = new b2RevoluteJointDef();
jd2.Initialize(body2, body3, bd3.position);
b2Joint joint2 = m_world.CreateJoint(jd2);
b2GearJointDef jd4 = new b2GearJointDef();
jd4.BodyA = body1;
jd4.BodyB = body3;
jd4.joint1 = joint1;
jd4.joint2 = joint2;
jd4.ratio = circle2.Radius / circle1.Radius;
m_world.CreateJoint(jd4);
}
{
b2CircleShape circle1 = new b2CircleShape();
circle1.Radius = 1.0f;
b2CircleShape circle2 = new b2CircleShape();
circle2.Radius = 2.0f;
b2PolygonShape box = new b2PolygonShape();
box.SetAsBox(0.5f, 5.0f);
b2BodyDef bd1 = new b2BodyDef();
bd1.type = b2BodyType.b2_dynamicBody;
bd1.position.Set(-3.0f, 12.0f);
b2Body body1 = m_world.CreateBody(bd1);
body1.CreateFixture(circle1, 5.0f);
b2RevoluteJointDef jd1 = new b2RevoluteJointDef();
jd1.BodyA = ground;
jd1.BodyB = body1;
jd1.localAnchorA = ground.GetLocalPoint(bd1.position);
jd1.localAnchorB = body1.GetLocalPoint(bd1.position);
jd1.referenceAngle = body1.Angle - ground.Angle;
m_joint1 = (b2RevoluteJoint)m_world.CreateJoint(jd1);
b2BodyDef bd2 = new b2BodyDef();
bd2.type = b2BodyType.b2_dynamicBody;
bd2.position.Set(0.0f, 12.0f);
b2Body body2 = m_world.CreateBody(bd2);
body2.CreateFixture(circle2, 5.0f);
b2RevoluteJointDef jd2 = new b2RevoluteJointDef();
jd2.Initialize(ground, body2, bd2.position);
m_joint2 = (b2RevoluteJoint)m_world.CreateJoint(jd2);
b2BodyDef bd3 = new b2BodyDef();
bd3.type = b2BodyType.b2_dynamicBody;
bd3.position.Set(2.5f, 12.0f);
b2Body body3 = m_world.CreateBody(bd3);
body3.CreateFixture(box, 5.0f);
b2PrismaticJointDef jd3 = new b2PrismaticJointDef();
jd3.Initialize(ground, body3, bd3.position, new b2Vec2(0.0f, 1.0f));
jd3.lowerTranslation = -5.0f;
jd3.upperTranslation = 5.0f;
jd3.enableLimit = true;
m_joint3 = (b2PrismaticJoint)m_world.CreateJoint(jd3);
b2GearJointDef jd4 = new b2GearJointDef();
jd4.BodyA = body1;
jd4.BodyB = body2;
jd4.joint1 = m_joint1;
jd4.joint2 = m_joint2;
jd4.ratio = circle2.Radius / circle1.Radius;
m_joint4 = (b2GearJoint)m_world.CreateJoint(jd4);
b2GearJointDef jd5 = new b2GearJointDef();
jd5.BodyA = body2;
jd5.BodyB = body3;
jd5.joint1 = m_joint2;
jd5.joint2 = m_joint3;
jd5.ratio = -1.0f / circle2.Radius;
m_joint5 = (b2GearJoint)m_world.CreateJoint(jd5);
}
}
public CollisionFiltering()
{
// Ground body
{
b2EdgeShape shape = new b2EdgeShape();
shape.Set(new b2Vec2(-40.0f, 0.0f), new b2Vec2(40.0f, 0.0f));
b2FixtureDef sd = new b2FixtureDef();
sd.shape = shape;
sd.friction = 0.3f;
b2BodyDef bd = new b2BodyDef();
b2Body ground = m_world.CreateBody(bd);
ground.CreateFixture(sd);
}
// Small triangle
b2Vec2[] vertices = new b2Vec2[3];
vertices[0].Set(-1.0f, 0.0f);
vertices[1].Set(1.0f, 0.0f);
vertices[2].Set(0.0f, 2.0f);
b2PolygonShape polygon = new b2PolygonShape();
polygon.Set(vertices, 3);
b2FixtureDef triangleShapeDef = new b2FixtureDef();
triangleShapeDef.shape = polygon;
triangleShapeDef.density = 1.0f;
triangleShapeDef.filter.groupIndex = k_smallGroup;
triangleShapeDef.filter.categoryBits = k_triangleCategory;
triangleShapeDef.filter.maskBits = k_triangleMask;
b2BodyDef triangleBodyDef = new b2BodyDef();
triangleBodyDef.type = b2BodyType.b2_dynamicBody;
triangleBodyDef.position.Set(-5.0f, 2.0f);
b2Body body1 = m_world.CreateBody(triangleBodyDef);
body1.CreateFixture(triangleShapeDef);
// Large triangle (recycle definitions)
vertices[0] *= 2.0f;
vertices[1] *= 2.0f;
vertices[2] *= 2.0f;
polygon.Set(vertices, 3);
triangleShapeDef.filter.groupIndex = k_largeGroup;
triangleBodyDef.position.Set(-5.0f, 6.0f);
triangleBodyDef.fixedRotation = true; // look at me!
b2Body body2 = m_world.CreateBody(triangleBodyDef);
body2.CreateFixture(triangleShapeDef);
{
b2BodyDef bd = new b2BodyDef();
bd.type = b2BodyType.b2_dynamicBody;
bd.position.Set(-5.0f, 10.0f);
b2Body body = m_world.CreateBody(bd);
b2PolygonShape p = new b2PolygonShape();
p.SetAsBox(0.5f, 1.0f);
body.CreateFixture(p, 1.0f);
b2PrismaticJointDef jd = new b2PrismaticJointDef();
jd.BodyA = body2;
jd.BodyB = body;
jd.enableLimit = true;
jd.localAnchorA.Set(0.0f, 4.0f);
jd.localAnchorB.SetZero();
jd.localAxisA.Set(0.0f, 1.0f);
jd.lowerTranslation = -1.0f;
jd.upperTranslation = 1.0f;
m_world.CreateJoint(jd);
}
// Small box
polygon.SetAsBox(1.0f, 0.5f);
b2FixtureDef boxShapeDef = new b2FixtureDef();
boxShapeDef.shape = polygon;
boxShapeDef.density = 1.0f;
boxShapeDef.restitution = 0.1f;
boxShapeDef.filter.groupIndex = k_smallGroup;
boxShapeDef.filter.categoryBits = k_boxCategory;
boxShapeDef.filter.maskBits = k_boxMask;
b2BodyDef boxBodyDef = new b2BodyDef();
boxBodyDef.type = b2BodyType.b2_dynamicBody;
boxBodyDef.position.Set(0.0f, 2.0f);
b2Body body3 = m_world.CreateBody(boxBodyDef);
body3.CreateFixture(boxShapeDef);
// Large box (recycle definitions)
polygon.SetAsBox(2.0f, 1.0f);
boxShapeDef.filter.groupIndex = k_largeGroup;
boxBodyDef.position.Set(0.0f, 6.0f);
b2Body body4 = m_world.CreateBody(boxBodyDef);
body4.CreateFixture(boxShapeDef);
// Small circle
b2CircleShape circle = new b2CircleShape();
circle.Radius = 1.0f;
b2FixtureDef circleShapeDef = new b2FixtureDef();
circleShapeDef.shape = circle;
circleShapeDef.density = 1.0f;
circleShapeDef.filter.groupIndex = k_smallGroup;
circleShapeDef.filter.categoryBits = k_circleCategory;
circleShapeDef.filter.maskBits = k_circleMask;
b2BodyDef circleBodyDef = new b2BodyDef();
circleBodyDef.type = b2BodyType.b2_dynamicBody;
circleBodyDef.position.Set(5.0f, 2.0f);
b2Body body5 = m_world.CreateBody(circleBodyDef);
body5.CreateFixture(circleShapeDef);
// Large circle
circle.Radius = circle.Radius * 2.0f;
circleShapeDef.filter.groupIndex = k_largeGroup;
circleBodyDef.position.Set(5.0f, 6.0f);
b2Body body6 = m_world.CreateBody(circleBodyDef);
body6.CreateFixture(circleShapeDef);
}
public void DrawShape(b2Fixture fixture, b2Transform xf, b2Color color)
{
switch (fixture.ShapeType)
{
case b2ShapeType.e_circle:
{
b2CircleShape circle = (b2CircleShape)fixture.Shape;
b2Vec2 center = b2Math.b2Mul(xf, circle.Position);
float radius = circle.Radius;
b2Vec2 axis = b2Math.b2Mul(xf.q, new b2Vec2(1.0f, 0.0f));
m_debugDraw.DrawSolidCircle(center, radius, axis, color);
}
break;
case b2ShapeType.e_edge:
{
b2EdgeShape edge = (b2EdgeShape)fixture.Shape;
b2Vec2 v1 = b2Mul(xf, edge.m_vertex1);
b2Vec2 v2 = b2Mul(xf, edge.m_vertex2);
m_debugDraw.DrawSegment(v1, v2, color);
}
break;
case b2ShapeType.e_chain:
{
b2ChainShape chain = (b2ChainShape)fixture.Shape;
int count = chain.Count;
b2Vec2[] vertices = chain.Vertices;
b2Vec2 v1 = b2Math.b2Mul(xf, vertices[0]);
for (int i = 1; i < count; ++i)
{
b2Vec2 v2 = b2Math.b2Mul(xf, vertices[i]);
m_debugDraw.DrawSegment(v1, v2, color);
m_debugDraw.DrawCircle(v1, 0.05f, color);
v1 = v2;
}
}
break;
case b2ShapeType.e_polygon:
{
b2PolygonShape poly = (b2PolygonShape)fixture.Shape;
int vertexCount = poly.VertexCount;
b2Vec2[] vertices = new b2Vec2[b2Settings.b2_maxPolygonVertices];
for (int i = 0; i < vertexCount; ++i)
{
vertices[i] = b2Math.b2Mul(xf, poly.Vertices[i]);
}
m_debugDraw.DrawSolidPolygon(vertices, vertexCount, color);
}
break;
default:
break;
}
}
