public override void initTest(bool deserialized)
{
if (deserialized)
{
return;
}
Body ground = null;
{
BodyDef bd = new BodyDef();
ground = getWorld().createBody(bd);
EdgeShape shape = new EdgeShape();
shape.set(new Vec2(-40.0f, 0.0f), new Vec2(40.0f, 0.0f));
ground.createFixture(shape, 0.0f);
}
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(0.6f, 0.125f);
FixtureDef fd = new FixtureDef();
fd.shape = shape;
fd.density = 20.0f;
fd.friction = 0.2f;
RevoluteJointDef jd = new RevoluteJointDef();
jd.collideConnected = false;
float y = 25.0f;
Body prevBody = ground;
for (int i = 0; i < 30; ++i)
{
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.5f + i, y);
Body body = getWorld().createBody(bd);
body.createFixture(fd);
Vec2 anchor = new Vec2(i, y);
jd.initialize(prevBody, body, anchor);
getWorld().createJoint(jd);
prevBody = body;
}
}
}
public override void initTest(bool deserialized)
{
{
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.allowSleep = false;
bd.position.set(0.0f, 10.0f);
Body body = m_world.createBody(bd);
PolygonShape shape = new PolygonShape();
shape.setAsBox(0.5f, 10.0f, new Vec2(20.0f, 0.0f), 0.0f);
body.createFixture(shape, 5.0f);
shape.setAsBox(0.5f, 10.0f, new Vec2(-20.0f, 0.0f), 0.0f);
body.createFixture(shape, 5.0f);
shape.setAsBox(20.0f, 0.5f, new Vec2(0.0f, 10.0f), 0.0f);
body.createFixture(shape, 5.0f);
shape.setAsBox(20.0f, 0.5f, new Vec2(0.0f, -10.0f), 0.0f);
body.createFixture(shape, 5.0f);
RevoluteJointDef jd = new RevoluteJointDef();
jd.bodyA = getGroundBody();
jd.bodyB = body;
jd.localAnchorA.set(0.0f, 10.0f);
jd.localAnchorB.set(0.0f, 0.0f);
jd.referenceAngle = 0.0f;
jd.motorSpeed = 0.05f*MathUtils.PI;
jd.maxMotorTorque = 1e7f;
jd.enableMotor = true;
m_joint = (RevoluteJoint) m_world.createJoint(jd);
}
m_world.setParticleRadius(0.15f);
m_world.setParticleDamping(0.2f);
{
ParticleGroupDef pd = new ParticleGroupDef();
pd.flags = 0;
PolygonShape shape = new PolygonShape();
shape.setAsBox(9.0f, 9.0f, new Vec2(0.0f, 10.0f), 0.0f);
pd.shape = shape;
m_world.createParticleGroup(pd);
}
m_time = 0;
}
internal RevoluteJoint(IWorldPool argWorld, RevoluteJointDef def)
: base(argWorld, def)
{
m_localAnchorA.set(def.localAnchorA);
m_localAnchorB.set(def.localAnchorB);
m_referenceAngle = def.referenceAngle;
m_motorImpulse = 0;
m_lowerAngle = def.lowerAngle;
m_upperAngle = def.upperAngle;
m_maxMotorTorque = def.maxMotorTorque;
m_motorSpeed = def.motorSpeed;
m_enableLimit = def.enableLimit;
m_enableMotor = def.enableMotor;
m_limitState = LimitState.INACTIVE;
}
public override void initTest(bool argDeserialized)
{
Body ground = null;
{
BodyDef bd = new BodyDef();
ground = getWorld().createBody(bd);
EdgeShape shape = new EdgeShape();
shape.set(new Vec2(50.0f, 0.0f), new Vec2(-50.0f, 0.0f));
ground.createFixture(shape, 0.0f);
}
{
CircleShape circle1 = new CircleShape();
circle1.m_radius = 1.0f;
PolygonShape box = new PolygonShape();
box.setAsBox(0.5f, 5.0f);
CircleShape circle2 = new CircleShape();
circle2.m_radius = 2.0f;
BodyDef bd1 = new BodyDef();
bd1.type = BodyType.STATIC;
bd1.position.set(10.0f, 9.0f);
Body body1 = m_world.createBody(bd1);
body1.createFixture(circle1, 5.0f);
BodyDef bd2 = new BodyDef();
bd2.type = BodyType.DYNAMIC;
bd2.position.set(10.0f, 8.0f);
Body body2 = m_world.createBody(bd2);
body2.createFixture(box, 5.0f);
BodyDef bd3 = new BodyDef();
bd3.type = BodyType.DYNAMIC;
bd3.position.set(10.0f, 6.0f);
Body body3 = m_world.createBody(bd3);
body3.createFixture(circle2, 5.0f);
RevoluteJointDef jd1 = new RevoluteJointDef();
jd1.initialize(body2, body1, bd1.position);
Joint joint1 = m_world.createJoint(jd1);
RevoluteJointDef jd2 = new RevoluteJointDef();
jd2.initialize(body2, body3, bd3.position);
Joint joint2 = m_world.createJoint(jd2);
GearJointDef jd4 = new GearJointDef();
jd4.bodyA = body1;
jd4.bodyB = body3;
jd4.joint1 = joint1;
jd4.joint2 = joint2;
jd4.ratio = circle2.m_radius/circle1.m_radius;
m_world.createJoint(jd4);
}
{
CircleShape circle1 = new CircleShape();
circle1.m_radius = 1.0f;
CircleShape circle2 = new CircleShape();
circle2.m_radius = 2.0f;
PolygonShape box = new PolygonShape();
box.setAsBox(0.5f, 5.0f);
BodyDef bd1 = new BodyDef();
bd1.type = BodyType.DYNAMIC;
bd1.position.set(-3.0f, 12.0f);
Body body1 = m_world.createBody(bd1);
body1.createFixture(circle1, 5.0f);
RevoluteJointDef jd1 = new RevoluteJointDef();
jd1.bodyA = ground;
jd1.bodyB = body1;
ground.getLocalPointToOut(bd1.position, ref jd1.localAnchorA);
body1.getLocalPointToOut(bd1.position, ref jd1.localAnchorB);
jd1.referenceAngle = body1.getAngle() - ground.getAngle();
m_joint1 = (RevoluteJoint) m_world.createJoint(jd1);
BodyDef bd2 = new BodyDef();
bd2.type = BodyType.DYNAMIC;
bd2.position.set(0.0f, 12.0f);
Body body2 = m_world.createBody(bd2);
body2.createFixture(circle2, 5.0f);
RevoluteJointDef jd2 = new RevoluteJointDef();
jd2.initialize(ground, body2, bd2.position);
m_joint2 = (RevoluteJoint) m_world.createJoint(jd2);
BodyDef bd3 = new BodyDef();
bd3.type = BodyType.DYNAMIC;
bd3.position.set(2.5f, 12.0f);
Body body3 = m_world.createBody(bd3);
body3.createFixture(box, 5.0f);
PrismaticJointDef jd3 = new PrismaticJointDef();
jd3.initialize(ground, body3, bd3.position, new Vec2(0.0f, 1.0f));
jd3.lowerTranslation = -5.0f;
jd3.upperTranslation = 5.0f;
jd3.enableLimit = true;
m_joint3 = (PrismaticJoint) m_world.createJoint(jd3);
GearJointDef jd4 = new GearJointDef();
jd4.bodyA = body1;
jd4.bodyB = body2;
jd4.joint1 = m_joint1;
jd4.joint2 = m_joint2;
jd4.ratio = circle2.m_radius/circle1.m_radius;
m_joint4 = (GearJoint) m_world.createJoint(jd4);
GearJointDef jd5 = new GearJointDef();
jd5.bodyA = body2;
jd5.bodyB = body3;
jd5.joint1 = m_joint2;
jd5.joint2 = m_joint3;
jd5.ratio = 1f/circle2.m_radius;
m_joint5 = (GearJoint) m_world.createJoint(jd5);
}
}
public override void initTest(bool deserialized)
{
if (deserialized)
{
return;
}
Body pendulum;
Body pendulumBase;
Body ground;
{
CircleShape circleShape = new CircleShape();
circleShape.m_radius = 1;
Shape shape = circleShape;
BodyDef bodyDef = new BodyDef();
bodyDef.type = BodyType.DYNAMIC;
bodyDef.position.set(-5, 0);
bodyDef.allowSleep = false;
pendulum = getWorld().createBody(bodyDef);
pendulum.createFixture(shape, 1);
}
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(1, 1);
BodyDef bodyDef = new BodyDef();
bodyDef.type = BodyType.DYNAMIC;
bodyDef.position.set(0, 2);
bodyDef.allowSleep = false;
pendulumBase = getWorld().createBody(bodyDef);
pendulumBase.createFixture(shape, 1);
}
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(3, 1);
BodyDef bodyDef = new BodyDef();
bodyDef.type = BodyType.STATIC;
ground = getWorld().createBody(bodyDef);
ground.createFixture(shape, 0);
}
RevoluteJointDef jointDef = new RevoluteJointDef();
if (switchBodiesInJoint)
jointDef.initialize(pendulum, pendulumBase, new Vec2(0, 0));
else
jointDef.initialize(pendulumBase, pendulum, new Vec2(0, 0));
getWorld().createJoint(jointDef);
}
public override void initTest(bool deserialized)
{
if (deserialized)
{
return;
}
Body ground = null;
{
BodyDef bd = new BodyDef();
ground = getWorld().createBody(bd);
EdgeShape shape = new EdgeShape();
shape.set(new Vec2(-40.0f, 0.0f), new Vec2(40.0f, 0.0f));
ground.createFixture(shape, 0.0f);
}
{
CircleShape shape = new CircleShape();
shape.m_radius = 0.5f;
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
RevoluteJointDef rjd = new RevoluteJointDef();
bd.position.set(-10f, 20.0f);
Body body = getWorld().createBody(bd);
body.createFixture(shape, 5.0f);
float w = 100.0f;
body.setAngularVelocity(w);
body.setLinearVelocity(new Vec2(-8.0f*w, 0.0f));
rjd.initialize(ground, body, new Vec2(-10.0f, 12.0f));
rjd.motorSpeed = -1.0f*MathUtils.PI;
rjd.maxMotorTorque = 10000.0f;
rjd.enableMotor = false;
rjd.lowerAngle = -0.25f*MathUtils.PI;
rjd.upperAngle = 0.5f*MathUtils.PI;
rjd.enableLimit = true;
rjd.collideConnected = true;
m_joint = (RevoluteJoint) getWorld().createJoint(rjd);
}
{
CircleShape circle_shape = new CircleShape();
circle_shape.m_radius = 3.0f;
BodyDef circle_bd = new BodyDef();
circle_bd.type = BodyType.DYNAMIC;
circle_bd.position.set(5.0f, 30.0f);
FixtureDef fd = new FixtureDef();
fd.density = 5.0f;
fd.filter.maskBits = 1;
fd.shape = circle_shape;
Body ball = m_world.createBody(circle_bd);
ball.createFixture(fd);
PolygonShape polygon_shape = new PolygonShape();
polygon_shape.setAsBox(10.0f, 0.2f, new Vec2(-10.0f, 0.0f), 0.0f);
BodyDef polygon_bd = new BodyDef();
polygon_bd.position.set(20.0f, 10.0f);
polygon_bd.type = BodyType.DYNAMIC;
polygon_bd.bullet = true;
Body polygon_body = m_world.createBody(polygon_bd);
polygon_body.createFixture(polygon_shape, 2.0f);
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(ground, polygon_body, new Vec2(20.0f, 10.0f));
rjd.lowerAngle = -0.25f*MathUtils.PI;
rjd.upperAngle = 0.0f*MathUtils.PI;
rjd.enableLimit = true;
m_world.createJoint(rjd);
}
// Tests mass computation of a small object far from the origin
{
BodyDef bodyDef = new BodyDef();
bodyDef.type = BodyType.DYNAMIC;
Body body = m_world.createBody(bodyDef);
PolygonShape polyShape = new PolygonShape();
Vec2[] verts = new Vec2[3];
verts[0] = new Vec2(17.63f, 36.31f);
verts[1] = new Vec2(17.52f, 36.69f);
verts[2] = new Vec2(17.19f, 36.36f);
polyShape.set(verts, 3);
FixtureDef polyFixtureDef = new FixtureDef();
polyFixtureDef.shape = polyShape;
polyFixtureDef.density = 1;
body.createFixture(polyFixtureDef); // assertion hits inside here
}
}
public override void initTest(bool argDeserialized)
{
if (argDeserialized)
{
return;
}
m_offset.set(0.0f, 8.0f);
m_motorSpeed = 2.0f;
m_motorOn = true;
Vec2 pivot = new Vec2(0.0f, 0.8f);
// Ground
{
BodyDef bd = new BodyDef();
Body ground = getWorld().createBody(bd);
EdgeShape shape = new EdgeShape();
shape.set(new Vec2(-50.0f, 0.0f), new Vec2(50.0f, 0.0f));
ground.createFixture(shape, 0.0f);
shape.set(new Vec2(-50.0f, 0.0f), new Vec2(-50.0f, 10.0f));
ground.createFixture(shape, 0.0f);
shape.set(new Vec2(50.0f, 0.0f), new Vec2(50.0f, 10.0f));
ground.createFixture(shape, 0.0f);
}
// Balls
for (int i = 0; i < 40; ++i)
{
CircleShape shape = new CircleShape();
shape.m_radius = 0.25f;
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(-40.0f + 2.0f*i, 0.5f);
Body body = getWorld().createBody(bd);
body.createFixture(shape, 1.0f);
}
// Chassis
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(2.5f, 1.0f);
FixtureDef sd = new FixtureDef();
sd.density = 1.0f;
sd.shape = shape;
sd.filter.groupIndex = -1;
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(pivot);
bd.position.addLocal(m_offset);
m_chassis = getWorld().createBody(bd);
m_chassis.createFixture(sd);
}
{
CircleShape shape = new CircleShape();
shape.m_radius = 1.6f;
FixtureDef sd = new FixtureDef();
sd.density = 1.0f;
sd.shape = shape;
sd.filter.groupIndex = -1;
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(pivot);
bd.position.addLocal(m_offset);
m_wheel = getWorld().createBody(bd);
m_wheel.createFixture(sd);
}
{
RevoluteJointDef jd = new RevoluteJointDef();
jd.initialize(m_wheel, m_chassis, pivot.add(m_offset));
jd.collideConnected = false;
jd.motorSpeed = m_motorSpeed;
jd.maxMotorTorque = 400.0f;
jd.enableMotor = m_motorOn;
m_motorJoint = (RevoluteJoint) getWorld().createJoint(jd);
}
Vec2 wheelAnchor;
wheelAnchor = pivot.add(new Vec2(0.0f, -0.8f));
createLeg(-1.0f, wheelAnchor);
createLeg(1.0f, wheelAnchor);
m_wheel.setTransform(m_wheel.getPosition(), 120.0f*MathUtils.PI/180.0f);
createLeg(-1.0f, wheelAnchor);
createLeg(1.0f, wheelAnchor);
m_wheel.setTransform(m_wheel.getPosition(), -120.0f*MathUtils.PI/180.0f);
createLeg(-1.0f, wheelAnchor);
createLeg(1.0f, wheelAnchor);
}
private void createLeg(float s, Vec2 wheelAnchor)
{
Vec2 p1 = new Vec2(5.4f*s, -6.1f);
Vec2 p2 = new Vec2(7.2f*s, -1.2f);
Vec2 p3 = new Vec2(4.3f*s, -1.9f);
Vec2 p4 = new Vec2(3.1f*s, 0.8f);
Vec2 p5 = new Vec2(6.0f*s, 1.5f);
Vec2 p6 = new Vec2(2.5f*s, 3.7f);
FixtureDef fd1 = new FixtureDef();
FixtureDef fd2 = new FixtureDef();
fd1.filter.groupIndex = -1;
fd2.filter.groupIndex = -1;
fd1.density = 1.0f;
fd2.density = 1.0f;
PolygonShape poly1 = new PolygonShape();
PolygonShape poly2 = new PolygonShape();
if (s > 0.0f)
{
Vec2[] vertices = new Vec2[3];
vertices[0] = p1;
vertices[1] = p2;
vertices[2] = p3;
poly1.set(vertices, 3);
vertices[0] = new Vec2();
vertices[1] = p5.sub(p4);
vertices[2] = p6.sub(p4);
poly2.set(vertices, 3);
}
else
{
Vec2[] vertices = new Vec2[3];
vertices[0] = p1;
vertices[1] = p3;
vertices[2] = p2;
poly1.set(vertices, 3);
vertices[0] = new Vec2();
vertices[1] = p6.sub(p4);
vertices[2] = p5.sub(p4);
poly2.set(vertices, 3);
}
fd1.shape = poly1;
fd2.shape = poly2;
BodyDef bd1 = new BodyDef(), bd2 = new BodyDef();
bd1.type = BodyType.DYNAMIC;
bd2.type = BodyType.DYNAMIC;
bd1.position = m_offset;
bd2.position = p4.add(m_offset);
bd1.angularDamping = 10.0f;
bd2.angularDamping = 10.0f;
Body body1 = getWorld().createBody(bd1);
Body body2 = getWorld().createBody(bd2);
body1.createFixture(fd1);
body2.createFixture(fd2);
DistanceJointDef djd = new DistanceJointDef();
// Using a soft distance constraint can reduce some jitter.
// It also makes the structure seem a bit more fluid by
// acting like a suspension system.
djd.dampingRatio = 0.5f;
djd.frequencyHz = 10.0f;
djd.initialize(body1, body2, p2.add(m_offset), p5.add(m_offset));
getWorld().createJoint(djd);
djd.initialize(body1, body2, p3.add(m_offset), p4.add(m_offset));
getWorld().createJoint(djd);
djd.initialize(body1, m_wheel, p3.add(m_offset), wheelAnchor.add(m_offset));
getWorld().createJoint(djd);
djd.initialize(body2, m_wheel, p6.add(m_offset), wheelAnchor.add(m_offset));
getWorld().createJoint(djd);
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(body2, m_chassis, p4.add(m_offset));
getWorld().createJoint(rjd);
}
public override void initTest(bool argDeserialized)
{
if (argDeserialized)
{
return;
}
Body leftWall = null;
Body rightWall = null;
{
// Ground
PolygonShape sd = new PolygonShape();
sd.setAsBox(50.0f, 10.0f);
BodyDef bd = new BodyDef();
bd.type = BodyType.STATIC;
bd.position = new Vec2(0.0f, -10.0f);
Body b = getWorld().createBody(bd);
FixtureDef fd = new FixtureDef();
fd.shape = sd;
fd.friction = 1.0f;
b.createFixture(fd);
// Walls
sd.setAsBox(3.0f, 50.0f);
bd = new BodyDef();
bd.position = new Vec2(45.0f, 25.0f);
rightWall = getWorld().createBody(bd);
rightWall.createFixture(sd, 0);
bd.position = new Vec2(-45.0f, 25.0f);
leftWall = getWorld().createBody(bd);
leftWall.createFixture(sd, 0);
// Corners
bd = new BodyDef();
sd.setAsBox(20.0f, 3.0f);
bd.angle = (float) (-System.Math.PI/4.0);
bd.position = new Vec2(-35f, 8.0f);
Body myBod = getWorld().createBody(bd);
myBod.createFixture(sd, 0);
bd.angle = (float) (System.Math.PI/4.0);
bd.position = new Vec2(35f, 8.0f);
myBod = getWorld().createBody(bd);
myBod.createFixture(sd, 0);
// top
sd.setAsBox(50.0f, 10.0f);
bd.type = BodyType.STATIC;
bd.angle = 0;
bd.position = new Vec2(0.0f, 75.0f);
b = getWorld().createBody(bd);
fd.shape = sd;
fd.friction = 1.0f;
b.createFixture(fd);
}
CircleShape cd;
FixtureDef fd2 = new FixtureDef();
BodyDef bd2 = new BodyDef();
bd2.type = BodyType.DYNAMIC;
int numPieces = 5;
float radius = 6f;
bd2.position = new Vec2(0.0f, 10.0f);
Body body = getWorld().createBody(bd2);
for (int i = 0; i < numPieces; i++)
{
cd = new CircleShape();
cd.m_radius = 1.2f;
fd2.shape = cd;
fd2.density = 25;
fd2.friction = .1f;
fd2.restitution = .9f;
float xPos = radius*(float) System.Math.Cos(2f*System.Math.PI*(i/(float) (numPieces)));
float yPos = radius*(float) System.Math.Sin(2f*System.Math.PI*(i/(float) (numPieces)));
cd.m_p.set(xPos, yPos);
body.createFixture(fd2);
}
body.setBullet(false);
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(body, getGroundBody(), body.getPosition());
rjd.motorSpeed = MathUtils.PI;
rjd.maxMotorTorque = 1000000.0f;
rjd.enableMotor = true;
joint = (RevoluteJoint) getWorld().createJoint(rjd);
{
int loadSize = 41;
for (int j = 0; j < 15; j++)
{
for (int i = 0; i < loadSize; i++)
{
CircleShape circ = new CircleShape();
BodyDef bod = new BodyDef();
bod.type = BodyType.DYNAMIC;
circ.m_radius = 1.0f + (i%2 == 0 ? 1.0f : -1.0f)*.5f*MathUtils.randomFloat(.5f, 1f);
FixtureDef fd3 = new FixtureDef();
fd3.shape = circ;
fd3.density = circ.m_radius*1.5f;
fd3.friction = 0.5f;
fd3.restitution = 0.7f;
float xPos = -39f + 2*i;
float yPos = 50f + j;
bod.position = new Vec2(xPos, yPos);
Body myBody = getWorld().createBody(bod);
myBody.createFixture(fd3);
}
}
}
getWorld().setGravity(new Vec2(0, -50));
}
public override void initTest(bool deserialized)
{
if (deserialized)
{
return;
}
m_hz = 4.0f;
m_zeta = 0.7f;
m_speed = 50.0f;
Body ground = null;
{
BodyDef bd = new BodyDef();
ground = m_world.createBody(bd);
EdgeShape shape = new EdgeShape();
FixtureDef fd = new FixtureDef();
fd.shape = shape;
fd.density = 0.0f;
fd.friction = 0.6f;
shape.set(new Vec2(-20.0f, 0.0f), new Vec2(20.0f, 0.0f));
ground.createFixture(fd);
float[] hs = {0.25f, 1.0f, 4.0f, 0.0f, 0.0f, -1.0f, -2.0f, -2.0f, -1.25f, 0.0f};
float x = 20.0f, y1 = 0.0f, dx = 5.0f;
for (int i = 0; i < 10; ++i)
{
float y2 = hs[i];
shape.set(new Vec2(x, y1), new Vec2(x + dx, y2));
ground.createFixture(fd);
y1 = y2;
x += dx;
}
for (int i = 0; i < 10; ++i)
{
float y2 = hs[i];
shape.set(new Vec2(x, y1), new Vec2(x + dx, y2));
ground.createFixture(fd);
y1 = y2;
x += dx;
}
shape.set(new Vec2(x, 0.0f), new Vec2(x + 40.0f, 0.0f));
ground.createFixture(fd);
x += 80.0f;
shape.set(new Vec2(x, 0.0f), new Vec2(x + 40.0f, 0.0f));
ground.createFixture(fd);
x += 40.0f;
shape.set(new Vec2(x, 0.0f), new Vec2(x + 10.0f, 5.0f));
ground.createFixture(fd);
x += 20.0f;
shape.set(new Vec2(x, 0.0f), new Vec2(x + 40.0f, 0.0f));
ground.createFixture(fd);
x += 40.0f;
shape.set(new Vec2(x, 0.0f), new Vec2(x, 20.0f));
ground.createFixture(fd);
}
// Teeter
{
BodyDef bd = new BodyDef();
bd.position.set(140.0f, 1.0f);
bd.type = BodyType.DYNAMIC;
Body body = m_world.createBody(bd);
PolygonShape box = new PolygonShape();
box.setAsBox(10.0f, 0.25f);
body.createFixture(box, 1.0f);
RevoluteJointDef jd = new RevoluteJointDef();
jd.initialize(ground, body, body.getPosition());
jd.lowerAngle = -8.0f*MathUtils.PI/180.0f;
jd.upperAngle = 8.0f*MathUtils.PI/180.0f;
jd.enableLimit = true;
m_world.createJoint(jd);
body.applyAngularImpulse(100.0f);
}
// Bridge
{
int N = 20;
PolygonShape shape = new PolygonShape();
shape.setAsBox(1.0f, 0.125f);
FixtureDef fd = new FixtureDef();
fd.shape = shape;
fd.density = 1.0f;
fd.friction = 0.6f;
RevoluteJointDef jd = new RevoluteJointDef();
Body prevBody = ground;
for (int i = 0; i < N; ++i)
{
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(161.0f + 2.0f*i, -0.125f);
Body body = m_world.createBody(bd);
body.createFixture(fd);
Vec2 anchor = new Vec2(160.0f + 2.0f*i, -0.125f);
jd.initialize(prevBody, body, anchor);
m_world.createJoint(jd);
prevBody = body;
}
Vec2 anchor2 = new Vec2(160.0f + 2.0f*N, -0.125f);
jd.initialize(prevBody, ground, anchor2);
m_world.createJoint(jd);
}
// Boxes
{
PolygonShape box = new PolygonShape();
box.setAsBox(0.5f, 0.5f);
Body body = null;
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(230.0f, 0.5f);
body = m_world.createBody(bd);
body.createFixture(box, 0.5f);
bd.position.set(230.0f, 1.5f);
body = m_world.createBody(bd);
body.createFixture(box, 0.5f);
bd.position.set(230.0f, 2.5f);
body = m_world.createBody(bd);
body.createFixture(box, 0.5f);
bd.position.set(230.0f, 3.5f);
body = m_world.createBody(bd);
body.createFixture(box, 0.5f);
bd.position.set(230.0f, 4.5f);
body = m_world.createBody(bd);
body.createFixture(box, 0.5f);
}
// Car
{
PolygonShape chassis = new PolygonShape();
Vec2[] vertices = new Vec2[8];
vertices[0] = new Vec2(-1.5f, -0.5f);
vertices[1] = new Vec2(1.5f, -0.5f);
vertices[2] = new Vec2(1.5f, 0.0f);
vertices[3] = new Vec2(0.0f, 0.9f);
vertices[4] = new Vec2(-1.15f, 0.9f);
vertices[5] = new Vec2(-1.5f, 0.2f);
chassis.set(vertices, 6);
CircleShape circle = new CircleShape();
circle.m_radius = 0.4f;
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.0f, 1.0f);
m_car = m_world.createBody(bd);
m_car.createFixture(chassis, 1.0f);
FixtureDef fd = new FixtureDef();
fd.shape = circle;
fd.density = 1.0f;
fd.friction = 0.9f;
bd.position.set(-1.0f, 0.35f);
m_wheel1 = m_world.createBody(bd);
m_wheel1.createFixture(fd);
bd.position.set(1.0f, 0.4f);
m_wheel2 = m_world.createBody(bd);
m_wheel2.createFixture(fd);
WheelJointDef jd = new WheelJointDef();
Vec2 axis = new Vec2(0.0f, 1.0f);
jd.initialize(m_car, m_wheel1, m_wheel1.getPosition(), axis);
jd.motorSpeed = 0.0f;
jd.maxMotorTorque = 20.0f;
jd.enableMotor = true;
jd.frequencyHz = m_hz;
jd.dampingRatio = m_zeta;
m_spring1 = (WheelJoint) m_world.createJoint(jd);
jd.initialize(m_car, m_wheel2, m_wheel2.getPosition(), axis);
jd.motorSpeed = 0.0f;
jd.maxMotorTorque = 10.0f;
jd.enableMotor = false;
jd.frequencyHz = m_hz;
jd.dampingRatio = m_zeta;
m_spring2 = (WheelJoint) m_world.createJoint(jd);
}
}
public override void initTest(bool deserialized)
{
m_speed = 3.0f;
if (deserialized)
{
return;
}
Body ground = null;
{
BodyDef bd = new BodyDef();
ground = getWorld().createBody(bd);
EdgeShape shape = new EdgeShape();
shape.set(new Vec2(-20.0f, 0.0f), new Vec2(20.0f, 0.0f));
FixtureDef fd = new FixtureDef();
fd.shape = shape;
ground.createFixture(fd);
}
// Define attachment
{
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.0f, 3.0f);
m_attachment = getWorld().createBody(bd);
PolygonShape shape = new PolygonShape();
shape.setAsBox(0.5f, 2.0f);
m_attachment.createFixture(shape, 2.0f);
}
// Define platform
{
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(-4.0f, 5.0f);
m_platform = getWorld().createBody(bd);
PolygonShape shape = new PolygonShape();
shape.setAsBox(0.5f, 4.0f, new Vec2(4.0f, 0.0f), 0.5f*MathUtils.PI);
FixtureDef fd = new FixtureDef();
fd.shape = shape;
fd.friction = 0.6f;
fd.density = 2.0f;
m_platform.createFixture(fd);
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(m_attachment, m_platform, new Vec2(0.0f, 5.0f));
rjd.maxMotorTorque = 50.0f;
rjd.enableMotor = true;
getWorld().createJoint(rjd);
PrismaticJointDef pjd = new PrismaticJointDef();
pjd.initialize(ground, m_platform, new Vec2(0.0f, 5.0f), new Vec2(1.0f, 0.0f));
pjd.maxMotorForce = 1000.0f;
pjd.enableMotor = true;
pjd.lowerTranslation = -10.0f;
pjd.upperTranslation = 10.0f;
pjd.enableLimit = true;
getWorld().createJoint(pjd);
}
// .create a payload
{
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.0f, 8.0f);
Body body = getWorld().createBody(bd);
PolygonShape shape = new PolygonShape();
shape.setAsBox(0.75f, 0.75f);
FixtureDef fd = new FixtureDef();
fd.shape = shape;
fd.friction = 0.6f;
fd.density = 2.0f;
body.createFixture(fd);
}
}
public override void initTest(bool argDeserialized)
{
Body ground = null;
{
BodyDef bd = new BodyDef();
ground = getWorld().createBody(bd);
EdgeShape shape = new EdgeShape();
shape.set(new Vec2(-40.0f, 0.0f), new Vec2(40.0f, 0.0f));
ground.createFixture(shape, 0.0f);
}
{
Body prevBody = ground;
// Define crank.
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(0.5f, 2.0f);
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.0f, 7.0f);
Body body = getWorld().createBody(bd);
body.createFixture(shape, 2.0f);
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(prevBody, body, new Vec2(0.0f, 5.0f));
rjd.motorSpeed = 1.0f*MathUtils.PI;
rjd.maxMotorTorque = 10000.0f;
rjd.enableMotor = true;
m_joint1 = (RevoluteJoint) getWorld().createJoint(rjd);
prevBody = body;
}
// Define follower.
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(0.5f, 4.0f);
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.0f, 13.0f);
Body body = getWorld().createBody(bd);
body.createFixture(shape, 2.0f);
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(prevBody, body, new Vec2(0.0f, 9.0f));
rjd.enableMotor = false;
getWorld().createJoint(rjd);
prevBody = body;
}
// Define piston
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(1.5f, 1.5f);
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.fixedRotation = true;
bd.position.set(0.0f, 17.0f);
Body body = getWorld().createBody(bd);
body.createFixture(shape, 2.0f);
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(prevBody, body, new Vec2(0.0f, 17.0f));
getWorld().createJoint(rjd);
PrismaticJointDef pjd = new PrismaticJointDef();
pjd.initialize(ground, body, new Vec2(0.0f, 17.0f), new Vec2(0.0f, 1.0f));
pjd.maxMotorForce = 1000.0f;
pjd.enableMotor = false;
m_joint2 = (PrismaticJoint) getWorld().createJoint(pjd);
}
// Create a payload
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(1.5f, 1.5f);
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.0f, 23.0f);
Body body = getWorld().createBody(bd);
body.createFixture(shape, 2.0f);
}
}
}
public override void initTest(bool deserialized)
{
if (deserialized)
{
return;
}
World world = getWorld();
Body ground = null;
{
BodyDef bd = new BodyDef();
ground = getWorld().createBody(bd);
PolygonShape shape = new PolygonShape();
shape.setAsBox(5.0f, 100.0f);
bd = new BodyDef();
bd.type = BodyType.STATIC;
FixtureDef sides = new FixtureDef();
sides.shape = shape;
sides.density = 0;
sides.friction = 0;
sides.restitution = .8f;
sides.filter.categoryBits = 4;
sides.filter.maskBits = 2;
bd.position.set(-10.01f, 50.0f);
Body bod = world.createBody(bd);
bod.createFixture(sides);
bd.position.set(10.01f, 50.0f);
bod = world.createBody(bd);
bod.createFixture(sides);
}
// turney
{
CircleShape cd;
FixtureDef fd = new FixtureDef();
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
int numPieces = 5;
float radius = 4f;
bd.position = new Vec2(0.0f, 25.0f);
Body body = getWorld().createBody(bd);
for (int i = 0; i < numPieces; i++)
{
cd = new CircleShape();
cd.m_radius = .5f;
fd.shape = cd;
fd.density = 25;
fd.friction = .1f;
fd.restitution = .9f;
float xPos = radius*(float) System.Math.Cos(2f*System.Math.PI*(i/(float) (numPieces)));
float yPos = radius*(float) System.Math.Sin(2f*System.Math.PI*(i/(float) (numPieces)));
cd.m_p.set(xPos, yPos);
body.createFixture(fd);
}
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(body, getGroundBody(), body.getPosition());
rjd.motorSpeed = MathUtils.PI;
rjd.maxMotorTorque = 1000000.0f;
rjd.enableMotor = true;
getWorld().createJoint(rjd);
}
{
Body prevBody = ground;
// Define crank.
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(0.5f, 2.0f);
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.0f, 7.0f);
Body body = getWorld().createBody(bd);
body.createFixture(shape, 2.0f);
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(prevBody, body, new Vec2(0.0f, 5.0f));
rjd.motorSpeed = 1.0f*MathUtils.PI;
rjd.maxMotorTorque = 20000;
rjd.enableMotor = true;
getWorld().createJoint(rjd);
prevBody = body;
}
// Define follower.
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(0.5f, 4.0f);
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.0f, 13.0f);
Body body = getWorld().createBody(bd);
body.createFixture(shape, 2.0f);
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(prevBody, body, new Vec2(0.0f, 9.0f));
rjd.enableMotor = false;
getWorld().createJoint(rjd);
prevBody = body;
}
// Define piston
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(7f, 2f);
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.0f, 17.0f);
Body body = getWorld().createBody(bd);
FixtureDef piston = new FixtureDef();
piston.shape = shape;
piston.density = 2;
piston.filter.categoryBits = 1;
piston.filter.maskBits = 2;
body.createFixture(piston);
body.setBullet(false);
RevoluteJointDef rjd = new RevoluteJointDef();
rjd.initialize(prevBody, body, new Vec2(0.0f, 17.0f));
getWorld().createJoint(rjd);
PrismaticJointDef pjd = new PrismaticJointDef();
pjd.initialize(ground, body, new Vec2(0.0f, 17.0f), new Vec2(0.0f, 1.0f));
pjd.maxMotorForce = 1000.0f;
pjd.enableMotor = true;
getWorld().createJoint(pjd);
}
// Create a payload
{
PolygonShape sd = new PolygonShape();
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
FixtureDef fixture = new FixtureDef();
Body body;
for (int i = 0; i < 100; ++i)
{
sd.setAsBox(0.4f, 0.3f);
bd.position.set(-1.0f, 23.0f + i);
bd.bullet = bullet;
body = world.createBody(bd);
fixture.shape = sd;
fixture.density = .1f;
fixture.filter.categoryBits = 2;
fixture.filter.maskBits = 1 | 4 | 2;
body.createFixture(fixture);
}
CircleShape cd = new CircleShape();
cd.m_radius = 0.36f;
for (int i = 0; i < 100; ++i)
{
bd.position.set(1.0f, 23.0f + i);
bd.bullet = bullet;
fixture.shape = cd;
fixture.density = 2f;
fixture.filter.categoryBits = 2;
fixture.filter.maskBits = 1 | 4 | 2;
body = world.createBody(bd);
body.createFixture(fixture);
}
float angle = 0.0f;
float delta = MathUtils.PI/3.0f;
Vec2[] vertices = new Vec2[6];
for (int i = 0; i < 6; ++i)
{
vertices[i] = new Vec2(0.3f*MathUtils.cos(angle), 0.3f*MathUtils.sin(angle));
angle += delta;
}
PolygonShape shape = new PolygonShape();
shape.set(vertices, 6);
for (int i = 0; i < 100; ++i)
{
bd.position.set(0f, 23.0f + i);
bd.type = BodyType.DYNAMIC;
bd.fixedRotation = true;
bd.bullet = bullet;
fixture.shape = shape;
fixture.density = 1f;
fixture.filter.categoryBits = 2;
fixture.filter.maskBits = 1 | 4 | 2;
body = world.createBody(bd);
body.createFixture(fixture);
}
}
}
}
public override void initTest(bool deserialized)
{
if (deserialized)
{
return;
}
Body ground = null;
{
BodyDef bd = new BodyDef();
ground = getWorld().createBody(bd);
EdgeShape shape = new EdgeShape();
shape.set(new Vec2(-40.0f, 0.0f), new Vec2(40.0f, 0.0f));
ground.createFixture(shape, 0.0f);
}
{
PolygonShape shape = new PolygonShape();
shape.setAsBox(0.5f, 0.125f);
FixtureDef fd = new FixtureDef();
fd.shape = shape;
fd.density = 20.0f;
fd.friction = 0.2f;
fd.filter.categoryBits = 0x0001;
fd.filter.maskBits = 0xFFFF & ~0x0002;
RevoluteJointDef jd = new RevoluteJointDef();
jd.collideConnected = false;
int N = 10;
float y = 15.0f;
m_ropeDef = new RopeJointDef();
m_ropeDef.localAnchorA.set(0.0f, y);
Body prevBody = ground;
for (int i = 0; i < N; ++i)
{
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
bd.position.set(0.5f + 1.0f*i, y);
if (i == N - 1)
{
shape.setAsBox(1.5f, 1.5f);
fd.density = 100.0f;
fd.filter.categoryBits = 0x0002;
bd.position.set(1.0f*i, y);
bd.angularDamping = 0.4f;
}
Body body = getWorld().createBody(bd);
body.createFixture(fd);
Vec2 anchor = new Vec2(i, y);
jd.initialize(prevBody, body, anchor);
getWorld().createJoint(jd);
prevBody = body;
}
m_ropeDef.localAnchorB.setZero();
float extraLength = 0.01f;
m_ropeDef.maxLength = N - 1.0f + extraLength;
m_ropeDef.bodyB = prevBody;
}
{
m_ropeDef.bodyA = ground;
m_rope = getWorld().createJoint(m_ropeDef);
}
}
