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=fdb413ee39316b1cbc0652a4e2360c0ceb105b39;hb=5303ddc439764f9263054f519deab7f9f350d561;hp=8f1b9a88bb6b7bf72ea20f866453deea1b76cc2b;hpb=9f84331c9967c88e0e5550ce91f2b7e364a5cb6d;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 8f1b9a88..fdb413ee 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
@@ -462,7 +462,7 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 		}
 		if (this.rotationAngle != null && Math.abs(this.rotationAngle-rotationAngle) < MathTools.NEAR_ZERO)
 			return;
-		if (Objects.equals(rotationAngle, rotationAngle))
+		if (Objects.equals(this.rotationAngle, rotationAngle))
 			return;
 		this.rotationAngle = rotationAngle;
 		firePropertyChanged("rotationAngle");
@@ -855,107 +855,70 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 	 */
 	public Vector3d getPathLegDirection(Direction direction) {
 		if (direction == Direction.NEXT) {
-			if (next != null) {
-				PipeControlPoint pcp = this;
-				if (pcp.isDualInline()) {
-					pcp = pcp.getDualSub();
-				}
-				Vector3d v = new Vector3d();
-				v.sub(next.getWorldPosition(),pcp.getWorldPosition());
-				if (v.lengthSquared() > MathTools.NEAR_ZERO)
-                    v.normalize();
-                else
-                    return null;
-				return v;
-			} else {
-				if (previous == null) {
-					if (!isDirected())
-						throw new RuntimeException("Cannot calculate path leg direction for unconnected control point " + this);
-					return getDirectedControlPointDirection();
+			return getPathLegDirectionNext();
+		} else {
+			return getPathLegDirectionPrevious();
+		}
+	}
 
-				} else {
-					if (isVariableAngle() && !asFixedAngle())
-						throw new RuntimeException("Cannot calculate path leg direction for unconnected variable angle control point " + this);
-					if (isInline()) {
-						PipeControlPoint pcp = this;
-						if (pcp.isDualSub()) {
-							pcp = pcp.getParentPoint();
-						}
-						Vector3d v = new Vector3d();
-						v.sub(pcp.getWorldPosition(),previous.getWorldPosition());
-						if (v.lengthSquared() > MathTools.NEAR_ZERO)
-	                        v.normalize();
-						else
-						    return null;
-						return v;
-					} else if (isDirected()) {
-						return getDirectedControlPointDirection();
-					} else if (isEnd()) {
-						Vector3d v = new Vector3d();
-						v.sub(getWorldPosition(),previous.getWorldPosition());
-						if (v.lengthSquared() > MathTools.NEAR_ZERO)
-                            v.normalize();
-                        else
-                            return null;
-						return v;
-					} else if (isTurn() && asFixedAngle() && !_getReversed()) {
-						return getDirection(Direction.NEXT);
-					}
-					throw new RuntimeException("Missing implementation " + this);
-				}
-			}
+	public Vector3d getPathLegDirectionPrevious() {
+		if (previous != null) {
+			PipeControlPoint pcp = this;
+			if (isDualSub()) 
+				pcp = getParentPoint();
+			Vector3d v = new Vector3d();
+			v.sub(previous.getWorldPosition(),pcp.getWorldPosition());
+			if (v.lengthSquared() > MathTools.NEAR_ZERO)
+		        v.normalize();
+		    else
+		        return null;
+			return v;
+		} else if (isDirected()) {
+			Vector3d v = getDirectedControlPointDirection();
+			v.negate();
+			return v;
+		} else if (next == null)  {
+			throw new RuntimeException("Cannot calculate path leg direction for unconnected control point " + this);
+		} else if (isVariableAngle() && !asFixedAngle()) {
+			throw new RuntimeException("Cannot calculate path leg direction for unconnected variable angle control point " + this);
+		} else if (isInline() || isEnd()) {
+			Vector3d v = getPathLegDirectionNext();
+			if (v != null) v.negate();
+			return v;
+		} else if (isTurn() && asFixedAngle() && _getReversed()) {
+			return getDirection(Direction.PREVIOUS);
 		} else {
-			if (previous != null) {
-				PipeControlPoint pcp = this;
-				if (isDualSub()) 
-					pcp = getParentPoint();
-				Vector3d v = new Vector3d();
-				v.sub(previous.getWorldPosition(),pcp.getWorldPosition());
-				if (v.lengthSquared() > MathTools.NEAR_ZERO)
-                    v.normalize();
-                else
-                    return null;
-				return v;
-			} else {
-				if (next == null)  {
-					if (!isDirected())
-						throw new RuntimeException("Cannot calculate path leg direction for unconnected control point " + this);
-					Vector3d v = getDirectedControlPointDirection();
-					v.negate();
-					return v;
-				} else {
-					if (isVariableAngle() && !asFixedAngle())
-						throw new RuntimeException("Cannot calculate path leg direction for unconnected variable angle control point " + this);
-					if (isInline()) {
-						PipeControlPoint pcp = this;
-						if (pcp.isDualInline()) {
-							pcp = pcp.getDualSub();
-						}
-						Vector3d v = new Vector3d();
-						v.sub(pcp.getWorldPosition(),next.getWorldPosition());
-						if (v.lengthSquared() > MathTools.NEAR_ZERO)
-                            v.normalize();
-                        else
-                            return null;
-						return v;
-					} else if (isDirected()) {
-						Vector3d v = getDirectedControlPointDirection();
-						v.negate();
-						return v;
-					} else if (isEnd()) {
-						Vector3d v = new Vector3d();
-						v.sub(getWorldPosition(),next.getWorldPosition());
-						if (v.lengthSquared() > MathTools.NEAR_ZERO)
-                            v.normalize();
-                        else
-                            return null;
-						return v;
-					} else if (isTurn() && asFixedAngle() && _getReversed()) {
-						return getDirection(Direction.PREVIOUS);
-					}
-					throw new RuntimeException("Missing implementation " + this);
-				}
+			throw new RuntimeException("Missing implementation " + this);
+		}
+	}
+
+	public Vector3d getPathLegDirectionNext() {
+		if (next != null) {
+			PipeControlPoint pcp = this;
+			if (pcp.isDualInline()) {
+				pcp = pcp.getDualSub();
 			}
+			Vector3d v = new Vector3d();
+			v.sub(next.getWorldPosition(),pcp.getWorldPosition());
+			if (v.lengthSquared() > MathTools.NEAR_ZERO)
+		        v.normalize();
+		    else
+		        return null;
+			return v;
+		} else if (isDirected()) {
+			return getDirectedControlPointDirection();
+		} else if (previous == null) {
+			throw new RuntimeException("Cannot calculate path leg direction for unconnected control point " + this);
+		} else if (isVariableAngle() && !asFixedAngle()) {
+			throw new RuntimeException("Cannot calculate path leg direction for unconnected variable angle control point " + this);
+		} else if (isInline() || isEnd()) {
+			Vector3d v = getPathLegDirectionPrevious();
+			if (v != null) v.negate();
+			return v;
+		} else if (isTurn() && asFixedAngle() && !_getReversed()) {
+			return getDirection(Direction.NEXT);
+		} else {
+			throw new RuntimeException("Missing implementation " + this);
 		}
 	}
 
@@ -1448,6 +1411,7 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
             
             PipeRun previousRun = previous.getPipeRun();
             nextPipeRun.setPipeDiameter(previousRun.getPipeDiameter());
+            nextPipeRun.setPipeThickness(previousRun.getPipeThickness());
             nextPipeRun.setTurnRadiusArray(previousRun.getTurnRadiusArray());
             
             PipelineComponent n = next.getPipelineComponent();
@@ -1650,6 +1614,21 @@ public class PipeControlPoint extends G3DNode implements IP3DNode {
 		updateSubPoint();
 	}
 
+	public void orientToDirection(Vector3d dir) {
+		Double angleO = getRotationAngle();
+		double angle = 0.0;
+		if (angleO != null)
+			angle = angleO;
+		boolean reversed = _getReversed();
+		Quat4d q = null;
+		if (dir != null) {
+		    q = getControlPointOrientationQuat(dir, angle, reversed);
+		} else {
+		    q = getControlPointOrientationQuat(angle, reversed);
+		}
+		setWorldOrientation(q);
+	}
+
 	@Override
 	public String toString() {
 		return getClass().getName() + "@" + Integer.toHexString(hashCode());