- Vector3d up = new Vector3d(0.0, 1.0, 0.0);
- double a = up.angle(getPathLegEndpointVector());
+ final P3DRootNode root = getRoot();
+ Vector3d up = root != null ? new Vector3d(root.getUpVector()) : new Vector3d(0.0, 1.0, 0.0);
+ final Vector3d legDir = getPathLegEndpointVector();
+ double a = up.angle(legDir);