1 // Copyright (C) 2014-20xx CEA/DEN, EDF R&D
3 // File: GeomAPI_Circ2d.cpp
4 // Created: 29 May 2014
5 // Author: Artem ZHIDKOV
7 #include <GeomAPI_Circ2d.h>
8 #include <GeomAPI_Pnt2d.h>
9 #include <GeomAPI_Dir2d.h>
11 #include <gp_Dir2d.hxx>
12 #include <gp_Circ2d.hxx>
13 #include <gp_Pnt2d.hxx>
14 #include <gp_Ax2d.hxx>
15 #include <GeomLib_Tool.hxx>
16 #include <Geom2d_Circle.hxx>
17 #include <Geom2dAPI_ProjectPointOnCurve.hxx>
18 #include <Precision.hxx>
20 #include <IntAna2d_AnaIntersection.hxx>
22 #define MY_CIRC2D implPtr<gp_Circ2d>()
24 static gp_Circ2d* newCirc2d(const double theCenterX, const double theCenterY, const gp_Dir2d theDir,
25 const double theRadius)
27 gp_Pnt2d aCenter(theCenterX, theCenterY);
28 return new gp_Circ2d(gp_Ax2d(aCenter, theDir), theRadius);
31 static gp_Circ2d* newCirc2d(const double theCenterX, const double theCenterY,
32 const double thePointX, const double thePointY)
34 gp_Pnt2d aCenter(theCenterX, theCenterY);
35 gp_Pnt2d aPoint(thePointX, thePointY);
37 double aRadius = aCenter.Distance(aPoint);
39 if (aCenter.IsEqual(aPoint, Precision::Confusion()))
42 gp_Dir2d aDir(theCenterX - thePointX, theCenterY - thePointY);
44 return newCirc2d(theCenterX, theCenterY, aDir, aRadius);
47 static gp_Circ2d* newCirc2d(const std::shared_ptr<GeomAPI_Pnt2d>& theFirstPoint,
48 const std::shared_ptr<GeomAPI_Pnt2d>& theSecondPoint,
49 const std::shared_ptr<GeomAPI_Pnt2d>& theThirdPoint)
51 gp_XY aFirstPnt(theFirstPoint->x(), theFirstPoint->y());
52 gp_XY aSecondPnt(theSecondPoint->x(), theSecondPoint->y());
53 gp_XY aThirdPnt(theThirdPoint->x(), theThirdPoint->y());
55 gp_XY aVec12 = aSecondPnt - aFirstPnt;
56 gp_XY aVec23 = aThirdPnt - aSecondPnt;
57 gp_XY aVec31 = aFirstPnt - aThirdPnt;
58 // square of parallelogram
59 double aSquare2 = aVec12.Crossed(aVec23);
60 aSquare2 *= aSquare2 * 2.0;
61 if (aSquare2 < 1.e-20)
63 // coefficients to calculate center
64 double aCoeff1 = aVec23.Dot(aVec23) / aSquare2 * aVec12.Dot(aVec31.Reversed());
65 double aCoeff2 = aVec31.Dot(aVec31) / aSquare2 * aVec23.Dot(aVec12.Reversed());
66 double aCoeff3 = aVec12.Dot(aVec12) / aSquare2 * aVec31.Dot(aVec23.Reversed());
68 gp_XY aCenter = aFirstPnt * aCoeff1 + aSecondPnt * aCoeff2 + aThirdPnt * aCoeff3;
70 double aRadius = (aFirstPnt - aCenter).Modulus();
72 gp_Dir2d aDir(aFirstPnt - aCenter);
73 return newCirc2d(aCenter.X(), aCenter.Y(), aDir, aRadius);
76 GeomAPI_Circ2d::GeomAPI_Circ2d(const std::shared_ptr<GeomAPI_Pnt2d>& theCenter,
77 const std::shared_ptr<GeomAPI_Pnt2d>& theCirclePoint)
79 newCirc2d(theCenter->x(), theCenter->y(), theCirclePoint->x(), theCirclePoint->y()))
83 GeomAPI_Circ2d::GeomAPI_Circ2d(const std::shared_ptr<GeomAPI_Pnt2d>& theCenter,
84 const std::shared_ptr<GeomAPI_Dir2d>& theDir, double theRadius)
86 newCirc2d(theCenter->x(), theCenter->y(), theDir->impl<gp_Dir2d>(), theRadius))
90 GeomAPI_Circ2d::GeomAPI_Circ2d(const std::shared_ptr<GeomAPI_Pnt2d>& theFirstPoint,
91 const std::shared_ptr<GeomAPI_Pnt2d>& theSecondPoint,
92 const std::shared_ptr<GeomAPI_Pnt2d>& theThirdPoint)
93 : GeomAPI_Interface(newCirc2d(theFirstPoint, theSecondPoint, theThirdPoint))
97 const std::shared_ptr<GeomAPI_Pnt2d> GeomAPI_Circ2d::project(
98 const std::shared_ptr<GeomAPI_Pnt2d>& thePoint) const
100 std::shared_ptr<GeomAPI_Pnt2d> aResult;
104 const gp_Pnt2d& aCenter = MY_CIRC2D->Location();
105 const gp_Pnt2d& aPoint = thePoint->impl<gp_Pnt2d>();
107 double aDist = aCenter.Distance(aPoint);
108 if (aDist < Precision::Confusion())
111 if (Abs(aDist - MY_CIRC2D->Radius()) < Precision::Confusion()) {
112 // Point on the circle
113 aResult = std::shared_ptr<GeomAPI_Pnt2d>(
114 new GeomAPI_Pnt2d(thePoint->x(), thePoint->y()));
116 gp_Dir2d aDir(aPoint.XY() - aCenter.XY());
117 gp_XY aNewPoint = aCenter.XY() + aDir.XY() * MY_CIRC2D->Radius();
118 aResult = std::shared_ptr<GeomAPI_Pnt2d>(
119 new GeomAPI_Pnt2d(aNewPoint.X(), aNewPoint.Y()));
125 const std::shared_ptr<GeomAPI_Pnt2d> GeomAPI_Circ2d::center() const
128 return std::shared_ptr<GeomAPI_Pnt2d>();
129 const gp_Pnt2d& aCenter = MY_CIRC2D->Location();
130 return std::shared_ptr<GeomAPI_Pnt2d>(new GeomAPI_Pnt2d(aCenter.X(), aCenter.Y()));
133 double GeomAPI_Circ2d::radius() const
137 return MY_CIRC2D->Radius();
140 //=================================================================================================
141 const bool GeomAPI_Circ2d::parameter(const std::shared_ptr<GeomAPI_Pnt2d> thePoint,
142 const double theTolerance,
143 double& theParameter) const
145 Handle(Geom2d_Circle) aCurve = new Geom2d_Circle(*MY_CIRC2D);
146 return GeomLib_Tool::Parameter(aCurve, thePoint->impl<gp_Pnt2d>(), theTolerance, theParameter) == Standard_True;
149 //=================================================================================================
150 void GeomAPI_Circ2d::D0(const double theU, std::shared_ptr<GeomAPI_Pnt2d>& thePoint)
152 Handle(Geom2d_Circle) aCurve = new Geom2d_Circle(*MY_CIRC2D);
154 aCurve->D0(theU, aPnt);
155 thePoint.reset(new GeomAPI_Pnt2d(aPnt.X(), aPnt.Y()));