src/BRepBlend/BRepBlend_SurfCurvConstRadInv.cxx

   1 // Created on: 1997-02-21
   2 // Created by: Laurent BOURESCHE
   3 // Copyright (c) 1997-1999 Matra Datavision
   4 // Copyright (c) 1999-2014 OPEN CASCADE SAS
   5 //
   6 // This file is part of Open CASCADE Technology software library.
   7 //
   8 // This library is free software; you can redistribute it and / or modify it
   9 // under the terms of the GNU Lesser General Public version 2.1 as published
  10 // by the Free Software Foundation, with special exception defined in the file
  11 // OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
  12 // distribution for complete text of the license and disclaimer of any warranty.
  13 //
  14 // Alternatively, this file may be used under the terms of Open CASCADE
  15 // commercial license or contractual agreement.
  16
  17 #include <BRepBlend_SurfCurvConstRadInv.ixx>
  18
  19 //=======================================================================
  20 //function : BRepBlend_SurfCurvConstRadInv
  21 //purpose  :
  22 //=======================================================================
  23
  24 BRepBlend_SurfCurvConstRadInv::BRepBlend_SurfCurvConstRadInv
  25 (const Handle(Adaptor3d_HSurface)& S,
  26  const Handle(Adaptor3d_HCurve)& C,
  27  const Handle(Adaptor3d_HCurve)& Cg) : surf(S),curv(C),guide(Cg)
  28 {
  29 }
  30
  31 //=======================================================================
  32 //function : Set
  33 //purpose  :
  34 //=======================================================================
  35
  36 void BRepBlend_SurfCurvConstRadInv::Set(const Standard_Real R,
  37                                         const Standard_Integer Choix)
  38 {
  39   choix = Choix;
  40   switch (choix) {
  41   case 1:
  42   case 2:
  43     {
  44       ray = -Abs(R);
  45     }
  46     break;
  47   case 3:
  48   case 4:
  49     {
  50       ray = Abs(R);
  51     }
  52     break;
  53   default:
  54     {
  55       ray = -Abs(R);
  56     }
  57   }
  58 }
  59
  60 //=======================================================================
  61 //function : NbEquations
  62 //purpose  :
  63 //=======================================================================
  64
  65 Standard_Integer BRepBlend_SurfCurvConstRadInv::NbEquations() const
  66 {
  67   return 3;
  68 }
  69
  70 //=======================================================================
  71 //function : Value
  72 //purpose  :
  73 //=======================================================================
  74
  75 Standard_Boolean BRepBlend_SurfCurvConstRadInv::Value(const math_Vector& X,
  76                                                       math_Vector& F)
  77 {
  78   gp_Pnt ptgui;
  79   gp_Vec d1gui;
  80   guide->D1(X(1),ptgui,d1gui);
  81   gp_Vec nplan = d1gui.Normalized();
  82   Standard_Real theD = -(nplan.XYZ().Dot(ptgui.XYZ()));
  83   gp_Pnt ptcur = curv->Value(X(2));
  84   F(1) = nplan.XYZ().Dot(ptcur.XYZ()) + theD;
  85   gp_Pnt2d p2drst = rst->Value(X(3));
  86   gp_Pnt pts;
  87   gp_Vec du,dv;
  88   surf->D1(p2drst.X(),p2drst.Y(),pts,du,dv);
  89   F(2) = nplan.XYZ().Dot(pts.XYZ()) + theD;
  90   gp_Vec ns = du.Crossed(dv);
  91   Standard_Real norm = nplan.Crossed(ns).Magnitude();
  92   Standard_Real unsurnorm = 1./norm;
  93   ns.SetLinearForm(nplan.Dot(ns),nplan, -1.,ns);
  94   ns.Multiply(unsurnorm);
  95   gp_Vec ref(ptcur,pts);
  96   ref.SetLinearForm(ray,ns,ref);
  97   F(3) = ref.SquareMagnitude() - ray*ray;
  98   return Standard_True;
  99 }
 100
 101 //=======================================================================
 102 //function : Derivatives
 103 //purpose  :
 104 //=======================================================================
 105
 106 Standard_Boolean BRepBlend_SurfCurvConstRadInv::Derivatives(const math_Vector& X,
 107                                                             math_Matrix& D)
 108 {
 109   gp_Pnt ptgui;
 110   gp_Vec d1gui,d2gui;
 111   guide->D2(X(1),ptgui,d1gui,d2gui);
 112   Standard_Real normd1gui = d1gui.Magnitude();
 113   Standard_Real unsurnormd1gui = 1./normd1gui;
 114   gp_Vec nplan = d1gui.Multiplied(unsurnormd1gui);
 115   gp_Vec dnplan;
 116   dnplan.SetLinearForm(-nplan.Dot(d2gui),nplan,d2gui);
 117   dnplan.Multiply(unsurnormd1gui);
 118   Standard_Real dtheD = - nplan.XYZ().Dot(d1gui.XYZ()) - dnplan.XYZ().Dot(ptgui.XYZ());
 119   gp_Pnt ptcur;
 120   gp_Vec d1cur;
 121   curv->D1(X(2),ptcur,d1cur);
 122   D(1,1) = dnplan.XYZ().Dot(ptcur.XYZ()) + dtheD;
 123   D(1,2) = nplan.XYZ().Dot(d1cur.XYZ());
 124   D(1,3) = 0.;
 125
 126   gp_Pnt2d p2drst;
 127   gp_Vec2d d1rst;
 128   rst->D1(X(3),p2drst,d1rst);
 129   gp_Pnt pts;
 130   gp_Vec d1u,d1v,d2u,d2v,duv;
 131   surf->D2(p2drst.X(),p2drst.Y(),pts,d1u,d1v,d2u,d2v,duv);
 132   D(2,1) = dnplan.XYZ().Dot(pts.XYZ()) + dtheD;
 133   D(2,2) = 0.;
 134   gp_Vec dwrstpts;
 135   dwrstpts.SetLinearForm(d1rst.X(),d1u,d1rst.Y(),d1v);
 136   D(2,3) = nplan.XYZ().Dot(dwrstpts.XYZ());
 137
 138   gp_Vec nsurf = d1u.Crossed(d1v);
 139   gp_Vec dunsurf = d2u.Crossed(d1v).Added(d1u.Crossed(duv));
 140   gp_Vec dvnsurf = d1u.Crossed(d2v).Added(duv.Crossed(d1v));
 141   gp_Vec dwrstnsurf;
 142   dwrstnsurf.SetLinearForm(d1rst.X(),dunsurf,d1rst.Y(),dvnsurf);
 143
 144   gp_Vec nplancrosnsurf = nplan.Crossed(nsurf);
 145   gp_Vec dwguinplancrosnsurf = dnplan.Crossed(nsurf);
 146   gp_Vec dwrstnplancrosnsurf = nplan.Crossed(dwrstnsurf);
 147
 148   Standard_Real norm2      = nplancrosnsurf.SquareMagnitude();
 149   Standard_Real norm       = sqrt(norm2);
 150   Standard_Real unsurnorm  = 1./norm;
 151   Standard_Real raysurnorm = ray*unsurnorm;
 152   Standard_Real unsurnorm2 = unsurnorm * unsurnorm;
 153   Standard_Real raysurnorm2 = ray*unsurnorm2;
 154   Standard_Real dwguinorm = unsurnorm*nplancrosnsurf.Dot(dwguinplancrosnsurf);
 155   Standard_Real dwrstnorm = unsurnorm*nplancrosnsurf.Dot(dwrstnplancrosnsurf);
 156
 157   Standard_Real nplandotnsurf   = nplan.Dot(nsurf);
 158   Standard_Real dwguinplandotnsurf = dnplan.Dot(nsurf);
 159   Standard_Real dwrstnplandotnsurf = nplan.Dot(dwrstnsurf);
 160
 161   gp_Vec temp,dwguitemp,dwrsttemp;
 162   temp.SetLinearForm(nplandotnsurf,nplan,-1.,nsurf);
 163   dwguitemp.SetLinearForm(nplandotnsurf,dnplan,dwguinplandotnsurf,nplan);
 164   dwrsttemp.SetLinearForm(dwrstnplandotnsurf,nplan,-1.,dwrstnsurf);
 165
 166   gp_Vec corde(ptcur,pts);
 167   gp_Vec ref,dwguiref,dwrstref;
 168   ref.SetLinearForm(raysurnorm,temp,corde);
 169   dwguiref.SetLinearForm(raysurnorm,dwguitemp,-raysurnorm2*dwguinorm,temp);
 170   dwrstref.SetLinearForm(raysurnorm,dwrsttemp,-raysurnorm2*dwrstnorm,temp,dwrstpts);
 171
 172   ref.Add(ref);
 173   D(3,1) = ref.Dot(dwguiref);
 174   D(3,2) = -ref.Dot(d1cur);
 175   D(3,3) = ref.Dot(dwrstref);
 176
 177   return Standard_True;
 178 }
 179
 180 //=======================================================================
 181 //function : Values
 182 //purpose  :
 183 //=======================================================================
 184
 185 Standard_Boolean BRepBlend_SurfCurvConstRadInv::Values(const math_Vector& X,
 186                                                        math_Vector& F,
 187                                                        math_Matrix& D)
 188 {
 189   gp_Pnt ptgui;
 190   gp_Vec d1gui(0.,0.,0.),d2gui(0.,0.,0.);
 191   guide->D2(X(1),ptgui,d1gui,d2gui);
 192   Standard_Real normd1gui = d1gui.Magnitude();
 193   Standard_Real unsurnormd1gui = 1./normd1gui;
 194   gp_Vec nplan = d1gui.Multiplied(unsurnormd1gui);
 195   Standard_Real theD = -(nplan.XYZ().Dot(ptgui.XYZ()));
 196   gp_Vec dnplan;
 197   dnplan.SetLinearForm(-nplan.Dot(d2gui),nplan,d2gui);
 198   dnplan.Multiply(unsurnormd1gui);
 199   Standard_Real dtheD = - nplan.XYZ().Dot(d1gui.XYZ()) - dnplan.XYZ().Dot(ptgui.XYZ());
 200   gp_Pnt ptcur;
 201   gp_Vec d1cur;
 202   curv->D1(X(2),ptcur,d1cur);
 203   F(1) = nplan.XYZ().Dot(ptcur.XYZ()) + theD;
 204   D(1,1) = dnplan.XYZ().Dot(ptcur.XYZ()) + dtheD;
 205   D(1,2) = nplan.XYZ().Dot(d1cur.XYZ());
 206   D(1,3) = 0.;
 207
 208   gp_Pnt2d p2drst;
 209   gp_Vec2d d1rst;
 210   rst->D1(X(3),p2drst,d1rst);
 211   gp_Pnt pts;
 212   gp_Vec d1u,d1v,d2u,d2v,duv;
 213   surf->D2(p2drst.X(),p2drst.Y(),pts,d1u,d1v,d2u,d2v,duv);
 214   F(2) = nplan.XYZ().Dot(pts.XYZ()) + theD;
 215   D(2,1) = dnplan.XYZ().Dot(pts.XYZ()) + dtheD;
 216   D(2,2) = 0.;
 217   gp_Vec dwrstpts;
 218   dwrstpts.SetLinearForm(d1rst.X(),d1u,d1rst.Y(),d1v);
 219   D(2,3) = nplan.XYZ().Dot(dwrstpts.XYZ());
 220
 221   gp_Vec nsurf = d1u.Crossed(d1v);
 222   gp_Vec dunsurf = d2u.Crossed(d1v).Added(d1u.Crossed(duv));
 223   gp_Vec dvnsurf = d1u.Crossed(d2v).Added(duv.Crossed(d1v));
 224   gp_Vec dwrstnsurf;
 225   dwrstnsurf.SetLinearForm(d1rst.X(),dunsurf,d1rst.Y(),dvnsurf);
 226
 227   gp_Vec nplancrosnsurf = nplan.Crossed(nsurf);
 228   gp_Vec dwguinplancrosnsurf = dnplan.Crossed(nsurf);
 229   gp_Vec dwrstnplancrosnsurf = nplan.Crossed(dwrstnsurf);
 230
 231   Standard_Real norm2      = nplancrosnsurf.SquareMagnitude();
 232   Standard_Real norm       = sqrt(norm2);
 233   Standard_Real unsurnorm  = 1./norm;
 234   Standard_Real raysurnorm = ray*unsurnorm;
 235   Standard_Real unsurnorm2 = unsurnorm * unsurnorm;
 236   Standard_Real raysurnorm2 = ray*unsurnorm2;
 237   Standard_Real dwguinorm = unsurnorm*nplancrosnsurf.Dot(dwguinplancrosnsurf);
 238   Standard_Real dwrstnorm = unsurnorm*nplancrosnsurf.Dot(dwrstnplancrosnsurf);
 239
 240   Standard_Real nplandotnsurf   = nplan.Dot(nsurf);
 241   Standard_Real dwguinplandotnsurf = dnplan.Dot(nsurf);
 242   Standard_Real dwrstnplandotnsurf = nplan.Dot(dwrstnsurf);
 243
 244   gp_Vec temp,dwguitemp,dwrsttemp;
 245   temp.SetLinearForm(nplandotnsurf,nplan,-1.,nsurf);
 246   dwguitemp.SetLinearForm(nplandotnsurf,dnplan,dwguinplandotnsurf,nplan);
 247   dwrsttemp.SetLinearForm(dwrstnplandotnsurf,nplan,-1.,dwrstnsurf);
 248
 249   gp_Vec corde(ptcur,pts);
 250   gp_Vec ref,dwguiref,dwrstref;
 251   ref.SetLinearForm(raysurnorm,temp,corde);
 252   F(3) = ref.SquareMagnitude() - ray*ray;
 253   dwguiref.SetLinearForm(raysurnorm,dwguitemp,-raysurnorm2*dwguinorm,temp);
 254   dwrstref.SetLinearForm(raysurnorm,dwrsttemp,-raysurnorm2*dwrstnorm,temp,dwrstpts);
 255
 256   ref.Add(ref);
 257   D(3,1) = ref.Dot(dwguiref);
 258   D(3,2) = -ref.Dot(d1cur);
 259   D(3,3) = ref.Dot(dwrstref);
 260   return Standard_True;
 261 }
 262
 263 //=======================================================================
 264 //function : Set
 265 //purpose  :
 266 //=======================================================================
 267
 268 void BRepBlend_SurfCurvConstRadInv::Set(const Handle(Adaptor2d_HCurve2d)& Rst)
 269 {
 270   rst = Rst;
 271 }
 272
 273 //=======================================================================
 274 //function : GetTolerance
 275 //purpose  :
 276 //=======================================================================
 277
 278 void BRepBlend_SurfCurvConstRadInv::GetTolerance(math_Vector& Tolerance,
 279                                                  const Standard_Real Tol) const
 280 {
 281   Tolerance(1) = guide->Resolution(Tol);
 282   Tolerance(2) = curv->Resolution(Tol);
 283   Standard_Real ru,rv;
 284   ru = surf->UResolution(Tol);
 285   rv = surf->VResolution(Tol);
 286   Tolerance(3) = rst->Resolution(Min(ru,rv));
 287 }
 288
 289 //=======================================================================
 290 //function : GetBounds
 291 //purpose  :
 292 //=======================================================================
 293
 294 void BRepBlend_SurfCurvConstRadInv::GetBounds(math_Vector& InfBound,
 295                                               math_Vector& SupBound) const
 296 {
 297   InfBound(1) = guide->FirstParameter();
 298   SupBound(1) = guide->LastParameter();
 299   InfBound(2) = curv->FirstParameter();
 300   SupBound(2) = curv->LastParameter();
 301   InfBound(3) = rst->FirstParameter();
 302   SupBound(3) = rst->LastParameter();
 303 }
 304
 305 //=======================================================================
 306 //function : IsSolution
 307 //purpose  :
 308 //=======================================================================
 309
 310 Standard_Boolean BRepBlend_SurfCurvConstRadInv::IsSolution(const math_Vector& Sol,
 311                                                            const Standard_Real Tol)
 312 {
 313   math_Vector valsol(1,3);
 314   Value(Sol,valsol);
 315   if (Abs(valsol(1)) <= Tol &&
 316       Abs(valsol(2)) <= Tol &&
 317       Abs(valsol(3)) <= 2*Tol*Abs(ray) ) {
 318     return Standard_True;
 319   }
 320   return Standard_False;
 321 }
 322
 323