checkpoint

[anneal.git] / src / edu / berkeley / qfat / geom / HasBindingGroup.java

diff --git a/src/edu/berkeley/qfat/geom/HasBindingGroup.java b/src/edu/berkeley/qfat/geom/HasBindingGroup.java
index fc12a29..65d581f 100644 (file)
--- a/src/edu/berkeley/qfat/geom/HasBindingGroup.java
+++ b/src/edu/berkeley/qfat/geom/HasBindingGroup.java
@@ -1,10 +1,11 @@
 package edu.berkeley.qfat.geom;
 import javax.media.opengl.*;
 import java.util.*;
+import edu.berkeley.qfat.Mesh;
 
 public abstract class HasBindingGroup {
 
-    BindingGroup bindingGroup;
+    public BindingGroup bindingGroup;
 
     // know:      self   = bindingGroup[self] * master
     // know:      other  = other.bindingGroup[other] * other.bindingGroup.master
@@ -16,26 +17,47 @@ public abstract class HasBindingGroup {
         if (other.bindingGroup == null) other.bindingGroup = new BindingGroup(other);
 
         if (other.bindingGroup == this.bindingGroup) {
-            if (getBindingMatrix(other).equals(bindingMatrix)) return;
-            throw new Error("rebind attempt: "+this+" and "+other+" with "
-                            + bindingMatrix
-                            + "; expected "
-                            + getBindingMatrix(other));
+            if (getBindingMatrix(other).equals(bindingMatrix))
+                return;
+            /*
+            if (this instanceof Mesh.E)
+                throw new Error("rebind attempt: "+this+" and "+other+" with "
+                                + bindingMatrix
+                                + "; expected "
+                                + getBindingMatrix(other));
+            */
+            setConstraint(bindingMatrix);
+            /*
+              System.err.println("WARNING: discarding rebind attempt: "+this+" and "+other+m);
+            */
+            //" with "
+            //+ bindingMatrix
+            //+ "; expected "
+            //+ getBindingMatrix(other));
+            return;
         }
 
+
         bindingMatrix =
-            getBindingMatrix()
+            getBindingMatrix().inverse()
             .times(bindingMatrix)
             .times(other.getBindingMatrix());
         other.bindingGroup.merge(bindingGroup, bindingMatrix);
     }
 
+    public int bindingGroupSize() {
+        if (bindingGroup == null) return 1;
+        return bindingGroup.size();
+    }
+
+
     public Matrix getBindingMatrix() {
         if (bindingGroup==null) return Matrix.ONE;
         return bindingGroup.getMatrix(this);
     }
 
     public Matrix getBindingMatrix(HasBindingGroup other) {
+        if (other==this) return Matrix.ONE;
         return bindingGroup.getMatrix(this, other);
     }
 
@@ -44,6 +66,17 @@ public abstract class HasBindingGroup {
         return bindingGroup.getMaster();
     }
 
+    public Matrix getConstraint() {
+        if (bindingGroup==null) return Matrix.ONE;
+        Matrix v = getBindingMatrix(getMaster());
+        return v.inverse().times(bindingGroup.krank).times(v);
+    }
+    public void setConstraint(Matrix m) {
+        if (bindingGroup==null) bindingGroup = new BindingGroup(this);
+        Matrix v = getBindingMatrix(getMaster());
+        bindingGroup.krank = bindingGroup.krank.times(v.inverse().times(m).times(v));
+    }
+
     public void unbind() {
         if (bindingGroup==null) return;
         bindingGroup.unbind(this);
@@ -52,7 +85,7 @@ public abstract class HasBindingGroup {
     }
 
     public boolean isBoundTo(HasBindingGroup t) {
-        return bindingGroup.contains(t);
+        return t==this || (bindingGroup!=null && bindingGroup.contains(t));
     }
 
     public Iterable getBoundPeers() {