private Body initPhysicsBody(World world, float x, float y) {
BodyDef bodyDef = new BodyDef();
bodyDef.type = BodyType.DYNAMIC;
bodyDef.position = new Vec2(0, 0);
Body body = world.createBody(bodyDef);
PolygonShape shape = new PolygonShape();
Transform fx = new Transform();
fx.position.set(100f, 100f);
shape.centroid(fx);
shape.setAsBox(
sprite.layer().width() * GameScreen.M_PER_PIXEL / 2,
sprite.layer().height() * GameScreen.M_PER_PIXEL / 2);
FixtureDef fixtureDef = new FixtureDef();
fixtureDef.shape = shape;
fixtureDef.density = 0.4f;
fixtureDef.friction = 0.1f;
fixtureDef.restitution = 0f;
body.createFixture(fixtureDef);
body.setLinearDamping(0.2f);
body.setTransform(new Vec2(x, y), 0f);
// MassData md = body.getMassData();
// massD.center.set(2f, 0); body.setMassData(massD);
return body;
}
public void addAreaObject(String worldname, String objname, LayoutArea area, ObjectProps props) {
Box2dData data = this.mBox2dWorlds.get(worldname);
if (data == null) {
return;
}
// Dynamic Body
BodyDef bodyDef = new BodyDef();
bodyDef.type = BodyType.DYNAMIC;
bodyDef.position.set(area.mLocation[0], area.mLocation[1]);
Body body = data.mWorld.createBody(bodyDef);
FixtureDef fixtureDef = new FixtureDef();
PolygonShape dynamicBox = new PolygonShape();
dynamicBox.setAsBox(area.mBounds[0] / 2, area.mBounds[1] / 2);
fixtureDef.shape = dynamicBox;
fixtureDef.density = props.mDensity;
fixtureDef.friction = props.mFriction;
fixtureDef.restitution = props.mRestitution;
// kinematicBody
fixtureDef.filter.groupIndex = props.mGroupIndex;
body.createFixture(fixtureDef);
BodyData bodydata = new BodyData();
bodydata.mArea = area;
bodydata.mBody = body;
bodydata.mProps = props;
area.assignPsyData(bodydata);
data.mAreaModels.add(bodydata);
}
/** 创建多边形物体 */
private void createBody() {
// 定义物体的形状是多边形形状
PolygonShape shape = new PolygonShape();
shape.set(vecs, edge);
// 设置多边形物体的一些固定的物理属性
FixtureDef fd = new FixtureDef();
fd.shape = shape;
// 固定设置参数
fd.density = 5.0f; // 密度
fd.friction = 0.3f; // 摩擦系数
fd.restitution = restitution; // 恢复系数
BodyDef bd = new BodyDef();
bd.position.set(x, y);
bd.type = BodyType.DYNAMIC;
bd.angle = angle;
bd.allowSleep = true;
bd.setAwake(true);
// 根据bodyDef创建物体到世界中
body = world.createBody(bd);
// 设置好物体的固定属性
body.createFixture(fd);
}
public void drawBranch(Branch branch) {
// only draw the branch if it is marked as active
float leafSize =
1.f
+ Main.sqrt(
Main.pow(branch.endX - branch.startX, 2)
+ Main.pow(branch.endY - branch.startY, 2))
/ 160.0f;
if (branch.activeP) {
float alpha = 255.0f;
// if the branch hasn't stopped growing, the alpha is less than 255.0
if (!branch.stoppedGrowing) {
alpha =
255.0f
* (float)
((double) (System.nanoTime() - branch.startGrowTimestamp)
/ (double) Tree.BRANCH_GROW_TIME);
if (alpha >= 255.0f) branch.stoppedGrowing = true;
}
p.stroke(0, 100, 0, alpha);
p.fill(0, 255, 0, alpha);
// Get the shape of the box2d body, and get its coordinates
p.beginShape();
// get the body transform so that we can convert the shape's coordinates to world coordinates
Transform transform = branch.body.getTransform();
Vec2 pos;
for (Fixture f = branch.body.getFixtureList(); f != null; f = f.getNext()) {
PolygonShape shape = (PolygonShape) f.getShape();
for (int i = 0; i < shape.getVertexCount(); i++) {
// apply the transform to the shape coordinates, and
// then convert box2d coordinates to processing coordinates
pos = box2d.coordWorldToPixels(Transform.mul(transform, shape.getVertex(i)));
p.vertex(pos.x, pos.y);
}
}
p.endShape(Main.CLOSE);
// draw leafs after the other branches
p.pushMatrix();
CPoint2 leafPos = branch.getLeafPosition();
p.translate(leafPos.x, leafPos.y);
// p.rotate(leafAngle);
p.rotate(-branch.body.getAngle() + -0.25f * Main.PI); // + Main.PI);
p.noStroke();
p.fill(0, 255, 0, alpha * 0.25f);
p.ellipseMode(Main.CORNER);
float s = 0.0f;
for (int i = 7; i > 2; i--) {
s = leafSize * i;
p.ellipse(0, 0, s, s);
}
p.ellipse(0, 0, s, s);
p.popMatrix();
p.strokeWeight(1.0f);
}
}
public final Shape clone() {
PolygonShape shape = new PolygonShape();
shape.m_centroid.set(this.m_centroid);
for (int i = 0; i < shape.m_normals.length; i++) {
shape.m_normals[i].set(m_normals[i]);
shape.m_vertices[i].set(m_vertices[i]);
}
shape.setRadius(this.getRadius());
shape.m_count = this.m_count;
return shape;
}
public void initWorld() {
Vec2 gravity = new Vec2(0.0f, 9.8f);
world = new World(gravity);
// ground
FixtureDef groundFixtureDef = new FixtureDef();
PolygonShape groundShape = new PolygonShape();
groundShape.setAsBox(20f, 0.1f);
groundFixtureDef.shape = groundShape;
groundFixtureDef.density = 25.0f;
groundFixtureDef.filter = new Filter();
groundFixtureDef.filter.categoryBits = 0x0001;
BodyDef groundBodyDef = new BodyDef();
groundBodyDef.position = new Vec2(0.0f, 3f);
groundBodyDef.angle = 0.0f;
groundBodyDef.type = BodyType.STATIC;
groundBody = world.createBody(groundBodyDef);
groundFixture = groundBody.createFixture(groundFixtureDef);
}
@Test
public void testIsWoundCorrectly() {
PolygonShape shape = new PolygonShape();
Vec2 lineVertices[] = new Vec2[] {new Vec2(-1.0f, -1.0f), new Vec2(1.0f, 1.0f)};
shape.set(lineVertices, lineVertices.length);
assertFalse(GeometryVerifier.IsWoundCorrectly(shape));
Vec2 boxVertices[] =
new Vec2[] {
new Vec2(0.25f, 0.25f),
new Vec2(-0.25f, 0.25f),
new Vec2(-0.25f, -0.25f),
new Vec2(0.25f, -0.25f)
};
shape.set(boxVertices, boxVertices.length);
assertTrue(GeometryVerifier.IsWoundCorrectly(shape));
Vec2 miswoundBoxVertices[] =
new Vec2[] {
new Vec2(0.25f, -0.25f),
new Vec2(-0.25f, -0.25f),
new Vec2(-0.25f, 0.25f),
new Vec2(0.25f, 0.25f)
};
shape.set(miswoundBoxVertices, miswoundBoxVertices.length);
assertFalse(GeometryVerifier.IsWoundCorrectly(shape));
Vec2 potatoVertices[] =
new Vec2[] {
new Vec2(4.0f, 4.0f),
new Vec2(5.0f, 3.0f),
new Vec2(4.0f, 1.0f),
new Vec2(2.0f, 2.0f),
new Vec2(3.0f, 3.0f),
new Vec2(2.0f, 5.0f)
};
shape.set(potatoVertices, potatoVertices.length);
assertFalse(GeometryVerifier.IsWoundCorrectly(shape));
}
public void initTest(boolean argDeserialized) {
if (argDeserialized) {
return;
}
{ // Floor
FixtureDef fd = new FixtureDef();
PolygonShape sd = new PolygonShape();
sd.setAsBox(50.0f, 10.0f);
fd.shape = sd;
BodyDef bd = new BodyDef();
bd.position = new Vec2(0.0f, -10.0f);
getWorld().createBody(bd).createFixture(fd);
}
{ // Platforms
for (int i = 0; i < 4; i++) {
FixtureDef fd = new FixtureDef();
PolygonShape sd = new PolygonShape();
sd.setAsBox(25.0f, 0.125f);
fd.shape = sd;
BodyDef bd = new BodyDef();
bd.position = new Vec2(0.0f, 5f + 5f * i);
getWorld().createBody(bd).createFixture(fd);
}
}
{
FixtureDef fd = new FixtureDef();
PolygonShape sd = new PolygonShape();
sd.setAsBox(0.125f, 2f);
fd.shape = sd;
fd.density = 25.0f;
BodyDef bd = new BodyDef();
bd.type = BodyType.DYNAMIC;
float friction = .5f;
int numPerRow = 25;
for (int i = 0; i < 4; ++i) {
for (int j = 0; j < numPerRow; j++) {
fd.friction = friction;
bd.position = new Vec2(-14.75f + j * (29.5f / (numPerRow - 1)), 7.3f + 5f * i);
if (i == 2 && j == 0) {
bd.angle = -0.1f;
bd.position.x += .1f;
} else if (i == 3 && j == numPerRow - 1) {
bd.angle = .1f;
bd.position.x -= .1f;
} else bd.angle = 0f;
Body myBody = getWorld().createBody(bd);
myBody.createFixture(fd);
}
}
}
}
public void addDynObject(
String worldname, String objname, GameonModelRef ref, ObjectProps props) {
Box2dData data = this.mBox2dWorlds.get(worldname);
if (data == null) {
return;
}
// Dynamic Body
BodyDef bodyDef = new BodyDef();
bodyDef.type = BodyType.DYNAMIC;
bodyDef.position.set(ref.mPosition[0], ref.mPosition[1]);
Body body = data.mWorld.createBody(bodyDef);
FixtureDef fixtureDef = new FixtureDef();
if (props.mShape == SHAPE_BOX) {
PolygonShape dynamicBox = new PolygonShape();
dynamicBox.setAsBox(ref.mScale[0] / 2, ref.mScale[1] / 2);
fixtureDef.shape = dynamicBox;
} else {
CircleShape dynamicCircle = new CircleShape();
dynamicCircle.m_radius = ref.mScale[0] / 2;
fixtureDef.shape = dynamicCircle;
}
fixtureDef.density = props.mDensity;
fixtureDef.friction = props.mFriction;
fixtureDef.restitution = props.mRestitution;
// kinematicBody
fixtureDef.filter.groupIndex = props.mGroupIndex;
body.createFixture(fixtureDef);
BodyData bodydata = new BodyData();
bodydata.mRef = ref;
bodydata.mBody = body;
bodydata.mProps = props;
ref.assignPsyData(bodydata);
data.mDynModels.add(bodydata);
}
// Constructor
Box(PApplet parent, PBox2D box2d, float x, float y, float w_, float h_, boolean lock) {
this.parent = parent;
this.box2d = box2d;
w = w_;
h = h_;
// Define and create the body
BodyDef bd = new BodyDef();
bd.position.set(box2d.coordPixelsToWorld(new Vec2(x, y)));
if (lock) bd.type = BodyType.STATIC;
else bd.type = BodyType.DYNAMIC;
body = box2d.createBody(bd);
// Define the shape -- a (this is what we use for a rectangle)
PolygonShape sd = new PolygonShape();
float box2dW = box2d.scalarPixelsToWorld(w / 2);
float box2dH = box2d.scalarPixelsToWorld(h / 2);
sd.setAsBox(box2dW, box2dH);
// Define a fixture
FixtureDef fd = new FixtureDef();
fd.shape = sd;
// Parameters that affect physics
fd.density = 1;
fd.friction = 0.3f;
fd.restitution = 0.5f;
body.createFixture(fd);
// Give it some initial random velocity
body.setLinearVelocity(new Vec2(parent.random(-5, 5), parent.random(2, 5)));
body.setAngularVelocity(parent.random(-5, 5));
}
public PhysicsObject(float x, float y, int w, int h, BodyType t) {
pos.x = x;
pos.y = y;
height = h;
width = w;
shape = new PolygonShape();
shape.setAsBox(
(width / 2) / PhysicsInvaders.PTM_RATIO, (height / 2) / PhysicsInvaders.PTM_RATIO);
FixtureDef fd = new FixtureDef();
fd.shape = shape;
fd.density = 100;
fd.friction = 0.9f;
fd.restitution = 0.1f;
BodyDef bodyDef = new BodyDef();
bodyDef.position.set(pos.x / PhysicsInvaders.PTM_RATIO, pos.y / PhysicsInvaders.PTM_RATIO);
bodyDef.type = t;
body = PhysicsInvaders.world.createBody(bodyDef);
body.createFixture(fd);
}
public void start() {
Vec2 gravity = new Vec2(0, 0);
World world = new World(gravity);
BodyDef groundBodyDef = new BodyDef();
groundBodyDef.position.set(0, -25);
Body groundBody = world.createBody(groundBodyDef);
PolygonShape groundBox = new PolygonShape();
groundBox.setAsBox(900, 10);
groundBody.createFixture(groundBox, 0);
// Dynamic Body
BodyDef bodyDef = new BodyDef();
bodyDef.type = BodyType.DYNAMIC;
bodyDef.position.set(0, 0);
Body body = world.createBody(bodyDef);
PolygonShape dynamicBox = new PolygonShape();
dynamicBox.setAsBox(12, 12);
FixtureDef fixtureDef = new FixtureDef();
fixtureDef.shape = dynamicBox;
fixtureDef.density = 1f;
fixtureDef.friction = 0.3f;
body.createFixture(fixtureDef);
// Setup world
float timeStep = 1.0f / 60.0f;
int velocityIterations = 6;
int positionIterations = 2;
body.setLinearVelocity(new Vec2(15.0f, -15.0f));
body.setLinearDamping(2f);
Vec2 f = body.getWorldVector(new Vec2(0.0f, -30.0f));
Vec2 p = body.getWorldPoint(body.getLocalCenter().add(new Vec2(-.2f, 0f)));
// body.applyForce(new Vec2(-200,-200),new Vec2(-200,200));
try {
Display.setDisplayMode(new DisplayMode(screen_width, screen_height));
Display.create();
} catch (LWJGLException e) {
e.printStackTrace();
System.exit(0);
}
lastFPS = getTime();
// standardBall[0] = new Ball(400,200,0,12);
// standardBall[1] = new Ball(100,210,2,12);
// standardBall[0].addImpulse(-10,0);
standardBall[0] = new Ball(200, 300, 0, 12);
standardBall[1] = new Ball(415, 100, 2, 12);
standardBall[0].addImpulse(10, -9.99f);
standardBall[2] = new Ball(620, 270, 2, 12);
standardBall[3] = new Ball(640, 290, 2, 12);
standardBall[4] = new Ball(660, 310, 2, 12);
standardBall[5] = new Ball(680, 330, 2, 12);
standardBall[6] = new Ball(620, 230, 2, 12);
standardBall[7] = new Ball(640, 210, 2, 12);
standardBall[8] = new Ball(660, 190, 2, 12);
standardBall[9] = new Ball(680, 170, 2, 12);
standardBall[10] = new Ball(640, 250, 1, 12);
standardBall[11] = new Ball(660, 230, 2, 12);
standardBall[12] = new Ball(660, 270, 2, 12);
standardBall[13] = new Ball(680, 290, 2, 12);
standardBall[14] = new Ball(680, 210, 2, 12);
standardBall[15] = new Ball(680, 250, 2, 12);
standardTable = new Table(0, 0, 800, 400, 25, 15);
// init OpenGL
GL11.glMatrixMode(GL11.GL_PROJECTION);
GL11.glLoadIdentity();
GL11.glOrtho(0, 900, 0, 500, 1, -1);
GL11.glMatrixMode(GL11.GL_MODELVIEW);
while (!Display.isCloseRequested()) {
int delta = getDelta();
world.step(timeStep, velocityIterations, positionIterations);
Vec2 position = body.getPosition();
float angle = body.getAngle();
// System.out.printf("%4.2f %4.2f %4.2f\n", position.x, position.y, angle);
// Clear the screen and depth buffer
GL11.glClear(GL11.GL_COLOR_BUFFER_BIT | GL11.GL_DEPTH_BUFFER_BIT);
standardTable.draw();
for (int i = 0; i < NUMBER_OF_BALLS; i++) {
standardBall[i].draw();
standardBall[i].update(delta);
}
standardBall[0].setX((position.x * 20) + offset_x);
standardBall[0].setY((position.y * 20) + offset_y);
update(delta);
Display.update();
Display.sync(60);
}
Display.destroy();
}
/**
* Sets the shape as a box.
*
* @param x the half-width
* @param y the half-height
*/
void setAsBox(float x, float y) {
mShape.m_type = ShapeType.POLYGON;
mType = Box2DShapeType.BOX;
((PolygonShape) mShape).setAsBox(x, y);
}
@Override
public void initTest(boolean 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, jd1.localAnchorA);
body1.getLocalPointToOut(bd1.position, 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);
}
}
/**
* Rozbije objekt. Upravi objekt world tak, ze vymaze triesteny objekt a nahradi ho fragmentami na
* zaklade nastaveneho materialu a clenskych premennych.
*
* @param dt casova dlzka framu
*/
public void smash(float dt) {
if (contact == null) { // riesi sa staticky prvok, ktory ma priliz maly obsah
b1.setType(BodyType.DYNAMIC);
return;
}
World w = b1.m_world;
Shape s = f1.m_shape;
Polygon p = f1.m_polygon;
if (p == null) {
switch (s.m_type) {
case POLYGON:
PolygonShape ps = (PolygonShape) s;
Vec2[] vertices = ps.m_vertices;
p = new Polygon();
for (int i = 0; i < ps.m_count; ++i) {
p.add(vertices[ps.m_count - i - 1]);
}
break;
case CIRCLE:
CircleShape cs = (CircleShape) s;
p = new Polygon();
float radius = cs.m_radius;
double u = Math.PI * 2 / CIRCLEVERTICES;
radius =
(float) Math.sqrt(u / Math.sin(u))
* radius; // upravim radius tak, aby bola zachovana velkost obsahu
Vec2 center = cs.m_p;
for (int i = 0; i < CIRCLEVERTICES; ++i) {
double j = u * i; // uhol
float sin = (float) Math.sin(j);
float cos = (float) Math.cos(j);
Vec2 v = new Vec2(sin, cos).mulLocal(radius).addLocal(center);
p.add(v);
}
break;
default:
throw new RuntimeException("Dany typ tvaru nepodporuje stiepenie");
}
}
float mConst = f1.m_material.m_rigidity / normalImpulse; // sila v zavislosti na pevnosti telesa
boolean fixA = f1 == contact.m_fixtureA; // true, ak f2 je v objekte contact ako m_fixtureA
float oldAngularVelocity =
fixA ? contact.m_angularVelocity_bodyA : contact.m_angularVelocity_bodyB;
Vec2 oldLinearVelocity = fixA ? contact.m_linearVelocity_bodyA : contact.m_linearVelocity_bodyB;
b1.setAngularVelocity(
(b1.m_angularVelocity - oldAngularVelocity) * mConst + oldAngularVelocity);
b1.setLinearVelocity(
b1.m_linearVelocity.sub(oldLinearVelocity).mulLocal(mConst).addLocal(oldLinearVelocity));
if (!w.isFractured(f2)
&& b2.m_type == BodyType.DYNAMIC
&& !b2.m_fractureTransformUpdate) { // ak sa druhy objekt nerozbija, tak sa jej nahodia
// povodne hodnoty (TREBA MODIFIKOVAT POHYB OBJEKTU,
// KTORY SPOSOBUJE ROZPAD)
oldAngularVelocity =
!fixA ? contact.m_angularVelocity_bodyA : contact.m_angularVelocity_bodyB;
oldLinearVelocity = !fixA ? contact.m_linearVelocity_bodyA : contact.m_linearVelocity_bodyB;
b2.setAngularVelocity(
(b2.m_angularVelocity - oldAngularVelocity) * mConst + oldAngularVelocity);
b2.setLinearVelocity(
b2.m_linearVelocity.sub(oldLinearVelocity).mulLocal(mConst).addLocal(oldLinearVelocity));
b2.setTransform(
b2.m_xf0.p.add(b2.m_linearVelocity.mul(dt)),
b2.m_xf0.q.getAngle()); // osetruje jbox2d od posuvania telesa pri rieseni kolizie
b2.m_fractureTransformUpdate = true;
}
Vec2 localPoint = Transform.mulTrans(b1.m_xf, point);
Vec2 b1Vec = b1.getLinearVelocityFromWorldPoint(point);
Vec2 b2Vec = b2.getLinearVelocityFromWorldPoint(point);
Vec2 localVector = b2Vec.subLocal(b1Vec);
localVector.mulLocal(dt);
Polygon[] fragment;
try {
fragment = m.split(p, localPoint, localVector, normalImpulse); // rodeli to
} catch (RuntimeException ex) {
return;
}
if (fragment.length == 1) { // nerozbilo to na ziadne fragmenty
return;
}
// definuje tela fragmentov - tie maju vsetky rovnaku definiciu (preberaju parametre z povodneho
// objektu)
BodyDef bodyDef = new BodyDef();
bodyDef.position.set(b1.m_xf.p); // pozicia
bodyDef.angle = b1.m_xf.q.getAngle(); // otocenie
bodyDef.fixedRotation = b1.isFixedRotation();
bodyDef.angularDamping = b1.m_angularDamping;
bodyDef.allowSleep = b1.isSleepingAllowed();
FixtureDef fd = new FixtureDef();
fd.friction = f1.m_friction; // trenie
fd.restitution = f1.m_restitution; // odrazivost
fd.isSensor = f1.m_isSensor;
fd.density = f1.m_density;
// odstrani fragmentacne predmety/cele teleso
ArrayList<Fixture> fixtures = new ArrayList<>();
if (f1.m_polygon != null) {
for (Fixture f = b1.m_fixtureList; f != null; f = f.m_next) {
if (f.m_polygon == f1.m_polygon) {
fixtures.add(f);
}
}
} else {
fixtures.add(f1);
}
for (Fixture f : fixtures) {
b1.destroyFixture(f);
}
if (b1.m_fixtureCount == 0) {
w.destroyBody(b1);
}
// prida fragmenty do simulacie
MyList<Body> newbodies = new MyList<>();
for (Polygon pg : fragment) { // vytvori tela, prida fixtury, poriesi konvexnu dekompoziciu
if (pg.isCorrect()) {
if (pg instanceof Fragment) {
Polygon[] convex = pg.convexDecomposition();
bodyDef.type = BodyType.DYNAMIC;
for (Polygon pgx : convex) {
Body f_body = w.createBody(bodyDef);
pgx.flip();
PolygonShape ps = new PolygonShape();
ps.set(pgx.getArray(), pgx.size());
fd.shape = ps;
fd.polygon = null;
fd.material = f1.m_material.m_fragments; // rekurzivne stiepenie
f_body.createFixture(fd);
f_body.setAngularVelocity(b1.m_angularVelocity);
f_body.setLinearVelocity(b1.getLinearVelocityFromLocalPoint(f_body.getLocalCenter()));
newbodies.add(f_body);
}
} else {
fd.material = f1.m_material.m_fragments; // rekurzivne stiepenie
bodyDef.type = b1.getType();
Body f_body = w.createBody(bodyDef);
PolygonFixture pf = new PolygonFixture(pg);
f_body.createFixture(pf, fd);
f_body.setLinearVelocity(b1.getLinearVelocityFromLocalPoint(f_body.getLocalCenter()));
f_body.setAngularVelocity(b1.m_angularVelocity);
newbodies.add(f_body);
}
}
}
// zavola sa funkcia z fraction listeneru (pokial je nadefinovany)
FractureListener fl = w.getContactManager().m_fractureListener;
if (fl != null) {
fl.action(m, normalImpulse, newbodies);
}
}
