internal double[,] GetBestMatrix(int f0, double[] p0, int f1, double[] p1) { // move from (f0,p0) to (f1,p1); point p is on the cell surface. PFace F0 = Faces[f0], F1 = Faces[f1]; if (F0.Base.Id != F1.Base.Id) { return(null); } double[] q0 = PGeom.ApplyInvMatrix(F0.Matrix, p0); double[] q1 = PGeom.ApplyInvMatrix(F1.Matrix, p1); double dbest = double.MaxValue; double[,] mr = null; foreach (double[,] m in F0.Base.SMatrices) { double[] qq = PGeom.ApplyMatrix(m, q0); double v = PGeom.Dist2(qq, q1); if (v < dbest) { dbest = v; mr = m; } } return(PGeom.MatrixMulInv2(F0.Matrix, PGeom.MatrixMul(mr, F1.Matrix))); }
private int FindFace(double[] p, double[,] matr) { p = PGeom.ApplyMatrix(matr, p); int r0 = 0; double d0 = double.MaxValue; foreach (PFace F in Faces) { double v = PGeom.Dist2(p, F.Pole); if (v < d0) { d0 = v; r0 = F.Id; } } return(r0); }
private int FindAxis(double[] dir) { int r0 = 0; double d0 = double.MaxValue; foreach (PAxis Ax in Axes) { double v = PGeom.Dist2(dir, Ax.Dir); if (v < d0) { d0 = v; r0 = Ax.Id + 1; } v = PGeom.Dist2Rev(dir, Ax.Dir); if (v < d0) { d0 = v; r0 = -Ax.Id - 1; } } return(r0); }
private void CutFaces() { double RMax = 0; foreach (PBaseFace F in BaseFaces) { RMax = Math.Max(RMax, PGeom.VLength(F.Pole)); } int minrank = int.MaxValue; foreach (PBaseFace F in BaseFaces) { CutNode face = CutNode.GenCube(Dim, RMax * Dim); double[] hpln = CutNetwork.GetPlane(F.Pole, 1); face.Split(1, hpln, false); face = face.ZeroNode; int opgen = 1; foreach (PFace FF in Faces) { if (F.Id != FF.Id) { hpln = CutNetwork.GetPlane(FF.Pole, 1); face.Split(++opgen, hpln, true); if (face.Status != CutNode.STAT_PLUS) { throw new Exception("Empty face: Id=" + F.Id); } } } int nff = face.Children.Length; double[][] ffpol = new double[nff][]; for (int i = 0; i < nff; i++) { ffpol[i] = face.Children[i].Pole; } F.FPoles = ffpol; LMesh m = new LMesh(Dim, true); face.FillLMesh(++opgen, m); m.CloseCtr(); F.FaceMesh = new PMesh(m); F.FaceMesh.FCtr = F.Pole; double[] verts = m.pts; int nverts = m.npts; CutNetwork CN = new CutNetwork(face, Dim, opgen); double[][] fctrs = null; if (QSimplified) { fctrs = CN.GetCtrs(); } F.AxisLayers = new int[Axes.Length]; for (int u = 0; u < Axes.Length; u++) { PAxis Ax = Axes[u]; double[] D = Ax.Dir; double lD = PGeom.Dist2(D, new double[Dim]); double smin = double.MaxValue, smax = double.MinValue; for (int i = 0; i < nverts; i++) { double v = 0; for (int j = 0; j < Dim; j++) { v += D[j] * verts[i * Dim + j]; } if (v < smin) { smin = v; } if (v > smax) { smax = v; } } smin /= lD; smax /= lD; bool cs = false, cc = false; int k = Ax.Base.NLayers - 1; for (int i = 0; i < Ax.Base.Cut.Length; i++) { double p = Ax.Base.Cut[i]; if (p >= smax - 0.0001) { continue; } if (!cs) { k = i; cs = true; } if (p <= smin + 0.0001) { break; } hpln = CutNetwork.GetPlane(Ax.Dir, p); CN.Split(hpln, false); cc = true; } if (cc) { k = -1; } F.AxisLayers[u] = k; } F.SetStickers(m, CN, Axes, fctrs); minrank = Math.Min(minrank, F.MinRank()); } foreach (PBaseFace F in BaseFaces) { F.SubRank(minrank); } }