protected static UVertexList deltaVectors3(UVertexList input) { UVertexList dl = new UVertexList(); boolean isClosed = input.isClosed(); for (int i = 0; i < input.size(); i++) { UVertex vv = null, vn = null, vp = null; vv = input.get(i); if (i > 0) vp = input.get(i - 1); if (i == 0 && isClosed) vp = input.last(); if (i < input.size() - 1) vn = input.get(i + 1); else if (isClosed) vn = input.first(); if (vn != null) vn = vn.copy().sub(vv); // .norm(); if (vp != null) vp = vv.copy().sub(vp); // .norm(); if (vp != null && vn != null) vv = vn.add(vp).mult(0.5f); else if (vn == null) vv = vp; else vv = vn; log( i + "/" + input.size() + " " + isClosed + " vp=" + (vp != null) + " vn=" + (vn != null) + " " + vv.str()); dl.add(vv); // if(i<input.size()-1) { // tmp=input.get(i+1).copy().sub(input.get(i)).norm(); // if(i>0) tmp.add( // input.get(i).copy().sub(input.get(i-1)).norm()).mult(0.5f); // } // else tmp=input.get(i).copy().sub(input.get(i-1)); // dl.add(tmp); } return dl; }
public void init() { if (main.nav == null) main.nav = new UNav3D(); UVertex v = new UVertex(1000, 0, 0); f = new UFace().set(v.copy(), v.copy().rotY(120 * DEG_TO_RAD), v.copy().rotY(240 * DEG_TO_RAD)); f.reverse(); UVertex.rotX(f.getV(), PI / 6); UVertex.rotZ(f.getV(), PI * 0.33f); UMB.log(f.getV()); f.rotX(f.rnd(TWO_PI)).rotZ(f.rnd(TWO_PI)); fv = UIntersections.faceYPlane(f, 0); lines = null; UMB.log(UMB.str(fv, ' ', null)); plane = UGeoGenerator.meshPlane(2000, 2000, 20).rotX(HALF_PI); }
private void initHeading(UVertex thedir) { this.dir = thedir.copy().norm(); if (is2D) { angle2D = dir.angleXY(); return; } Vector3D v = toVector(dir); // System.out.println(v.getX()+" "+v.getY()+" "+v.getZ()); rot = new Rotation(v, new Vector3D(0, 0, 1)); // -UConst.HALF_PI); // rot=new Rotation(order,dir.x,dir.y,dir.z); }
/** * Aligns and scales a UGeo instance so that the result geometry lies along the vector given by * the input vertices. <code>geo</code> is assumed to be facing "forward" along the positive Z * axis and will be scaled along that axis to match the length of the input vector, leaving the X * and Y dimensions unchanged. * * @param geo * @param v1 * @param v2 * @return */ public static UGeo align(UGeo geo, UVertex v1, UVertex v2, float extend) { UVertex dir = v2.copy().sub(v1); UHeading h = new UHeading(dir); // UMB.log(dir.mag()+" "+geo.dimZ()); float m = dir.mag(); if (extend > 0) m += extend * 2; geo.center().scale(1, 1, m / geo.dimZ()); h.align(geo.getV()); geo.translate(dir.mult(0.5f).add(v1)); return geo; }