-// Copyright (C) 2007-2010 CEA/DEN, EDF R&D, OPEN CASCADE
+// Copyright (C) 2007-2012 CEA/DEN, EDF R&D, OPEN CASCADE
//
-// Copyright (C) 2003-2007 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
-// CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
+// Copyright (C) 2003-2007 OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
+// CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
//
-// This library is free software; you can redistribute it and/or
-// modify it under the terms of the GNU Lesser General Public
-// License as published by the Free Software Foundation; either
-// version 2.1 of the License.
+// This library is free software; you can redistribute it and/or
+// modify it under the terms of the GNU Lesser General Public
+// License as published by the Free Software Foundation; either
+// version 2.1 of the License.
//
-// This library is distributed in the hope that it will be useful,
-// but WITHOUT ANY WARRANTY; without even the implied warranty of
-// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
-// Lesser General Public License for more details.
+// This library is distributed in the hope that it will be useful,
+// but WITHOUT ANY WARRANTY; without even the implied warranty of
+// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+// Lesser General Public License for more details.
//
-// You should have received a copy of the GNU Lesser General Public
-// License along with this library; if not, write to the Free Software
-// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
+// You should have received a copy of the GNU Lesser General Public
+// License along with this library; if not, write to the Free Software
+// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
//
-// See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
+// See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
//
// GEOM SKETCHER : basic sketcher
// File : Sketcher_Profile.cxx
// Author : Damien COQUERET
// Module : GEOM
-// $Header:
-//
+
#include <Standard_Stream.hxx>
#include <Sketcher_Profile.hxx>
first = Standard_True;
stayfirst = face = close = Standard_False;
+ Standard_Integer reversed = 0;
+ Standard_Integer control_Tolerance = 0;
+
TopoDS_Shape S;
TopoDS_Vertex MP;
BRepBuilderAPI_MakeWire MW;
Handle(Geom_Surface) Surface;
myOK = Standard_False;
+ myError = 0;
//TCollection_AsciiString aCommand(CORBA::string_dup(aCmd));
TCollection_AsciiString aCommand ((char*)aCmd);
case 'R':
{
if (n1 != 2) goto badargs;
- angle = a(1).RealValue() * PI180;
+ angle = a(1).RealValue() * M_PI / 180.;
if (a(0) == "RR") {
dx = Cos(angle);
dy = Sin(angle);
if (n1 != 3) goto badargs;
radius = a(1).RealValue();
if (Abs(radius) > Precision::Confusion()) {
- angle = a(2).RealValue() * PI180;
+ angle = a(2).RealValue() * M_PI / 180.;
move = circle;
}
else
move = none;
break;
- }
- case 'A':
- {
+ }
+ case 'A': // TAngential arc by end point
+ {
if (n1 != 3) goto badargs;
- Standard_Real vx = a(1).RealValue();
- Standard_Real vy = a(2).RealValue();
- if (a(0) == "AA") {
+ Standard_Real vx = a(1).RealValue();
+ Standard_Real vy = a(2).RealValue();
+ if (a(0) == "AA") {
vx -= x;
vy -= y;
}
- Standard_Real det = (dx * vy - dy * vx);
- if ( Abs(det) > Precision::Confusion()) {
- Standard_Real c = (dx * vx + dy * vy) // Cosine of alpha = arc angle / 2
- / Sqrt((dx * dx + dy * dy)
- * (vx * vx + vy * vy));
- radius = (vx * vx + vy * vy) // radius = distance between start
- * Sqrt(dx * dx + dy * dy) // and end point / 2 * sin(alpha)
- / (2.0 * det); // radius is > 0 or < 0
- if (Abs(radius) > Precision::Confusion()) {
- angle = 2.0 * acos(c); // angle in [0,Pi]
- move = circle;
+ Standard_Real det = dx * vy - dy * vx;
+ if ( Abs(det) > Precision::Confusion()) {
+ // Cosine of alpha = arc of angle / 2 , alpha in [0,Pi]
+ Standard_Real c = (dx * vx + dy * vy) / Sqrt((dx * dx + dy * dy) * (vx * vx + vy * vy));
+ // radius = distance between start and end point / 2 * sin(alpha)
+ // radius is > 0 or < 0
+ radius = (vx * vx + vy * vy)* Sqrt(dx * dx + dy * dy) / (2.0 * det);
+ if (Abs(radius) > Precision::Confusion()) {
+ angle = 2.0 * acos(c); // angle in [0,2Pi]
+ move = circle;
}
- else
- move = none;
- break;
- }
+ else
+ move = none;
+ break;
+ }
else
move = none;
break;
- }
+ }
+ case 'U': // Arc by end point and radiUs
+ {
+ if (n1 != 5) goto badargs;
+ Standard_Real vx = a(1).RealValue();
+ Standard_Real vy = a(2).RealValue();
+ radius = a(3).RealValue();
+ reversed = a(4).IntegerValue();
+ if (a(0) == "UU") { // Absolute
+ vx -= x;
+ vy -= y;
+ }
+ Standard_Real length = Sqrt(vx * vx + vy * vy);
+ if ( (4.0 - (vx * vx + vy * vy) / (radius * radius) >= 0.0 ) && (length > Precision::Confusion()) ) {
+ // Cosine of alpha = arc angle / 2 , alpha in [0,Pi/2]
+ Standard_Real c = 0.5 * Sqrt(4.0 - (vx * vx + vy * vy) / (radius * radius));
+ angle = 2.0 * acos(c); // angle in [0,Pi]
+ if ( reversed == 2 )
+ angle = angle - 2 * M_PI;
+ dx = 0.5 * ( vy * 1.0/radius
+ + vx * Sqrt(4.0 / (vx * vx + vy * vy) - 1.0 / (radius * radius)));
+ dy = - 0.5 * ( vx * 1.0/radius
+ - vy * Sqrt(4.0 / (vx * vx + vy * vy) - 1.0 / (radius * radius)));
+ move = circle;
+ }
+ else{
+ move = none;
+ }
+ break;
+ }
+ case 'E': // Arc by end point and cEnter
+ {
+ if (n1 != 7) goto badargs;
+ Standard_Real vx = a(1).RealValue();
+ Standard_Real vy = a(2).RealValue();
+ Standard_Real vxc = a(3).RealValue();
+ Standard_Real vyc = a(4).RealValue();
+ reversed = a(5).IntegerValue();
+ control_Tolerance = a(6).IntegerValue();
+
+ if (a(0) == "EE") { // Absolute
+ vx -= x;
+ vy -= y;
+ vxc -= x;
+ vyc -= y;
+ }
+ radius = Sqrt( vxc * vxc + vyc * vyc );
+ Standard_Real det = vx * vyc - vy * vxc;
+ Standard_Real length = Sqrt(vx * vx + vy * vy);
+ Standard_Real length2 = Sqrt((vx-vxc) * (vx-vxc) + (vy-vyc) * (vy-vyc));
+ Standard_Real length3 = Sqrt(vxc * vxc + vyc * vyc);
+ Standard_Real error = Abs(length2 - radius);
+ myError = error;
+ if ( error > Precision::Confusion() ){
+ MESSAGE("Warning : The specified end point is not on the Arc, distance = "<<error);
+ }
+ if ( error > Precision::Confusion() && control_Tolerance == 1) // Don't create the arc if the end point
+ move = none; // is too far from it
+ else if ( (length > Precision::Confusion()) &&
+ (length2 > Precision::Confusion()) &&
+ (length3 > Precision::Confusion()) ) {
+ Standard_Real c = ( radius * radius - (vx * vxc + vy * vyc) )
+ / ( radius * Sqrt((vx-vxc) * (vx-vxc) + (vy-vyc) * (vy-vyc)) ) ; // Cosine of arc angle
+ angle = acos(c); // angle in [0,Pi]
+ if ( reversed == 2 )
+ angle = angle - 2 * M_PI;
+ if (det < 0)
+ angle = -angle;
+ dx = vyc / radius;
+ dy = -vxc / radius;
+ move = circle;
+ }
+ else {
+ move = none;
+ }
+ break;
+ }
case 'I':
{
if (n1 != 2) goto badargs;