mirror of
https://git.dev.opencascade.org/repos/occt.git
synced 2025-04-08 18:40:55 +03:00
d5f74e42d6
License statement text corrected; compiler warnings caused by Bison 2.41 disabled for MSVC; a few other compiler warnings on 54-bit Windows eliminated by appropriate type cast Wrong license statements corrected in several files. Copyright and license statements added in XSD and GLSL files. Copyright year updated in some files. Obsolete documentation files removed from DrawResources.
448 lines
12 KiB
C++
448 lines
12 KiB
C++
// Created on: 1993-12-21
|
|
// Created by: Jacques GOUSSARD
|
|
// Copyright (c) 1993-1999 Matra Datavision
|
|
// Copyright (c) 1999-2014 OPEN CASCADE SAS
|
|
//
|
|
// This file is part of Open CASCADE Technology software library.
|
|
//
|
|
// This library is free software; you can redistribute it and/or modify it under
|
|
// the terms of the GNU Lesser General Public License version 2.1 as published
|
|
// by the Free Software Foundation, with special exception defined in the file
|
|
// OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
|
|
// distribution for complete text of the license and disclaimer of any warranty.
|
|
//
|
|
// Alternatively, this file may be used under the terms of Open CASCADE
|
|
// commercial license or contractual agreement.
|
|
|
|
#include <BlendFunc_EvolRadInv.ixx>
|
|
|
|
#include <Precision.hxx>
|
|
#include <BlendFunc.hxx>
|
|
#define Eps 1.e-15
|
|
|
|
|
|
BlendFunc_EvolRadInv::BlendFunc_EvolRadInv(const Handle(Adaptor3d_HSurface)& S1,
|
|
const Handle(Adaptor3d_HSurface)& S2,
|
|
const Handle(Adaptor3d_HCurve)& C,
|
|
const Handle(Law_Function)& Law) :
|
|
surf1(S1),surf2(S2),curv(C)
|
|
{
|
|
fevol = Law;
|
|
}
|
|
|
|
void BlendFunc_EvolRadInv::Set(const Standard_Integer Choix)
|
|
|
|
{
|
|
choix = Choix;
|
|
switch (choix) {
|
|
case 1:
|
|
case 2:
|
|
{
|
|
sg1 = -1.;
|
|
sg2 = -1.;
|
|
}
|
|
break;
|
|
case 3:
|
|
case 4:
|
|
{
|
|
sg1 = 1.;
|
|
sg2 = -1.;
|
|
}
|
|
break;
|
|
case 5:
|
|
case 6:
|
|
{
|
|
sg1 = 1.;
|
|
sg2 = 1.;
|
|
}
|
|
break;
|
|
case 7:
|
|
case 8:
|
|
{
|
|
sg1 = -1.;
|
|
sg2 = 1.;
|
|
}
|
|
break;
|
|
default:
|
|
sg1 = sg2 = -1.;
|
|
}
|
|
}
|
|
|
|
void BlendFunc_EvolRadInv::Set(const Standard_Boolean OnFirst,
|
|
const Handle(Adaptor2d_HCurve2d)& C)
|
|
{
|
|
first = OnFirst;
|
|
csurf = C;
|
|
}
|
|
|
|
Standard_Integer BlendFunc_EvolRadInv::NbEquations () const
|
|
{
|
|
return 4;
|
|
}
|
|
|
|
|
|
void BlendFunc_EvolRadInv::GetTolerance(math_Vector& Tolerance,
|
|
const Standard_Real Tol) const
|
|
{
|
|
Tolerance(1) = csurf->Resolution(Tol);
|
|
Tolerance(2) = curv->Resolution(Tol);
|
|
if (first) {
|
|
Tolerance(3) = surf2->UResolution(Tol);
|
|
Tolerance(4) = surf2->VResolution(Tol);
|
|
}
|
|
else {
|
|
Tolerance(3) = surf1->UResolution(Tol);
|
|
Tolerance(4) = surf1->VResolution(Tol);
|
|
}
|
|
}
|
|
|
|
|
|
void BlendFunc_EvolRadInv::GetBounds(math_Vector& InfBound,
|
|
math_Vector& SupBound) const
|
|
{
|
|
InfBound(1) = csurf->FirstParameter();
|
|
InfBound(2) = curv->FirstParameter();
|
|
SupBound(1) = csurf->LastParameter();
|
|
SupBound(2) = curv->LastParameter();
|
|
|
|
if (first) {
|
|
InfBound(3) = surf2->FirstUParameter();
|
|
InfBound(4) = surf2->FirstVParameter();
|
|
SupBound(3) = surf2->LastUParameter();
|
|
SupBound(4) = surf2->LastVParameter();
|
|
if(!Precision::IsInfinite(InfBound(3)) &&
|
|
!Precision::IsInfinite(SupBound(3))) {
|
|
const Standard_Real range = (SupBound(3) - InfBound(3));
|
|
InfBound(3) -= range;
|
|
SupBound(3) += range;
|
|
}
|
|
if(!Precision::IsInfinite(InfBound(4)) &&
|
|
!Precision::IsInfinite(SupBound(4))) {
|
|
const Standard_Real range = (SupBound(4) - InfBound(4));
|
|
InfBound(4) -= range;
|
|
SupBound(4) += range;
|
|
}
|
|
}
|
|
else {
|
|
InfBound(3) = surf1->FirstUParameter();
|
|
InfBound(4) = surf1->FirstVParameter();
|
|
SupBound(3) = surf1->LastUParameter();
|
|
SupBound(4) = surf1->LastVParameter();
|
|
if(!Precision::IsInfinite(InfBound(3)) &&
|
|
!Precision::IsInfinite(SupBound(3))) {
|
|
const Standard_Real range = (SupBound(3) - InfBound(3));
|
|
InfBound(3) -= range;
|
|
SupBound(3) += range;
|
|
}
|
|
if(!Precision::IsInfinite(InfBound(4)) &&
|
|
!Precision::IsInfinite(SupBound(4))) {
|
|
const Standard_Real range = (SupBound(4) - InfBound(4));
|
|
InfBound(4) -= range;
|
|
SupBound(4) += range;
|
|
}
|
|
}
|
|
}
|
|
|
|
Standard_Boolean BlendFunc_EvolRadInv::IsSolution(const math_Vector& Sol,
|
|
const Standard_Real Tol)
|
|
{
|
|
math_Vector valsol(1,4);
|
|
Value(Sol,valsol);
|
|
if (Abs(valsol(1)) <= Tol &&
|
|
(valsol(2)*valsol(2) + valsol(3)*valsol(3) + valsol(4)*valsol(4)) <= Tol*Tol)
|
|
return Standard_True;
|
|
|
|
return Standard_False;
|
|
}
|
|
|
|
|
|
Standard_Boolean BlendFunc_EvolRadInv::Value(const math_Vector& X,
|
|
math_Vector& F)
|
|
{
|
|
const Standard_Real ray = fevol->Value(X(2));
|
|
|
|
gp_Pnt ptcur;
|
|
gp_Vec d1cur;
|
|
curv->D1(X(2),ptcur,d1cur);
|
|
|
|
const gp_Vec nplan = d1cur.Normalized();
|
|
const Standard_Real theD = -(nplan.XYZ().Dot(ptcur.XYZ()));
|
|
|
|
const gp_Pnt2d pt2d(csurf->Value(X(1)));
|
|
|
|
gp_Pnt pts1,pts2;
|
|
gp_Vec d1u1,d1v1,d1u2,d1v2;
|
|
if (first)
|
|
{
|
|
surf1->D1(pt2d.X(),pt2d.Y(),pts1,d1u1,d1v1);
|
|
surf2->D1(X(3),X(4),pts2,d1u2,d1v2);
|
|
}
|
|
else
|
|
{
|
|
surf1->D1(X(3),X(4),pts1,d1u1,d1v1);
|
|
surf2->D1(pt2d.X(),pt2d.Y(),pts2,d1u2,d1v2);
|
|
}
|
|
|
|
F(1) = (nplan.X() * (pts1.X() + pts2.X()) +
|
|
nplan.Y() * (pts1.Y() + pts2.Y()) +
|
|
nplan.Z() * (pts1.Z() + pts2.Z())) /2. + theD;
|
|
|
|
gp_Vec ns1 = d1u1.Crossed(d1v1);
|
|
if (ns1.Magnitude() < Eps) {
|
|
if (first) BlendFunc::ComputeNormal(surf1, pt2d, ns1);
|
|
else {
|
|
gp_Pnt2d P(X(3), X(4));
|
|
BlendFunc::ComputeNormal(surf1, P, ns1);
|
|
}
|
|
}
|
|
|
|
gp_Vec ns2 = d1u2.Crossed(d1v2).XYZ();
|
|
if (ns2.Magnitude() < Eps) {
|
|
if (!first) BlendFunc::ComputeNormal(surf2, pt2d, ns2);
|
|
else {
|
|
gp_Pnt2d P(X(3), X(4));
|
|
BlendFunc::ComputeNormal(surf2, P, ns2);
|
|
}
|
|
}
|
|
|
|
const gp_Vec ncrossns1 = nplan.Crossed(ns1);
|
|
const gp_Vec ncrossns2 = nplan.Crossed(ns2);
|
|
Standard_Real norm1 = ncrossns1.Magnitude();
|
|
Standard_Real norm2 = ncrossns2.Magnitude();
|
|
|
|
if (norm1 < Eps) {
|
|
norm1 = 1.;
|
|
//#if DEB
|
|
// cout << "EvolRadInv : Surface singuliere " << endl;
|
|
//#endif
|
|
}
|
|
if (norm2 < Eps) {
|
|
norm2 = 1.;
|
|
//#if DEB
|
|
// cout << "EvolRadInv : Surface singuliere " << endl;
|
|
//#endif
|
|
}
|
|
|
|
gp_Vec resul;
|
|
const Standard_Real ndotns1 = nplan.Dot(ns1);
|
|
const Standard_Real ndotns2 = nplan.Dot(ns2);
|
|
ns1.SetLinearForm(ndotns1/norm1,nplan, -1./norm1,ns1);
|
|
ns2.SetLinearForm(ndotns2/norm2,nplan, -1./norm2,ns2);
|
|
resul.SetLinearForm(sg1*ray,ns1,-1.,pts2.XYZ(),-sg2*ray,ns2,pts1.XYZ());
|
|
F(2) = resul.X();
|
|
F(3) = resul.Y();
|
|
F(4) = resul.Z();
|
|
|
|
return Standard_True;
|
|
}
|
|
|
|
Standard_Boolean BlendFunc_EvolRadInv::Derivatives(const math_Vector& X,
|
|
math_Matrix& D)
|
|
{
|
|
math_Vector F(1, 4);
|
|
return Values (X, F, D);
|
|
}
|
|
|
|
Standard_Boolean BlendFunc_EvolRadInv::Values(const math_Vector& X,
|
|
math_Vector& F,
|
|
math_Matrix& D)
|
|
{
|
|
Standard_Real ray,dray;
|
|
fevol->D1(X(2),ray,dray);
|
|
|
|
gp_Pnt ptcur;
|
|
gp_Vec d1cur,d2cur;
|
|
curv->D2(X(2),ptcur,d1cur,d2cur);
|
|
|
|
const Standard_Real normtgcur = d1cur.Magnitude();
|
|
const gp_Vec nplan = d1cur.Normalized();
|
|
const Standard_Real theD = -(nplan.XYZ().Dot(ptcur.XYZ()));
|
|
|
|
gp_Vec dnplan;
|
|
dnplan.SetLinearForm(-nplan.Dot(d2cur),nplan,d2cur);
|
|
dnplan /= normtgcur;
|
|
|
|
gp_Pnt2d p2d;
|
|
gp_Vec2d v2d;
|
|
csurf->D1(X(1),p2d,v2d);
|
|
|
|
gp_Pnt pts1,pts2;
|
|
gp_Vec d1u1,d1v1,d1u2,d1v2;
|
|
gp_Vec d2u1,d2v1,d2u2,d2v2,d2uv1,d2uv2;
|
|
gp_Vec temp;
|
|
if (first)
|
|
{
|
|
surf1->D2(p2d.X(),p2d.Y(),pts1,d1u1,d1v1,d2u1,d2v1,d2uv1);
|
|
surf2->D2(X(3),X(4),pts2,d1u2,d1v2,d2u2,d2v2,d2uv2);
|
|
|
|
temp.SetLinearForm(v2d.X(),d1u1,v2d.Y(),d1v1);
|
|
D(1,1) = nplan.Dot(temp)/2.;
|
|
temp.SetXYZ(0.5*(pts1.XYZ()+pts2.XYZ())-ptcur.XYZ());
|
|
D(1,2) = dnplan.Dot(temp) - normtgcur;
|
|
D(1,3) = nplan.Dot(d1u2)/2.;
|
|
D(1,4) = nplan.Dot(d1v2)/2.;
|
|
}
|
|
else
|
|
{
|
|
surf1->D2(X(3),X(4),pts1,d1u1,d1v1,d2u1,d2v1,d2uv1);
|
|
surf2->D2(p2d.X(),p2d.Y(),pts2,d1u2,d1v2,d2u2,d2v2,d2uv2);
|
|
|
|
temp.SetLinearForm(v2d.X(),d1u2,v2d.Y(),d1v2);
|
|
D(1,1) = nplan.Dot(temp)/2.;
|
|
temp.SetXYZ(0.5*(pts1.XYZ()+pts2.XYZ())-ptcur.XYZ());
|
|
D(1,2) = dnplan.Dot(temp) - normtgcur;
|
|
D(1,3) = nplan.Dot(d1u1)/2.;
|
|
D(1,4) = nplan.Dot(d1v1)/2.;
|
|
}
|
|
|
|
F(1) = (nplan.X()* (pts1.X() + pts2.X()) +
|
|
nplan.Y()* (pts1.Y() + pts2.Y()) +
|
|
nplan.Z()* (pts1.Z() + pts2.Z())) /2. + theD;
|
|
|
|
gp_Vec ns1 = d1u1.Crossed(d1v1);
|
|
if (ns1.Magnitude() < Eps) {
|
|
if (first) BlendFunc::ComputeNormal(surf1, p2d, ns1);
|
|
else {
|
|
gp_Pnt2d P(X(3), X(4));
|
|
BlendFunc::ComputeNormal(surf1, P, ns1);
|
|
}
|
|
}
|
|
|
|
gp_Vec ns2 = d1u2.Crossed(d1v2);
|
|
if (ns2.Magnitude() < Eps) {
|
|
if (!first) BlendFunc::ComputeNormal(surf2, p2d, ns2);
|
|
else {
|
|
gp_Pnt2d P(X(3), X(4));
|
|
BlendFunc::ComputeNormal(surf2, P, ns2);
|
|
}
|
|
}
|
|
|
|
const gp_Vec ncrossns1 = nplan.Crossed(ns1);
|
|
const gp_Vec ncrossns2 = nplan.Crossed(ns2);
|
|
Standard_Real norm1 = ncrossns1.Magnitude();
|
|
Standard_Real norm2 = ncrossns2.Magnitude();
|
|
if (norm1 < Eps) {
|
|
norm1 = 1.;
|
|
//#if DEB
|
|
// cout << "EvolRadInv : Surface singuliere " << endl;
|
|
//#endif
|
|
}
|
|
if (norm2 < Eps) {
|
|
norm2 = 1.;
|
|
//#if DEB
|
|
// cout << "EvolRadInv : Surface singuliere " << endl;
|
|
//#endif
|
|
}
|
|
|
|
gp_Vec resul1,resul2;
|
|
Standard_Real grosterme;
|
|
|
|
const Standard_Real ndotns1 = nplan.Dot(ns1);
|
|
const Standard_Real ndotns2 = nplan.Dot(ns2);
|
|
temp.SetLinearForm(ndotns1/norm1,nplan, -1./norm1,ns1);
|
|
resul1.SetLinearForm(sg1*ray,temp,gp_Vec(pts2,pts1));
|
|
temp.SetLinearForm(ndotns2/norm2,nplan,-1./norm2,ns2);
|
|
resul1.Subtract(sg2*ray*temp);
|
|
|
|
F(2) = resul1.X();
|
|
F(3) = resul1.Y();
|
|
F(4) = resul1.Z();
|
|
|
|
// Derivee par rapport a u1
|
|
|
|
temp = d2u1.Crossed(d1v1).Added(d1u1.Crossed(d2uv1));
|
|
grosterme = ncrossns1.Dot(nplan.Crossed(temp))/norm1/norm1;
|
|
resul1.SetLinearForm
|
|
(-sg1*ray/norm1*(grosterme*ndotns1-nplan.Dot(temp)),nplan,
|
|
sg1*ray*grosterme/norm1,ns1,
|
|
-sg1*ray/norm1,temp,
|
|
d1u1);
|
|
|
|
|
|
// Derivee par rapport a v1
|
|
|
|
temp = d2uv1.Crossed(d1v1).Added(d1u1.Crossed(d2v1));
|
|
grosterme = ncrossns1.Dot(nplan.Crossed(temp))/norm1/norm1;
|
|
resul2.SetLinearForm
|
|
(-sg1*ray/norm1*(grosterme*ndotns1-nplan.Dot(temp)),nplan,
|
|
sg1*ray*grosterme/norm1,ns1,
|
|
-sg1*ray/norm1,temp,
|
|
d1v1);
|
|
|
|
if (first) {
|
|
D(2,1) = v2d.X()*resul1.X() + v2d.Y()*resul2.X();
|
|
D(3,1) = v2d.X()*resul1.Y() + v2d.Y()*resul2.Y();
|
|
D(4,1) = v2d.X()*resul1.Z() + v2d.Y()*resul2.Z();
|
|
}
|
|
else {
|
|
D(2,3) = resul1.X();
|
|
D(3,3) = resul1.Y();
|
|
D(4,3) = resul1.Z();
|
|
|
|
D(2,4) = resul2.X();
|
|
D(3,4) = resul2.Y();
|
|
D(4,4) = resul2.Z();
|
|
}
|
|
|
|
// derivee par rapport a w (parametre sur ligne guide)
|
|
|
|
grosterme = ncrossns1.Dot(dnplan.Crossed(ns1))/norm1/norm1;
|
|
resul1.SetLinearForm(-sg1/norm1*(grosterme*ndotns1-dnplan.Dot(ns1)),nplan,
|
|
sg1*ndotns1/norm1,dnplan,
|
|
sg1*grosterme/norm1,ns1);
|
|
|
|
|
|
grosterme = ncrossns2.Dot(dnplan.Crossed(ns2))/norm2/norm2;
|
|
resul2.SetLinearForm(sg2/norm2*(grosterme*ndotns2-dnplan.Dot(ns2)),nplan,
|
|
-sg2*ndotns2/norm2,dnplan,
|
|
-sg2*grosterme/norm2,ns2);
|
|
|
|
|
|
D(2,2) = ray*(resul1.X() + resul2.X());
|
|
D(3,2) = ray*(resul1.Y() + resul2.Y());
|
|
D(4,2) = ray*(resul1.Z() + resul2.Z());
|
|
|
|
temp.SetLinearForm(sg1*ndotns1/norm1 - sg2*ndotns2/norm2,nplan,
|
|
-sg1/norm1,ns1,
|
|
sg2/norm2,ns2);
|
|
|
|
D(2,2) += dray*temp.X();
|
|
D(3,2) += dray*temp.Y();
|
|
D(4,2) += dray*temp.Z();
|
|
|
|
|
|
|
|
// Derivee par rapport a u2
|
|
temp = d2u2.Crossed(d1v2).Added(d1u2.Crossed(d2uv2));
|
|
grosterme = ncrossns2.Dot(nplan.Crossed(temp))/norm2/norm2;
|
|
resul1.SetLinearForm(sg2*ray/norm2*(grosterme*ndotns2-nplan.Dot(temp)),nplan,
|
|
-sg2*ray*grosterme/norm2,ns2,
|
|
sg2*ray/norm2,temp);
|
|
resul1.Subtract(d1u2);
|
|
|
|
// Derivee par rapport a v2
|
|
temp = d2uv2.Crossed(d1v2).Added(d1u2.Crossed(d2v2));
|
|
grosterme = ncrossns2.Dot(nplan.Crossed(temp))/norm2/norm2;
|
|
resul2.SetLinearForm(sg2*ray/norm2*(grosterme*ndotns2-nplan.Dot(temp)),nplan,
|
|
-sg2*ray*grosterme/norm2,ns2,
|
|
sg2*ray/norm2,temp);
|
|
resul2.Subtract(d1v2);
|
|
|
|
if (!first) {
|
|
D(2,1) = v2d.X()*resul1.X() + v2d.Y()*resul2.X();
|
|
D(3,1) = v2d.X()*resul1.Y() + v2d.Y()*resul2.Y();
|
|
D(4,1) = v2d.X()*resul1.Z() + v2d.Y()*resul2.Z();
|
|
}
|
|
else {
|
|
D(2,3) = resul1.X();
|
|
D(3,3) = resul1.Y();
|
|
D(4,3) = resul1.Z();
|
|
|
|
D(2,4) = resul2.X();
|
|
D(3,4) = resul2.Y();
|
|
D(4,4) = resul2.Z();
|
|
}
|
|
|
|
return Standard_True;
|
|
}
|