public void SetCircle3Points(Point[] p) { PointDbl[] dblArray = new PointDbl[3]; PointDbl dbl3 = new PointDbl(p[0]); dblArray[0] = dbl3; PointDbl dbl2 = new PointDbl(p[1]); dblArray[1] = dbl2; PointDbl dbl = new PointDbl(p[2]); dblArray[2] = dbl; CircleInfo info = CGM2SVGMath.FindCircleBy3Points(dblArray); if (info.R >= 0.0) { this.center.X = new decimal(info.Center.X); this.center.Y = new decimal(info.Center.Y); this.SetCircleDiameters(info.R, Math2.CompareAngles(Convert.ToDouble(decimal.Subtract(p[2].X, p[0].X)), Convert.ToDouble(decimal.Subtract(p[2].Y, p[0].Y)), Convert.ToDouble(decimal.Subtract(p[1].X, p[0].X)), Convert.ToDouble(decimal.Subtract(p[1].Y, p[0].Y))) < 0.0); this.v1.X = decimal.Subtract(p[0].X, this.center.X); this.v1.Y = decimal.Subtract(p[0].Y, this.center.Y); this.v2.X = decimal.Subtract(p[2].X, this.center.X); this.v2.Y = decimal.Subtract(p[2].Y, this.center.Y); } else { this.collinearCoords = true; this.center = p[1]; this.SetCircleDiameters(Math2.Distance(Convert.ToDouble(decimal.Subtract(p[0].X, this.center.X)), Convert.ToDouble(decimal.Subtract(p[2].X, this.center.X))), false); this.v1.X = decimal.Subtract(p[0].X, this.center.X); this.v1.Y = decimal.Subtract(p[0].Y, this.center.Y); this.v2.X = decimal.Subtract(p[2].X, this.center.X); this.v2.Y = decimal.Subtract(p[2].Y, this.center.Y); } }
// Methods public static CircleInfo FindCircleBy3Points(PointDbl[] p) { CircleInfo info = new CircleInfo();//TODO if (Math2.IsNul(Math2.CompareAngles(p[0].X - p[1].X, p[0].Y - p[1].Y, p[2].X - p[1].X, p[2].Y - p[1].Y))) { info.R = -1.0; return(info); } double[] numArray = Math2.SolveSystem2(new double[, ] { { 2.0 * (p[0].X - p[2].X), 2.0 * (p[0].Y - p[2].Y) }, { 2.0 * (p[1].X - p[2].X), 2.0 * (p[1].Y - p[2].Y) } }, new double[] { (((p[0].X * p[0].X) - (p[2].X * p[2].X)) + (p[0].Y * p[0].Y)) - (p[2].Y * p[2].Y), (((p[1].X * p[1].X) - (p[2].X * p[2].X)) + (p[1].Y * p[1].Y)) - (p[2].Y * p[2].Y) }); info.Center.X = numArray[0]; info.Center.Y = numArray[1]; info.R = Math2.Distance(p[0].X - numArray[0], p[0].Y - numArray[1]); return(info); }
public static SVGEllipseArc FindSVGArc(PointDbl p, PointDbl p1, PointDbl p2, PointDbl Δstart, PointDbl Δend) { SVGEllipseArc arc2 = new SVGEllipseArc(); arc2.RadiusX = Math2.Distance(p.X, p.Y, p2.X, p2.Y); arc2.RadiusY = Math2.Distance(p.X, p.Y, p1.X, p1.Y); double[,] a = FindEllipseTransformToHorizontal(p, p1, p2); double[,] numArray2 = SpecialInvertMatrix(a); PointDbl dbl3 = new PointDbl(Δstart.X + p.X, Δstart.Y + p.Y); PointDbl dbl2 = TransformPoint(numArray2, dbl3); double introduced10 = Math2.Sqr(dbl2.X / arc2.RadiusX); double num = Math.Sqrt(introduced10 + Math2.Sqr(dbl2.Y / arc2.RadiusY)); dbl2.X /= num; dbl2.Y /= num; dbl3 = new PointDbl(Δend.X + p.X, Δend.Y + p.Y); PointDbl dbl = TransformPoint(numArray2, dbl3); double introduced11 = Math2.Sqr(dbl.X / arc2.RadiusX); double num2 = Math.Sqrt(introduced11 + Math2.Sqr(dbl.Y / arc2.RadiusY)); dbl.X /= num2; dbl.Y /= num2; if (Math2.Is90DegIntersection(p1.X - p.X, p1.Y - p.Y, p2.X - p.X, p2.Y - p.Y)) { arc2.AngleX = Math.Atan2(a[1, 0], a[0, 0]); arc2.StartP = TransformPoint(a, dbl2); arc2.EndP = TransformPoint(a, dbl); arc2.CenterP = p; arc2.SweepFlag = Math2.CompareAngles(p1.X - p.X, p1.Y - p.Y, p2.X - p.X, p2.Y - p.Y) < 0.0; arc2.LargeArc = Math2.CompareAngles(dbl2.X, dbl2.Y, dbl.X, dbl.Y) < 0.0; return(arc2); } arc2.Transform = a; arc2.AngleX = 0.0; arc2.StartP = dbl2; arc2.EndP = dbl; dbl3 = new PointDbl(0.0, 0.0); arc2.CenterP = dbl3; arc2.SweepFlag = false; arc2.LargeArc = Math2.CompareAngles(dbl2.X, dbl2.Y, dbl.X, dbl.Y) < 0.0; return(arc2); }