//Create vertex structure for creation of decomposition polygon (use the translated vertices)
float xArr[] = new float[vertices.length];
float yArr[] = new float[vertices.length];
for (int i = 0; i < vertices.length; i++) {
Vertex v = vertices[i];
xArr[i] = v.x;
yArr[i] = v.y;
}
//Create a polygon too see if its simple and eventually decompose it
org.jbox2d.util.nonconvex.Polygon myPoly = new org.jbox2d.util.nonconvex.Polygon(xArr, yArr);
PolygonDef pd = new PolygonDef();
if (density != 0.0f){
pd.density = density;
pd.friction = friction;
pd.restitution = restituion;
}
//Create polygon body
BodyDef dymBodyDef = new BodyDef();
// dymBodyDef.position = new Vec2(position.x /worldScale, position.y /worldScale);
dymBodyDef.position = new Vec2(position.x , position.y );
this.bodyDefB4CreationCallback(dymBodyDef);
this.body = world.createBody(dymBodyDef);
// GluTrianglulator triangulator = new GluTrianglulator(applet);
// List<Vertex> physicsTris = triangulator.tesselate(vertices, GLU.GLU_TESS_WINDING_NONZERO);
// Vertex[] triangulatedBodyVerts = physicsTris.toArray(new Vertex[physicsTris.size()]);
// triangulator.deleteTess();
// //Set the triangulated vertices as the polygons (mesh's) vertices
// this.setGeometryInfo(new GeometryInfo(applet, triangulatedBodyVerts));
//Decompose poly and add verts to phys body if possible
int success = org.jbox2d.util.nonconvex.Polygon.decomposeConvexAndAddTo(myPoly, this.body, pd);
if (success != -1){
System.out.println("-> Ear clipping SUCCESSFUL -> Using triangulated and polygonized shape for b2d.");
this.body.setMassFromShapes();
this.body.setUserData(this);
this.setUserData("box2d", this.body); //TODO rename userData
//Performance hit! but prevents object from sticking to another sometimes
// theBody.setBullet(true);
}else{
System.out.println("-> Ear clipping had an ERROR - trying again by triangulating shape for b2d with GLU-Triangulator");
// GluTrianglulator triangulator = new GluTrianglulator(app);
// List<Vertex> physicsTris = triangulator.tesselate(bodyVerts, GLU.GLU_TESS_WINDING_NONZERO);
// Vertex[] triangulatedBodyVerts = physicsTris.toArray(new Vertex[physicsTris.size()]);
//System.out.println("GLU tris created: " + triangulatedBodyVerts.length);
//Cap the max triangles - dont use anymore triangles for the physics body..
int cap = 400;
if (triangulatedBodyVerts.length > cap){
//System.err.println("OVER cap! -> capping!");
Vertex[] tmp = new Vertex[cap];
System.arraycopy(triangulatedBodyVerts, 0, tmp, 0, cap);
triangulatedBodyVerts = tmp;
}
//Create polygon body
world.destroyBody(this.body);
dymBodyDef = new BodyDef();
dymBodyDef.position = new Vec2(position.x, position.y);
this.bodyDefB4CreationCallback(dymBodyDef);
this.body = world.createBody(dymBodyDef);
for (int i = 0; i < triangulatedBodyVerts.length/3; i++) {
//Create polygon definition
PolygonDef polyDef = new PolygonDef();
if (density != 0.0f){
polyDef.density = density;
polyDef.friction = friction;
polyDef.restitution = restituion;
}
this.polyDefB4CreationCallback(polyDef); //FIXME TEST
//Add triangle vertices
Vertex vertex1 = triangulatedBodyVerts[i*3];
Vertex vertex2 = triangulatedBodyVerts[i*3+1];
Vertex vertex3 = triangulatedBodyVerts[i*3+2];
polyDef.addVertex(new Vec2(vertex1.x, vertex1.y));
polyDef.addVertex(new Vec2(vertex2.x, vertex2.y));
polyDef.addVertex(new Vec2(vertex3.x, vertex3.y));
//Add poly to body
this.body.createShape(polyDef);