X-Git-Url: https://gerrit.simantics.org/r/gitweb?a=blobdiff_plain;f=org.simantics.plant3d%2Fsrc%2Forg%2Fsimantics%2Fplant3d%2Fscenegraph%2Fcontrolpoint%2FPipeControlPoint.java;h=b14b298bcf26d0060ea91ec09521f740fc596b45;hb=refs%2Fchanges%2F29%2F3029%2F1;hp=02bce62246e8748612ac72f7e2b64afae4da06de;hpb=22bb24d2a7e26c70b0dd4c57080f2c25ac3d40a8;p=simantics%2F3d.git

diff --git a/org.simantics.plant3d/src/org/simantics/plant3d/scenegraph/controlpoint/PipeControlPoint.java b/org.simantics.plant3d/src/org/simantics/plant3d/scenegraph/controlpoint/PipeControlPoint.java
index 02bce622..b14b298b 100644
--- a/org.simantics.plant3d/src/org/simantics/plant3d/scenegraph/controlpoint/PipeControlPoint.java
+++ b/org.simantics.plant3d/src/org/simantics/plant3d/scenegraph/controlpoint/PipeControlPoint.java
@@ -1,6 +1,7 @@
 package org.simantics.plant3d.scenegraph.controlpoint;
 
 import java.util.ArrayList;
+import java.util.Arrays;
 import java.util.Collection;
 import java.util.List;
 
@@ -30,6 +31,7 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 	
 	private Type type;
 	private boolean fixed = true;
+	private boolean rotate = false;
 	private boolean deletable = true;
 	private boolean sub = false;
 	
@@ -81,6 +83,16 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 		this.fixed = fixed;
 	}
 	
+	@GetPropertyValue(name="Rotate",tabId="Debug",value="rotate")
+	public boolean isRotate() {
+		return rotate;
+	}
+	
+	
+	public void setRotate(boolean rotate) {
+		this.rotate = rotate;
+	}
+	
 	public void setSub(boolean sub) {
 		this.sub = sub;
 	}
@@ -173,7 +185,9 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 				component.setNext(next != null ? next.component : null);
 			else
 				component.setBranch0(next != null ? next.component : null);
+			updateSubPoint();
 		}
+		
 	}
 	
 	public void setPrevious(PipeControlPoint previous) {
@@ -182,11 +196,14 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 //		if (previous != null && getPipeRun() == null)
 //			throw new RuntimeException("Cannot connect control point befor piperun has been set");
 		this.previous = previous;
-		if (component != null)
+		if (component != null) {
 			if (parent == null || sub)
 				component.setPrevious(previous != null ? previous.component : null);
 			else
 				component.setBranch0(previous != null ? previous.component : null);
+			updateSubPoint();
+		}
+		
 	}
 	
 	public PipeControlPoint parent;
@@ -287,10 +304,24 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 	}
 	
 	public Vector3d getSizeChangeOffsetVector(Vector3d dir) {
+		Quat4d q;
 		if (rotationAngle == null)
-			rotationAngle = 0.0;
-		Quat4d q = getControlPointOrientationQuat(dir, rotationAngle);
-		Vector3d v = new Vector3d(0.0,0.0,offset);
+			q = getControlPointOrientationQuat(dir, 0.0);
+		else
+			q = getControlPointOrientationQuat(dir, rotationAngle);
+		Vector3d v = new Vector3d(0.0,offset,0.0);
+    	Vector3d offset = new Vector3d();
+    	MathTools.rotate(q, v, offset);
+    	return offset;
+	}
+	
+	public Vector3d getSizeChangeOffsetVector() {
+		Quat4d q;
+		if (rotationAngle == null)
+			q = getControlPointOrientationQuat(0.0);
+		else
+			q = getControlPointOrientationQuat(rotationAngle);
+		Vector3d v = new Vector3d(0.0,offset,0.0);
     	Vector3d offset = new Vector3d();
     	MathTools.rotate(q, v, offset);
     	return offset;
@@ -310,6 +341,18 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 		return previous.toString();
 	}
 	
