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); }