blob: 9dcb480bb18ad17c582d2443fb70f554ee377a2e [file] [log] [blame]
/*
* Copyright John E. Lloyd, 2003. All rights reserved. Permission
* to use, copy, and modify, without fee, is granted for non-commercial
* and research purposes, provided that this copyright notice appears
* in all copies.
*
* This software is distributed "as is", without any warranty, including
* any implied warranty of merchantability or fitness for a particular
* use. The authors assume no responsibility for, and shall not be liable
* for, any special, indirect, or consequential damages, or any damages
* whatsoever, arising out of or in connection with the use of this
* software.
*/
package org.eclipse.apogy.common.math.quickhull3d;
import javax.vecmath.Vector3d;
/**
* Basic triangular face used to form the hull.
*
* <p>
* The information stored for each face consists of a planar normal, a planar
* offset, and a doubly-linked list of three <a href=HalfEdge>HalfEdges</a>
* which surround the face in a counter-clockwise direction.
*
* @author John E. Lloyd, Fall 2004
*/
class Face {
HalfEdge he0;
private final Vector3d normal;
double area;
private final Vector3d centroid;
double planeOffset;
int index;
int numVerts;
Face next;
static final int VISIBLE = 1;
static final int NON_CONVEX = 2;
static final int DELETED = 3;
int mark = VISIBLE;
Vertex outside;
public void computeCentroid(Vector3d centroid) {
centroid.x = 0.0;
centroid.y = 0.0;
centroid.z = 0.0;
HalfEdge he = this.he0;
do {
centroid.add(he.head().pnt);
he = he.next;
} while (he != this.he0);
centroid.scale(1 / (double) this.numVerts);
}
public void computeNormal(Vector3d normal, double minArea) {
computeNormal(normal);
if (this.area < minArea) {
// make the normal more robust by removing
// components parallel to the longest edge
HalfEdge hedgeMax = null;
double lenSqrMax = 0;
HalfEdge hedge = this.he0;
do {
double lenSqr = hedge.lengthSquared();
if (lenSqr > lenSqrMax) {
hedgeMax = hedge;
lenSqrMax = lenSqr;
}
hedge = hedge.next;
} while (hedge != this.he0);
Vector3d p2 = hedgeMax.head().pnt;
Vector3d p1 = hedgeMax.tail().pnt;
double lenMax = Math.sqrt(lenSqrMax);
double ux = (p2.x - p1.x) / lenMax;
double uy = (p2.y - p1.y) / lenMax;
double uz = (p2.z - p1.z) / lenMax;
double dot = normal.x * ux + normal.y * uy + normal.z * uz;
normal.x -= dot * ux;
normal.y -= dot * uy;
normal.z -= dot * uz;
normal.normalize();
}
}
public void computeNormal(Vector3d normal) {
HalfEdge he1 = this.he0.next;
HalfEdge he2 = he1.next;
Vector3d p0 = this.he0.head().pnt;
Vector3d p2 = he1.head().pnt;
double d2x = p2.x - p0.x;
double d2y = p2.y - p0.y;
double d2z = p2.z - p0.z;
normal.x = 0.0;
normal.y = 0.0;
normal.z = 0.0;
this.numVerts = 2;
while (he2 != this.he0) {
double d1x = d2x;
double d1y = d2y;
double d1z = d2z;
p2 = he2.head().pnt;
d2x = p2.x - p0.x;
d2y = p2.y - p0.y;
d2z = p2.z - p0.z;
normal.x += d1y * d2z - d1z * d2y;
normal.y += d1z * d2x - d1x * d2z;
normal.z += d1x * d2y - d1y * d2x;
he1 = he2;
he2 = he2.next;
this.numVerts++;
}
this.area = normal.length();
normal.scale(1 / this.area);
}
private void computeNormalAndCentroid() {
computeNormal(this.normal);
computeCentroid(this.centroid);
this.planeOffset = this.normal.dot(new Vector3d(this.centroid));
int numv = 0;
HalfEdge he = this.he0;
do {
numv++;
he = he.next;
} while (he != this.he0);
if (numv != this.numVerts) {
throw new InternalErrorException(
"face " + getVertexString() + " numVerts=" + this.numVerts + " should be " + numv);
}
}
private void computeNormalAndCentroid(double minArea) {
computeNormal(this.normal, minArea);
computeCentroid(this.centroid);
this.planeOffset = this.normal.dot(new Vector3d(this.centroid));
}
public static Face createTriangle(Vertex v0, Vertex v1, Vertex v2) {
return createTriangle(v0, v1, v2, 0);
}
/**
* Constructs a triangule Face from vertices v0, v1, and v2.
*
* @param v0 first vertex
* @param v1 second vertex
* @param v2 third vertex
*/
public static Face createTriangle(Vertex v0, Vertex v1, Vertex v2, double minArea) {
Face face = new Face();
HalfEdge he0 = new HalfEdge(v0, face);
HalfEdge he1 = new HalfEdge(v1, face);
HalfEdge he2 = new HalfEdge(v2, face);
he0.prev = he2;
he0.next = he1;
he1.prev = he0;
he1.next = he2;
he2.prev = he1;
he2.next = he0;
face.he0 = he0;
// compute the normal and offset
face.computeNormalAndCentroid(minArea);
return face;
}
public static Face create(Vertex[] vtxArray, int[] indices) {
Face face = new Face();
HalfEdge hePrev = null;
for (int i = 0; i < indices.length; i++) {
HalfEdge he = new HalfEdge(vtxArray[indices[i]], face);
if (hePrev != null) {
he.setPrev(hePrev);
hePrev.setNext(he);
} else {
face.he0 = he;
}
hePrev = he;
}
face.he0.setPrev(hePrev);
hePrev.setNext(face.he0);
// compute the normal and offset
face.computeNormalAndCentroid();
return face;
}
public Face() {
this.normal = new Vector3d();
this.centroid = new Vector3d();
this.mark = VISIBLE;
}
/**
* Gets the i-th half-edge associated with the face.
*
* @param i the half-edge index, in the range 0-2.
* @return the half-edge
*/
public HalfEdge getEdge(int i) {
HalfEdge he = this.he0;
while (i > 0) {
he = he.next;
i--;
}
while (i < 0) {
he = he.prev;
i++;
}
return he;
}
public HalfEdge getFirstEdge() {
return this.he0;
}
/**
* Finds the half-edge within this face which has tail <code>vt</code> and head
* <code>vh</code>.
*
* @param vt tail point
* @param vh head point
* @return the half-edge, or null if none is found.
*/
public HalfEdge findEdge(Vertex vt, Vertex vh) {
HalfEdge he = this.he0;
do {
if (he.head() == vh && he.tail() == vt) {
return he;
}
he = he.next;
} while (he != this.he0);
return null;
}
/**
* Computes the distance from a point p to the plane of this face.
*
* @param p the point
* @return distance from the point to the plane
*/
public double distanceToPlane(Vector3d p) {
return this.normal.x * p.x + this.normal.y * p.y + this.normal.z * p.z - this.planeOffset;
}
/**
* Returns the normal of the plane associated with this face.
*
* @return the planar normal
*/
public Vector3d getNormal() {
return this.normal;
}
public Vector3d getCentroid() {
return this.centroid;
}
public int numVertices() {
return this.numVerts;
}
public String getVertexString() {
String s = null;
HalfEdge he = this.he0;
do {
if (s == null) {
s = "" + he.head().index;
} else {
s += " " + he.head().index;
}
he = he.next;
} while (he != this.he0);
return s;
}
public void getVertexIndices(int[] idxs) {
HalfEdge he = this.he0;
int i = 0;
do {
idxs[i++] = he.head().index;
he = he.next;
} while (he != this.he0);
}
private Face connectHalfEdges(HalfEdge hedgePrev, HalfEdge hedge) {
Face discardedFace = null;
if (hedgePrev.oppositeFace() == hedge.oppositeFace()) { // then there is
// a redundant
// edge that we
// can get rid
// off
Face oppFace = hedge.oppositeFace();
HalfEdge hedgeOpp;
if (hedgePrev == this.he0) {
this.he0 = hedge;
}
if (oppFace.numVertices() == 3) { // then we can get rid of the
// opposite face altogether
hedgeOpp = hedge.getOpposite().prev.getOpposite();
oppFace.mark = DELETED;
discardedFace = oppFace;
} else {
hedgeOpp = hedge.getOpposite().next;
if (oppFace.he0 == hedgeOpp.prev) {
oppFace.he0 = hedgeOpp;
}
hedgeOpp.prev = hedgeOpp.prev.prev;
hedgeOpp.prev.next = hedgeOpp;
}
hedge.prev = hedgePrev.prev;
hedge.prev.next = hedge;
hedge.opposite = hedgeOpp;
hedgeOpp.opposite = hedge;
// oppFace was modified, so need to recompute
oppFace.computeNormalAndCentroid();
} else {
hedgePrev.next = hedge;
hedge.prev = hedgePrev;
}
return discardedFace;
}
void checkConsistency() {
// do a sanity check on the face
HalfEdge hedge = this.he0;
double maxd = 0;
int numv = 0;
if (this.numVerts < 3) {
throw new InternalErrorException("degenerate face: " + getVertexString());
}
do {
HalfEdge hedgeOpp = hedge.getOpposite();
if (hedgeOpp == null) {
throw new InternalErrorException(
"face " + getVertexString() + ": " + "unreflected half edge " + hedge.getVertexString());
} else if (hedgeOpp.getOpposite() != hedge) {
throw new InternalErrorException("face " + getVertexString() + ": " + "opposite half edge "
+ hedgeOpp.getVertexString() + " has opposite " + hedgeOpp.getOpposite().getVertexString());
}
if (hedgeOpp.head() != hedge.tail() || hedge.head() != hedgeOpp.tail()) {
throw new InternalErrorException("face " + getVertexString() + ": " + "half edge "
+ hedge.getVertexString() + " reflected by " + hedgeOpp.getVertexString());
}
Face oppFace = hedgeOpp.face;
if (oppFace == null) {
throw new InternalErrorException(
"face " + getVertexString() + ": " + "no face on half edge " + hedgeOpp.getVertexString());
} else if (oppFace.mark == DELETED) {
throw new InternalErrorException("face " + getVertexString() + ": " + "opposite face "
+ oppFace.getVertexString() + " not on hull");
}
double d = Math.abs(distanceToPlane(hedge.head().pnt));
if (d > maxd) {
maxd = d;
}
numv++;
hedge = hedge.next;
} while (hedge != this.he0);
if (numv != this.numVerts) {
throw new InternalErrorException(
"face " + getVertexString() + " numVerts=" + this.numVerts + " should be " + numv);
}
}
public int mergeAdjacentFace(HalfEdge hedgeAdj, Face[] discarded) {
Face oppFace = hedgeAdj.oppositeFace();
int numDiscarded = 0;
discarded[numDiscarded++] = oppFace;
oppFace.mark = DELETED;
HalfEdge hedgeOpp = hedgeAdj.getOpposite();
HalfEdge hedgeAdjPrev = hedgeAdj.prev;
HalfEdge hedgeAdjNext = hedgeAdj.next;
HalfEdge hedgeOppPrev = hedgeOpp.prev;
HalfEdge hedgeOppNext = hedgeOpp.next;
while (hedgeAdjPrev.oppositeFace() == oppFace) {
hedgeAdjPrev = hedgeAdjPrev.prev;
hedgeOppNext = hedgeOppNext.next;
}
while (hedgeAdjNext.oppositeFace() == oppFace) {
hedgeOppPrev = hedgeOppPrev.prev;
hedgeAdjNext = hedgeAdjNext.next;
}
HalfEdge hedge;
for (hedge = hedgeOppNext; hedge != hedgeOppPrev.next; hedge = hedge.next) {
hedge.face = this;
}
if (hedgeAdj == this.he0) {
this.he0 = hedgeAdjNext;
}
// handle the half edges at the head
Face discardedFace;
discardedFace = connectHalfEdges(hedgeOppPrev, hedgeAdjNext);
if (discardedFace != null) {
discarded[numDiscarded++] = discardedFace;
}
// handle the half edges at the tail
discardedFace = connectHalfEdges(hedgeAdjPrev, hedgeOppNext);
if (discardedFace != null) {
discarded[numDiscarded++] = discardedFace;
}
computeNormalAndCentroid();
checkConsistency();
return numDiscarded;
}
public void triangulate(FaceList newFaces, double minArea) {
HalfEdge hedge;
if (numVertices() < 4) {
return;
}
Vertex v0 = this.he0.head();
hedge = this.he0.next;
HalfEdge oppPrev = hedge.opposite;
Face face0 = null;
for (hedge = hedge.next; hedge != this.he0.prev; hedge = hedge.next) {
Face face = createTriangle(v0, hedge.prev.head(), hedge.head(), minArea);
face.he0.next.setOpposite(oppPrev);
face.he0.prev.setOpposite(hedge.opposite);
oppPrev = face.he0;
newFaces.add(face);
if (face0 == null) {
face0 = face;
}
}
hedge = new HalfEdge(this.he0.prev.prev.head(), this);
hedge.setOpposite(oppPrev);
hedge.prev = this.he0;
hedge.prev.next = hedge;
hedge.next = this.he0.prev;
hedge.next.prev = hedge;
computeNormalAndCentroid(minArea);
checkConsistency();
for (Face face = face0; face != null; face = face.next) {
face.checkConsistency();
}
}
}