+	@GetPropertyValue(name="Sub",tabId="Debug",value="sub")
+	private String getSubString() {
+		if (children.size() == 0)
+			return "";
+		return Arrays.toString(children.toArray());
+	}
+	
+	@GetPropertyValue(name="Type",tabId="Debug",value="type")
+	public String getTypeString() {
+		return type.name();
+	}
+	
 	 public Quat4d getControlPointOrientationQuat(double angle) {
 		 
 		 if (turnAxis == null) {
@@ -547,8 +590,12 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 					
 				} else {
 					if (isInline()) {
+						PipeControlPoint pcp = this;
+						if (pcp.isDualSub()) {
+							pcp = pcp.getParentPoint();
+						}
 						Vector3d v = new Vector3d();
-						v.sub(getWorldPosition(),previous.getWorldPosition());
+						v.sub(pcp.getWorldPosition(),previous.getWorldPosition());
 						return v;
 					} else if (isDirected()) {
 						return getDirectedControlPointDirection();
@@ -579,8 +626,12 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 					return v;
 				} else {
 					if (isInline()) {
+						PipeControlPoint pcp = this;
+						if (pcp.isDualInline()) {
+							pcp = pcp.getSubPoint().get(0);
+						}
 						Vector3d v = new Vector3d();
-						v.sub(getWorldPosition(),next.getWorldPosition());
+						v.sub(pcp.getWorldPosition(),next.getWorldPosition());
 						return v;
 					} else if (isDirected()) {
 						Vector3d v = getDirectedControlPointDirection();
@@ -980,6 +1031,15 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 		p1.remChild(ocp);
 		p2.remChild(sccp);
 		
+		// TODO : now we assume that this is size change, and we do
+		if (ocp.next != null)
+			ocp.next.setPrevious(null);
+		if (ocp.previous != null)
+			ocp.previous.setNext(null);
+		if (sccp.next != null)
+			sccp.next.setPrevious(null);
+		if (sccp.previous != null)
+			sccp.previous.setNext(null);
 		ocp.setNext(null);
 		ocp.setPrevious(null);
 		sccp.setNext(null);
@@ -1021,6 +1081,7 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 		}
 		PipelineComponent comp = component;
 		component = null;
+		
 		comp.remove();
 	}
 	
@@ -1031,22 +1092,41 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 		super.setOrientation(orientation);
 		if (getParentPoint() == null && component != null)
 			component._setWorldOrientation(getWorldOrientation());
-		for (PipeControlPoint sub : getSubPoint()) {
-			sub.setWorldPosition(getWorldPosition());
-			sub.setWorldOrientation(getWorldOrientation());
-		}
+		updateSubPoint();
 	}
 	
 	@Override
 	public void setPosition(Vector3d position) {
 		if (MathTools.equals(position, getPosition()))
 			return;
+		if (Double.isNaN(position.x) || Double.isNaN(position.y) || Double.isNaN(position.z))
+			throw new IllegalArgumentException("NaN is not supported");
 		super.setPosition(position);
 		if (getParentPoint() == null && component != null)
 			component._setWorldPosition(getWorldPosition());
-		for (PipeControlPoint sub : getSubPoint()) {
-			sub.setWorldPosition(getWorldPosition());
-			sub.setWorldOrientation(getWorldOrientation());
+		updateSubPoint();
+	}
+	
+	private void updateSubPoint() {
+		if (isOffset()) {
+			if (next == null && previous == null) {
+				for (PipeControlPoint sub : getSubPoint()) {
+					sub.setWorldPosition(getWorldPosition());
+					sub.setWorldOrientation(getWorldOrientation());
+				}
+				return;
+			}
+			for (PipeControlPoint sub : getSubPoint()) {
+				Vector3d wp = getWorldPosition();
+				wp.add(getSizeChangeOffsetVector());
+				sub.setWorldPosition(wp);
+				sub.setWorldOrientation(getWorldOrientation());
+			}
+		} else {
+			for (PipeControlPoint sub : getSubPoint()) {
+				sub.setWorldPosition(getWorldPosition());
+				sub.setWorldOrientation(getWorldOrientation());
+			}
 		}
 	}
 
@@ -1054,19 +1134,13 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 	public void _setWorldPosition(Vector3d position) {
 		Vector3d localPos = getLocalPosition(position);
 		super.setPosition(localPos);
-		for (PipeControlPoint sub : getSubPoint()) {
-			sub.setWorldPosition(getWorldPosition());
-			sub.setWorldOrientation(getWorldOrientation());
-		}
+		updateSubPoint();
 	}
 	
 	public void _setWorldOrientation(Quat4d orientation) {
 		Quat4d localOr = getLocalOrientation(orientation);
 		super.setOrientation(localOr);
-		for (PipeControlPoint sub : getSubPoint()) {
-			sub.setWorldPosition(getWorldPosition());
-			sub.setWorldOrientation(getWorldOrientation());
-		}
+		updateSubPoint();
 	}
 	
 	@Override