checkpoint
[anneal.git] / src / edu / berkeley / qfat / Mesh.java
index ff9819d..fe5baf7 100644 (file)
@@ -149,14 +149,12 @@ public class Mesh implements Iterable<Mesh.T> {
             quadricStale = false;
             unApplyQuadricToNeighbor();
             Matrix m = Matrix.ZERO;
-            E e = this.e;
             int count = 0;
-            do {
+            for(E e = this.e; e!=null; e=e.pair.next==this.e?null:e.pair.next) {
                 T t = e.t;
                 m = m.plus(t.norm().fundamentalQuadric(t.centroid()));
                 count++;
-                e = e.pair.next;
-            } while(e != this.e);
+            }
             fundamentalQuadric = m.times(1/(float)count);
             applyQuadricToNeighbor();
         }
@@ -199,11 +197,8 @@ public class Mesh implements Iterable<Mesh.T> {
         public void reComputeErrorAround() {
             reComputeError();
             if (nearest_in_other_mesh != null) nearest_in_other_mesh.reComputeError();
-            E e = this.e;
-            do {
+            for(E e = this.e; e!=null; e=e.pair.next==this.e?null:e.pair.next)
                 e.p2.reComputeError();
-                e = e.pair.next;
-            } while (e != this.e);
         }
         public void reComputeError() {
             unComputeError();
@@ -234,24 +229,21 @@ public class Mesh implements Iterable<Mesh.T> {
 
             int numaspects = 0;
             float aspects = 0;
-            E e = this.e;
-            do {
+            for(E e = this.e; e!=null; e=e.pair.next==this.e?null:e.pair.next) {
                 //double ang = Math.abs(e.crossAngle());
                 double ang = Math.abs(e.crossAngle());
                 if (ang > Math.PI) throw new Error();
                 /*
-                if (e.t != null) {
-                    numaspects++;
-                    aspects += e.t.aspect()*e.t.aspect();
-                }
+                  if (e.t != null) {
+                  numaspects++;
+                  aspects += e.t.aspect()*e.t.aspect();
+                  }
                 */
 
                 float minangle = (float)(Math.PI * 0.8);
                 if (ang > minangle)
                     oldscore += (ang - minangle);
-
-                e = e.pair.next;
-            } while (e != this.e);
+        }
             if (numaspects > 0) oldscore += (aspects / numaspects);
 
             //System.out.println(oldscore);
@@ -260,80 +252,58 @@ public class Mesh implements Iterable<Mesh.T> {
         }
 
         private void removeTrianglesFromRTree() {
-            E e = this.e;
-            do {
+            for(E e = this.e; e!=null; e=e.pair.next==this.e?null:e.pair.next)
                 if (e.t != null) e.t.removeFromRTree();
-                e = e.pair.next;
-            } while(e != this.e);
         }
         private void addTrianglesToRTree() {
-            E e = this.e;
-            do {
+            for(E e = this.e; e!=null; e=e.pair.next==this.e?null:e.pair.next)
                 if (e.t != null) e.t.addToRTree();
-                e = e.pair.next;
-            } while(e != this.e);
         }
 
         /** does NOT update bound pairs! */
         public boolean transform(Matrix m) {
             if (immutableVertices) throw new Error();
+
             unApplyQuadricToNeighbor();
             Point oldp = this.p;
-            try {
-                if (vertices.get(this.p)==null) throw new Error();
-                vertices.remove(this);
-                removeTrianglesFromRTree();
-                float newx = m.a*p.x + m.b*p.y + m.c*p.z + m.d;
-                float newy = m.e*p.x + m.f*p.y + m.g*p.z + m.h;
-                float newz = m.i*p.x + m.j*p.y + m.k*p.z + m.l;
-                this.p = new Point(newx, newy, newz);
-                addTrianglesToRTree();
-                vertices.add(this);
-            } catch (Exception e) {
-                throw new RuntimeException(e);
-            }
+
+            if (vertices.get(this.p)==null) throw new Error();
+            vertices.remove(this);
+            removeTrianglesFromRTree();
+            float newx = m.a*p.x + m.b*p.y + m.c*p.z + m.d;
+            float newy = m.e*p.x + m.f*p.y + m.g*p.z + m.h;
+            float newz = m.i*p.x + m.j*p.y + m.k*p.z + m.l;
+            this.p = new Point(newx, newy, newz);
+            addTrianglesToRTree();
+            vertices.add(this);
+
             applyQuadricToNeighbor();
 
-            // FIXME: intersection test needed?
             good = true;
 
-            // should recompute fundamental quadrics of all vertices sharing a face, but we defer...
-            E e = this.e;
-            do {
-                /*
-                if (Math.abs(e.crossAngle()) > (Math.PI * 0.9) ||
-                    Math.abs(e.next.crossAngle()) > (Math.PI * 0.9)) {
-                    good = false;
-                }
-                if (e.t.aspect() < 0.1) {
-                    good = false;
-                }
-                */
+            for(E e = this.e; e!=null; e=e.pair.next==this.e?null:e.pair.next) {
+                if (Math.abs(e.crossAngle()) > (Math.PI * 0.9) || Math.abs(e.next.crossAngle()) > (Math.PI * 0.9)) good = false;
+                if (e.t.aspect() < 0.1) good = false;
                 e.p2.quadricStale = true;
-                e = e.pair.next;
-            } while(e != this.e);
-
-            if (!ignorecollision && good) triangles.range(new Segment(oldp, this.p), this);
-
+            }
 
+            if (!ignorecollision && good) triangles.range(oldp, this.p, (Visitor<T>)this);
 
             reComputeErrorAround();
             return good;
         }
 
-    public void visit(T t) {
-        if (!good) return;
-        E e = Vertex.this.e;
-        do {
-            if (!t.has(e.p1) && !t.has(e.p2) && e.intersects(t)) { good = false; }
-            if (e.t != null) {
-                if (!e.t.has(t.e1().p1) && !e.t.has(t.e1().p2) && t.e1().intersects(e.t)) { good = false; }
-                if (!e.t.has(t.e2().p1) && !e.t.has(t.e2().p2) && t.e2().intersects(e.t)) { good = false; }
-                if (!e.t.has(t.e3().p1) && !e.t.has(t.e3().p2) && t.e3().intersects(e.t)) { good = false; }
+        public void visit(T t) {
+            if (!good) return;
+            for(E e = Vertex.this.e; e!=null; e=e.pair.next==Vertex.this.e?null:e.pair.next) {
+                if (!t.has(e.p1) && !t.has(e.p2) && e.intersects(t)) { good = false; }
+                if (e.t != null) {
+                    if (!e.t.has(t.e1().p1) && !e.t.has(t.e1().p2) && t.e1().intersects(e.t)) { good = false; }
+                    if (!e.t.has(t.e2().p1) && !e.t.has(t.e2().p2) && t.e2().intersects(e.t)) { good = false; }
+                    if (!e.t.has(t.e3().p1) && !e.t.has(t.e3().p2) && t.e3().intersects(e.t)) { good = false; }
+                }
             }
-            e = e.pair.next;
-        } while(e != Vertex.this.e);
-    }
+        }
         private boolean good;
 
         public boolean move(Vec v) {
@@ -474,15 +444,15 @@ public class Mesh implements Iterable<Mesh.T> {
             Vertex nearest = score_against.nearest(midpoint());
             //if (t==null) return length();
             /*
-            double ang = Math.abs(crossAngle());
-            float minangle = (float)(Math.PI * 0.9);
-            if (ang > minangle)
-                return 300;
+              double ang = Math.abs(crossAngle());
+              float minangle = (float)(Math.PI * 0.9);
+              if (ang > minangle)
+              return 300;
             */
             /*
-            if ((length() * length()) / t.area() > 10)
-                return (float)(length()*Math.sqrt(t.area()));
-            return length()*t.area();
+              if ((length() * length()) / t.area() > 10)
+              return (float)(length()*Math.sqrt(t.area()));
+              return length()*t.area();
             */
             return (float)Math.max(length(), midpoint().distance(nearest.p));
             //return length();