src/SKETCHER/Sketcher_Profile.cxx

   1 //  Copyright (C) 2007-2010  CEA/DEN, EDF R&D, OPEN CASCADE
   2 //
   3 //  Copyright (C) 2003-2007  OPEN CASCADE, EADS/CCR, LIP6, CEA/DEN,
   4 //  CEDRAT, EDF R&D, LEG, PRINCIPIA R&D, BUREAU VERITAS
   5 //
   6 //  This library is free software; you can redistribute it and/or
   7 //  modify it under the terms of the GNU Lesser General Public
   8 //  License as published by the Free Software Foundation; either
   9 //  version 2.1 of the License.
  10 //
  11 //  This library is distributed in the hope that it will be useful,
  12 //  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13 //  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14 //  Lesser General Public License for more details.
  15 //
  16 //  You should have received a copy of the GNU Lesser General Public
  17 //  License along with this library; if not, write to the Free Software
  18 //  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  19 //
  20 //  See http://www.salome-platform.org/ or email : webmaster.salome@opencascade.com
  21 //
  22
  23 //  GEOM SKETCHER : basic sketcher
  24 //  File   : Sketcher_Profile.cxx
  25 //  Author : Damien COQUERET
  26 //  Module : GEOM
  27 //  $Header:
  28 //
  29 #include <Standard_Stream.hxx>
  30
  31 #include <Sketcher_Profile.hxx>
  32
  33 #include <TopoDS_Vertex.hxx>
  34 #include <TopoDS_Face.hxx>
  35 #include <BRepLib.hxx>
  36 #include <BRepBuilderAPI_MakeVertex.hxx>
  37 #include <BRepBuilderAPI_MakeEdge.hxx>
  38 #include <BRepBuilderAPI_MakeWire.hxx>
  39 #include <BRepBuilderAPI_MakeFace.hxx>
  40
  41 #include <GeomAPI.hxx>
  42 #include <Geom2d_Line.hxx>
  43 #include <Geom2d_Circle.hxx>
  44 #include <Geom_Surface.hxx>
  45
  46 #include <Precision.hxx>
  47 #include <gp_Pln.hxx>
  48 #include <gp_Ax2.hxx>
  49
  50 #include <TCollection_AsciiString.hxx>
  51 #include <TColStd_Array1OfAsciiString.hxx>
  52
  53 #include "utilities.h"
  54
  55 //=======================================================================
  56 // profile
  57 // command to build a profile
  58 //=======================================================================
  59 Sketcher_Profile::Sketcher_Profile()
  60 {
  61 }
  62
  63
  64 //=======================================================================
  65 // profile
  66 // command to build a profile
  67 //=======================================================================
  68 Sketcher_Profile::Sketcher_Profile(const char* aCmd)
  69 {
  70   enum {line, circle, point, none} move;
  71
  72   Standard_Integer i = 1;
  73   Standard_Real x0, y0, x, y, dx, dy;
  74   x0 = y0 = x = y = dy = 0;
  75   dx = 1;
  76
  77   Standard_Boolean first, stayfirst, face, close;
  78   first = Standard_True;
  79   stayfirst = face = close = Standard_False;
  80
  81   TopoDS_Shape S;
  82   TopoDS_Vertex MP;
  83   BRepBuilderAPI_MakeWire MW;
  84   gp_Ax3 DummyHP(gp::XOY());
  85   gp_Pln P(DummyHP);
  86   TopLoc_Location TheLocation;
  87   Handle(Geom_Surface) Surface;
  88
  89   myOK = Standard_False;
  90
  91   //TCollection_AsciiString aCommand(CORBA::string_dup(aCmd));
  92   TCollection_AsciiString aCommand ((char*)aCmd);
  93   TCollection_AsciiString aToken = aCommand.Token(":", 1);
  94   int n = 0;
  95   // porting to WNT
  96   TColStd_Array1OfAsciiString aTab (0, aCommand.Length() - 1);
  97   if ( aCommand.Length() )
  98   {
  99     while(aToken.Length() != 0) {
 100       if(aCommand.Token(":", n + 1).Length() > 0)
 101         aTab(n) = aCommand.Token(":", n + 1);
 102       aToken = aCommand.Token(":", ++n);
 103     }
 104     n = n - 1;
 105   }
 106   if ( aTab.Length() && aTab(0).Length() )
 107     while(i < n) {
 108       Standard_Real length = 0, radius = 0, angle = 0;
 109       move = point;
 110
 111       int n1 = 0;
 112       TColStd_Array1OfAsciiString a (0, aTab(0).Length());
 113       aToken = aTab(i).Token(" ", 1);
 114       while (aToken.Length() != 0) {
 115         if (aTab(i).Token(" ", n1 + 1).Length() > 0)
 116           a(n1) = aTab(i).Token(" ", n1 + 1);
 117         aToken = aTab(i).Token(" ", ++n1);
 118       }
 119       n1 = n1 - 1;
 120
 121       switch(a(0).Value(1))
 122       {
 123       case 'F':
 124         {
 125           if (n1 != 3) goto badargs;
 126           if (!first) {
 127             MESSAGE("profile : The F instruction must precede all moves");
 128             return;
 129           }
 130           x0 = x = a(1).RealValue();
 131           y0 = y = a(2).RealValue();
 132           stayfirst = Standard_True;
 133           break;
 134         }
 135       case 'O':
 136         {
 137           if (n1 != 4) goto badargs;
 138           P.SetLocation(gp_Pnt(a(1).RealValue(), a(2).RealValue(), a(3).RealValue()));
 139           stayfirst = Standard_True;
 140           break;
 141         }
 142       case 'P':
 143         {
 144           if (n1 != 7) goto badargs;
 145           gp_Vec vn(a(1).RealValue(), a(2).RealValue(), a(3).RealValue());
 146           gp_Vec vx(a(4).RealValue(), a(5).RealValue(), a(6).RealValue());
 147           if (vn.Magnitude() <= Precision::Confusion() || vx.Magnitude() <= Precision::Confusion()) {
 148             MESSAGE("profile : null direction");
 149             return;
 150           }
 151           gp_Ax2 ax(P.Location(), vn, vx);
 152           P.SetPosition(ax);
 153           stayfirst = Standard_True;
 154           break;
 155         }
 156       case 'X':
 157         {
 158           if (n1 != 2) goto badargs;
 159           length = a(1).RealValue();
 160           if (a(0) == "XX")
 161             length -= x;
 162           dx = 1; dy = 0;
 163           move = line;
 164           break;
 165         }
 166       case 'Y':
 167         {
 168           if (n1 != 2) goto badargs;
 169           length = a(1).RealValue();
 170           if (a(0) == "YY")
 171             length -= y;
 172           dx = 0; dy = 1;
 173           move = line;
 174           break;
 175         }
 176       case 'L':
 177         {
 178           if (n1 != 2) goto badargs;
 179           length = a(1).RealValue();
 180           if (Abs(length) > Precision::Confusion())
 181             move = line;
 182           else
 183             move = none;
 184           break;
 185         }
 186       case 'T':
 187         {
 188           if (n1 != 3) goto badargs;
 189           Standard_Real vx = a(1).RealValue();
 190           Standard_Real vy = a(2).RealValue();
 191           if (a(0) == "TT") {
 192             vx -= x;
 193             vy -= y;
 194           }
 195           length = Sqrt(vx * vx + vy * vy);
 196           if (length > Precision::Confusion()) {
 197             move = line;
 198             dx = vx / length;
 199             dy = vy / length;
 200           }
 201           else
 202             move = none;
 203           break;
 204         }
 205       case 'R':
 206         {
 207           if (n1 != 2) goto badargs;
 208           angle = a(1).RealValue() * PI180;
 209           if (a(0) == "RR") {
 210             dx = Cos(angle);
 211             dy = Sin(angle);
 212           }
 213           else {
 214             Standard_Real c = Cos(angle);
 215             Standard_Real s = Sin(angle);
 216             Standard_Real t = c * dx - s * dy;
 217             dy = s * dx + c * dy;
 218             dx = t;
 219           }
 220           break;
 221         }
 222       case 'D':
 223         {
 224           if (n1 != 3) goto badargs;
 225           Standard_Real vx = a(1).RealValue();
 226           Standard_Real vy = a(2).RealValue();
 227           length = Sqrt(vx * vx + vy * vy);
 228           if (length > Precision::Confusion()) {
 229             dx = vx / length;
 230             dy = vy / length;
 231           }
 232           else
 233             move = none;
 234           break;
 235         }
 236       case 'C':
 237         {
 238           if (n1 != 3) goto badargs;
 239           radius = a(1).RealValue();
 240           if (Abs(radius) > Precision::Confusion()) {
 241             angle = a(2).RealValue() * PI180;
 242             move = circle;
 243           }
 244           else
 245             move = none;
 246           break;
 247         }
 248       case 'I':
 249         {
 250           if (n1 != 2) goto badargs;
 251           length = a(1).RealValue();
 252           if (a(0) == "IX") {
 253             if (Abs(dx) < Precision::Confusion()) {
 254               MESSAGE("profile : cannot intersect, arg "<<i-1);
 255               return;
 256             }
 257             length = (length - x) / dx;
 258           }
 259           else if (a(0) == "IY") {
 260             if (Abs(dy) < Precision::Confusion()) {
 261               MESSAGE("profile : cannot intersect, arg "<<i-1);
 262               return;
 263             }
 264             length = (length - y) / dy;
 265           }
 266           if (Abs(length) > Precision::Confusion())
 267             move = line;
 268           else
 269             move = none;
 270           break;
 271         }
 272       case 'W':
 273         {
 274           if (a(0) == "WW")
 275             close = Standard_True;
 276           else if(a(0) == "WF") {
 277             close = Standard_True;
 278             face = Standard_True;
 279           }
 280           i = n - 1;
 281           break;
 282         }
 283       default:
 284         {
 285           MESSAGE("profile : unknown code " << a(i));
 286           return;
 287         }
 288     }
 289
 290 again :
 291     switch (move)
 292     {
 293     case line :
 294       {
 295         if (length < 0) {
 296           length = -length;
 297           dx = -dx;
 298           dy = -dy;
 299         }
 300         Handle(Geom2d_Line) l = new Geom2d_Line(gp_Pnt2d(x,y),gp_Dir2d(dx,dy));
 301         BRepBuilderAPI_MakeEdge ME (GeomAPI::To3d(l,P),0,length);
 302         if (!ME.IsDone())
 303           return;
 304         MW.Add(ME);
 305         x += length*dx;
 306         y += length*dy;
 307         break;
 308       }
 309     case circle :
 310       {
 311         Standard_Boolean sense = Standard_True;
 312         if (radius < 0) {
 313           radius = -radius;
 314           sense = !sense;
 315           dx = -dx;
 316           dy = -dy;
 317         }
 318         gp_Ax2d ax(gp_Pnt2d(x-radius*dy,y+radius*dx),gp_Dir2d(dy,-dx));
 319         if (angle < 0) {
 320           angle = -angle;
 321           sense = !sense;
 322         }
 323         Handle(Geom2d_Circle) c = new Geom2d_Circle(ax,radius,sense);
 324         BRepBuilderAPI_MakeEdge ME (GeomAPI::To3d(c,P),0,angle);
 325         if (!ME.IsDone())
 326           return;
 327         MW.Add(ME);
 328         gp_Pnt2d p;
 329         gp_Vec2d v;
 330         c->D1(angle,p,v);
 331         x = p.X();
 332         y = p.Y();
 333         dx = v.X() / radius;
 334         dy = v.Y() / radius;
 335         break;
 336       }
 337     case point:
 338       {
 339         MP = BRepBuilderAPI_MakeVertex(gp_Pnt(x, y, 0.0));
 340         break;
 341       }
 342     case none:
 343       {
 344         i = n - 1;
 345         break;
 346       }
 347     }
 348
 349     // update first
 350     first = stayfirst;
 351     stayfirst = Standard_False;
 352
 353     if(!(dx == 0 && dy == 0))
 354       myLastDir.SetCoord(dx, dy, 0.0);
 355     else
 356       return;
 357     myLastPoint.SetX(x);
 358     myLastPoint.SetY(y);
 359
 360     // next segment....
 361     i++;
 362     if ((i == n) && close) {
 363       // the closing segment
 364       dx = x0 - x;
 365       dy = y0 - y;
 366       length = Sqrt(dx * dx + dy * dy);
 367       move = line;
 368       if (length > Precision::Confusion()) {
 369         dx = dx / length;
 370         dy = dy / length;
 371         goto again;
 372       }
 373     }
 374   }
 375
 376   // get the result, face or wire
 377   if (move == none) {
 378     return;
 379   } else if (move == point) {
 380     S = MP;
 381   } else if (face) {
 382     if (!MW.IsDone()) {
 383       return;
 384     }
 385     BRepBuilderAPI_MakeFace MF (P, MW.Wire());
 386     if (!MF.IsDone()) {
 387       return;
 388     }
 389     S = MF;
 390   } else {
 391     if (!MW.IsDone()) {
 392       return;
 393     }
 394     S = MW;
 395   }
 396
 397   if(!TheLocation.IsIdentity())
 398     S.Move(TheLocation);
 399
 400   myShape = S;
 401   myOK = true;
 402   return;
 403
 404   badargs :
 405     MESSAGE("profile : bad number of arguments");
 406     return;
 407 }