mirror of
https://git.dev.opencascade.org/repos/occt.git
synced 2025-08-14 13:30:48 +03:00
Integration of OCCT 6.5.0 from SVN
This commit is contained in:
bugmaster
bugmaster
482
src/GccAna/GccAna_Circ2d3Tan_3.cxx
Executable file
482
src/GccAna/GccAna_Circ2d3Tan_3.cxx
Executable file
@@ -0,0 +1,482 @@
|
||||
// File GccAna_Circ2d3Tan_3.cxx, REG 08/07/91
|
||||
|
||||
#include <ElCLib.hxx>
|
||||
#include <GccAna_Circ2d3Tan.jxx>
|
||||
#include <IntAna2d_AnaIntersection.hxx>
|
||||
#include <IntAna2d_IntPoint.hxx>
|
||||
#include <gp_Lin2d.hxx>
|
||||
#include <gp_Circ2d.hxx>
|
||||
#include <gp_Dir2d.hxx>
|
||||
#include <TColStd_Array1OfReal.hxx>
|
||||
#include <GccAna_Lin2dBisec.hxx>
|
||||
#include <GccEnt_BadQualifier.hxx>
|
||||
|
||||
//=========================================================================
|
||||
// Creation d un cercle tangent a trois droites. +
|
||||
// On cree les Bissectrices a Qualified1 et Qualified2 et +
|
||||
// les Bissectrices a Qualified1 et Qualified3. +
|
||||
// On intersecte les bissectrices ainsi calculees ==> Points de centre. +
|
||||
// On Choisit le point de centre qui correspond aux qualifieurs et on +
|
||||
// construit la solution de rayon egal a la distance entre le point de +
|
||||
// centre choisi et la droite Qualified1. +
|
||||
//=========================================================================
|
||||
|
||||
GccAna_Circ2d3Tan::
|
||||
GccAna_Circ2d3Tan (const GccEnt_QualifiedLin& Qualified1,
|
||||
const GccEnt_QualifiedLin& Qualified2,
|
||||
const GccEnt_QualifiedLin& Qualified3,
|
||||
const Standard_Real
|
||||
#ifdef DEB
|
||||
Tolerance
|
||||
#endif
|
||||
):
|
||||
|
||||
//=========================================================================
|
||||
// Initialisation des champs. +
|
||||
//=========================================================================
|
||||
|
||||
cirsol(1,4) ,
|
||||
qualifier1(1,4) ,
|
||||
qualifier2(1,4) ,
|
||||
qualifier3(1,4) ,
|
||||
TheSame1(1,4) ,
|
||||
TheSame2(1,4) ,
|
||||
TheSame3(1,4) ,
|
||||
pnttg1sol(1,4) ,
|
||||
pnttg2sol(1,4) ,
|
||||
pnttg3sol(1,4) ,
|
||||
par1sol(1,4) ,
|
||||
par2sol(1,4) ,
|
||||
par3sol(1,4) ,
|
||||
pararg1(1,4) ,
|
||||
pararg2(1,4) ,
|
||||
pararg3(1,4)
|
||||
{
|
||||
|
||||
TheSame1.Init(0);
|
||||
TheSame2.Init(0);
|
||||
TheSame3.Init(0);
|
||||
gp_Dir2d dirx(1.0,0.0);
|
||||
#ifdef DEB
|
||||
Standard_Real Tol = Abs(Tolerance);
|
||||
#endif
|
||||
WellDone = Standard_False;
|
||||
NbrSol = 0;
|
||||
if (!(Qualified1.IsEnclosed() ||
|
||||
Qualified1.IsOutside() || Qualified1.IsUnqualified()) ||
|
||||
!(Qualified2.IsEnclosed() ||
|
||||
Qualified2.IsOutside() || Qualified2.IsUnqualified()) ||
|
||||
!(Qualified3.IsEnclosed() ||
|
||||
Qualified3.IsOutside() || Qualified3.IsUnqualified())) {
|
||||
GccEnt_BadQualifier::Raise();
|
||||
return;
|
||||
}
|
||||
|
||||
//=========================================================================
|
||||
// Traitement. +
|
||||
//=========================================================================
|
||||
|
||||
gp_Lin2d L1(Qualified1.Qualified());
|
||||
gp_Lin2d L2(Qualified2.Qualified());
|
||||
gp_Lin2d L3(Qualified3.Qualified());
|
||||
gp_Pnt2d origin1(L1.Location());
|
||||
gp_Dir2d dir1(L1.Direction());
|
||||
gp_Dir2d normL1(-dir1.Y(),dir1.X());
|
||||
gp_Pnt2d origin2(L2.Location());
|
||||
gp_Dir2d dir2(L2.Direction());
|
||||
gp_Dir2d normL2(-dir2.Y(),dir2.X());
|
||||
gp_Pnt2d origin3(L3.Location());
|
||||
gp_Dir2d dir3(L3.Direction());
|
||||
gp_Dir2d normL3(-dir3.Y(),dir3.X());
|
||||
Standard_Real xloc1 = origin1.X();
|
||||
Standard_Real xloc2 = origin2.X();
|
||||
Standard_Real xloc3 = origin3.X();
|
||||
Standard_Real yloc1 = origin1.Y();
|
||||
Standard_Real yloc2 = origin2.Y();
|
||||
Standard_Real yloc3 = origin3.Y();
|
||||
Standard_Real xdir1 = dir1.X();
|
||||
Standard_Real xdir2 = dir2.X();
|
||||
Standard_Real xdir3 = dir3.X();
|
||||
Standard_Real ydir1 = dir1.Y();
|
||||
Standard_Real ydir2 = dir2.Y();
|
||||
Standard_Real ydir3 = dir3.Y();
|
||||
GccAna_Lin2dBisec Bisec1(L1,L2);
|
||||
GccAna_Lin2dBisec Bisec2(L1,L3);
|
||||
Standard_Integer ncote1=0;
|
||||
Standard_Integer ncote2=0;
|
||||
Standard_Integer ncote3=0;
|
||||
TColStd_Array1OfReal cote1(1,2);
|
||||
TColStd_Array1OfReal cote2(1,2);
|
||||
TColStd_Array1OfReal cote3(1,2);
|
||||
Standard_Integer nbsol = 0;
|
||||
if (Bisec1.IsDone() && Bisec2.IsDone()) {
|
||||
for (Standard_Integer i = 1 ; i <= Bisec1.NbSolutions() ; i++) {
|
||||
for (Standard_Integer j = 1 ; j <= Bisec2.NbSolutions() ; j++) {
|
||||
IntAna2d_AnaIntersection Intp(Bisec1.ThisSolution(i),
|
||||
Bisec2.ThisSolution(j));
|
||||
if (Intp.IsDone()) {
|
||||
if (!Intp.IsEmpty()) {
|
||||
for (Standard_Integer k = 1 ; k <= Intp.NbPoints() ; k++) {
|
||||
nbsol++;
|
||||
Standard_Real Radius = (L1.Distance(Intp.Point(k).Value())+
|
||||
L2.Distance(Intp.Point(k).Value())+
|
||||
L3.Distance(Intp.Point(k).Value()))/3.0;
|
||||
gp_Pnt2d Center(Intp.Point(k).Value());
|
||||
Standard_Real cx = Center.X();
|
||||
Standard_Real cy = Center.Y();
|
||||
cirsol(nbsol) = gp_Circ2d(gp_Ax2d(Center,dirx),Radius);
|
||||
// ======================================================
|
||||
gp_Dir2d dc1(origin1.XY()-Center.XY());
|
||||
if (!Qualified1.IsUnqualified()) {
|
||||
qualifier1(nbsol) = Qualified1.Qualifier();
|
||||
}
|
||||
else if (dc1.Dot(normL1) > 0.0) {
|
||||
qualifier1(nbsol) = GccEnt_outside;
|
||||
}
|
||||
else { qualifier1(nbsol) = GccEnt_enclosed; }
|
||||
gp_Dir2d dc2(origin2.XY()-Center.XY());
|
||||
if (!Qualified2.IsUnqualified()) {
|
||||
qualifier2(nbsol) = Qualified2.Qualifier();
|
||||
}
|
||||
else if (dc2.Dot(normL2) > 0.0) {
|
||||
qualifier2(nbsol) = GccEnt_outside;
|
||||
}
|
||||
else { qualifier2(nbsol) = GccEnt_enclosed; }
|
||||
gp_Dir2d dc3(origin3.XY()-Center.XY());
|
||||
if (!Qualified3.IsUnqualified()) {
|
||||
qualifier3(nbsol) = Qualified3.Qualifier();
|
||||
}
|
||||
else if (dc3.Dot(normL3) > 0.0) {
|
||||
qualifier3(nbsol) = GccEnt_outside;
|
||||
}
|
||||
else { qualifier3(nbsol) = GccEnt_enclosed; }
|
||||
|
||||
Standard_Real cross1=gp_Dir2d(-ydir1,xdir1)
|
||||
.Dot(gp_Dir2d(xloc1-cx,yloc1-cy));
|
||||
Standard_Real cross2=gp_Dir2d(-ydir2,xdir2)
|
||||
.Dot(gp_Dir2d(xloc2-cx,yloc2-cy));
|
||||
Standard_Real cross3=gp_Dir2d(-ydir3,xdir3)
|
||||
.Dot(gp_Dir2d(xloc3-cx,yloc3-cy));
|
||||
if (cross1 != 0.0) {
|
||||
cross1 = cross1/Abs(cross1);
|
||||
}
|
||||
pnttg1sol(nbsol) = gp_Pnt2d(gp_XY(cx,cy)+
|
||||
cross1*Radius*gp_XY(-ydir1,xdir1));
|
||||
if (cross2 != 0.0) {
|
||||
cross2 = cross2/Abs(cross2);
|
||||
}
|
||||
pnttg2sol(nbsol) = gp_Pnt2d(gp_XY(cx,cy)+
|
||||
cross2*Radius*gp_XY(-ydir2,xdir2));
|
||||
if (cross3 != 0.0) {
|
||||
cross3 = cross3/Abs(cross3);
|
||||
}
|
||||
pnttg3sol(nbsol) = gp_Pnt2d(gp_XY(cx,cy)+
|
||||
cross3*Radius*gp_XY(-ydir3,xdir3));
|
||||
par1sol(nbsol)=ElCLib::Parameter(cirsol(nbsol),
|
||||
pnttg1sol(nbsol));
|
||||
pararg1(nbsol)=ElCLib::Parameter(L1,pnttg1sol(nbsol));
|
||||
par2sol(nbsol)=ElCLib::Parameter(cirsol(nbsol),
|
||||
pnttg2sol(nbsol));
|
||||
pararg2(nbsol)=ElCLib::Parameter(L2,pnttg2sol(nbsol));
|
||||
par3sol(nbsol)=ElCLib::Parameter(cirsol(nbsol),
|
||||
pnttg3sol(nbsol));
|
||||
pararg3(nbsol)=ElCLib::Parameter(L3,pnttg3sol(nbsol));
|
||||
}
|
||||
}
|
||||
WellDone = Standard_True;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
if (Qualified1.IsEnclosed() && Qualified2.IsEnclosed() &&
|
||||
// =========================================================
|
||||
Qualified3.IsEnclosed()) {
|
||||
// ========================
|
||||
ncote1 = 1;
|
||||
ncote2 = 1;
|
||||
ncote3 = 1;
|
||||
cote1(1) = 1.0;
|
||||
cote2(1) = 1.0;
|
||||
cote3(1) = 1.0;
|
||||
}
|
||||
else if (Qualified1.IsEnclosed() && Qualified2.IsEnclosed() &&
|
||||
// ==============================================================
|
||||
Qualified3.IsOutside()) {
|
||||
// =======================
|
||||
ncote1 = 1;
|
||||
ncote2 = 1;
|
||||
ncote3 = 1;
|
||||
cote1(1) = 1.0;
|
||||
cote2(1) = 1.0;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
else if (Qualified1.IsEnclosed() && Qualified2.IsOutside() &&
|
||||
// =============================================================
|
||||
Qualified3.IsEnclosed()) {
|
||||
// ========================
|
||||
ncote1 = 1;
|
||||
ncote2 = 1;
|
||||
ncote3 = 1;
|
||||
cote1(1) = 1.0;
|
||||
cote2(1) = -1.0;
|
||||
cote3(1) = 1.0;
|
||||
}
|
||||
else if (Qualified1.IsEnclosed() && Qualified2.IsOutside() &&
|
||||
// =============================================================
|
||||
Qualified3.IsOutside()) {
|
||||
// =======================
|
||||
ncote1 = 1;
|
||||
ncote2 = 1;
|
||||
ncote3 = 1;
|
||||
cote1(1) = 1.0;
|
||||
cote2(1) = -1.0;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
else if (Qualified1.IsOutside() && Qualified2.IsEnclosed() &&
|
||||
// =============================================================
|
||||
Qualified3.IsEnclosed()) {
|
||||
// ========================
|
||||
ncote1 = 1;
|
||||
ncote2 = 1;
|
||||
ncote3 = 1;
|
||||
cote1(1) = -1.0;
|
||||
cote2(1) = 1.0;
|
||||
cote3(1) = 1.0;
|
||||
}
|
||||
else if (Qualified1.IsOutside() && Qualified2.IsEnclosed() &&
|
||||
// =============================================================
|
||||
Qualified3.IsOutside()) {
|
||||
// =======================
|
||||
ncote1 = 1;
|
||||
ncote2 = 1;
|
||||
ncote3 = 1;
|
||||
cote1(1) = -1.0;
|
||||
cote2(1) = 1.0;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
else if (Qualified1.IsOutside() && Qualified2.IsOutside() &&
|
||||
// ============================================================
|
||||
Qualified3.IsEnclosed()) {
|
||||
// ========================
|
||||
ncote1 = 1;
|
||||
ncote2 = 1;
|
||||
ncote3 = 1;
|
||||
cote1(1) = -1.0;
|
||||
cote2(1) = -1.0;
|
||||
cote3(1) = 1.0;
|
||||
}
|
||||
else if (Qualified1.IsOutside() && Qualified2.IsOutside() &&
|
||||
// ============================================================
|
||||
Qualified3.IsOutside()) {
|
||||
// =======================
|
||||
ncote1 = 1;
|
||||
ncote2 = 1;
|
||||
ncote3 = 1;
|
||||
cote1(1) = -1.0;
|
||||
cote2(1) = -1.0;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
else {
|
||||
if (Qualified1.IsUnqualified()) {
|
||||
// ====================================
|
||||
ncote1 = 2;
|
||||
cote1(1) = 1.0;
|
||||
cote1(2) = -1.0;
|
||||
if (Qualified2.IsUnqualified()) {
|
||||
// ===============================
|
||||
ncote2 = 2;
|
||||
cote2(1) = 1.0;
|
||||
cote2(2) = -1.0;
|
||||
if (Qualified3.IsUnqualified()) {
|
||||
// ===============================
|
||||
ncote3 = 2;
|
||||
cote2(1) = 1.0;
|
||||
cote2(2) = -1.0;
|
||||
NbrSol = nbsol;
|
||||
WellDone = Standard_True;
|
||||
}
|
||||
else if (Qualified3.IsEnclosed()) {
|
||||
// ===============================
|
||||
ncote3 = 1;
|
||||
cote3(1) = 1.0;
|
||||
}
|
||||
else if (Qualified3.IsOutside()) {
|
||||
// ================================
|
||||
ncote3 = 1;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
}
|
||||
else if (Qualified2.IsEnclosed()) {
|
||||
// =================================
|
||||
ncote2 = 1;
|
||||
cote2(1) = 1.0;
|
||||
if (Qualified3.IsUnqualified()) {
|
||||
// ===============================
|
||||
ncote3 = 2;
|
||||
cote3(1) = 1.0;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
else if (Qualified3.IsEnclosed()) {
|
||||
// =================================
|
||||
ncote3 = 1;
|
||||
cote3(1) = 1.0;
|
||||
}
|
||||
else if (Qualified3.IsOutside()) {
|
||||
// ================================
|
||||
ncote3 = 1;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
}
|
||||
else if (Qualified2.IsOutside()) {
|
||||
// ================================
|
||||
ncote2 = 1;
|
||||
cote2(1) = -1.0;
|
||||
if (Qualified3.IsUnqualified()) {
|
||||
// ===============================
|
||||
ncote3 = 2;
|
||||
cote3(1) = 1.0;
|
||||
cote3(2) = -1.0;
|
||||
}
|
||||
else if (Qualified3.IsEnclosed()) {
|
||||
// =================================
|
||||
ncote3 = 1;
|
||||
cote3(1) = 1.0;
|
||||
}
|
||||
else if (Qualified3.IsOutside()) {
|
||||
// ================================
|
||||
ncote3 = 1;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
}
|
||||
}
|
||||
else if (Qualified2.IsUnqualified()) {
|
||||
// ===================================
|
||||
ncote2 = 2;
|
||||
cote2(1) = 1.0;
|
||||
cote2(2) = -1.0;
|
||||
if (Qualified1.IsEnclosed()) {
|
||||
// ============================
|
||||
ncote1 = 1;
|
||||
cote1(1) = 1.0;
|
||||
if (Qualified3.IsUnqualified()) {
|
||||
// ===============================
|
||||
ncote3 = 2;
|
||||
cote3(1) = -1.0;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
else if (Qualified3.IsEnclosed()) {
|
||||
// =================================
|
||||
ncote3 = 1;
|
||||
cote3(1) = 1.0;
|
||||
}
|
||||
else if (Qualified3.IsOutside()) {
|
||||
// ================================
|
||||
ncote3 = 1;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
}
|
||||
else if (Qualified1.IsOutside()) {
|
||||
// ================================
|
||||
ncote1 = 1;
|
||||
cote1(1) = 1.0;
|
||||
if (Qualified3.IsUnqualified()) {
|
||||
// ===============================
|
||||
ncote3 = 2;
|
||||
cote3(1) = 1.0;
|
||||
cote3(2) = -1.0;
|
||||
}
|
||||
else if (Qualified3.IsEnclosed()) {
|
||||
// =================================
|
||||
ncote3 = 1;
|
||||
cote3(1) = 1.0;
|
||||
}
|
||||
else if (Qualified3.IsOutside()) {
|
||||
// ================================
|
||||
ncote3 = 1;
|
||||
cote3(1) = -1.0;
|
||||
}
|
||||
}
|
||||
}
|
||||
else if (Qualified3.IsUnqualified()) {
|
||||
// ===================================
|
||||
ncote3 = 2;
|
||||
cote3(1) = 1.0;
|
||||
cote3(2) = -1.0;
|
||||
if (Qualified1.IsEnclosed()) {
|
||||
// ============================
|
||||
ncote1 = 1;
|
||||
cote1(1) = 1.0;
|
||||
if (Qualified2.IsEnclosed()) {
|
||||
// ============================
|
||||
ncote2 = 1;
|
||||
cote2(1) = 1.0;
|
||||
}
|
||||
else if (Qualified2.IsOutside()) {
|
||||
// ===============================
|
||||
ncote2 = 1;
|
||||
cote2(1) = -1.0;
|
||||
}
|
||||
}
|
||||
else if (Qualified1.IsOutside()) {
|
||||
// ================================
|
||||
ncote1 = 1;
|
||||
cote1(1) = -1.0;
|
||||
if (Qualified2.IsEnclosed()) {
|
||||
// ============================
|
||||
ncote2 = 1;
|
||||
cote2(1) = 1.0;
|
||||
}
|
||||
else if (Qualified2.IsOutside()) {
|
||||
// ===============================
|
||||
ncote2 = 1;
|
||||
cote2(1) = -1.0;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
if (NbrSol > 0) { return; }
|
||||
for (Standard_Integer i = 1 ; i <= nbsol ; i++) {
|
||||
for (Standard_Integer j1 = 1 ; j1 <= ncote1 ; j1++) {
|
||||
for (Standard_Integer j2 = 1 ; j2 <= ncote2 ; j2++) {
|
||||
for (Standard_Integer j3 = 1 ; j3 <= ncote3 ; j3++) {
|
||||
if ((cote2(j2)*((cirsol(i).Location().X()-origin2.X())*
|
||||
(-dir2.Y())+(cirsol(i).Location().Y()-
|
||||
origin2.Y())*(dir2.X())) > 0.0) &&
|
||||
(cote3(j3)*((cirsol(i).Location().X()-origin3.X())*
|
||||
(-dir3.Y())+(cirsol(i).Location().Y()-
|
||||
origin3.Y())*(dir3.X())) > 0.0) &&
|
||||
(cote1(j1)*((cirsol(i).Location().X()-origin1.X())*
|
||||
(-dir1.Y())+(cirsol(i).Location().Y()-
|
||||
origin1.Y())*(dir1.X())) > 0.0)) {
|
||||
NbrSol++;
|
||||
cirsol(NbrSol) = gp_Circ2d(cirsol(i));
|
||||
// =====================================
|
||||
Standard_Real Radius = cirsol(NbrSol).Radius();
|
||||
gp_Pnt2d Center(cirsol(NbrSol).Location());
|
||||
gp_Dir2d dc(origin1.XY()-Center.XY());
|
||||
Standard_Real sign = dc.Dot(gp_Dir2d(-dir1.Y(),dir1.X()));
|
||||
dc = gp_Dir2d(sign*gp_XY(-dir1.Y(),dir1.X()));
|
||||
pnttg1sol(NbrSol) = gp_Pnt2d(Center.XY()+Radius*dc.XY());
|
||||
dc = gp_Dir2d(origin2.XY()-Center.XY());
|
||||
sign = dc.Dot(gp_Dir2d(-dir2.Y(),dir2.X()));
|
||||
dc = gp_Dir2d(sign*gp_XY(-dir2.Y(),dir2.X()));
|
||||
pnttg2sol(NbrSol) = gp_Pnt2d(Center.XY()+Radius*dc.XY());
|
||||
dc = gp_Dir2d(origin3.XY()-Center.XY());
|
||||
sign = dc.Dot(gp_Dir2d(-dir3.Y(),dir3.X()));
|
||||
dc = gp_Dir2d(sign*gp_XY(-dir3.Y(),dir3.X()));
|
||||
pnttg3sol(NbrSol) = gp_Pnt2d(Center.XY()+Radius*dc.XY());
|
||||
par1sol(NbrSol)=ElCLib::Parameter(cirsol(NbrSol),
|
||||
pnttg1sol(NbrSol));
|
||||
pararg1(NbrSol)=ElCLib::Parameter(L1,pnttg1sol(NbrSol));
|
||||
par2sol(NbrSol)=ElCLib::Parameter(cirsol(NbrSol),
|
||||
pnttg2sol(NbrSol));
|
||||
pararg2(NbrSol)=ElCLib::Parameter(L2,pnttg2sol(NbrSol));
|
||||
par3sol(NbrSol)=ElCLib::Parameter(cirsol(NbrSol),
|
||||
pnttg3sol(NbrSol));
|
||||
pararg3(NbrSol)=ElCLib::Parameter(L3,pnttg3sol(NbrSol));
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user