2843 lines
74 KiB
C++
2843 lines
74 KiB
C++
|
#include "Stdafx.h"
|
|||
|
|
#include "DllImportViewControl.h"
|
|||
|
|
//#include "OCCViewer.h"
|
|||
|
|
//2016srq
|
|||
|
|
//#include "ISession_Text.h"
|
|||
|
|
//#include "Quantity_Color.hxx"
|
|||
|
|
|
|||
|
|
// DELETE BY XUEFENG 20180731
|
|||
|
|
// FOR CODES COMBINE
|
|||
|
|
/*
|
|||
|
|
#include "Style/AFaceStyle.h"
|
|||
|
|
#include "Style/APointStyle.h"
|
|||
|
|
#include "Node/ATextNode.h"
|
|||
|
|
#include "Node/APointNode.h"
|
|||
|
|
#include "Node/AScreenWidget.h"
|
|||
|
|
#include "Render/ARenderWindow.h"
|
|||
|
|
#include "DataType/ACamera.h"
|
|||
|
|
#include "TopoShape/ATopoShapeImpl.h"
|
|||
|
|
#include "Geometry/ARenderableGeometry.h"
|
|||
|
|
#include "View/ARenderer.h"
|
|||
|
|
#include "DataType/ASceneEnvironment.h"
|
|||
|
|
using namespace AnyCore;
|
|||
|
|
//end
|
|||
|
|
*/
|
|||
|
|
// END DELETE
|
|||
|
|
|
|||
|
|
// ADDED BY XUEFENG 20180731
|
|||
|
|
// FOR CODES COMBINE
|
|||
|
|
#include "Prs3d_PointAspect.hxx"
|
|||
|
|
// #include "AIS_Drawer.hxx" // XUEFENG DELETE 202009
|
|||
|
|
#include "CCS_AISShape.h"
|
|||
|
|
#include "Graphic3d_Group.hxx"
|
|||
|
|
#include "Graphic3d_AspectText3d.hxx"
|
|||
|
|
#include "Prs3d_Root.hxx"
|
|||
|
|
|
|||
|
|
// END ADDED
|
|||
|
|
|
|||
|
|
#include "BaseAlgo.h"
|
|||
|
|
//extern OCCViewer myOCCViewer;
|
|||
|
|
extern OCCStructDataMD dataMD;
|
|||
|
|
/*
|
|||
|
|
DLLEXPORT BOOL InitView(int viewsize,HWND hwnd[])
|
|||
|
|
{
|
|||
|
|
if( myOCCViewer.InitViewer(viewsize, hwnd))
|
|||
|
|
{
|
|||
|
|
myOCCViewer.AxoViewF(0);
|
|||
|
|
return TRUE;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
return FALSE;
|
|||
|
|
}
|
|||
|
|
DLLEXPORT void RedrawView(int flag)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.RedrawView(flag);
|
|||
|
|
}
|
|||
|
|
DLLEXPORT void UpdateView(int flag)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.UpdateView(flag);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// ADDED BY XUEFENG 20181201
|
|||
|
|
DLLEXPORT void ResetView()
|
|||
|
|
{
|
|||
|
|
myOCCViewer.ResetView();
|
|||
|
|
}
|
|||
|
|
// END ADDED
|
|||
|
|
|
|||
|
|
DLLEXPORT void ZoomWheel(float delta,int flag)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.ZoomWheel(delta,flag);
|
|||
|
|
//myOCCViewer.DepthFitAll(flag);
|
|||
|
|
//20170801 added by czb
|
|||
|
|
bool fflag;
|
|||
|
|
int ID= myOCCViewer.GetCurrentSelectedId(fflag);
|
|||
|
|
int type=ID/MAX_SIZE_OF_OBJECT_GROUP;
|
|||
|
|
if ( myOCCViewer.GetNumofSelected()==1 && type>=1 &&type<2)
|
|||
|
|
{
|
|||
|
|
// DELETE BY XUEFENG 20181020 Why Add?
|
|||
|
|
//ShowPointOnLine(ID);//如果只选中一根线，则要显示线上的点
|
|||
|
|
// END DELETE
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void StartRotation(int x,int y,int flag)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.StartRotation(x,y,flag);
|
|||
|
|
//myOCCViewer.DepthFitAll(flag);
|
|||
|
|
//20170801 added by czb
|
|||
|
|
bool fflag;
|
|||
|
|
int ID= myOCCViewer.GetCurrentSelectedId(fflag);
|
|||
|
|
int type=ID/MAX_SIZE_OF_OBJECT_GROUP;
|
|||
|
|
if ( myOCCViewer.GetNumofSelected()==1 && type>=1 &&type<2)
|
|||
|
|
{
|
|||
|
|
// DELETE BY XUEFENG 20181020
|
|||
|
|
//ShowPointOnLine(ID);//如果只选中一根线，则要显示线上的点
|
|||
|
|
// END DELETE
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void Rotation(int x, int y,int flag)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.Rotation(x,y,flag);
|
|||
|
|
//myOCCViewer.DepthFitAll(flag);
|
|||
|
|
//20170801 added by czb
|
|||
|
|
bool fflag;
|
|||
|
|
int ID= myOCCViewer.GetCurrentSelectedId(fflag);
|
|||
|
|
int type=ID/MAX_SIZE_OF_OBJECT_GROUP;
|
|||
|
|
if ( myOCCViewer.GetNumofSelected()==1 && type>=1 &&type<2)
|
|||
|
|
{
|
|||
|
|
// DELETE BY XUEFENG 20181020
|
|||
|
|
//ShowPointOnLine(ID);//如果只选中一根线，则要显示线上的点
|
|||
|
|
// END DELETE
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void Select()
|
|||
|
|
{
|
|||
|
|
myOCCViewer.Select();
|
|||
|
|
//myOCCViewer.DepthFitAll(2);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void MoveTo(int x,int y ,int flag)
|
|||
|
|
{
|
|||
|
|
if(dataMD.m_mapAllTopoShapes.size()>0)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.MoveTo(x,y,flag);
|
|||
|
|
// myOCCViewer.DepthFitAll(flag);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void Pan(int x, int y, int flag)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.Pan(x,y,flag);
|
|||
|
|
//myOCCViewer.DepthFitAll(flag);
|
|||
|
|
//20170801 added by czb
|
|||
|
|
bool fflag;
|
|||
|
|
int ID= myOCCViewer.GetCurrentSelectedId(fflag);
|
|||
|
|
int type=ID/MAX_SIZE_OF_OBJECT_GROUP;
|
|||
|
|
if ( myOCCViewer.GetNumofSelected()==1 && type>=1 &&type<2)
|
|||
|
|
{
|
|||
|
|
// DELETE BY XUEFENG 20181020
|
|||
|
|
//ShowPointOnLine(ID);//如果只选中一根线，则要显示线上的点
|
|||
|
|
// END DELETE
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void FitAll(int flag,bool isUpdate)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.FitAll(flag,isUpdate);
|
|||
|
|
// myOCCViewer.DepthFitAll(flag);
|
|||
|
|
//20170801 added by czb
|
|||
|
|
bool fflag;
|
|||
|
|
int ID= myOCCViewer.GetCurrentSelectedId(fflag);
|
|||
|
|
int type=ID/MAX_SIZE_OF_OBJECT_GROUP;
|
|||
|
|
if ( myOCCViewer.GetNumofSelected()==1 && type>=1 &&type<2)
|
|||
|
|
{
|
|||
|
|
// DELETE BY XUEFENG 20181020
|
|||
|
|
//ShowPointOnLine(ID);//如果只选中一根线，则要显示线上的点
|
|||
|
|
// END DELETE
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void WindowFitAll(int myXmin, int myYmin, int myXmax, int myYmax)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.WindowFitAll(myXmin,myYmin,myXmax,myYmax);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void SetDisplayMode(int mode)
|
|||
|
|
{
|
|||
|
|
dataMD.m_bshowPoint=(bool)(mode & 1);
|
|||
|
|
dataMD.m_bshowCurve=(bool)(mode & 2);
|
|||
|
|
dataMD.m_bshowSurface=(bool)(mode & 4);
|
|||
|
|
dataMD.m_bshowSolid=(bool)(mode & 8);
|
|||
|
|
dataMD.m_bshowMainDeck=(bool)(mode & 16);
|
|||
|
|
dataMD.m_bshowShell=(bool)(mode & 32);
|
|||
|
|
dataMD.m_bshowDeck=(bool)(mode & 64);
|
|||
|
|
dataMD.m_bshowBound=(bool)(mode & 128);
|
|||
|
|
dataMD.m_bshowSubdiv=(bool)(mode & 256);
|
|||
|
|
dataMD.m_bshowOpenCargoRegion=(bool)(mode & 512);
|
|||
|
|
dataMD.m_bshowSpace=(bool)(mode & 1024);
|
|||
|
|
dataMD.m_bshowAppendage=(bool)(mode & 2048);
|
|||
|
|
dataMD.m_bshowFrameRuler=(bool)(mode & 4096);
|
|||
|
|
dataMD.m_bshowHull=(bool)(mode & 8192);
|
|||
|
|
dataMD.m_bshowMainHull = (bool)(mode&16384);
|
|||
|
|
dataMD.m_bshowSpaceElement = (bool)(mode & 0x8000);
|
|||
|
|
RedrawTypeObjProps();
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void SetAISDisplayMode(int aMode)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.SetAISDisplayMode(aMode);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void SetViewDirection(int flag, int dir)
|
|||
|
|
{
|
|||
|
|
// dir--0前,1后,2顶,3底,4左,5右,6侧前,7侧后***
|
|||
|
|
switch (dir)
|
|||
|
|
{
|
|||
|
|
case 0:
|
|||
|
|
myOCCViewer.FrontView(flag);
|
|||
|
|
break;
|
|||
|
|
case 1:
|
|||
|
|
myOCCViewer.BackView(flag);
|
|||
|
|
break;
|
|||
|
|
case 2:
|
|||
|
|
myOCCViewer.TopView (flag);
|
|||
|
|
break;
|
|||
|
|
case 3:
|
|||
|
|
myOCCViewer.BottomView(flag);
|
|||
|
|
break;
|
|||
|
|
case 4:
|
|||
|
|
myOCCViewer.LeftView(flag);
|
|||
|
|
break;
|
|||
|
|
case 5:
|
|||
|
|
myOCCViewer.RightView(flag);
|
|||
|
|
break;
|
|||
|
|
case 6:
|
|||
|
|
myOCCViewer.AxoViewF(flag);
|
|||
|
|
break;
|
|||
|
|
case 7:
|
|||
|
|
myOCCViewer.AxoViewB(flag);
|
|||
|
|
break;
|
|||
|
|
default:
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
//myOCCViewer.DepthFitAll(flag);
|
|||
|
|
//20170801 added by czb
|
|||
|
|
bool fflag;
|
|||
|
|
int ID= myOCCViewer.GetCurrentSelectedId(fflag);
|
|||
|
|
int type=ID/MAX_SIZE_OF_OBJECT_GROUP;
|
|||
|
|
if ( myOCCViewer.GetNumofSelected()==1 && type>=1 &&type<2)
|
|||
|
|
{
|
|||
|
|
ShowPointOnLine(ID);//如果只选中一根线，则要显示线上的点
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//打开或关闭定时器 Lvxj
|
|||
|
|
DLLEXPORT void EnableTimer(bool isTimerEnable)
|
|||
|
|
{
|
|||
|
|
myOCCViewer.EnAbleTimer(isTimerEnable);
|
|||
|
|
}
|
|||
|
|
DLLEXPORT BOOL SelectOneMode(int x, int y,int ids[],int flag, double &rx, double &ry, double &rz,bool bctrlselect)
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT BOOL SelectFrameMode(int prex,int prey,int x,int y,int flag,int IDs[],double &rx, double &ry, double &rz,bool bctrlselect)
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT BOOL SelectOppositeFrameMode(int prex,int prey,int x,int y,int flag,int IDs[],double &rx, double &ry, double &rz,bool bctrlselect)
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT bool HiLight( int id [])
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
*/
|
|||
|
|
DLLEXPORT void SetObjVisible(int n,int ids[], int visibles[])
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void SetInteractType(int type)
|
|||
|
|
{
|
|||
|
|
//设置图形交互类型(可选择对象类型) type可选择对象类型:0所有图元,1屏幕任意位置,2曲线节点(knot)
|
|||
|
|
dataMD.m_curInteractType=type;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT int GenShapeLine2(double x, ScPoint2D *pt,bool withDeck, int dir, double v)
|
|||
|
|
{
|
|||
|
|
std::map<double ,ScPoint2D> pitmap;
|
|||
|
|
std::map<double ,ScPoint2D>::iterator ptit;
|
|||
|
|
std::map<double ,ScPoint2D> pitmap2;
|
|||
|
|
std::map<double ,ScPoint2D>::iterator ptit2;
|
|||
|
|
TopoDS_Edge tpinsecedge;
|
|||
|
|
double dF,dL;
|
|||
|
|
double dF2,dL2;
|
|||
|
|
gp_Pnt fp,ep,fp2,ep2,tempp;
|
|||
|
|
|
|||
|
|
TopoDS_Shape TopoShape,sshape1,sshape2,sshapeship,sshapetemp;
|
|||
|
|
double step=0.2;
|
|||
|
|
int ptnum=0;
|
|||
|
|
BRepBuilderAPI_MakeWire wiretest ;
|
|||
|
|
TopExp_Explorer ex;
|
|||
|
|
bool insertbehind=false;
|
|||
|
|
|
|||
|
|
if(dataMD.m_mapMainDeckSurf.size()==1)
|
|||
|
|
sshape1=dataMD.m_mapAllTopoShapes.find(dataMD.m_mapMainDeckSurf.begin()->first)->second;
|
|||
|
|
else
|
|||
|
|
return ptnum;
|
|||
|
|
if(dataMD.m_mapShellSurf.size()==1)
|
|||
|
|
sshape2=dataMD.m_mapAllTopoShapes.find(dataMD.m_mapShellSurf.begin()->first)->second;
|
|||
|
|
else
|
|||
|
|
return ptnum;
|
|||
|
|
|
|||
|
|
double miny=-100;
|
|||
|
|
double maxy=100;
|
|||
|
|
double minx=x;
|
|||
|
|
double maxx=x;
|
|||
|
|
double minz=-50;
|
|||
|
|
double maxz=100;
|
|||
|
|
|
|||
|
|
gp_Pnt p1;
|
|||
|
|
gp_Pnt p2;
|
|||
|
|
gp_Pnt p3;
|
|||
|
|
p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
p2=gp_Pnt(minx,miny,maxz);
|
|||
|
|
p3=gp_Pnt(minx,maxy,maxz);
|
|||
|
|
|
|||
|
|
gp_Lin aLin(p1,gp_Vec(p1,p2));
|
|||
|
|
double dist = aLin.Distance(p3);
|
|||
|
|
if(dist < Precision::Confusion())
|
|||
|
|
{
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
TopoDS_Edge aE = BRepBuilderAPI_MakeEdge(p1,p2);
|
|||
|
|
if(!aE.IsNull())
|
|||
|
|
{
|
|||
|
|
//计算拉伸方向
|
|||
|
|
gp_Lin aDLin = aLin.Normal(p3);
|
|||
|
|
double x,y,z;
|
|||
|
|
aDLin.Direction().Coord(x,y,z);
|
|||
|
|
sshapetemp = BRepPrimAPI_MakePrism(aE,gp_Vec(dist * x,dist * y,dist * z));
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//缝合后求交
|
|||
|
|
BRepOffsetAPI_Sewing aMethod;
|
|||
|
|
aMethod.Add(sshape1);
|
|||
|
|
aMethod.Add(sshape2);
|
|||
|
|
aMethod.Perform();
|
|||
|
|
sshapeship = aMethod.SewedShape();
|
|||
|
|
|
|||
|
|
BRepAlgoAPI_Section sec1(sshapeship,sshapetemp,Standard_False);
|
|||
|
|
sec1.ComputePCurveOn1(Standard_True);
|
|||
|
|
sec1.Approximation(TopOpeBRepTool_APPROX);
|
|||
|
|
|
|||
|
|
BOOL bDone = TRUE;
|
|||
|
|
try
|
|||
|
|
{
|
|||
|
|
sec1.Build();
|
|||
|
|
}
|
|||
|
|
catch(Standard_Failure)
|
|||
|
|
{
|
|||
|
|
bDone = FALSE;
|
|||
|
|
}
|
|||
|
|
if(!bDone || !sec1.IsDone())
|
|||
|
|
{
|
|||
|
|
return ptnum;
|
|||
|
|
}
|
|||
|
|
TopoDS_Shape splitResult = sec1.Shape();
|
|||
|
|
list<TopoDS_Edge> edgeList;
|
|||
|
|
dataMD.GetInsectWirePts( splitResult,edgeList );
|
|||
|
|
|
|||
|
|
//方法一、船壳甲板线弯曲！！！！
|
|||
|
|
//tpinsecedge=dataMD.SetInsectWireToEdge(edgeList);
|
|||
|
|
//Handle(Geom_Curve) aCur= BRep_Tool::Curve(tpinsecedge,dF,dL);
|
|||
|
|
//if(dir==0)//返回所有点
|
|||
|
|
//{
|
|||
|
|
// int k=(int)(dL-dF)/step;
|
|||
|
|
// if (k>0)
|
|||
|
|
// {
|
|||
|
|
// fp=aCur->Value(dF);
|
|||
|
|
// ep=aCur->Value(dL);
|
|||
|
|
// for(int i=0;i<k;i++)
|
|||
|
|
// {
|
|||
|
|
// gp_Pnt pt1=aCur->Value(dF+step*i);
|
|||
|
|
// (pt+ptnum)->Y=pt1.Y();
|
|||
|
|
// (pt+ptnum)->Z=pt1.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
//}
|
|||
|
|
//else if(dir==1)//返回与y= v？的交点
|
|||
|
|
//{
|
|||
|
|
// gp_Pnt Or=gp_Pnt(0,0,0.);
|
|||
|
|
// gp_Dir Norm=gp_Dir(0., 1, 0.);
|
|||
|
|
// gp_Pln pln(Or,Norm);
|
|||
|
|
// Handle(Geom_Surface) aSurface =GC_MakePlane(pln).Value();
|
|||
|
|
// GeomAPI_IntCS intcs_sn(aCur, aSurface);
|
|||
|
|
// if (!intcs_sn.IsDone())
|
|||
|
|
// {
|
|||
|
|
// dataMD.errorinfo="交点生成失败 ";
|
|||
|
|
// return 0;
|
|||
|
|
// }
|
|||
|
|
// int nPnt=intcs_sn.NbPoints();
|
|||
|
|
// if (nPnt<= 0)
|
|||
|
|
// {
|
|||
|
|
// dataMD.errorinfo="不能相交,没有交点 ";
|
|||
|
|
// return 0;
|
|||
|
|
// }
|
|||
|
|
// for(int i=1;i<=nPnt;i++)
|
|||
|
|
// {
|
|||
|
|
// gp_Pnt interpt = intcs_sn.Point(i);
|
|||
|
|
// BRepBuilderAPI_MakeVertex newv(interpt);
|
|||
|
|
// if(!newv.IsDone())
|
|||
|
|
// {
|
|||
|
|
// dataMD.errorinfo="生成交点失败";
|
|||
|
|
// return 0;
|
|||
|
|
// }
|
|||
|
|
// if(abs(interpt.X())<10e-14)
|
|||
|
|
// interpt.SetX(0.0);
|
|||
|
|
// if(abs(interpt.Y())<10e-14)
|
|||
|
|
// interpt.SetY(0.0);
|
|||
|
|
// if(abs(interpt.Z())<10e-14)
|
|||
|
|
// interpt.SetZ(0.0);
|
|||
|
|
// (pt+ptnum)->Y=interpt.Y();
|
|||
|
|
// (pt+ptnum)->Z=interpt.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
//}
|
|||
|
|
//else if(dir==2)//返回与z= v？的交点
|
|||
|
|
//{
|
|||
|
|
// gp_Pnt Or=gp_Pnt(0,0,1);
|
|||
|
|
// gp_Dir Norm=gp_Dir(0.,0, 1);
|
|||
|
|
// gp_Pln pln(Or,Norm);
|
|||
|
|
// Handle(Geom_Surface) aSurface =GC_MakePlane(pln).Value();
|
|||
|
|
// GeomAPI_IntCS intcs_sn(aCur, aSurface);
|
|||
|
|
// if (!intcs_sn.IsDone())
|
|||
|
|
// {
|
|||
|
|
// dataMD.errorinfo="交点生成失败 ";
|
|||
|
|
// return 0;
|
|||
|
|
// }
|
|||
|
|
// int nPnt=intcs_sn.NbPoints();
|
|||
|
|
// if (nPnt<= 0)
|
|||
|
|
// {
|
|||
|
|
// dataMD.errorinfo="不能相交,没有交点 ";
|
|||
|
|
// return 0;
|
|||
|
|
// }
|
|||
|
|
// for(int i=1;i<=nPnt;i++)
|
|||
|
|
// {
|
|||
|
|
// gp_Pnt interpt = intcs_sn.Point(i);
|
|||
|
|
// BRepBuilderAPI_MakeVertex newv(interpt);
|
|||
|
|
// if(!newv.IsDone())
|
|||
|
|
// {
|
|||
|
|
// dataMD.errorinfo="生成交点失败";
|
|||
|
|
// return 0;
|
|||
|
|
// }
|
|||
|
|
// if(abs(interpt.X())<10e-14)
|
|||
|
|
// interpt.SetX(0.0);
|
|||
|
|
// if(abs(interpt.Y())<10e-14)
|
|||
|
|
// interpt.SetY(0.0);
|
|||
|
|
// if(abs(interpt.Z())<10e-14)
|
|||
|
|
// interpt.SetZ(0.0);
|
|||
|
|
// (pt+ptnum)->Y=interpt.Y();
|
|||
|
|
// (pt+ptnum)->Z=interpt.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
//}
|
|||
|
|
//else
|
|||
|
|
//{
|
|||
|
|
// return 0;
|
|||
|
|
//}
|
|||
|
|
|
|||
|
|
////方法二、测试无问题，
|
|||
|
|
//list<TopoDS_Edge>::iterator iter1,iter2;
|
|||
|
|
//int i=0;
|
|||
|
|
//if(dir==0)
|
|||
|
|
//{
|
|||
|
|
// if(edgeList.size()>2)
|
|||
|
|
// {
|
|||
|
|
// iter1 = edgeList.begin();
|
|||
|
|
// iter2=edgeList.begin();
|
|||
|
|
// iter2++;
|
|||
|
|
// Handle(Geom_Curve) aBeginCur = BRep_Tool::Curve(TopoDS::Edge(*iter1),dF,dL);
|
|||
|
|
// Handle(Geom_Curve) aNextCur = BRep_Tool::Curve(TopoDS::Edge(*iter2),dF2,dL2);
|
|||
|
|
// fp=aBeginCur->Value(dF);
|
|||
|
|
// ep=aBeginCur->Value(dL);
|
|||
|
|
// fp2=aNextCur->Value(dF2);
|
|||
|
|
// ep2=aNextCur->Value(dL2);
|
|||
|
|
// if(abs(fp.Distance(fp2))<10e-5)
|
|||
|
|
// {
|
|||
|
|
// tempp=ep;
|
|||
|
|
// }
|
|||
|
|
// else if(abs(fp.Distance(ep2))<10e-5)
|
|||
|
|
// {
|
|||
|
|
// tempp=ep;
|
|||
|
|
// }
|
|||
|
|
// else if(abs(ep.Distance(fp2))<10e-5)
|
|||
|
|
// {
|
|||
|
|
// tempp=fp;
|
|||
|
|
// }
|
|||
|
|
// else if(abs(ep.Distance(ep2))<10e-5)
|
|||
|
|
// {
|
|||
|
|
// tempp=fp;
|
|||
|
|
// }
|
|||
|
|
// for(iter1 = edgeList.begin();iter1 != edgeList.end(); iter1++)
|
|||
|
|
// {
|
|||
|
|
// Handle(Geom_Curve) aCur = BRep_Tool::Curve(TopoDS::Edge(*iter1),dF,dL);
|
|||
|
|
// int k=(int)((dL-dF)/step);
|
|||
|
|
// k=k>0?k:1;
|
|||
|
|
// k=k>15?15:k;
|
|||
|
|
// if(k>0)
|
|||
|
|
// {
|
|||
|
|
// fp=aCur->Value(dF);
|
|||
|
|
// ep=aCur->Value(dL);
|
|||
|
|
// if(abs(fp.Distance(tempp))<10e-5)
|
|||
|
|
// {
|
|||
|
|
// for(i=0;i<k;i++)
|
|||
|
|
// {
|
|||
|
|
// gp_Pnt pt1=aCur->Value(dF+step*i);
|
|||
|
|
// if(i==0)
|
|||
|
|
// {
|
|||
|
|
// if(ptnum==0)
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->Y=fp.Y();
|
|||
|
|
// (pt+ptnum)->Z=fp.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->Y=pt1.Y();
|
|||
|
|
// (pt+ptnum)->Z=pt1.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
|
|||
|
|
// }
|
|||
|
|
// if(i==k)
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->Y=ep.Y();
|
|||
|
|
// (pt+ptnum)->Z=ep.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// tempp=ep;
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// for(i=0;i<k;i++)
|
|||
|
|
// {
|
|||
|
|
// gp_Pnt pt1=aCur->Value(dL-step*i);
|
|||
|
|
// if(i==0)
|
|||
|
|
// {
|
|||
|
|
// if(ptnum==0)
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->Y=ep.Y();
|
|||
|
|
// (pt+ptnum)->Z=ep.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->Y=pt1.Y();
|
|||
|
|
// (pt+ptnum)->Z=pt1.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// if(i==k)
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->Y=fp.Y();
|
|||
|
|
// (pt+ptnum)->Z=fp.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// tempp=fp;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
// double b1=(pt+ptnum-1)->Y-(pt)->Y;
|
|||
|
|
// double b2=(pt+ptnum-1)->Z-(pt)->Z;
|
|||
|
|
// if((abs(b1)<10e-5)&&(abs(b2)<10e-5))
|
|||
|
|
// ptnum--;
|
|||
|
|
// }
|
|||
|
|
//}
|
|||
|
|
//else if(dir==1)//返回与y= v？的交点
|
|||
|
|
//{
|
|||
|
|
// Handle(Geom_Surface) aSurface;
|
|||
|
|
// TopoDS_Shape aface;
|
|||
|
|
// double miny,maxy,minx,maxx,minz,maxz;
|
|||
|
|
// minz=-0.2*dataMD.m_shipDepth<-1?-0.2*dataMD.m_shipDepth:-100;
|
|||
|
|
// maxz=1.2*dataMD.m_shipDepth>1?1.2*dataMD.m_shipDepth:100;
|
|||
|
|
// minx=x;
|
|||
|
|
// maxx=x;
|
|||
|
|
// maxy=v;
|
|||
|
|
// miny=-100;
|
|||
|
|
// p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
// p2=gp_Pnt(minx,maxy,minz);
|
|||
|
|
// p3=gp_Pnt(minx,maxy,maxz);
|
|||
|
|
// gp_Lin aLin(p1,gp_Vec(p1,p2));
|
|||
|
|
// double dist = aLin.Distance(p3);
|
|||
|
|
// if(dist < Precision::Confusion())
|
|||
|
|
// return FALSE;
|
|||
|
|
// TopoDS_Edge aE = BRepBuilderAPI_MakeEdge(p1,p2);
|
|||
|
|
// if(!aE.IsNull())
|
|||
|
|
// {
|
|||
|
|
// //计算拉伸方向
|
|||
|
|
// gp_Lin aDLin = aLin.Normal(p3);
|
|||
|
|
// double x,y,z;
|
|||
|
|
// aDLin.Direction().Coord(x,y,z);
|
|||
|
|
// aface = BRepPrimAPI_MakePrism(aE,gp_Vec(dist * x,dist * y,dist * z));
|
|||
|
|
// aSurface=BRep_Tool::Surface(TopoDS::Face(aface));
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
// if(edgeList.size()>0)
|
|||
|
|
// {
|
|||
|
|
// for(iter1 = edgeList.begin();iter1 != edgeList.end(); iter1++)
|
|||
|
|
// {
|
|||
|
|
// Handle(Geom_Curve) aCur = BRep_Tool::Curve(TopoDS::Edge(*iter1),dF,dL);
|
|||
|
|
// GeomAPI_IntCS intcs_sn(aCur, aSurface);
|
|||
|
|
// if (!intcs_sn.IsDone())
|
|||
|
|
// {
|
|||
|
|
// dataMD.errorinfo="交点生成失败 ";
|
|||
|
|
// return 0;
|
|||
|
|
// }
|
|||
|
|
// int nPnt=intcs_sn.NbPoints();
|
|||
|
|
// if (nPnt<= 0)
|
|||
|
|
// {
|
|||
|
|
// continue;
|
|||
|
|
// }
|
|||
|
|
// for(int i=1;i<=nPnt;i++)
|
|||
|
|
// {
|
|||
|
|
// gp_Pnt interpt = intcs_sn.Point(i);
|
|||
|
|
// BRepBuilderAPI_MakeVertex newv(interpt);
|
|||
|
|
// if(abs(interpt.X())<10e-14)
|
|||
|
|
// interpt.SetX(0.0);
|
|||
|
|
// if(abs(interpt.Y())<10e-14)
|
|||
|
|
// interpt.SetY(0.0);
|
|||
|
|
// if(abs(interpt.Z())<10e-14)
|
|||
|
|
// interpt.SetZ(0.0);
|
|||
|
|
// (pt+ptnum)->Y=interpt.Y();
|
|||
|
|
// (pt+ptnum)->Z=interpt.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
//}
|
|||
|
|
//else if(dir==2)//返回与z= v？的交点
|
|||
|
|
//{
|
|||
|
|
// Handle(Geom_Surface) aSurface;
|
|||
|
|
// TopoDS_Shape aface;
|
|||
|
|
// double miny,maxy,minx,maxx,minz,maxz;
|
|||
|
|
// miny=-dataMD.m_shipWidth<-1?-dataMD.m_shipWidth:-100;
|
|||
|
|
// maxy=dataMD.m_shipWidth>1?dataMD.m_shipWidth:100;
|
|||
|
|
// minx=x;
|
|||
|
|
// maxx=x;
|
|||
|
|
// minz=-100;
|
|||
|
|
// maxz=v;
|
|||
|
|
// p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
// p2=gp_Pnt(minx,miny,maxz);
|
|||
|
|
// p3=gp_Pnt(minx,maxy,maxz);
|
|||
|
|
// gp_Lin aLin(p1,gp_Vec(p1,p2));
|
|||
|
|
// double dist = aLin.Distance(p3);
|
|||
|
|
// if(dist < Precision::Confusion())
|
|||
|
|
// return FALSE;
|
|||
|
|
// TopoDS_Edge aE = BRepBuilderAPI_MakeEdge(p1,p2);
|
|||
|
|
// if(!aE.IsNull())
|
|||
|
|
// {
|
|||
|
|
// //计算拉伸方向
|
|||
|
|
// gp_Lin aDLin = aLin.Normal(p3);
|
|||
|
|
// double x,y,z;
|
|||
|
|
// aDLin.Direction().Coord(x,y,z);
|
|||
|
|
// aface = BRepPrimAPI_MakePrism(aE,gp_Vec(dist * x,dist * y,dist * z));
|
|||
|
|
// aSurface=BRep_Tool::Surface(TopoDS::Face(aface));
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
// if(edgeList.size()>0)
|
|||
|
|
// {
|
|||
|
|
// for(iter1 = edgeList.begin();iter1 != edgeList.end(); iter1++)
|
|||
|
|
// {
|
|||
|
|
// Handle(Geom_Curve) aCur = BRep_Tool::Curve(TopoDS::Edge(*iter1),dF,dL);
|
|||
|
|
// GeomAPI_IntCS intcs_sn(aCur, aSurface);
|
|||
|
|
// if (!intcs_sn.IsDone())
|
|||
|
|
// {
|
|||
|
|
// dataMD.errorinfo="交点生成失败 ";
|
|||
|
|
// return 0;
|
|||
|
|
// }
|
|||
|
|
// int nPnt=intcs_sn.NbPoints();
|
|||
|
|
// if (nPnt<= 0)
|
|||
|
|
// {
|
|||
|
|
// continue;
|
|||
|
|
// }
|
|||
|
|
// for(int i=1;i<=nPnt;i++)
|
|||
|
|
// {
|
|||
|
|
// gp_Pnt interpt = intcs_sn.Point(i);
|
|||
|
|
// BRepBuilderAPI_MakeVertex newv(interpt);
|
|||
|
|
// if(abs(interpt.X())<10e-14)
|
|||
|
|
// interpt.SetX(0.0);
|
|||
|
|
// if(abs(interpt.Y())<10e-14)
|
|||
|
|
// interpt.SetY(0.0);
|
|||
|
|
// if(abs(interpt.Z())<10e-14)
|
|||
|
|
// interpt.SetZ(0.0);
|
|||
|
|
// (pt+ptnum)->Y=interpt.Y();
|
|||
|
|
// (pt+ptnum)->Z=interpt.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
//}
|
|||
|
|
//else
|
|||
|
|
//{
|
|||
|
|
// return 0;
|
|||
|
|
//}
|
|||
|
|
|
|||
|
|
//方法三
|
|||
|
|
|
|||
|
|
list<TopoDS_Edge>::iterator iter1,iter2;
|
|||
|
|
int i=0;
|
|||
|
|
if(dir==0)
|
|||
|
|
{
|
|||
|
|
if(edgeList.size()>2)
|
|||
|
|
{
|
|||
|
|
iter1 = edgeList.begin();
|
|||
|
|
iter2=edgeList.begin();
|
|||
|
|
iter2++;
|
|||
|
|
Handle(Geom_Curve) aBeginCur = BRep_Tool::Curve(TopoDS::Edge(*iter1),dF,dL);
|
|||
|
|
Handle(Geom_Curve) aNextCur = BRep_Tool::Curve(TopoDS::Edge(*iter2),dF2,dL2);
|
|||
|
|
fp=aBeginCur->Value(dF);
|
|||
|
|
ep=aBeginCur->Value(dL);
|
|||
|
|
fp2=aNextCur->Value(dF2);
|
|||
|
|
ep2=aNextCur->Value(dL2);
|
|||
|
|
if(abs(fp.Distance(fp2))<10e-5)
|
|||
|
|
{
|
|||
|
|
tempp=ep;
|
|||
|
|
}
|
|||
|
|
else if(abs(fp.Distance(ep2))<10e-5)
|
|||
|
|
{
|
|||
|
|
tempp=ep;
|
|||
|
|
}
|
|||
|
|
else if(abs(ep.Distance(fp2))<10e-5)
|
|||
|
|
{
|
|||
|
|
tempp=fp;
|
|||
|
|
}
|
|||
|
|
else if(abs(ep.Distance(ep2))<10e-5)
|
|||
|
|
{
|
|||
|
|
tempp=fp;
|
|||
|
|
}
|
|||
|
|
for(iter1 = edgeList.begin();iter1 != edgeList.end(); iter1++)
|
|||
|
|
{
|
|||
|
|
Handle(Geom_Curve) aCur = BRep_Tool::Curve(TopoDS::Edge(*iter1),dF,dL);
|
|||
|
|
int k=(int)((dL-dF)/step);
|
|||
|
|
k=k>0?k:1;
|
|||
|
|
k=k>15?15:k;
|
|||
|
|
if(k>0)
|
|||
|
|
{
|
|||
|
|
fp=aCur->Value(dF);
|
|||
|
|
ep=aCur->Value(dL);
|
|||
|
|
if(abs(fp.Distance(tempp))<10e-5)
|
|||
|
|
{
|
|||
|
|
for(i=0;i<k;i++)
|
|||
|
|
{
|
|||
|
|
gp_Pnt pt1=aCur->Value(dF+step*i);
|
|||
|
|
if(i==0)
|
|||
|
|
{
|
|||
|
|
if(ptnum==0)
|
|||
|
|
{
|
|||
|
|
(pt+ptnum)->Y=fp.Y();
|
|||
|
|
(pt+ptnum)->Z=fp.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
(pt+ptnum)->Y=pt1.Y();
|
|||
|
|
(pt+ptnum)->Z=pt1.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
if(i==k)
|
|||
|
|
{
|
|||
|
|
(pt+ptnum)->Y=ep.Y();
|
|||
|
|
(pt+ptnum)->Z=ep.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
tempp=ep;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
for(i=0;i<k;i++)
|
|||
|
|
{
|
|||
|
|
gp_Pnt pt1=aCur->Value(dL-step*i);
|
|||
|
|
if(i==0)
|
|||
|
|
{
|
|||
|
|
if(ptnum==0)
|
|||
|
|
{
|
|||
|
|
(pt+ptnum)->Y=ep.Y();
|
|||
|
|
(pt+ptnum)->Z=ep.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
(pt+ptnum)->Y=pt1.Y();
|
|||
|
|
(pt+ptnum)->Z=pt1.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
if(i==k)
|
|||
|
|
{
|
|||
|
|
(pt+ptnum)->Y=fp.Y();
|
|||
|
|
(pt+ptnum)->Z=fp.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
tempp=fp;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
double b1=(pt+ptnum-1)->Y-(pt)->Y;
|
|||
|
|
double b2=(pt+ptnum-1)->Z-(pt)->Z;
|
|||
|
|
if((abs(b1)<10e-5)&&(abs(b2)<10e-5))
|
|||
|
|
ptnum--;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else if(dir==1)//返回与y= v？的交点
|
|||
|
|
{
|
|||
|
|
tpinsecedge=dataMD.SetInsectWireToEdge(edgeList);
|
|||
|
|
Handle(Geom_Curve) aCur= BRep_Tool::Curve(tpinsecedge,dF,dL);
|
|||
|
|
Handle(Geom_Surface) aSurface;
|
|||
|
|
TopoDS_Shape aface;
|
|||
|
|
double miny,maxy,minx,maxx,minz,maxz;
|
|||
|
|
minz=-0.2*dataMD.m_shipDepth<-1?-0.2*dataMD.m_shipDepth:-100;
|
|||
|
|
maxz=1.2*dataMD.m_shipDepth>1?1.2*dataMD.m_shipDepth:100;
|
|||
|
|
minx=-100;
|
|||
|
|
maxx=100;
|
|||
|
|
maxy=v;
|
|||
|
|
miny=v;
|
|||
|
|
p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
p2=gp_Pnt(minx,miny,maxz);
|
|||
|
|
p3=gp_Pnt(maxx,miny,maxz);
|
|||
|
|
gp_Lin aLin(p1,gp_Vec(p1,p2));
|
|||
|
|
double dist = aLin.Distance(p3);
|
|||
|
|
if(dist < Precision::Confusion())
|
|||
|
|
return FALSE;
|
|||
|
|
TopoDS_Edge aE = BRepBuilderAPI_MakeEdge(p1,p2);
|
|||
|
|
if(!aE.IsNull())
|
|||
|
|
{
|
|||
|
|
//计算拉伸方向
|
|||
|
|
gp_Lin aDLin = aLin.Normal(p3);
|
|||
|
|
double x,y,z;
|
|||
|
|
aDLin.Direction().Coord(x,y,z);
|
|||
|
|
aface = BRepPrimAPI_MakePrism(aE,gp_Vec(dist * x,dist * y,dist * z));
|
|||
|
|
aSurface=BRep_Tool::Surface(TopoDS::Face(aface));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
GeomAPI_IntCS intcs_sn(aCur, aSurface);
|
|||
|
|
if (!intcs_sn.IsDone())
|
|||
|
|
{
|
|||
|
|
dataMD.errorinfo="交点生成失败 ";
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
int nPnt=intcs_sn.NbPoints();
|
|||
|
|
for(int i=1;i<=nPnt;i++)
|
|||
|
|
{
|
|||
|
|
gp_Pnt interpt = intcs_sn.Point(i);
|
|||
|
|
BRepBuilderAPI_MakeVertex newv(interpt);
|
|||
|
|
if(abs(interpt.X())<10e-14)
|
|||
|
|
interpt.SetX(0.0);
|
|||
|
|
if(abs(interpt.Y())<10e-14)
|
|||
|
|
interpt.SetY(0.0);
|
|||
|
|
if(abs(interpt.Z())<10e-14)
|
|||
|
|
interpt.SetZ(0.0);
|
|||
|
|
(pt+ptnum)->Y=interpt.Y();
|
|||
|
|
(pt+ptnum)->Z=interpt.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else if(dir==2)//返回与z= v？的交点
|
|||
|
|
{
|
|||
|
|
tpinsecedge=dataMD.SetInsectWireToEdge(edgeList);
|
|||
|
|
Handle(Geom_Curve) aCur= BRep_Tool::Curve(tpinsecedge,dF,dL);
|
|||
|
|
Handle(Geom_Surface) aSurface;
|
|||
|
|
TopoDS_Shape aface;
|
|||
|
|
double miny,maxy,minx,maxx,minz,maxz;
|
|||
|
|
miny=-dataMD.m_shipWidth<-1?-dataMD.m_shipWidth:-100;
|
|||
|
|
maxy=dataMD.m_shipWidth>1?dataMD.m_shipWidth:100;
|
|||
|
|
minx=-100;
|
|||
|
|
maxx=100;
|
|||
|
|
minz=v;
|
|||
|
|
maxz=v;
|
|||
|
|
p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
p2=gp_Pnt(minx,maxy,minz);
|
|||
|
|
p3=gp_Pnt(maxx,maxy,minz);
|
|||
|
|
gp_Lin aLin(p1,gp_Vec(p1,p2));
|
|||
|
|
double dist = aLin.Distance(p3);
|
|||
|
|
if(dist < Precision::Confusion())
|
|||
|
|
return FALSE;
|
|||
|
|
TopoDS_Edge aE = BRepBuilderAPI_MakeEdge(p1,p2);
|
|||
|
|
if(!aE.IsNull())
|
|||
|
|
{
|
|||
|
|
//计算拉伸方向
|
|||
|
|
gp_Lin aDLin = aLin.Normal(p3);
|
|||
|
|
double x,y,z;
|
|||
|
|
aDLin.Direction().Coord(x,y,z);
|
|||
|
|
aface = BRepPrimAPI_MakePrism(aE,gp_Vec(dist * x,dist * y,dist * z));
|
|||
|
|
aSurface=BRep_Tool::Surface(TopoDS::Face(aface));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
GeomAPI_IntCS intcs_sn(aCur, aSurface);
|
|||
|
|
if (!intcs_sn.IsDone())
|
|||
|
|
{
|
|||
|
|
dataMD.errorinfo="交点生成失败 ";
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
int nPnt=intcs_sn.NbPoints();
|
|||
|
|
for(int i=1;i<=nPnt;i++)
|
|||
|
|
{
|
|||
|
|
gp_Pnt interpt = intcs_sn.Point(i);
|
|||
|
|
BRepBuilderAPI_MakeVertex newv(interpt);
|
|||
|
|
if(abs(interpt.X())<10e-14)
|
|||
|
|
interpt.SetX(0.0);
|
|||
|
|
if(abs(interpt.Y())<10e-14)
|
|||
|
|
interpt.SetY(0.0);
|
|||
|
|
if(abs(interpt.Z())<10e-14)
|
|||
|
|
interpt.SetZ(0.0);
|
|||
|
|
(pt+ptnum)->Y=interpt.Y();
|
|||
|
|
(pt+ptnum)->Z=interpt.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
/*Handle_AIS_Shape AISShape=new AIS_Shape(splitResult);
|
|||
|
|
myOCCViewer.myAISContext->SetColor(AISShape,Quantity_Color(1,0,0,Quantity_TOC_RGB), false);
|
|||
|
|
myOCCViewer.myAISContext->SetTransparency(AISShape,1,false);
|
|||
|
|
myOCCViewer.myAISContext->SetMaterial(AISShape, Graphic3d_NOM_SILVER, false);
|
|||
|
|
myOCCViewer.myAISContext->Display(AISShape,false);*/
|
|||
|
|
|
|||
|
|
return ptnum;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT int GenShapeLine(OffsetTablePoint *pt,int dir1, double v1, int dir2, double v2)
|
|||
|
|
{
|
|||
|
|
BaseAlgo algo;
|
|||
|
|
std::map<double ,ScPoint2D> pitmap;
|
|||
|
|
std::map<double ,ScPoint2D>::iterator ptit;
|
|||
|
|
std::map<double ,ScPoint2D> pitmap2;
|
|||
|
|
std::map<double ,ScPoint2D>::iterator ptit2;
|
|||
|
|
TopoDS_Edge tpinsecedge;
|
|||
|
|
double dF,dL;
|
|||
|
|
gp_Pnt fp,ep,fp2,ep2,tempp;
|
|||
|
|
|
|||
|
|
TopoDS_Shape TopoShape,sshape1,sshape2,sshapeship,sshapetemp;
|
|||
|
|
double step=0.2;
|
|||
|
|
int ptnum=0;
|
|||
|
|
BRepBuilderAPI_MakeWire wiretest ;
|
|||
|
|
TopExp_Explorer ex;
|
|||
|
|
bool insertbehind=false;
|
|||
|
|
|
|||
|
|
if(dataMD.m_mapMainDeckSurf.size()==1)
|
|||
|
|
sshape1=dataMD.m_mapAllTopoShapes.find(dataMD.m_mapMainDeckSurf.begin()->first)->second;
|
|||
|
|
else
|
|||
|
|
return ptnum;
|
|||
|
|
if(dataMD.m_mapShellSurf.size()==1)
|
|||
|
|
sshape2=dataMD.m_mapAllTopoShapes.find(dataMD.m_mapShellSurf.begin()->first)->second;
|
|||
|
|
else
|
|||
|
|
return ptnum;
|
|||
|
|
|
|||
|
|
double miny,maxy;
|
|||
|
|
double minx,maxx;
|
|||
|
|
double minz,maxz;
|
|||
|
|
|
|||
|
|
BRepBuilderAPI_MakeFace face;
|
|||
|
|
if(dir1==0)
|
|||
|
|
{
|
|||
|
|
miny=-100;
|
|||
|
|
maxy=100;
|
|||
|
|
minx=v1;
|
|||
|
|
maxx=v1;
|
|||
|
|
minz=-50;
|
|||
|
|
maxz=50;
|
|||
|
|
}
|
|||
|
|
else if(dir1==1)
|
|||
|
|
{
|
|||
|
|
miny=v1;
|
|||
|
|
maxy=v1;
|
|||
|
|
minx=-200;
|
|||
|
|
maxx=500;
|
|||
|
|
minz=-50;
|
|||
|
|
maxz=50;
|
|||
|
|
}
|
|||
|
|
else if(dir1==2)
|
|||
|
|
{
|
|||
|
|
miny=-100;
|
|||
|
|
maxy=100;
|
|||
|
|
minx=-200;
|
|||
|
|
maxx=500;
|
|||
|
|
minz=v1;
|
|||
|
|
maxz=v1;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
gp_Pnt p1;
|
|||
|
|
gp_Pnt p2;
|
|||
|
|
gp_Pnt p3;
|
|||
|
|
if(dir1==0)
|
|||
|
|
{
|
|||
|
|
p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
p2=gp_Pnt(minx,miny,maxz);
|
|||
|
|
p3=gp_Pnt(minx,maxy,maxz);
|
|||
|
|
}
|
|||
|
|
else if(dir1==1)
|
|||
|
|
{
|
|||
|
|
p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
p2=gp_Pnt(minx,miny,maxz);
|
|||
|
|
p3=gp_Pnt(maxx,miny,maxz);
|
|||
|
|
}
|
|||
|
|
else if(dir1==2)
|
|||
|
|
{
|
|||
|
|
p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
p2=gp_Pnt(minx,maxy,minz);
|
|||
|
|
p3=gp_Pnt(maxx,maxy,minz);
|
|||
|
|
}
|
|||
|
|
gp_Lin aLin(p1,gp_Vec(p1,p2));
|
|||
|
|
double dist = aLin.Distance(p3);
|
|||
|
|
if(dist < Precision::Confusion())
|
|||
|
|
return ptnum;
|
|||
|
|
|
|||
|
|
TopoDS_Edge aE = BRepBuilderAPI_MakeEdge(p1,p2);
|
|||
|
|
if(!aE.IsNull())
|
|||
|
|
{
|
|||
|
|
//计算拉伸方向
|
|||
|
|
gp_Lin aDLin = aLin.Normal(p3);
|
|||
|
|
double x,y,z;
|
|||
|
|
aDLin.Direction().Coord(x,y,z);
|
|||
|
|
sshapetemp = BRepPrimAPI_MakePrism(aE,gp_Vec(dist * x,dist * y,dist * z));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
//缝合后求交
|
|||
|
|
BRepOffsetAPI_Sewing aMethod;
|
|||
|
|
aMethod.Add(sshape1);
|
|||
|
|
aMethod.Add(sshape2);
|
|||
|
|
aMethod.Perform();
|
|||
|
|
sshapeship = aMethod.SewedShape();
|
|||
|
|
|
|||
|
|
BRepAlgoAPI_Section sec1(sshapeship,sshapetemp,Standard_False);
|
|||
|
|
sec1.ComputePCurveOn1(Standard_True);
|
|||
|
|
sec1.Approximation(TopOpeBRepTool_APPROX);
|
|||
|
|
|
|||
|
|
BOOL bDone = TRUE;
|
|||
|
|
try
|
|||
|
|
{
|
|||
|
|
sec1.Build();
|
|||
|
|
}
|
|||
|
|
catch(Standard_Failure)
|
|||
|
|
{
|
|||
|
|
bDone = FALSE;
|
|||
|
|
}
|
|||
|
|
if(!bDone || !sec1.IsDone())
|
|||
|
|
{
|
|||
|
|
return ptnum;
|
|||
|
|
}
|
|||
|
|
TopoDS_Shape splitResult = sec1.Shape();
|
|||
|
|
list<TopoDS_Edge> edgeList;
|
|||
|
|
dataMD.GetInsectWirePts( splitResult,edgeList );
|
|||
|
|
|
|||
|
|
map<int, TopoDS_Edge> mapEdge;
|
|||
|
|
for (TopExp_Explorer Ex(splitResult,TopAbs_EDGE); Ex.More(); Ex.Next())
|
|||
|
|
{
|
|||
|
|
mapEdge.insert(make_pair(mapEdge.size(), TopoDS::Edge(Ex.Current())));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
vector<vector<int>> edgeIndex;
|
|||
|
|
algo.GetWireSingleEdges(mapEdge,edgeIndex);
|
|||
|
|
|
|||
|
|
|
|||
|
|
list<TopoDS_Edge>::iterator iter1,iter2;
|
|||
|
|
int i=0;
|
|||
|
|
if(dir2==-1)
|
|||
|
|
{
|
|||
|
|
//if(edgeList.size()>2)
|
|||
|
|
//{
|
|||
|
|
//iter1 = edgeList.begin();
|
|||
|
|
//iter2=edgeList.begin();
|
|||
|
|
//iter2++;
|
|||
|
|
//Handle(Geom_Curve) aBeginCur = BRep_Tool::Curve(TopoDS::Edge(*iter1),dF,dL);
|
|||
|
|
//Handle(Geom_Curve) aNextCur = BRep_Tool::Curve(TopoDS::Edge(*iter2),dF2,dL2);
|
|||
|
|
//fp=aBeginCur->Value(dF);
|
|||
|
|
//ep=aBeginCur->Value(dL);
|
|||
|
|
//fp2=aNextCur->Value(dF2);
|
|||
|
|
//ep2=aNextCur->Value(dL2);
|
|||
|
|
//if(abs(fp.Distance(fp2))<10e-5)
|
|||
|
|
//{
|
|||
|
|
// tempp=ep;
|
|||
|
|
//}
|
|||
|
|
//else if(abs(fp.Distance(ep2))<10e-5)
|
|||
|
|
//{
|
|||
|
|
// tempp=ep;
|
|||
|
|
//}
|
|||
|
|
//else if(abs(ep.Distance(fp2))<10e-5)
|
|||
|
|
//{
|
|||
|
|
// tempp=fp;
|
|||
|
|
//}
|
|||
|
|
//else if(abs(ep.Distance(ep2))<10e-5)
|
|||
|
|
//{
|
|||
|
|
// tempp=fp;
|
|||
|
|
//}
|
|||
|
|
//for(iter1 = edgeList.begin();iter1 != edgeList.end(); iter1++)
|
|||
|
|
//{
|
|||
|
|
// Handle(Geom_Curve) aCur = BRep_Tool::Curve(TopoDS::Edge(*iter1),dF,dL);
|
|||
|
|
// int k=(int)((dL-dF)/step);
|
|||
|
|
// k=k>0?k:1;
|
|||
|
|
// k=k>15?15:k;
|
|||
|
|
// if(k>0)
|
|||
|
|
// {
|
|||
|
|
// fp=aCur->Value(dF);
|
|||
|
|
// ep=aCur->Value(dL);
|
|||
|
|
// if(abs(fp.Distance(tempp))<10e-5)
|
|||
|
|
// {
|
|||
|
|
// for(i=0;i<k;i++)
|
|||
|
|
// {
|
|||
|
|
// gp_Pnt pt1=aCur->Value(dF+step*i);
|
|||
|
|
// if(i==0)
|
|||
|
|
// {
|
|||
|
|
// if(ptnum==0)
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->X=fp.X();
|
|||
|
|
// (pt+ptnum)->Y=fp.Y();
|
|||
|
|
// (pt+ptnum)->Z=fp.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->X=fp.X();
|
|||
|
|
// (pt+ptnum)->Y=pt1.Y();
|
|||
|
|
// (pt+ptnum)->Z=pt1.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
|
|||
|
|
|
|||
|
|
// }
|
|||
|
|
// if(i==k)
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->X=fp.X();
|
|||
|
|
// (pt+ptnum)->Y=ep.Y();
|
|||
|
|
// (pt+ptnum)->Z=ep.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// tempp=ep;
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// for(i=0;i<k;i++)
|
|||
|
|
// {
|
|||
|
|
// gp_Pnt pt1=aCur->Value(dL-step*i);
|
|||
|
|
// if(i==0)
|
|||
|
|
// {
|
|||
|
|
// if(ptnum==0)
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->X=fp.X();
|
|||
|
|
// (pt+ptnum)->Y=ep.Y();
|
|||
|
|
// (pt+ptnum)->Z=ep.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->X=fp.X();
|
|||
|
|
// (pt+ptnum)->Y=pt1.Y();
|
|||
|
|
// (pt+ptnum)->Z=pt1.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// if(i==k)
|
|||
|
|
// {
|
|||
|
|
// (pt+ptnum)->X=fp.X();
|
|||
|
|
// (pt+ptnum)->Y=fp.Y();
|
|||
|
|
// (pt+ptnum)->Z=fp.Z();
|
|||
|
|
// ptnum++;
|
|||
|
|
// }
|
|||
|
|
// tempp=fp;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
//}
|
|||
|
|
//double b3=(pt+ptnum-1)->X-(pt)->X;
|
|||
|
|
//double b1=(pt+ptnum-1)->Y-(pt)->Y;
|
|||
|
|
//double b2=(pt+ptnum-1)->Z-(pt)->Z;
|
|||
|
|
//if((abs(b1)<10e-5)&&(abs(b2)<10e-5)&&(abs(b3)<10e-5))
|
|||
|
|
// ptnum--;
|
|||
|
|
|
|||
|
|
//}
|
|||
|
|
|
|||
|
|
|
|||
|
|
for(int i = 0; i < edgeIndex.size(); i++)
|
|||
|
|
{
|
|||
|
|
vector<int> edgesID = edgeIndex[i];
|
|||
|
|
gp_Pnt startp;
|
|||
|
|
for(int j = 0; j < edgesID.size(); j++)
|
|||
|
|
{
|
|||
|
|
//加首不加尾
|
|||
|
|
int firstID =edgesID[j];
|
|||
|
|
int lastID = edgesID[(j + 1 )% edgesID.size()];
|
|||
|
|
TopoDS_Edge ef = mapEdge[firstID];
|
|||
|
|
TopoDS_Edge el = mapEdge[lastID];
|
|||
|
|
gp_Pnt p01,p02,p11,p12;
|
|||
|
|
double df,dl,df1,dl1;
|
|||
|
|
Handle(Geom_Curve) aCurf= BRep_Tool::Curve(ef,df,dl);
|
|||
|
|
p01 = aCurf->Value(df);
|
|||
|
|
p02 = aCurf->Value(dl);
|
|||
|
|
|
|||
|
|
Handle(Geom_Curve) aCurl= BRep_Tool::Curve(el,df1,dl1);
|
|||
|
|
p11 = aCurl->Value(df1);
|
|||
|
|
p12 = aCurl->Value(dl1);
|
|||
|
|
double step = (dl - df) / 15;
|
|||
|
|
step = step > 0.2 ? step : 0.2;
|
|||
|
|
|
|||
|
|
//algo.GetEdgeStartEndPoint(ef,p01,p02);
|
|||
|
|
//algo.GetEdgeStartEndPoint(el,p11,p12);
|
|||
|
|
|
|||
|
|
|
|||
|
|
|
|||
|
|
double f , l;
|
|||
|
|
|
|||
|
|
if(p02.Distance(p11) < Precision::Confusion() || p02.Distance(p12) < Precision::Confusion())
|
|||
|
|
{
|
|||
|
|
f = df;
|
|||
|
|
l = dl;
|
|||
|
|
if(j == 0)
|
|||
|
|
{
|
|||
|
|
startp = aCurf->Value(f);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
f= dl;
|
|||
|
|
l = df;
|
|||
|
|
step = -1* step;
|
|||
|
|
if(j == 0)
|
|||
|
|
{
|
|||
|
|
startp = aCurf->Value(f);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
int count = 0;
|
|||
|
|
bool isMore = true;
|
|||
|
|
|
|||
|
|
while(isMore)
|
|||
|
|
{
|
|||
|
|
double u = f + step * count;
|
|||
|
|
gp_Pnt p = aCurf->Value(u);
|
|||
|
|
(pt+ptnum)->X=p.X();
|
|||
|
|
(pt+ptnum)->Y=p.Y();
|
|||
|
|
(pt+ptnum)->Z=p.Z();
|
|||
|
|
|
|||
|
|
count++;
|
|||
|
|
ptnum++;
|
|||
|
|
isMore = (l > f)
|
|||
|
|
? !(l < f + count * step || abs(l - f - count * step ) < Precision::Confusion())
|
|||
|
|
: !(l > f + count * step || abs(l - f -count * step ) < Precision::Confusion()) ;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
(pt+ptnum)->X=startp.X();
|
|||
|
|
(pt+ptnum)->Y=startp.Y();
|
|||
|
|
(pt+ptnum)->Z=startp.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else if(dir2==0)//返回与x= v？的交点
|
|||
|
|
{
|
|||
|
|
tpinsecedge=dataMD.SetInsectWireToEdge(edgeList);
|
|||
|
|
Handle(Geom_Curve) aCur= BRep_Tool::Curve(tpinsecedge,dF,dL);
|
|||
|
|
Handle(Geom_Surface) aSurface;
|
|||
|
|
TopoDS_Shape aface;
|
|||
|
|
double miny,maxy,minx,maxx,minz,maxz;
|
|||
|
|
minz=-0.2*dataMD.m_shipDepth<-1?-0.2*dataMD.m_shipDepth:-100;
|
|||
|
|
maxz=1.2*dataMD.m_shipDepth>1?1.2*dataMD.m_shipDepth:100;
|
|||
|
|
miny=-100;
|
|||
|
|
maxy=100;
|
|||
|
|
minx=v2;
|
|||
|
|
maxx=v2;
|
|||
|
|
p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
p2=gp_Pnt(minx,miny,maxz);
|
|||
|
|
p3=gp_Pnt(minx,maxy,maxz);
|
|||
|
|
gp_Lin aLin(p1,gp_Vec(p1,p2));
|
|||
|
|
double dist = aLin.Distance(p3);
|
|||
|
|
if(dist < Precision::Confusion())
|
|||
|
|
return FALSE;
|
|||
|
|
TopoDS_Edge aE = BRepBuilderAPI_MakeEdge(p1,p2);
|
|||
|
|
if(!aE.IsNull())
|
|||
|
|
{
|
|||
|
|
//计算拉伸方向
|
|||
|
|
gp_Lin aDLin = aLin.Normal(p3);
|
|||
|
|
double x,y,z;
|
|||
|
|
aDLin.Direction().Coord(x,y,z);
|
|||
|
|
aface = BRepPrimAPI_MakePrism(aE,gp_Vec(dist * x,dist * y,dist * z));
|
|||
|
|
aSurface=BRep_Tool::Surface(TopoDS::Face(aface));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
GeomAPI_IntCS intcs_sn(aCur, aSurface);
|
|||
|
|
if (!intcs_sn.IsDone())
|
|||
|
|
{
|
|||
|
|
dataMD.errorinfo="交点生成失败 ";
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
int nPnt=intcs_sn.NbPoints();
|
|||
|
|
for(int i=1;i<=nPnt;i++)
|
|||
|
|
{
|
|||
|
|
gp_Pnt interpt = intcs_sn.Point(i);
|
|||
|
|
BRepBuilderAPI_MakeVertex newv(interpt);
|
|||
|
|
if(abs(interpt.X())<10e-14)
|
|||
|
|
interpt.SetX(0.0);
|
|||
|
|
if(abs(interpt.Y())<10e-14)
|
|||
|
|
interpt.SetY(0.0);
|
|||
|
|
if(abs(interpt.Z())<10e-14)
|
|||
|
|
interpt.SetZ(0.0);
|
|||
|
|
(pt+ptnum)->X=v2;
|
|||
|
|
(pt+ptnum)->Y=interpt.Y();
|
|||
|
|
(pt+ptnum)->Z=interpt.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else if(dir2==1)//返回与y= v？的交点
|
|||
|
|
{
|
|||
|
|
tpinsecedge=dataMD.SetInsectWireToEdge(edgeList);
|
|||
|
|
Handle(Geom_Curve) aCur= BRep_Tool::Curve(tpinsecedge,dF,dL);
|
|||
|
|
Handle(Geom_Surface) aSurface;
|
|||
|
|
TopoDS_Shape aface;
|
|||
|
|
double miny,maxy,minx,maxx,minz,maxz;
|
|||
|
|
minz=-0.2*dataMD.m_shipDepth<-1?-0.2*dataMD.m_shipDepth:-100;
|
|||
|
|
maxz=1.2*dataMD.m_shipDepth>1?1.2*dataMD.m_shipDepth:100;
|
|||
|
|
minx=-100;
|
|||
|
|
maxx=100;
|
|||
|
|
maxy=v2;
|
|||
|
|
miny=v2;
|
|||
|
|
p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
p2=gp_Pnt(minx,miny,maxz);
|
|||
|
|
p3=gp_Pnt(maxx,miny,maxz);
|
|||
|
|
gp_Lin aLin(p1,gp_Vec(p1,p2));
|
|||
|
|
double dist = aLin.Distance(p3);
|
|||
|
|
if(dist < Precision::Confusion())
|
|||
|
|
return FALSE;
|
|||
|
|
TopoDS_Edge aE = BRepBuilderAPI_MakeEdge(p1,p2);
|
|||
|
|
if(!aE.IsNull())
|
|||
|
|
{
|
|||
|
|
//计算拉伸方向
|
|||
|
|
gp_Lin aDLin = aLin.Normal(p3);
|
|||
|
|
double x,y,z;
|
|||
|
|
aDLin.Direction().Coord(x,y,z);
|
|||
|
|
aface = BRepPrimAPI_MakePrism(aE,gp_Vec(dist * x,dist * y,dist * z));
|
|||
|
|
aSurface=BRep_Tool::Surface(TopoDS::Face(aface));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
GeomAPI_IntCS intcs_sn(aCur, aSurface);
|
|||
|
|
if (!intcs_sn.IsDone())
|
|||
|
|
{
|
|||
|
|
dataMD.errorinfo="交点生成失败 ";
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
int nPnt=intcs_sn.NbPoints();
|
|||
|
|
for(int i=1;i<=nPnt;i++)
|
|||
|
|
{
|
|||
|
|
gp_Pnt interpt = intcs_sn.Point(i);
|
|||
|
|
BRepBuilderAPI_MakeVertex newv(interpt);
|
|||
|
|
if(abs(interpt.X())<10e-14)
|
|||
|
|
interpt.SetX(0.0);
|
|||
|
|
if(abs(interpt.Y())<10e-14)
|
|||
|
|
interpt.SetY(0.0);
|
|||
|
|
if(abs(interpt.Z())<10e-14)
|
|||
|
|
interpt.SetZ(0.0);
|
|||
|
|
(pt+ptnum)->Y=v2;
|
|||
|
|
(pt+ptnum)->X=interpt.X();
|
|||
|
|
(pt+ptnum)->Z=interpt.Z();
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else if(dir2==2)//返回与z= v？的交点
|
|||
|
|
{
|
|||
|
|
tpinsecedge=dataMD.SetInsectWireToEdge(edgeList);
|
|||
|
|
Handle(Geom_Curve) aCur= BRep_Tool::Curve(tpinsecedge,dF,dL);
|
|||
|
|
Handle(Geom_Surface) aSurface;
|
|||
|
|
TopoDS_Shape aface;
|
|||
|
|
double miny,maxy,minx,maxx,minz,maxz;
|
|||
|
|
miny=-dataMD.m_shipWidth<-1?-dataMD.m_shipWidth:-100;
|
|||
|
|
maxy=dataMD.m_shipWidth>1?dataMD.m_shipWidth:100;
|
|||
|
|
minx=-100;
|
|||
|
|
maxx=100;
|
|||
|
|
minz=v2;
|
|||
|
|
maxz=v2;
|
|||
|
|
p1=gp_Pnt(minx,miny,minz);
|
|||
|
|
p2=gp_Pnt(minx,maxy,minz);
|
|||
|
|
p3=gp_Pnt(maxx,maxy,minz);
|
|||
|
|
gp_Lin aLin(p1,gp_Vec(p1,p2));
|
|||
|
|
double dist = aLin.Distance(p3);
|
|||
|
|
if(dist < Precision::Confusion())
|
|||
|
|
return FALSE;
|
|||
|
|
TopoDS_Edge aE = BRepBuilderAPI_MakeEdge(p1,p2);
|
|||
|
|
if(!aE.IsNull())
|
|||
|
|
{
|
|||
|
|
//计算拉伸方向
|
|||
|
|
gp_Lin aDLin = aLin.Normal(p3);
|
|||
|
|
double x,y,z;
|
|||
|
|
aDLin.Direction().Coord(x,y,z);
|
|||
|
|
aface = BRepPrimAPI_MakePrism(aE,gp_Vec(dist * x,dist * y,dist * z));
|
|||
|
|
aSurface=BRep_Tool::Surface(TopoDS::Face(aface));
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
GeomAPI_IntCS intcs_sn(aCur, aSurface);
|
|||
|
|
if (!intcs_sn.IsDone())
|
|||
|
|
{
|
|||
|
|
dataMD.errorinfo="交点生成失败 ";
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
int nPnt=intcs_sn.NbPoints();
|
|||
|
|
for(int i=1;i<=nPnt;i++)
|
|||
|
|
{
|
|||
|
|
gp_Pnt interpt = intcs_sn.Point(i);
|
|||
|
|
BRepBuilderAPI_MakeVertex newv(interpt);
|
|||
|
|
if(abs(interpt.X())<10e-14)
|
|||
|
|
interpt.SetX(0.0);
|
|||
|
|
if(abs(interpt.Y())<10e-14)
|
|||
|
|
interpt.SetY(0.0);
|
|||
|
|
if(abs(interpt.Z())<10e-14)
|
|||
|
|
interpt.SetZ(0.0);
|
|||
|
|
(pt+ptnum)->X=interpt.X();
|
|||
|
|
(pt+ptnum)->Y=interpt.Y();
|
|||
|
|
(pt+ptnum)->Z=v2;
|
|||
|
|
ptnum++;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
return 0;
|
|||
|
|
}
|
|||
|
|
return ptnum;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// Added by XUEFENG 20180926
|
|||
|
|
// 三角显示
|
|||
|
|
DLLEXPORT bool ShowMeshTriOrNot(bool flag)
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
// End Added
|
|||
|
|
|
|||
|
|
DLLEXPORT void SetOptions(bool autoCross,ModelDisplayOption displayOptions[])
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void ShowSectionPos(double x,bool bdrawprofle)
|
|||
|
|
{
|
|||
|
|
dataMD.ShowSectionPos(x,bdrawprofle);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
DLLEXPORT void ShowTempCurve(bool show, Curve crv, int npnt, Point3D pnt[])
|
|||
|
|
{
|
|||
|
|
dataMD.ShowTempCurve(show,crv,npnt,pnt);
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void ClearAisTempmodel()
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
void ShowFrameRulerModel()
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void ShowProfileModel()
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
//曲线上显示节点,ID:曲线ID，颜色为“点”对象的颜色
|
|||
|
|
void ShowPointOnLine(int ID, bool isHighLight)
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void PixelToModel(int x, int y,double &rx,double &ry,double &rz,int flag,BOOL bWCS)
|
|||
|
|
{
|
|||
|
|
//2016srq
|
|||
|
|
// V3d_Coordinate XEye,YEye,ZEye,XAt,YAt,ZAt;
|
|||
|
|
// myOCCViewer.view[flag]->Eye(XEye,YEye,ZEye);//视点
|
|||
|
|
// myOCCViewer.view[flag]->At(XAt,YAt,ZAt);//VRC原点
|
|||
|
|
// gp_Pnt EyePoint(XEye,YEye,ZEye);
|
|||
|
|
// gp_Pnt AtPoint(XAt,YAt,ZAt);
|
|||
|
|
//
|
|||
|
|
// gp_Vec EyeVector(EyePoint,AtPoint);
|
|||
|
|
// gp_Dir EyeDir(EyeVector);//视线
|
|||
|
|
//
|
|||
|
|
// gp_Pln PlaneOfTheView = gp_Pln(AtPoint,EyeDir);//视平面
|
|||
|
|
//
|
|||
|
|
// //屏幕点转换为模型空间（或世界坐标系）的点。
|
|||
|
|
// Standard_Real X,Y,Z;
|
|||
|
|
// myOCCViewer.view[flag]->Convert((int)x,(int)y,X,Y,Z);
|
|||
|
|
// //但点可能不在视平面上，因此要将点投影到视平面，再计算视平面上的点。
|
|||
|
|
// gp_Pnt ConvertedPoint(X,Y,Z);
|
|||
|
|
// gp_Pnt2d ConvertedPointOnPlane = ProjLib::Project(PlaneOfTheView,ConvertedPoint);
|
|||
|
|
//
|
|||
|
|
// gp_Pnt ResultPoint = ElSLib::Value(ConvertedPointOnPlane.X(),
|
|||
|
|
// ConvertedPointOnPlane.Y(),
|
|||
|
|
// PlaneOfTheView);
|
|||
|
|
//
|
|||
|
|
//#ifdef _VERBOSE_DEBUG
|
|||
|
|
// DTRACE("\n Eye [%.4f,%.4f,%.4f] At [%.4f,%.4f,%.4f],viewpoint [%.4f,%.4f,%.4f],result [%.4f,%.4f,%.4f].",
|
|||
|
|
// XEye,YEye,ZEye,XAt,YAt,ZAt,X,Y,Z,ResultPoint.X(),ResultPoint.Y(),ResultPoint.Z());
|
|||
|
|
//#endif
|
|||
|
|
//
|
|||
|
|
// rx=ResultPoint.X();
|
|||
|
|
// ry=ResultPoint.Y() ;
|
|||
|
|
// rz=ResultPoint.Z();
|
|||
|
|
// DELETE BY XUEFENG 20180731
|
|||
|
|
// FOR CODES COMBINE
|
|||
|
|
/*
|
|||
|
|
auto pt = myOCCViewer.m_Renderer->ScreenPoint2WorldPoint(AnyCore::Vector2(x, y));
|
|||
|
|
rx = pt.x;
|
|||
|
|
ry = pt.y;
|
|||
|
|
rz = pt.z;
|
|||
|
|
*/
|
|||
|
|
// END DELETE
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
void RedrawTypeObjProps()
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// ADDED by GUAN 202009~12
|
|||
|
|
// MERGED by XUEFENG 202101
|
|||
|
|
|
|||
|
|
// Added by XUEFENG
|
|||
|
|
// FOR DEBUG HULL
|
|||
|
|
// 20200820
|
|||
|
|
// 可参考Opencascade论坛上的
|
|||
|
|
// https://www.opencascade.com/content/how-render-bspline-surface-using-glunurbs
|
|||
|
|
#include "Geom_BSplineSurface.hxx"
|
|||
|
|
#include "TColStd_Array1OfReal.hxx"
|
|||
|
|
#include "TColStd_Array1OfInteger.hxx"
|
|||
|
|
#include <TColgp_Array2OfPnt.hxx>
|
|||
|
|
//
|
|||
|
|
#include <TopExp_Explorer.hxx>
|
|||
|
|
#include <Poly_Triangulation.hxx>
|
|||
|
|
//
|
|||
|
|
#include "BRepMesh_IncrementalMesh.hxx"
|
|||
|
|
#include "BRepBuilderAPI_Copy.hxx"
|
|||
|
|
#include "StlAPI_Writer.hxx"
|
|||
|
|
|
|||
|
|
// XUEFENG ADDED 202009
|
|||
|
|
int preNUm(unsigned char byte) {
|
|||
|
|
unsigned char mask = 0x80;
|
|||
|
|
int num = 0;
|
|||
|
|
for (int i = 0; i < 8; i++) {
|
|||
|
|
if ((byte & mask) == mask) {
|
|||
|
|
mask = mask >> 1;
|
|||
|
|
num++;
|
|||
|
|
} else {
|
|||
|
|
break;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
return num;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
|
|||
|
|
bool isUtf8(unsigned char* data, int len) {
|
|||
|
|
int num = 0;
|
|||
|
|
int i = 0;
|
|||
|
|
while (i < len) {
|
|||
|
|
if ((data[i] & 0x80) == 0x00) {
|
|||
|
|
// 0XXX_XXXX
|
|||
|
|
i++;
|
|||
|
|
continue;
|
|||
|
|
}
|
|||
|
|
else if ((num = preNUm(data[i])) > 2) {
|
|||
|
|
// 110X_XXXX 10XX_XXXX
|
|||
|
|
// 1110_XXXX 10XX_XXXX 10XX_XXXX
|
|||
|
|
// 1111_0XXX 10XX_XXXX 10XX_XXXX 10XX_XXXX
|
|||
|
|
// 1111_10XX 10XX_XXXX 10XX_XXXX 10XX_XXXX 10XX_XXXX
|
|||
|
|
// 1111_110X 10XX_XXXX 10XX_XXXX 10XX_XXXX 10XX_XXXX 10XX_XXXX
|
|||
|
|
// preNUm() 返回首个字节8个bits中首 0bit前面1bit的个数，该数量也是该字符所使用的字节数
|
|||
|
|
i++;
|
|||
|
|
for(int j = 0; j < num - 1; j++) {
|
|||
|
|
//判断后面num - 1 个字节是不是都是10开
|
|||
|
|
if ((data[i] & 0xc0) != 0x80) {
|
|||
|
|
return false;
|
|||
|
|
}
|
|||
|
|
i++;
|
|||
|
|
}
|
|||
|
|
} else {
|
|||
|
|
//其他情况说明不是utf-8
|
|||
|
|
return false;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
bool isGBK(unsigned char* data, int len) {
|
|||
|
|
int i = 0;
|
|||
|
|
while (i < len) {
|
|||
|
|
if (data[i] <= 0x7f) {
|
|||
|
|
//编码小于等于127,只有一个字节的编码，兼容ASCII
|
|||
|
|
i++;
|
|||
|
|
continue;
|
|||
|
|
} else {
|
|||
|
|
//大于127的使用双字节编码
|
|||
|
|
if (data[i] >= 0x81 &&
|
|||
|
|
data[i] <= 0xfe &&
|
|||
|
|
data[i + 1] >= 0x40 &&
|
|||
|
|
data[i + 1] <= 0xfe &&
|
|||
|
|
data[i + 1] != 0xf7) {
|
|||
|
|
i += 2;
|
|||
|
|
continue;
|
|||
|
|
} else {
|
|||
|
|
return false;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// GBK to UTF-8
|
|||
|
|
std::string GbkToUtf8(const char *src_str)
|
|||
|
|
{
|
|||
|
|
/*
|
|||
|
|
int len = MultiByteToWideChar(CP_ACP, 0, src_str, -1, NULL, 0);
|
|||
|
|
wchar_t* wstr = new wchar_t[len + 1];
|
|||
|
|
memset(wstr, 0, len + 1);
|
|||
|
|
MultiByteToWideChar(CP_ACP, 0, src_str, -1, wstr, len);
|
|||
|
|
len = WideCharToMultiByte(CP_UTF8, 0, wstr, -1, NULL, 0, NULL, NULL);
|
|||
|
|
char* str = new char[len + 1];
|
|||
|
|
memset(str, 0, len + 1);
|
|||
|
|
WideCharToMultiByte(CP_UTF8, 0, wstr, -1, str, len, NULL, NULL);
|
|||
|
|
std::string strTemp = str;
|
|||
|
|
|
|||
|
|
if (wstr) delete[] wstr;
|
|||
|
|
if (str) delete[] str;
|
|||
|
|
|
|||
|
|
return strTemp;
|
|||
|
|
*/
|
|||
|
|
return "";
|
|||
|
|
}
|
|||
|
|
// END ADDED
|
|||
|
|
|
|||
|
|
|
|||
|
|
DLLEXPORT bool DebugHullForDoctorGUAN(int id)
|
|||
|
|
{
|
|||
|
|
/*
|
|||
|
|
string filePath = ".";
|
|||
|
|
if(strlen(path) == 0)
|
|||
|
|
{
|
|||
|
|
filePath = tempPath;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
string s(path);
|
|||
|
|
filePath = s+"\\";
|
|||
|
|
}
|
|||
|
|
*/
|
|||
|
|
ofstream FileHull;
|
|||
|
|
FileHull.open("Surface.txt",ios::out);
|
|||
|
|
FileHull.close();
|
|||
|
|
|
|||
|
|
///// cqr-20180724
|
|||
|
|
map<int,TopoDS_Shape>::iterator tpit1; //c
|
|||
|
|
tpit1=dataMD.m_mapAllTopoShapes.find(id); //c
|
|||
|
|
|
|||
|
|
if(tpit1!=dataMD.m_mapAllTopoShapes.end()) //c
|
|||
|
|
{
|
|||
|
|
TopoDS_Shape sss = dataMD.m_mapAllTopoShapes.find(id)->second;
|
|||
|
|
//TopoDS_Shape h;
|
|||
|
|
//h = cp.Shape();
|
|||
|
|
// 20200602 by czb, begin
|
|||
|
|
BRepBuilderAPI_Copy cp(sss);
|
|||
|
|
BRepTools::Clean(cp);
|
|||
|
|
//BRepMesh_IncrementalMesh myMesh(cp, 2, Standard_False, 0.5); //cqr-20200716
|
|||
|
|
BRepMesh_IncrementalMesh myMesh(cp, dataMD.GetSTLCoefficient()*250, Standard_False, 0.1); //cqr-20200716
|
|||
|
|
myMesh.Perform();
|
|||
|
|
// 20200602 by czb, end
|
|||
|
|
|
|||
|
|
|
|||
|
|
try
|
|||
|
|
{
|
|||
|
|
StlAPI_Writer stlW;
|
|||
|
|
//stlW.SetCoefficient(GetSTLCoefficient());
|
|||
|
|
//// 20200602 by czb， 相对精度修改为绝对精度，使得船体与舱室的网格大小一致
|
|||
|
|
//stlW.RelativeMode() == Standard_False;
|
|||
|
|
//stlW.SetDeflection(0.001);
|
|||
|
|
//stlW.Write(h,(filePath + ".\\" +"hull.stl").c_str());
|
|||
|
|
|
|||
|
|
// XUEFENG ADDED 202102 cqr-20210315从OCCViewer中复制过来并修改
|
|||
|
|
char pFileName[256];
|
|||
|
|
// int pos = GetCurrentDirectory(256, pFileName);
|
|||
|
|
memset(pFileName, 0, sizeof(pFileName)); // 清空数值，以防止多个主船体时此次有前面主船体的hull名 cqr-20210315
|
|||
|
|
strcat(pFileName,"Surface.txt");
|
|||
|
|
Standard_CString tmpFileName = (Standard_CString)pFileName;
|
|||
|
|
Standard_Boolean result = false;
|
|||
|
|
|
|||
|
|
int len = strlen(tmpFileName);
|
|||
|
|
bool isutf8 = isUtf8((unsigned char*)tmpFileName, len);
|
|||
|
|
bool isgbk = isGBK((unsigned char*)tmpFileName, len);
|
|||
|
|
|
|||
|
|
if(isutf8==false && isgbk==true) // Chinese path
|
|||
|
|
{
|
|||
|
|
std::string mystr = GbkToUtf8(tmpFileName);
|
|||
|
|
char myUTF8Filepath[1024];
|
|||
|
|
strcpy(myUTF8Filepath, mystr.c_str());
|
|||
|
|
//result = BRepTools::Read(shapeCompound, myUTF8Filepath, aBuilder);
|
|||
|
|
stlW.Write(cp, myUTF8Filepath);
|
|||
|
|
}
|
|||
|
|
else if(isutf8==true && isgbk==true) // English path
|
|||
|
|
{
|
|||
|
|
//result = BRepTools::Read(shapeCompound, aFileName, aBuilder);
|
|||
|
|
stlW.Write(cp, tmpFileName);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
catch(Standard_Failure)
|
|||
|
|
{
|
|||
|
|
}
|
|||
|
|
/* finally //pj change ע<>͵<EFBFBD>finally
|
|||
|
|
{
|
|||
|
|
} */
|
|||
|
|
}
|
|||
|
|
return true;
|
|||
|
|
|
|||
|
|
//myOCCViewer.DebugHullForDoctorGUAN(flag);
|
|||
|
|
map<int,TopoDS_Shape>::iterator it;
|
|||
|
|
int type;
|
|||
|
|
|
|||
|
|
if(dataMD.m_mapAllTopoShapes.size()>0)
|
|||
|
|
{
|
|||
|
|
ofstream ofs;
|
|||
|
|
ofs.open("Surface.txt", ios::out);
|
|||
|
|
ofs << "VARIABLES='X','Y','Z','NX','NY','NZ'" << endl;
|
|||
|
|
//
|
|||
|
|
/*ofs.open("out.stl", ios::out);
|
|||
|
|
string s_normal = " facet normal ";
|
|||
|
|
string s_outer = " outer loop";
|
|||
|
|
string s_vertex = " vertex ";
|
|||
|
|
string s_endloop = " endloop";
|
|||
|
|
string s_endfacet = " endfacet";
|
|||
|
|
string s;
|
|||
|
|
ofs << "solid" << endl;*/
|
|||
|
|
//
|
|||
|
|
int nu=16;
|
|||
|
|
int nv=16;
|
|||
|
|
double* sur=new double[nu*nv];
|
|||
|
|
int Con=1;
|
|||
|
|
for(it=dataMD.m_mapAllTopoShapes.begin();it!=dataMD.m_mapAllTopoShapes.end();++it)
|
|||
|
|
{
|
|||
|
|
int realHullID = it->first;
|
|||
|
|
type=it->first/MAX_SIZE_OF_OBJECT_GROUP;
|
|||
|
|
if(type >=18 && type<19)
|
|||
|
|
{
|
|||
|
|
memset(sur,0,nu*nv*sizeof(int));
|
|||
|
|
/*ofs << "ZONE T='1',I=" << nv << "J=" << nu << ",K=1,F=POINT"<< endl;*/
|
|||
|
|
TopoDS_Shape hullShape = it->second;
|
|||
|
|
|
|||
|
|
//TopoDS_Shell HullShell = (TopoDS_Shell)hullShape;
|
|||
|
|
|
|||
|
|
for (TopExp_Explorer faceExp(hullShape, TopAbs_FACE); faceExp.More(); faceExp.Next()){
|
|||
|
|
|
|||
|
|
TopoDS_Face tmpFace = TopoDS::Face(faceExp.Current());
|
|||
|
|
Handle_Geom_Surface tmpSurface = BRep_Tool::Surface(tmpFace);
|
|||
|
|
////
|
|||
|
|
//TopLoc_Location loc;
|
|||
|
|
////BRepMesh_IncrementalMesh myMesh(tmpFace, 10, Standard_True, 5);
|
|||
|
|
//BRepMesh_IncrementalMesh myMesh(tmpFace, 0.02, Standard_False, 0.5);
|
|||
|
|
//Handle_Poly_Triangulation triFace = BRep_Tool::Triangulation(tmpFace, loc);
|
|||
|
|
////BRepMesh_IncrementalMesh myMesh(triFace, 2, Standard_False, 0.5);
|
|||
|
|
//Standard_Integer nTriangles = triFace->NbTriangles();
|
|||
|
|
//gp_Trsf myTrsf = loc.Transformation();//
|
|||
|
|
//bool myInvert = (tmpFace.Orientation()==TopAbs_REVERSED);//
|
|||
|
|
//if(myTrsf.IsNegative())//
|
|||
|
|
// myInvert =! myInvert;//
|
|||
|
|
//gp_Pnt vertex1;
|
|||
|
|
//gp_Pnt vertex2;
|
|||
|
|
//gp_Pnt vertex3;
|
|||
|
|
//Standard_Integer nVertexIndex1 = 0;
|
|||
|
|
//Standard_Integer nVertexIndex2 = 0;
|
|||
|
|
//Standard_Integer nVertexIndex3 = 0;
|
|||
|
|
|
|||
|
|
//TColgp_Array1OfPnt nodes(1, triFace->NbNodes());
|
|||
|
|
//Poly_Array1OfTriangle triangles(1, triFace->NbTriangles());
|
|||
|
|
//nodes = triFace->Nodes();
|
|||
|
|
//triangles = triFace->Triangles();
|
|||
|
|
|
|||
|
|
//for (Standard_Integer i = 1; i <= nTriangles; i++)
|
|||
|
|
//{
|
|||
|
|
// Poly_Triangle aTriangle = triangles.Value(i);
|
|||
|
|
// aTriangle.Get(nVertexIndex1, nVertexIndex2, nVertexIndex3);
|
|||
|
|
// vertex1 = nodes.Value(nVertexIndex1);
|
|||
|
|
// vertex2 = nodes.Value(myInvert? nVertexIndex3:nVertexIndex2);
|
|||
|
|
// vertex3 = nodes.Value(myInvert? nVertexIndex2:nVertexIndex3);
|
|||
|
|
|
|||
|
|
// gp_XYZ vector12(vertex2.XYZ() - vertex1.XYZ());
|
|||
|
|
// gp_XYZ vector13(vertex3.XYZ() - vertex1.XYZ());
|
|||
|
|
// gp_XYZ normal = vector12.Crossed(vector13);
|
|||
|
|
// Standard_Real rModulus = normal.Modulus();
|
|||
|
|
|
|||
|
|
// if (rModulus > gp::Resolution())
|
|||
|
|
// {
|
|||
|
|
// normal.Normalize();
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// normal.SetCoord(0., 0., 0.);
|
|||
|
|
// }
|
|||
|
|
// ofs << s_normal << normal.X() <<" " << normal.Y() << " " << normal.Z() << endl;
|
|||
|
|
// ofs << s_outer << endl;
|
|||
|
|
// ofs << s_vertex << vertex1.X() <<" " << vertex1.Y() << " " << vertex1.Z() << endl;
|
|||
|
|
// ofs << s_vertex << vertex2.X() <<" " << vertex2.Y() << " " << vertex2.Z() << endl;
|
|||
|
|
// ofs << s_vertex << vertex3.X() <<" " << vertex3.Y() << " " << vertex3.Z() << endl;
|
|||
|
|
// ofs << s_endloop << endl;
|
|||
|
|
// ofs << s_endfacet << endl;
|
|||
|
|
//}
|
|||
|
|
//ofs << flush;
|
|||
|
|
////
|
|||
|
|
Handle_Geom_BSplineSurface myBSplineSurface = GeomConvert::SurfaceToBSplineSurface(tmpSurface);
|
|||
|
|
{
|
|||
|
|
//Standard_Integer vdegree = myBSplineSurface->VDegree();
|
|||
|
|
//Standard_Integer myVKnotsNumber = myBSplineSurface->NbVKnots();
|
|||
|
|
//
|
|||
|
|
bool myInvert = (tmpFace.Orientation()==TopAbs_REVERSED);//
|
|||
|
|
//bool myInvert = (myBSplineSurface.Orientation()==TopAbs_REVERSED);//
|
|||
|
|
|
|||
|
|
Standard_Real us = 0.0;
|
|||
|
|
Standard_Real ue = 0.0;
|
|||
|
|
Standard_Real vs = 0.0;
|
|||
|
|
Standard_Real ve = 0.0;
|
|||
|
|
myBSplineSurface->Bounds(us,ue,vs,ve);
|
|||
|
|
Standard_Real uu = 0.0;
|
|||
|
|
Standard_Real vv = 0.0;
|
|||
|
|
gp_Pnt aP00;
|
|||
|
|
gp_Pnt aP01;
|
|||
|
|
gp_Pnt aP10;
|
|||
|
|
gp_Pnt aP11;
|
|||
|
|
Standard_Real Lu0,Lu1,Lv0,Lv1, Lu, Lv, xx,yy, zz;
|
|||
|
|
myBSplineSurface->D0(us, vs, aP00);
|
|||
|
|
myBSplineSurface->D0(us, ve, aP01);
|
|||
|
|
myBSplineSurface->D0(ue, vs, aP10);
|
|||
|
|
myBSplineSurface->D0(ue, ve, aP11);
|
|||
|
|
xx=aP10.X()-aP00.X();
|
|||
|
|
yy=aP10.Y()-aP00.Y();
|
|||
|
|
zz=aP10.Z()-aP00.Z();
|
|||
|
|
Lu0=sqrt(xx*xx+yy*yy+zz*zz);
|
|||
|
|
xx=aP11.X()-aP01.X();
|
|||
|
|
yy=aP11.Y()-aP01.Y();
|
|||
|
|
zz=aP11.Z()-aP01.Z();
|
|||
|
|
Lu1=sqrt(xx*xx+yy*yy+zz*zz);
|
|||
|
|
xx=aP01.X()-aP00.X();
|
|||
|
|
yy=aP01.Y()-aP00.Y();
|
|||
|
|
zz=aP01.Z()-aP00.Z();
|
|||
|
|
Lv0=sqrt(xx*xx+yy*yy+zz*zz);
|
|||
|
|
xx=aP11.X()-aP10.X();
|
|||
|
|
yy=aP11.Y()-aP10.Y();
|
|||
|
|
zz=aP11.Z()-aP10.Z();
|
|||
|
|
Lv1=sqrt(xx*xx+yy*yy+zz*zz);
|
|||
|
|
Lu=Lu0;
|
|||
|
|
if(Lu<Lu1)
|
|||
|
|
{
|
|||
|
|
Lu=Lu1;
|
|||
|
|
}
|
|||
|
|
Lv=Lv0;
|
|||
|
|
if(Lv<Lv1)
|
|||
|
|
{
|
|||
|
|
Lv=Lv1;
|
|||
|
|
}
|
|||
|
|
nu=(int)(25.0*Lu/dataMD.m_shipDepth);
|
|||
|
|
nv=(int)(25.0*Lv/dataMD.m_shipDepth);
|
|||
|
|
if(nu < 6)
|
|||
|
|
{
|
|||
|
|
nu = 6;
|
|||
|
|
}
|
|||
|
|
if(nv < 6)
|
|||
|
|
{
|
|||
|
|
nv = 6;
|
|||
|
|
}
|
|||
|
|
//
|
|||
|
|
gp_Pnt aP;
|
|||
|
|
gp_Vec aDu;
|
|||
|
|
gp_Vec aDv;
|
|||
|
|
gp_Vec normal;
|
|||
|
|
Standard_Real rModulus;
|
|||
|
|
/*ofs << "ZONE T='1',I=" << nv << ",J=" << nu << ",K=1,F=POINT"<< endl;*/
|
|||
|
|
ofs << "ZONE T='"<< Con++ <<"',I=" << nv << ",J=" << nu << ",K=1,F=POINT" << endl;
|
|||
|
|
/*if(Con==9)
|
|||
|
|
{
|
|||
|
|
Standard_Integer Ni=myBSplineSurface->NbUPoles();
|
|||
|
|
Standard_Integer Nj=myBSplineSurface->NbVPoles();
|
|||
|
|
TColgp_Array2OfPnt poles(1,Ni,1,Nj);
|
|||
|
|
myBSplineSurface->Poles(poles);
|
|||
|
|
for(int i=1;i<=Ni;i++)
|
|||
|
|
{
|
|||
|
|
for(int j=1;j<=Nj;j++)
|
|||
|
|
{
|
|||
|
|
aP=poles(i,j);
|
|||
|
|
cout << aP.X() << "\t" << aP.Y() << "\t" << aP.Z() << endl;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}*/
|
|||
|
|
for(int i=0;i<nu;i++)
|
|||
|
|
{
|
|||
|
|
uu=us+(ue-us)/(nu-1)*(Standard_Real)i;
|
|||
|
|
for(int j=0;j<nv;j++)
|
|||
|
|
{
|
|||
|
|
vv=vs+(ve-vs)/(nv-1)*(Standard_Real)j;
|
|||
|
|
myBSplineSurface->D1(uu, vv, aP, aDu, aDv);
|
|||
|
|
if(myInvert==false)
|
|||
|
|
{
|
|||
|
|
normal = aDu.Crossed(aDv);
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
normal = -aDu.Crossed(aDv);
|
|||
|
|
}
|
|||
|
|
//normal = aDu.Crossed(aDv);
|
|||
|
|
rModulus = sqrt(normal.X()*normal.X()+normal.Y()*normal.Y()+normal.Z()*normal.Z());
|
|||
|
|
|
|||
|
|
if (rModulus > 1.0e-9) //gp::Resolution()
|
|||
|
|
{
|
|||
|
|
normal.Normalize();
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(0., 0., 0.);
|
|||
|
|
}
|
|||
|
|
if (fabs(normal.X())<1.0e-6)
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(0.0,normal.Y(),normal.Z());
|
|||
|
|
}
|
|||
|
|
if (fabs(normal.Y())<1.0e-6)
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(normal.X(),0.0,normal.Z());
|
|||
|
|
}
|
|||
|
|
if (fabs(normal.Z())<1.0e-6)
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(normal.X(),normal.Y(),0.0);
|
|||
|
|
}
|
|||
|
|
ofs << aP.X() << "\t" << aP.Y() << "\t" << aP.Z() << "\t" << normal.X() << "\t" << normal.Y() << "\t" << normal.Z() << endl;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
ofs << flush;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
//ofs << "endsolid" << endl;
|
|||
|
|
|
|||
|
|
|
|||
|
|
// 显示目前不能直接显示。
|
|||
|
|
dataMD.m_bshowHull = true;
|
|||
|
|
dataMD.OccDisplayAis(realHullID+1, hullShape, true);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
ofs.close();
|
|||
|
|
}
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
// End Added
|
|||
|
|
// Added by GUAN
|
|||
|
|
// FOR DEBUG HULL
|
|||
|
|
// 20210103
|
|||
|
|
// 可参考Opencascade论坛上的
|
|||
|
|
// https://www.opencascade.com/content/how-render-bspline-surface-using-glunurbs
|
|||
|
|
#include "Geom_BSplineSurface.hxx"
|
|||
|
|
#include "TColStd_Array1OfReal.hxx"
|
|||
|
|
#include "TColStd_Array1OfInteger.hxx"
|
|||
|
|
#include <TColgp_Array2OfPnt.hxx>
|
|||
|
|
//
|
|||
|
|
#include <TopExp_Explorer.hxx>
|
|||
|
|
#include <Poly_Triangulation.hxx>
|
|||
|
|
//
|
|||
|
|
#include "BRepMesh_IncrementalMesh.hxx"
|
|||
|
|
void Check_uv(int i, int Mark, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve, Handle_Geom_BSplineSurface myBSplineSurface, bool myInvert);
|
|||
|
|
void Check_uv2(int i, int Mark, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve, Handle_Geom_BSplineSurface myBSplineSurface, bool myInvert);
|
|||
|
|
gp_Vec Cal_normal(int i, int Mark, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve, Handle_Geom_BSplineSurface myBSplineSurface, bool myInvert, int k, int n);//
|
|||
|
|
gp_Vec Cal_normal2(int i, int Mark, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve, Handle_Geom_BSplineSurface myBSplineSurface, bool myInvert, int k, int n);//
|
|||
|
|
void Check_normal(int i, int ii, int j, int jj, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve,
|
|||
|
|
vector<Handle_Geom_BSplineSurface> sur1, vector<bool> surInvert, int Mark, vector<bool> modefiedu, vector<bool> modefiedv);
|
|||
|
|
Handle_Geom_BSplineSurface Modefy_sur(int i, int Mark, vector<Handle_Geom_BSplineSurface> sur1, Standard_Real* temp, vector<bool> modefiedu, vector<bool> modefiedv);
|
|||
|
|
Standard_Real Cal_sita(int i, int ii, int j, int jj, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve,
|
|||
|
|
Handle_Geom_BSplineSurface sur1, Handle_Geom_BSplineSurface sur2, vector<bool> surInvert, int n, Standard_Real* normala, int Mark, Standard_Real* sita);
|
|||
|
|
Standard_Real Cal_sita_Modify(int i, int ii, int j, int jj, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve,
|
|||
|
|
Handle_Geom_BSplineSurface sur1, Handle_Geom_BSplineSurface sur2, vector<bool> surInvert, int n, int Mark, Standard_Real* sita);
|
|||
|
|
void Modefy_sur2(int i, int Mark, vector<Handle_Geom_BSplineSurface> sur1, Standard_Real* temp, vector<bool> modefiedu, vector<bool> modefiedv);
|
|||
|
|
DLLEXPORT bool DebugHullForDoctorGUAN2(int id)
|
|||
|
|
{
|
|||
|
|
//myOCCViewer.DebugHullForDoctorGUAN(flag);
|
|||
|
|
map<int,TopoDS_Shape>::iterator it;
|
|||
|
|
int type;
|
|||
|
|
|
|||
|
|
if(dataMD.m_mapAllTopoShapes.size()>0)
|
|||
|
|
{
|
|||
|
|
/*ofstream ofs;
|
|||
|
|
ofs.open("Surface2.txt", ios::out);
|
|||
|
|
ofs << "VARIABLES='X','Y','Z','NX','NY','NZ'" << endl;*/
|
|||
|
|
//
|
|||
|
|
/*ofs.open("out.stl", ios::out);
|
|||
|
|
string s_normal = " facet normal ";
|
|||
|
|
string s_outer = " outer loop";
|
|||
|
|
string s_vertex = " vertex ";
|
|||
|
|
string s_endloop = " endloop";
|
|||
|
|
string s_endfacet = " endfacet";
|
|||
|
|
string s;
|
|||
|
|
ofs << "solid" << endl;*/
|
|||
|
|
//
|
|||
|
|
int nu=16;
|
|||
|
|
int nv=16;
|
|||
|
|
double* sur=new double[nu*nv];
|
|||
|
|
int Con=0;
|
|||
|
|
vector<Standard_Real> us;
|
|||
|
|
vector<Standard_Real> ue;
|
|||
|
|
vector<Standard_Real> vs;
|
|||
|
|
vector<Standard_Real> ve;
|
|||
|
|
vector<gp_Pnt> edge;
|
|||
|
|
vector<Handle_Geom_BSplineSurface> sur1;
|
|||
|
|
vector<bool> surInvert;
|
|||
|
|
vector<bool> modefiedu;
|
|||
|
|
vector<bool> modefiedv;
|
|||
|
|
vector<bool> marked;
|
|||
|
|
for(it=dataMD.m_mapAllTopoShapes.begin();it!=dataMD.m_mapAllTopoShapes.end();++it)
|
|||
|
|
{
|
|||
|
|
int realHullID = it->first;
|
|||
|
|
type=it->first/MAX_SIZE_OF_OBJECT_GROUP;
|
|||
|
|
if(type >=18 && type<19)
|
|||
|
|
{
|
|||
|
|
memset(sur,0,nu*nv*sizeof(int));
|
|||
|
|
TopoDS_Shape hullShape = it->second;
|
|||
|
|
|
|||
|
|
for (TopExp_Explorer faceExp(hullShape, TopAbs_FACE); faceExp.More(); faceExp.Next())
|
|||
|
|
{
|
|||
|
|
TopoDS_Face tmpFace = TopoDS::Face(faceExp.Current());
|
|||
|
|
Handle_Geom_Surface tmpSurface = BRep_Tool::Surface(tmpFace);
|
|||
|
|
////
|
|||
|
|
Handle_Geom_BSplineSurface myBSplineSurface = GeomConvert::SurfaceToBSplineSurface(tmpSurface);
|
|||
|
|
{
|
|||
|
|
//Standard_Integer vdegree = myBSplineSurface->VDegree();
|
|||
|
|
//Standard_Integer myVKnotsNumber = myBSplineSurface->NbVKnots();
|
|||
|
|
//
|
|||
|
|
bool myInvert = (tmpFace.Orientation()==TopAbs_REVERSED);//
|
|||
|
|
//tmpFace.
|
|||
|
|
Standard_Real us0 = 0.0;
|
|||
|
|
Standard_Real ue0 = 0.0;
|
|||
|
|
Standard_Real vs0 = 0.0;
|
|||
|
|
Standard_Real ve0 = 0.0;
|
|||
|
|
myBSplineSurface->Bounds(us0,ue0,vs0,ve0);
|
|||
|
|
gp_Pnt aP00;
|
|||
|
|
gp_Pnt aP01;
|
|||
|
|
gp_Pnt aP10;
|
|||
|
|
gp_Pnt aP11;
|
|||
|
|
myBSplineSurface->D0(us0, vs0, aP00);
|
|||
|
|
myBSplineSurface->D0(us0, ve0, aP01);
|
|||
|
|
myBSplineSurface->D0(ue0, vs0, aP10);
|
|||
|
|
myBSplineSurface->D0(ue0, ve0, aP11);
|
|||
|
|
us.push_back(us0);
|
|||
|
|
ue.push_back(ue0);
|
|||
|
|
vs.push_back(vs0);
|
|||
|
|
ve.push_back(ve0);
|
|||
|
|
//edge:00-10-11-01-00
|
|||
|
|
edge.push_back(aP00);
|
|||
|
|
edge.push_back(aP10);
|
|||
|
|
edge.push_back(aP11);
|
|||
|
|
edge.push_back(aP01);
|
|||
|
|
edge.push_back(aP00);
|
|||
|
|
sur1.push_back(myBSplineSurface);
|
|||
|
|
surInvert.push_back(myInvert);
|
|||
|
|
modefiedu.push_back(false);
|
|||
|
|
modefiedv.push_back(false);
|
|||
|
|
//
|
|||
|
|
marked.push_back(false);
|
|||
|
|
marked.push_back(false);
|
|||
|
|
marked.push_back(false);
|
|||
|
|
marked.push_back(false);
|
|||
|
|
Con++;
|
|||
|
|
//cout<< Con << "\t" << myBSplineSurface->NbUPoles() << "\t" << myBSplineSurface->NbVPoles() << "\t" << myBSplineSurface->NbUKnots() << "\t" << myBSplineSurface->NbVKnots() <<endl;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
//Deleted by GUAN, 20210309
|
|||
|
|
//cout<<endl;
|
|||
|
|
//End Delete
|
|||
|
|
Standard_Real L0, L1, L2, L3;
|
|||
|
|
for(int i=0;i<Con;i++)
|
|||
|
|
{
|
|||
|
|
for(int ii=0;ii<4;ii++)
|
|||
|
|
{
|
|||
|
|
if(marked[4*i+ii]==false)
|
|||
|
|
{
|
|||
|
|
for(int j=i+1;j<Con;j++)
|
|||
|
|
{
|
|||
|
|
for(int jj=0;jj<4;jj++)
|
|||
|
|
{
|
|||
|
|
if(marked[4*j+jj]==false)
|
|||
|
|
{
|
|||
|
|
L0=sqrt(pow(edge[5*i+ii].X()-edge[5*j+jj].X(),2)+pow(edge[5*i+ii].Y()-edge[5*j+jj].Y(),2)+pow(edge[5*i+ii].Z()-edge[5*j+jj].Z(),2));
|
|||
|
|
L1=sqrt(pow(edge[5*i+ii+1].X()-edge[5*j+jj+1].X(),2)+pow(edge[5*i+ii+1].Y()-edge[5*j+jj+1].Y(),2)+pow(edge[5*i+ii+1].Z()-edge[5*j+jj+1].Z(),2));
|
|||
|
|
if(L0<1.0e-6 && L1<1.0e-6)
|
|||
|
|
{
|
|||
|
|
//cout<< i << "\t" << j << "\t" << edge[5*i+ii].X() << "\t" << edge[5*i+ii].Y() << "\t" << edge[5*i+ii].Z() << "\t" << edge[5*i+ii+1].X() << "\t" << edge[5*i+ii+1].Y() << "\t" << edge[5*i+ii+1].Z() <<endl;
|
|||
|
|
//cout<< i << "\t" << j << "\t" << edge[5*j+jj].X() << "\t" << edge[5*j+jj].Y() << "\t" << edge[5*j+jj].Z() << "\t" << edge[5*j+jj+1].X() << "\t" << edge[5*j+jj+1].Y() << "\t" << edge[5*j+jj+1].Z() <<endl;
|
|||
|
|
//Deleted by GUAN, 20210309
|
|||
|
|
//cout<< i << "\t" << j;// << "\t" << us[i] << "\t" << ue[i] << "\t" << vs[i] << "\t" << ve[i]<< "\t" << us[j] << "\t" << ue[j] << "\t" << vs[j] << "\t" << ve[j] <<endl;
|
|||
|
|
//cout<<endl;
|
|||
|
|
//End Delete
|
|||
|
|
Check_normal(i, ii,j, jj,us,ue,vs,ve, sur1, surInvert, 1, modefiedu, modefiedv);//
|
|||
|
|
//Check_uv(i, ii,us,ue,vs,ve, sur1[i], surInvert[i]);//
|
|||
|
|
//cout<<endl;
|
|||
|
|
//Check_uv(j, jj,us,ue,vs,ve, sur1[j], surInvert[j]);//
|
|||
|
|
//cout<<endl;
|
|||
|
|
marked[4*i+ii]=true;
|
|||
|
|
marked[4*j+jj]=true;
|
|||
|
|
jj+=4;
|
|||
|
|
j+=Con;
|
|||
|
|
//ii+=4;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
L2=sqrt(pow(edge[5*i+ii].X()-edge[5*j+jj+1].X(),2)+pow(edge[5*i+ii].Y()-edge[5*j+jj+1].Y(),2)+pow(edge[5*i+ii].Z()-edge[5*j+jj+1].Z(),2));
|
|||
|
|
L3=sqrt(pow(edge[5*i+ii+1].X()-edge[5*j+jj].X(),2)+pow(edge[5*i+ii+1].Y()-edge[5*j+jj].Y(),2)+pow(edge[5*i+ii+1].Z()-edge[5*j+jj].Z(),2));
|
|||
|
|
if(L2<1.0e-6 && L3<1.0e-6)
|
|||
|
|
{
|
|||
|
|
//cout<< i << "\t" << j << "\t" << edge[5*i+ii].X() << "\t" << edge[5*i+ii].Y() << "\t" << edge[5*i+ii].Z() << "\t" << edge[5*i+ii+1].X() << "\t" << edge[5*i+ii+1].Y() << "\t" << edge[5*i+ii+1].Z() <<endl;
|
|||
|
|
//cout<< i << "\t" << j << "\t" << edge[5*j+jj].X() << "\t" << edge[5*j+jj].Y() << "\t" << edge[5*j+jj].Z() << "\t" << edge[5*j+jj+1].X() << "\t" << edge[5*j+jj+1].Y() << "\t" << edge[5*j+jj+1].Z() <<endl;
|
|||
|
|
//Deleted by GUAN, 20210309
|
|||
|
|
//cout<< i << "\t" << j;// << "\t" << us[i] << "\t" << ue[i] << "\t" << vs[i] << "\t" << ve[i]<< "\t" << us[j] << "\t" << ue[j] << "\t" << vs[j] << "\t" << ve[j] <<endl;
|
|||
|
|
//cout<<endl;
|
|||
|
|
//End Delete
|
|||
|
|
Check_normal(i, ii,j, jj,us,ue,vs,ve, sur1, surInvert, 2, modefiedu, modefiedv);//
|
|||
|
|
//Check_uv(i, ii,us,ue,vs,ve, sur1[i], surInvert[i]);//
|
|||
|
|
//cout<<endl;
|
|||
|
|
//Check_uv2(j, jj,us,ue,vs,ve, sur1[j], surInvert[j]);//
|
|||
|
|
//cout<<endl;
|
|||
|
|
marked[4*i+ii]=true;
|
|||
|
|
marked[4*j+jj]=true;
|
|||
|
|
jj+=4;
|
|||
|
|
j+=Con;
|
|||
|
|
//ii+=4;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
//ofs << "endsolid" << endl;
|
|||
|
|
////////////////////////////////////////////////////////////
|
|||
|
|
//int Cot=1;
|
|||
|
|
//for(int k=0;k<Con;k++)
|
|||
|
|
//{
|
|||
|
|
// //cout<<k<<endl;
|
|||
|
|
// Handle_Geom_BSplineSurface myBSplineSurface = sur1[k];
|
|||
|
|
// {
|
|||
|
|
// //Standard_Integer vdegree = myBSplineSurface->VDegree();
|
|||
|
|
// //Standard_Integer myVKnotsNumber = myBSplineSurface->NbVKnots();
|
|||
|
|
// //
|
|||
|
|
// bool myInvert = surInvert[k];//
|
|||
|
|
// //bool myInve[k]rt = (myBSplineSurface.Orientation()==TopAbs_REve[k]RSED);//
|
|||
|
|
// Standard_Real uu = 0.0;
|
|||
|
|
// Standard_Real vv = 0.0;
|
|||
|
|
// gp_Pnt aP00;
|
|||
|
|
// gp_Pnt aP01;
|
|||
|
|
// gp_Pnt aP10;
|
|||
|
|
// gp_Pnt aP11;
|
|||
|
|
// Standard_Real Lu0,Lu1,Lv0,Lv1, Lu, Lv, xx,yy, zz;
|
|||
|
|
// myBSplineSurface->D0(us[k], vs[k], aP00);
|
|||
|
|
// myBSplineSurface->D0(us[k], ve[k], aP01);
|
|||
|
|
// myBSplineSurface->D0(ue[k], vs[k], aP10);
|
|||
|
|
// myBSplineSurface->D0(ue[k], ve[k], aP11);
|
|||
|
|
// xx=aP10.X()-aP00.X();
|
|||
|
|
// yy=aP10.Y()-aP00.Y();
|
|||
|
|
// zz=aP10.Z()-aP00.Z();
|
|||
|
|
// Lu0=sqrt(xx*xx+yy*yy+zz*zz);
|
|||
|
|
// xx=aP11.X()-aP01.X();
|
|||
|
|
// yy=aP11.Y()-aP01.Y();
|
|||
|
|
// zz=aP11.Z()-aP01.Z();
|
|||
|
|
// Lu1=sqrt(xx*xx+yy*yy+zz*zz);
|
|||
|
|
// xx=aP01.X()-aP00.X();
|
|||
|
|
// yy=aP01.Y()-aP00.Y();
|
|||
|
|
// zz=aP01.Z()-aP00.Z();
|
|||
|
|
// Lv0=sqrt(xx*xx+yy*yy+zz*zz);
|
|||
|
|
// xx=aP11.X()-aP10.X();
|
|||
|
|
// yy=aP11.Y()-aP10.Y();
|
|||
|
|
// zz=aP11.Z()-aP10.Z();
|
|||
|
|
// Lv1=sqrt(xx*xx+yy*yy+zz*zz);
|
|||
|
|
// Lu=Lu0;
|
|||
|
|
// if(Lu<Lu1)
|
|||
|
|
// {
|
|||
|
|
// Lu=Lu1;
|
|||
|
|
// }
|
|||
|
|
// Lv=Lv0;
|
|||
|
|
// if(Lv<Lv1)
|
|||
|
|
// {
|
|||
|
|
// Lv=Lv1;
|
|||
|
|
// }
|
|||
|
|
// nu=(int)(25.0*Lu/dataMD.m_shipDepth);
|
|||
|
|
// nv=(int)(25.0*Lv/dataMD.m_shipDepth);
|
|||
|
|
// if(nu < 6)
|
|||
|
|
// {
|
|||
|
|
// nu = 6;
|
|||
|
|
// }
|
|||
|
|
// if(nv < 6)
|
|||
|
|
// {
|
|||
|
|
// nv = 6;
|
|||
|
|
// }
|
|||
|
|
// //
|
|||
|
|
// gp_Pnt aP;
|
|||
|
|
// gp_Vec aDu;
|
|||
|
|
// gp_Vec aDv;
|
|||
|
|
// gp_Vec normal;
|
|||
|
|
// Standard_Real rModulus;
|
|||
|
|
// /*ofs << "ZONE T='1',I=" << nv << ",J=" << nu << ",K=1,F=POINT"<< endl;*/
|
|||
|
|
// ofs << "ZONE T='"<< Cot++ <<"',I=" << nv << ",J=" << nu << ",K=1,F=POINT" << endl;
|
|||
|
|
// /*if(Con==9)
|
|||
|
|
// {
|
|||
|
|
// Standard_Integer Ni=myBSplineSurface->NbUPoles();
|
|||
|
|
// Standard_Integer Nj=myBSplineSurface->NbVPoles();
|
|||
|
|
// TColgp_Array2OfPnt poles(1,Ni,1,Nj);
|
|||
|
|
// myBSplineSurface->Poles(poles);
|
|||
|
|
// for(int i=1;i<=Ni;i++)
|
|||
|
|
// {
|
|||
|
|
// for(int j=1;j<=Nj;j++)
|
|||
|
|
// {
|
|||
|
|
// aP=poles(i,j);
|
|||
|
|
// cout << aP.X() << "\t" << aP.Y() << "\t" << aP.Z() << endl;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// }*/
|
|||
|
|
// for(int i=0;i<nu;i++)
|
|||
|
|
// {
|
|||
|
|
// uu=us[k]+(ue[k]-us[k])/(nu-1)*(Standard_Real)i;
|
|||
|
|
// for(int j=0;j<nv;j++)
|
|||
|
|
// {
|
|||
|
|
// vv=vs[k]+(ve[k]-vs[k])/(nv-1)*(Standard_Real)j;
|
|||
|
|
// myBSplineSurface->D1(uu, vv, aP, aDu, aDv);
|
|||
|
|
// if(myInvert==false)
|
|||
|
|
// {
|
|||
|
|
// normal = aDu.Crossed(aDv);
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// normal = -aDu.Crossed(aDv);
|
|||
|
|
// }
|
|||
|
|
// //normal = aDu.Crossed(aDv);
|
|||
|
|
// rModulus = sqrt(normal.X()*normal.X()+normal.Y()*normal.Y()+normal.Z()*normal.Z());
|
|||
|
|
|
|||
|
|
// if (rModulus > 1.0e-9) //gp::Resolution()
|
|||
|
|
// {
|
|||
|
|
// normal.Normalize();
|
|||
|
|
// }
|
|||
|
|
// else
|
|||
|
|
// {
|
|||
|
|
// normal.SetCoord(0., 0., 0.);
|
|||
|
|
// }
|
|||
|
|
// if (fabs(normal.X())<1.0e-6)
|
|||
|
|
// {
|
|||
|
|
// normal.SetCoord(0.0,normal.Y(),normal.Z());
|
|||
|
|
// }
|
|||
|
|
// if (fabs(normal.Y())<1.0e-6)
|
|||
|
|
// {
|
|||
|
|
// normal.SetCoord(normal.X(),0.0,normal.Z());
|
|||
|
|
// }
|
|||
|
|
// if (fabs(normal.Z())<1.0e-6)
|
|||
|
|
// {
|
|||
|
|
// normal.SetCoord(normal.X(),normal.Y(),0.0);
|
|||
|
|
// }
|
|||
|
|
// ofs << aP.X() << "\t" << aP.Y() << "\t" << aP.Z() << "\t" << normal.X() << "\t" << normal.Y() << "\t" << normal.Z() << endl;
|
|||
|
|
// }
|
|||
|
|
// }
|
|||
|
|
// ofs << flush;
|
|||
|
|
// }
|
|||
|
|
//}
|
|||
|
|
////////////////////////////////////////////////////////////
|
|||
|
|
// 显示目前不能直接显示。
|
|||
|
|
dataMD.m_bshowHull = true;
|
|||
|
|
dataMD.OccDisplayAis(realHullID+1, hullShape, true);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
//ofs.close();
|
|||
|
|
}
|
|||
|
|
return true;
|
|||
|
|
}
|
|||
|
|
void Check_uv(int i, int Mark, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve, Handle_Geom_BSplineSurface myBSplineSurface, bool myInvert)//
|
|||
|
|
{
|
|||
|
|
Standard_Integer Num;
|
|||
|
|
if(Mark==0)//00-10 vs[i]
|
|||
|
|
{
|
|||
|
|
Num = myBSplineSurface->NbUKnots();
|
|||
|
|
//cout<< "\t" << us[i] << "\t" << ue[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==1)//10-11 ue[i]
|
|||
|
|
{
|
|||
|
|
Num = myBSplineSurface->NbVKnots();
|
|||
|
|
//cout<< "\t" << vs[i] << "\t" << ve[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==2)//11-01 ve[i]
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
Num = myBSplineSurface->NbUKnots();
|
|||
|
|
//cout<< "\t" << us[i] << "\t" << ue[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==3)//01-00 us[i]
|
|||
|
|
{
|
|||
|
|
Num = myBSplineSurface->NbVKnots();
|
|||
|
|
//cout<< "\t" << vs[i] << "\t" << ve[i];
|
|||
|
|
}
|
|||
|
|
/*cout<< "\t" << Num << "\t" << myBSplineSurface->NbUPoles() << "\t" << myBSplineSurface->NbVPoles();*/
|
|||
|
|
//Deleted by GUAN, 20210309
|
|||
|
|
//cout<< "\t" << Num << "\t" << myBSplineSurface->NbUPoles() << "\t" << myBSplineSurface->NbVPoles() << "\t" << myBSplineSurface->NbUKnots() << "\t" << myBSplineSurface->NbVKnots();
|
|||
|
|
//End Delete
|
|||
|
|
}
|
|||
|
|
void Check_uv2(int i, int Mark, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve, Handle_Geom_BSplineSurface myBSplineSurface, bool myInvert)//
|
|||
|
|
{
|
|||
|
|
Standard_Integer Num;
|
|||
|
|
if(Mark==0)//00-10 vs[i]
|
|||
|
|
{
|
|||
|
|
Num = myBSplineSurface->NbUKnots();
|
|||
|
|
//cout<< "\t" << us[i] << "\t" << ue[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==1)//10-11 ue[i]
|
|||
|
|
{
|
|||
|
|
Num = myBSplineSurface->NbVKnots();
|
|||
|
|
//cout<< "\t" << vs[i] << "\t" << ve[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==2)//11-01 ve[i]
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
Num = myBSplineSurface->NbUKnots();
|
|||
|
|
//cout<< "\t" << us[i] << "\t" << ue[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==3)//01-00 us[i]
|
|||
|
|
{
|
|||
|
|
Num = myBSplineSurface->NbVKnots();
|
|||
|
|
}
|
|||
|
|
/*cout<< "\t" << Num << "\t" << myBSplineSurface->NbUPoles() << "\t" << myBSplineSurface->NbVPoles();*/
|
|||
|
|
//Deleted by GUAN, 20210309
|
|||
|
|
//cout<< "\t" << Num << "\t" << myBSplineSurface->NbUPoles() << "\t" << myBSplineSurface->NbVPoles()<< "\t" << myBSplineSurface->NbUKnots() << "\t" << myBSplineSurface->NbVKnots();
|
|||
|
|
//End Delete
|
|||
|
|
}
|
|||
|
|
void Check_normal(int i, int ii, int j, int jj, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve,
|
|||
|
|
vector<Handle_Geom_BSplineSurface> sur1, vector<bool> surInvert, int Mark, vector<bool> modefiedu, vector<bool> modefiedv)
|
|||
|
|
{
|
|||
|
|
int n=4;//8
|
|||
|
|
Standard_Real normala[3];
|
|||
|
|
Standard_Real temp[3];
|
|||
|
|
Standard_Real sita[9];//n+1
|
|||
|
|
Standard_Real average, average1;
|
|||
|
|
average1=Cal_sita(i, ii, j, jj,us,ue,vs,ve, sur1[i], sur1[j], surInvert, n, normala, Mark, sita);
|
|||
|
|
/*if(i==61&j==62)
|
|||
|
|
{
|
|||
|
|
int nn=3;
|
|||
|
|
nn+=4;
|
|||
|
|
}*/
|
|||
|
|
// Deleted by GUAN, 20210309
|
|||
|
|
/*cout<< "修正前：";
|
|||
|
|
for(int k=0;k<=n;k++)
|
|||
|
|
{
|
|||
|
|
cout<<fixed<<setprecision(6)<< "\t" << sita[k];
|
|||
|
|
}
|
|||
|
|
cout<<endl;*/
|
|||
|
|
//End Delete
|
|||
|
|
if(average1>=1.0 && average1<=30.0)//0.01
|
|||
|
|
{
|
|||
|
|
average=average1;
|
|||
|
|
Handle_Geom_BSplineSurface sur;
|
|||
|
|
Standard_Real kk = -0.01;//-0.001
|
|||
|
|
Standard_Real dk = kk;
|
|||
|
|
int Cn=0;
|
|||
|
|
temp[0]=0.0;
|
|||
|
|
temp[1]=0.0;
|
|||
|
|
temp[2]=0.0;
|
|||
|
|
Standard_Real amini=average1;
|
|||
|
|
Standard_Real tpi[3]={0.0,0.0,0.0};
|
|||
|
|
Standard_Real sitami[9];
|
|||
|
|
while(average>1.0 && Cn<30)//0.01 100
|
|||
|
|
{
|
|||
|
|
temp[0]=normala[0]*dk;
|
|||
|
|
temp[1]=normala[1]*dk;
|
|||
|
|
temp[2]=normala[2]*dk;
|
|||
|
|
dk+=kk;
|
|||
|
|
Cn+=1;
|
|||
|
|
if(Cn==15 && average>average1)//50
|
|||
|
|
{
|
|||
|
|
kk = 0.01;
|
|||
|
|
dk = kk;
|
|||
|
|
temp[0]=normala[0]*dk;
|
|||
|
|
temp[1]=normala[1]*dk;
|
|||
|
|
temp[2]=normala[2]*dk;
|
|||
|
|
}
|
|||
|
|
sur=Modefy_sur(i, ii, sur1, temp, modefiedu, modefiedv);
|
|||
|
|
average=Cal_sita_Modify(i, ii, j, jj,us,ue,vs,ve, sur, sur1[j], surInvert, n, Mark, sita);
|
|||
|
|
if(average<amini)
|
|||
|
|
{
|
|||
|
|
amini=average;
|
|||
|
|
tpi[0]=temp[0];
|
|||
|
|
tpi[1]=temp[1];
|
|||
|
|
tpi[2]=temp[2];
|
|||
|
|
for(int k=0;k<=n;k++)
|
|||
|
|
{
|
|||
|
|
sitami[k]=sita[k];
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
if(amini<average1)//average<2.0
|
|||
|
|
{
|
|||
|
|
Modefy_sur2(i, ii, sur1, tpi, modefiedu, modefiedv);
|
|||
|
|
}
|
|||
|
|
Cn=0;
|
|||
|
|
average=amini;
|
|||
|
|
kk = -0.01;
|
|||
|
|
dk = kk;
|
|||
|
|
Standard_Real tpj[3]={0.0,0.0,0.0};
|
|||
|
|
Standard_Real aminj=amini;
|
|||
|
|
Standard_Real sitamj[9];
|
|||
|
|
while(average>1.0 && Cn<30)//0.01 100
|
|||
|
|
{
|
|||
|
|
temp[0]=normala[0]*dk;
|
|||
|
|
temp[1]=normala[1]*dk;
|
|||
|
|
temp[2]=normala[2]*dk;
|
|||
|
|
dk+=kk;
|
|||
|
|
Cn+=1;
|
|||
|
|
if(Cn==15 && average>amini)//50
|
|||
|
|
{
|
|||
|
|
kk = 0.01;
|
|||
|
|
dk = kk;
|
|||
|
|
temp[0]=normala[0]*dk;
|
|||
|
|
temp[1]=normala[1]*dk;
|
|||
|
|
temp[2]=normala[2]*dk;
|
|||
|
|
}
|
|||
|
|
sur=Modefy_sur(j, jj, sur1, temp, modefiedu, modefiedv);
|
|||
|
|
average=Cal_sita_Modify(i, ii, j, jj,us,ue,vs,ve, sur1[i], sur, surInvert, n, Mark, sita);
|
|||
|
|
if(average<aminj)
|
|||
|
|
{
|
|||
|
|
aminj=average;
|
|||
|
|
tpj[0]=temp[0];
|
|||
|
|
tpj[1]=temp[1];
|
|||
|
|
tpj[2]=temp[2];
|
|||
|
|
for(int k=0;k<=n;k++)
|
|||
|
|
{
|
|||
|
|
sitamj[k]=sita[k];
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
if(aminj<aminj)//average<2.0
|
|||
|
|
{
|
|||
|
|
Modefy_sur2(j, jj, sur1, tpj, modefiedu, modefiedv);
|
|||
|
|
// Deleted by GUAN, 20210309
|
|||
|
|
/*cout<< "修正后：";
|
|||
|
|
for(int k=0;k<=n;k++)
|
|||
|
|
{
|
|||
|
|
cout<<fixed<<setprecision(6)<< "\t" << sitamj[k];
|
|||
|
|
}*/
|
|||
|
|
//End Delete
|
|||
|
|
}
|
|||
|
|
// Deleted by GUAN, 20210309
|
|||
|
|
/*cout<< "修正后：";
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
if(amini<average1)//average<2.0
|
|||
|
|
{
|
|||
|
|
cout<< "修正后：";
|
|||
|
|
for(int k=0;k<=n;k++)
|
|||
|
|
{
|
|||
|
|
cout<<fixed<<setprecision(6)<< "\t" << sitami[k];
|
|||
|
|
}
|
|||
|
|
//End Delete
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
cout<<endl;*/
|
|||
|
|
//End Delete
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
Standard_Real Cal_sita(int i, int ii, int j, int jj, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve,
|
|||
|
|
Handle_Geom_BSplineSurface sur1, Handle_Geom_BSplineSurface sur2, vector<bool> surInvert, int n, Standard_Real* normala, int Mark, Standard_Real* sita)
|
|||
|
|
{
|
|||
|
|
gp_Vec normal1;
|
|||
|
|
gp_Vec normal2;
|
|||
|
|
Standard_Real rModulus1;
|
|||
|
|
Standard_Real rModulus2;
|
|||
|
|
Standard_Real PI_VALUE=3.1415926535898; //#include "StdAfx.h"PI->PI_VALUE
|
|||
|
|
Standard_Real temp, Csita, sum, average, nx,ny,nz;
|
|||
|
|
normala[0]=0.0;
|
|||
|
|
normala[1]=0.0;
|
|||
|
|
normala[2]=0.0;
|
|||
|
|
int Con=0;
|
|||
|
|
sum=0.0;
|
|||
|
|
for(int k=0;k<=n;k++)
|
|||
|
|
{
|
|||
|
|
normal1=Cal_normal(i, ii,us,ue,vs,ve, sur1, surInvert[i], k, n);//
|
|||
|
|
if(Mark==1)
|
|||
|
|
{
|
|||
|
|
normal2=Cal_normal(j, jj,us,ue,vs,ve, sur2, surInvert[j], k, n);//
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
normal2=Cal_normal2(j, jj,us,ue,vs,ve, sur2, surInvert[j], k, n);//
|
|||
|
|
}
|
|||
|
|
rModulus1 = sqrt(normal1.X()*normal1.X()+normal1.Y()*normal1.Y()+normal1.Z()*normal1.Z());
|
|||
|
|
rModulus2 = sqrt(normal2.X()*normal2.X()+normal2.Y()*normal2.Y()+normal2.Z()*normal2.Z());
|
|||
|
|
if(rModulus1>0&&rModulus2>0)
|
|||
|
|
{
|
|||
|
|
temp=normal1.X()*normal2.X()+normal1.Y()*normal2.Y()+normal1.Z()*normal2.Z();
|
|||
|
|
Csita=temp/rModulus1/rModulus2;
|
|||
|
|
if(Csita>1.0)
|
|||
|
|
{
|
|||
|
|
Csita=1.0;
|
|||
|
|
}
|
|||
|
|
else if(Csita<-1.0)
|
|||
|
|
{
|
|||
|
|
Csita=-1.0;
|
|||
|
|
}
|
|||
|
|
sita[k]=acos(Csita)*180/PI_VALUE; //pj change
|
|||
|
|
/*cout<< "\t" << sita[i];*/
|
|||
|
|
if(k>0&&k<n)
|
|||
|
|
{
|
|||
|
|
Con++;
|
|||
|
|
sum+=sita[k];
|
|||
|
|
}
|
|||
|
|
normala[0]+=normal1.X();
|
|||
|
|
normala[1]+=normal1.Y();
|
|||
|
|
normala[2]+=normal1.Z();
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
if(Con>0)
|
|||
|
|
{
|
|||
|
|
temp=sqrt(normala[0]*normala[0]+normala[1]*normala[1]+normala[2]*normala[2]);
|
|||
|
|
normala[0]/=temp;
|
|||
|
|
normala[1]/=temp;
|
|||
|
|
normala[2]/=temp;
|
|||
|
|
average=sum/Con;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
average=0.0;
|
|||
|
|
}
|
|||
|
|
return(average);
|
|||
|
|
}
|
|||
|
|
Standard_Real Cal_sita_Modify(int i, int ii, int j, int jj, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve,
|
|||
|
|
Handle_Geom_BSplineSurface sur1, Handle_Geom_BSplineSurface sur2, vector<bool> surInvert, int n, int Mark, Standard_Real* sita)
|
|||
|
|
{
|
|||
|
|
gp_Vec normal1;
|
|||
|
|
gp_Vec normal2;
|
|||
|
|
Standard_Real rModulus1;
|
|||
|
|
Standard_Real rModulus2;
|
|||
|
|
Standard_Real PI_VALUE=3.1415926535898; // pj change
|
|||
|
|
Standard_Real temp, Csita, sum, average, nx,ny,nz;
|
|||
|
|
int Con=0;
|
|||
|
|
sum=0.0;
|
|||
|
|
for(int k=0;k<=n;k++)
|
|||
|
|
{
|
|||
|
|
normal1=Cal_normal(i, ii,us,ue,vs,ve, sur1, surInvert[i], k, n);//
|
|||
|
|
if(Mark==1)
|
|||
|
|
{
|
|||
|
|
normal2=Cal_normal(j, jj,us,ue,vs,ve, sur2, surInvert[j], k, n);//
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
normal2=Cal_normal2(j, jj,us,ue,vs,ve, sur2, surInvert[j], k, n);//
|
|||
|
|
}
|
|||
|
|
rModulus1 = sqrt(normal1.X()*normal1.X()+normal1.Y()*normal1.Y()+normal1.Z()*normal1.Z());
|
|||
|
|
rModulus2 = sqrt(normal2.X()*normal2.X()+normal2.Y()*normal2.Y()+normal2.Z()*normal2.Z());
|
|||
|
|
if(rModulus1>0&&rModulus2>0)
|
|||
|
|
{
|
|||
|
|
temp=normal1.X()*normal2.X()+normal1.Y()*normal2.Y()+normal1.Z()*normal2.Z();
|
|||
|
|
Csita=temp/rModulus1/rModulus2;
|
|||
|
|
if(Csita>1.0)
|
|||
|
|
{
|
|||
|
|
Csita=1.0;
|
|||
|
|
}
|
|||
|
|
else if(Csita<-1.0)
|
|||
|
|
{
|
|||
|
|
Csita=-1.0;
|
|||
|
|
}
|
|||
|
|
sita[k]=acos(Csita)*180/PI_VALUE;
|
|||
|
|
/*cout<< "\t" << sita[i];*/
|
|||
|
|
if(k>0&&k<n)
|
|||
|
|
{
|
|||
|
|
Con++;
|
|||
|
|
sum+=sita[k];
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
if(Con>0)
|
|||
|
|
{
|
|||
|
|
average=sum/Con;
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
average=0.0;
|
|||
|
|
}
|
|||
|
|
return(average);
|
|||
|
|
}
|
|||
|
|
Handle_Geom_BSplineSurface Modefy_sur(int i, int Mark, vector<Handle_Geom_BSplineSurface> sur1, Standard_Real* temp, vector<bool> modefiedu, vector<bool> modefiedv)
|
|||
|
|
{
|
|||
|
|
int row,col;
|
|||
|
|
gp_Pnt aP;//, aQ
|
|||
|
|
/*Handle_Geom_BSplineSurface sur=sur1[i]->Copy();*/
|
|||
|
|
Handle(Geom_BSplineSurface) sur=Handle(Geom_BSplineSurface)::DownCast(sur1[i]->Copy());
|
|||
|
|
row=sur->NbUPoles();
|
|||
|
|
col=sur->NbVPoles();
|
|||
|
|
if(Mark==0)//00-10 vs[i]
|
|||
|
|
{
|
|||
|
|
for(int k=2;k<row;k++)
|
|||
|
|
{
|
|||
|
|
aP=sur1[i]->Pole(k,2);
|
|||
|
|
aP.SetCoord(aP.X()+temp[0],aP.Y()+temp[1],aP.Z()+temp[2]);
|
|||
|
|
sur->SetPole(k,2, aP);
|
|||
|
|
//aQ=sur1[i]->Pole(k,2);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else if(Mark==1)//10-11 ue[i]
|
|||
|
|
{
|
|||
|
|
for(int k=2;k<col;k++)
|
|||
|
|
{
|
|||
|
|
aP=sur1[i]->Pole(row-1,k);
|
|||
|
|
aP.SetCoord(aP.X()+temp[0],aP.Y()+temp[1],aP.Z()+temp[2]);
|
|||
|
|
sur->SetPole(row-1,k, aP);
|
|||
|
|
//aQ=sur1[i]->Pole(row-1,k);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else if(Mark==2)//11-01 ve[i]
|
|||
|
|
{
|
|||
|
|
for(int k=2;k<row;k++)
|
|||
|
|
{
|
|||
|
|
aP=sur1[i]->Pole(k,col-1);
|
|||
|
|
aP.SetCoord(aP.X()+temp[0],aP.Y()+temp[1],aP.Z()+temp[2]);
|
|||
|
|
sur->SetPole(k,col-1, aP);
|
|||
|
|
//aQ=sur1[i]->Pole(k,col-1);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else// if(Mark==3)//01-00 us[i]
|
|||
|
|
{
|
|||
|
|
for(int k=2;k<col;k++)
|
|||
|
|
{
|
|||
|
|
aP=sur1[i]->Pole(2,k);
|
|||
|
|
aP.SetCoord(aP.X()+temp[0],aP.Y()+temp[1],aP.Z()+temp[2]);
|
|||
|
|
sur->SetPole(2,k, aP);
|
|||
|
|
//aQ=sur1[i]->Pole(2,k);
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
return(sur);
|
|||
|
|
}
|
|||
|
|
void Modefy_sur2(int i, int Mark, vector<Handle_Geom_BSplineSurface> sur1, Standard_Real* temp, vector<bool> modefiedu, vector<bool> modefiedv)
|
|||
|
|
{
|
|||
|
|
int row,col;
|
|||
|
|
gp_Pnt aP;//, aQ
|
|||
|
|
row=sur1[i]->NbUPoles();
|
|||
|
|
col=sur1[i]->NbVPoles();
|
|||
|
|
if(Mark==0)//00-10 vs[i]
|
|||
|
|
{
|
|||
|
|
if(col>3||modefiedu[i]==false)
|
|||
|
|
{
|
|||
|
|
for(int k=2;k<row;k++)
|
|||
|
|
{
|
|||
|
|
aP=sur1[i]->Pole(k,2);
|
|||
|
|
aP.SetCoord(aP.X()+temp[0],aP.Y()+temp[1],aP.Z()+temp[2]);
|
|||
|
|
sur1[i]->SetPole(k,2, aP);
|
|||
|
|
//aQ=sur1[i]->Pole(k,2);
|
|||
|
|
}
|
|||
|
|
modefiedu[i]=true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else if(Mark==1)//10-11 ue[i]
|
|||
|
|
{
|
|||
|
|
if(row>3||modefiedv[i]==false)
|
|||
|
|
{
|
|||
|
|
for(int k=2;k<col;k++)
|
|||
|
|
{
|
|||
|
|
aP=sur1[i]->Pole(row-1,k);
|
|||
|
|
aP.SetCoord(aP.X()+temp[0],aP.Y()+temp[1],aP.Z()+temp[2]);
|
|||
|
|
sur1[i]->SetPole(row-1,k, aP);
|
|||
|
|
//aQ=sur1[i]->Pole(row-1,k);
|
|||
|
|
}
|
|||
|
|
modefiedv[i]=true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else if(Mark==2)//11-01 ve[i]
|
|||
|
|
{
|
|||
|
|
if(col>3||modefiedu[i]==false)
|
|||
|
|
{
|
|||
|
|
for(int k=2;k<row;k++)
|
|||
|
|
{
|
|||
|
|
aP=sur1[i]->Pole(k,col-1);
|
|||
|
|
aP.SetCoord(aP.X()+temp[0],aP.Y()+temp[1],aP.Z()+temp[2]);
|
|||
|
|
sur1[i]->SetPole(k,col-1, aP);
|
|||
|
|
//aQ=sur1[i]->Pole(k,col-1);
|
|||
|
|
}
|
|||
|
|
modefiedu[i]=true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
else// if(Mark==3)//01-00 us[i]
|
|||
|
|
{
|
|||
|
|
if(row>3||modefiedv[i]==false)
|
|||
|
|
{
|
|||
|
|
for(int k=2;k<col;k++)
|
|||
|
|
{
|
|||
|
|
aP=sur1[i]->Pole(2,k);
|
|||
|
|
aP.SetCoord(aP.X()+temp[0],aP.Y()+temp[1],aP.Z()+temp[2]);
|
|||
|
|
sur1[i]->SetPole(2,k, aP);
|
|||
|
|
//aQ=sur1[i]->Pole(2,k);
|
|||
|
|
}
|
|||
|
|
modefiedv[i]=true;
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
}
|
|||
|
|
gp_Vec Cal_normal(int i, int Mark, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve, Handle_Geom_BSplineSurface myBSplineSurface, bool myInvert, int k, int n)//
|
|||
|
|
{
|
|||
|
|
double uu, vv;
|
|||
|
|
gp_Pnt aP;
|
|||
|
|
gp_Vec aDu;
|
|||
|
|
gp_Vec aDv;
|
|||
|
|
gp_Vec normal;
|
|||
|
|
Standard_Real rModulus;
|
|||
|
|
if(Mark==0)//00-10 vs[i]
|
|||
|
|
{
|
|||
|
|
uu=us[i]+(double)k / n *(ue[i]-us[i]);
|
|||
|
|
vv=vs[i];
|
|||
|
|
//cout<< "\t" << us[i] << "\t" << ue[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==1)//10-11 ue[i]
|
|||
|
|
{
|
|||
|
|
uu=ue[i];
|
|||
|
|
vv=vs[i]+(double)k / n *(ve[i]-vs[i]);
|
|||
|
|
//cout<< "\t" << vs[i] << "\t" << ve[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==2)//11-01 ve[i]
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
uu=ue[i]+(double)k / n *(us[i]-ue[i]);
|
|||
|
|
vv=ve[i];
|
|||
|
|
//cout<< "\t" << us[i] << "\t" << ue[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==3)//01-00 us[i]
|
|||
|
|
{
|
|||
|
|
uu=us[i];
|
|||
|
|
vv=ve[i]+(double)k / n *(vs[i]-ve[i]);
|
|||
|
|
//cout<< "\t" << vs[i] << "\t" << ve[i];
|
|||
|
|
}
|
|||
|
|
myBSplineSurface->D1(uu, vv, aP, aDu, aDv);
|
|||
|
|
if(myInvert==false)
|
|||
|
|
{
|
|||
|
|
normal = aDu.Crossed(aDv);
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
normal = -aDu.Crossed(aDv);
|
|||
|
|
}
|
|||
|
|
rModulus = sqrt(normal.X()*normal.X()+normal.Y()*normal.Y()+normal.Z()*normal.Z());
|
|||
|
|
|
|||
|
|
if (rModulus > 1.0e-9)
|
|||
|
|
{
|
|||
|
|
normal.Normalize();
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(0., 0., 0.);
|
|||
|
|
}
|
|||
|
|
if (fabs(normal.X())<1.0e-6)
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(0.0,normal.Y(),normal.Z());
|
|||
|
|
}
|
|||
|
|
if (fabs(normal.Y())<1.0e-6)
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(normal.X(),0.0,normal.Z());
|
|||
|
|
}
|
|||
|
|
if (fabs(normal.Z())<1.0e-6)
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(normal.X(),normal.Y(),0.0);
|
|||
|
|
}
|
|||
|
|
//cout<<fixed<<setprecision(6)<< "\t" << normal.X() << "\t" << normal.Y() << "\t" << normal.Z();
|
|||
|
|
return normal;
|
|||
|
|
/*cout<< "\t" << aP.X() << "\t" << aP.Y() << "\t" << aP.Z();*/
|
|||
|
|
}
|
|||
|
|
gp_Vec Cal_normal2(int i, int Mark, vector<Standard_Real> us, vector<Standard_Real> ue, vector<Standard_Real> vs, vector<Standard_Real> ve, Handle_Geom_BSplineSurface myBSplineSurface, bool myInvert, int k, int n)//
|
|||
|
|
{
|
|||
|
|
double uu, vv;
|
|||
|
|
gp_Pnt aP;
|
|||
|
|
gp_Vec aDu;
|
|||
|
|
gp_Vec aDv;
|
|||
|
|
gp_Vec normal;
|
|||
|
|
Standard_Real rModulus;
|
|||
|
|
if(Mark==0)//00-10 vs[i]
|
|||
|
|
{
|
|||
|
|
uu=us[i]+(double)k / n *(ue[i]-us[i]);
|
|||
|
|
vv=vs[i];
|
|||
|
|
//cout<< "\t" << us[i] << "\t" << ue[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==1)//10-11 ue[i]
|
|||
|
|
{
|
|||
|
|
uu=ue[i];
|
|||
|
|
vv=vs[i]+(double)k / n *(ve[i]-vs[i]);
|
|||
|
|
//cout<< "\t" << vs[i] << "\t" << ve[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==2)//11-01 ve[i]
|
|||
|
|
{
|
|||
|
|
|
|||
|
|
uu=ue[i]+(double)k / n *(us[i]-ue[i]);
|
|||
|
|
vv=ve[i];
|
|||
|
|
//cout<< "\t" << us[i] << "\t" << ue[i];
|
|||
|
|
}
|
|||
|
|
else if(Mark==3)//01-00 us[i]
|
|||
|
|
{
|
|||
|
|
uu=us[i];
|
|||
|
|
vv=ve[i]+(double)k / n *(vs[i]-ve[i]);
|
|||
|
|
//cout<< "\t" << vs[i] << "\t" << ve[i];
|
|||
|
|
}
|
|||
|
|
myBSplineSurface->D1(uu, vv, aP, aDu, aDv);
|
|||
|
|
if(myInvert==false)
|
|||
|
|
{
|
|||
|
|
normal = aDu.Crossed(aDv);
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
normal = -aDu.Crossed(aDv);
|
|||
|
|
}
|
|||
|
|
rModulus = sqrt(normal.X()*normal.X()+normal.Y()*normal.Y()+normal.Z()*normal.Z());
|
|||
|
|
|
|||
|
|
if (rModulus > 1.0e-9)
|
|||
|
|
{
|
|||
|
|
normal.Normalize();
|
|||
|
|
}
|
|||
|
|
else
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(0., 0., 0.);
|
|||
|
|
}
|
|||
|
|
if (fabs(normal.X())<1.0e-6)
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(0.0,normal.Y(),normal.Z());
|
|||
|
|
}
|
|||
|
|
if (fabs(normal.Y())<1.0e-6)
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(normal.X(),0.0,normal.Z());
|
|||
|
|
}
|
|||
|
|
if (fabs(normal.Z())<1.0e-6)
|
|||
|
|
{
|
|||
|
|
normal.SetCoord(normal.X(),normal.Y(),0.0);
|
|||
|
|
}
|
|||
|
|
//cout<<fixed<<setprecision(6)<< "\t" << normal.X() << "\t" << normal.Y() << "\t" << normal.Z();
|
|||
|
|
return normal;
|
|||
|
|
/*cout<< "\t" << aP.X() << "\t" << aP.Y() << "\t" << aP.Z();*/
|
|||
|
|
}
|
|||
|
|
|
|||
|
|
// END GUAN ADDED
|