1 // Copyright (C) 2014-2017 CEA/DEN, EDF R&D
3 // This library is free software; you can redistribute it and/or
4 // modify it under the terms of the GNU Lesser General Public
5 // License as published by the Free Software Foundation; either
6 // version 2.1 of the License, or (at your option) any later version.
8 // This library is distributed in the hope that it will be useful,
9 // but WITHOUT ANY WARRANTY; without even the implied warranty of
10 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 // Lesser General Public License for more details.
13 // You should have received a copy of the GNU Lesser General Public
14 // License along with this library; if not, write to the Free Software
15 // Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
17 // See http://www.salome-platform.org/ or
18 // email : webmaster.salome@opencascade.com<mailto:webmaster.salome@opencascade.com>
21 #include "GeomAlgoAPI_Rotation.h"
23 #include <GeomAPI_XYZ.h>
25 #include <BRepBuilderAPI_Transform.hxx>
31 #include <Precision.hxx>
33 //=================================================================================================
34 GeomAlgoAPI_Rotation::GeomAlgoAPI_Rotation(std::shared_ptr<GeomAPI_Shape> theSourceShape,
35 std::shared_ptr<GeomAPI_Ax1> theAxis,
38 myMethodType = BY_ANGLE;
39 mySourceShape = theSourceShape;
45 //=================================================================================================
46 GeomAlgoAPI_Rotation::GeomAlgoAPI_Rotation(std::shared_ptr<GeomAPI_Shape> theSourceShape,
47 std::shared_ptr<GeomAPI_Pnt> theCenterPoint,
48 std::shared_ptr<GeomAPI_Pnt> theStartPoint,
49 std::shared_ptr<GeomAPI_Pnt> theEndPoint)
51 myMethodType = BY_POINTS;
52 mySourceShape = theSourceShape;
53 myCenterPoint = theCenterPoint;
54 myStartPoint = theStartPoint;
55 myEndPoint = theEndPoint;
58 //=================================================================================================
59 bool GeomAlgoAPI_Rotation::check()
61 switch (myMethodType) {
64 myError = "Rotation builder :: axis is not valid.";
68 myError = "Rotation builder :: source shape is not valid.";
75 myError = "Rotation builder :: center point is not valid.";
79 myError = "Rotation builder :: start point is not valid.";
83 myError = "Rotation builder :: end point is not valid.";
87 myError = "Rotation builder :: source shape is not valid.";
90 if(myCenterPoint->distance(myStartPoint) < Precision::Confusion()) {
91 myError = "Rotation builder :: center point and start point coincide.";
94 if(myCenterPoint->distance(myEndPoint) < Precision::Confusion()) {
95 myError = "Rotation builder :: center point and end point coincide.";
98 if(myStartPoint->distance(myEndPoint) < Precision::Confusion()) {
99 myError = "Rotation builder :: start point and end point coincide.";
102 std::shared_ptr<GeomAPI_XYZ> aCenterPointXYZ = myCenterPoint->xyz();
103 std::shared_ptr<GeomAPI_XYZ> aStartPointXYZ = myStartPoint->xyz();
104 std::shared_ptr<GeomAPI_XYZ> aEndPointXYZ = myEndPoint->xyz();
105 std::shared_ptr<GeomAPI_XYZ> vectCenterPointStartPoint =
106 aStartPointXYZ->decreased(aCenterPointXYZ);
107 std::shared_ptr<GeomAPI_XYZ> vectCenterPointEndPoint =
108 aEndPointXYZ->decreased(aCenterPointXYZ);
109 std::shared_ptr<GeomAPI_XYZ> crossProduct =
110 vectCenterPointStartPoint->cross(vectCenterPointEndPoint);
111 std::shared_ptr<GeomAPI_Pnt> aOriginPnt =
112 std::shared_ptr<GeomAPI_Pnt>(new GeomAPI_Pnt(0.,0.,0.));
113 std::shared_ptr<GeomAPI_XYZ> aOriginXYZ = aOriginPnt->xyz();
115 if (crossProduct->distance(aOriginXYZ) < Precision::Confusion()) {
116 myError = "Rotation builder :: center point, start point and end point are on a line.";
122 myError = "Rotation builder :: method not implemented.";
128 //=================================================================================================
129 void GeomAlgoAPI_Rotation::build()
131 gp_Trsf* aTrsf = new gp_Trsf();
133 switch (myMethodType) {
135 const gp_Ax1& anAxis = myAxis->impl<gp_Ax1>();
136 aTrsf->SetRotation(anAxis, myAngle/180.0*M_PI);
140 const gp_Pnt& aCenterPoint = myCenterPoint->impl<gp_Pnt>();
141 const gp_Pnt& aStartPoint = myStartPoint->impl<gp_Pnt>();
142 const gp_Pnt& aEndPoint = myEndPoint->impl<gp_Pnt>();
143 gp_Vec aVec1(aCenterPoint, aStartPoint);
144 gp_Vec aVec2(aCenterPoint, aEndPoint);
145 gp_Dir aDir(aVec1^aVec2);
146 gp_Ax1 anAxis(aCenterPoint, aDir);
147 double anAngle = aVec1.Angle(aVec2);
148 if (fabs(anAngle) < Precision::Angular()) anAngle += 2.*M_PI;
149 aTrsf->SetRotation(anAxis, anAngle);
153 myError = "Rotation builder :: method not supported";
158 const TopoDS_Shape& aSourceShape = mySourceShape->impl<TopoDS_Shape>();
160 if(aSourceShape.IsNull()) {
161 myError = "Rotation builder :: source shape does not contain any actual shape.";
165 // Transform the shape while copying it.
166 BRepBuilderAPI_Transform* aBuilder = new BRepBuilderAPI_Transform(aSourceShape, *aTrsf, true);
168 myError = "Rotation builder :: transform initialization failed.";
173 setBuilderType(OCCT_BRepBuilderAPI_MakeShape);
175 if(!aBuilder->IsDone()) {
176 myError = "Rotation builder :: algorithm failed.";
180 TopoDS_Shape aResult = aBuilder->Shape();
182 std::shared_ptr<GeomAPI_Shape> aShape(new GeomAPI_Shape());
183 aShape->setImpl(new TopoDS_Shape(aResult));