Added rotation by three points.

[modules/shaper.git] / src / GeomAPI / GeomAPI_Trsf.cpp

diff --git a/src/GeomAPI/GeomAPI_Trsf.cpp b/src/GeomAPI/GeomAPI_Trsf.cpp
index 701e0bdff3871f59b88cfac9ae5a972b780f2424..7246364f13031cf51b8f097f38c69c3be94be06e 100644 (file)
--- a/src/GeomAPI/GeomAPI_Trsf.cpp
+++ b/src/GeomAPI/GeomAPI_Trsf.cpp
@@ -59,6 +59,25 @@ void GeomAPI_Trsf::setRotation(const std::shared_ptr<GeomAPI_Ax1> theAxis,
   MY_TRSF->SetRotation(theAxis->impl<gp_Ax1>(), theAngle / 180.0 * M_PI);
 }
 
+//=================================================================================================
+void GeomAPI_Trsf::setRotation(const std::shared_ptr<GeomAPI_Pnt> theCenterPoint,
+                               const std::shared_ptr<GeomAPI_Pnt> theStartPoint,
+                               const std::shared_ptr<GeomAPI_Pnt> theEndPoint)
+{
+  gp_Pnt aCenterPoint = theCenterPoint->impl<gp_Pnt>();
+  gp_Pnt aStartPoint = theStartPoint->impl<gp_Pnt>();
+  gp_Pnt aEndPoint = theEndPoint->impl<gp_Pnt>();
+
+  gp_Vec aVec1(aCenterPoint, aStartPoint);
+  gp_Vec aVec2(aCenterPoint, aEndPoint);
+  gp_Dir aDir(aVec1 ^ aVec2);
+  gp_Ax1 anAxis(aCenterPoint, aDir);
+  double anAngle = aVec1.Angle(aVec2);
+  if (fabs(anAngle) < Precision::Angular()) anAngle += 2.*M_PI; // Taken from old GEOM code
+
+  MY_TRSF->SetRotation(anAxis, anAngle);
+}
+
 //=================================================================================================
 void GeomAPI_Trsf::setSymmetry(const std::shared_ptr<GeomAPI_Pnt> thePoint)
 {