|
@@ -0,0 +1,1395 @@
|
|
|
+#pragma once
|
|
|
+#include <BRepAlgoAPI_Cut.hxx>
|
|
|
+#include <BRepAlgoAPI_Fuse.hxx>
|
|
|
+#include <BRepBuilderAPI_MakeEdge.hxx>
|
|
|
+#include <BRepBuilderAPI_MakeFace.hxx>
|
|
|
+#include <BRepBuilderAPI_MakePolygon.hxx>
|
|
|
+#include <BRepBuilderAPI_MakeWire.hxx>
|
|
|
+#include <BRepFilletAPI_MakeFillet.hxx>
|
|
|
+#include <BRepOffsetAPI_MakePipe.hxx>
|
|
|
+#include <BRepOffsetAPI_ThruSections.hxx>
|
|
|
+#include <BRepPrimAPI_MakePrism.hxx>
|
|
|
+#include <GC_MakeArcOfCircle.hxx>
|
|
|
+#include <GeomAPI_ExtremaCurveCurve.hxx>
|
|
|
+#include <GeomAPI_IntCS.hxx>
|
|
|
+#include <Geom_Line.hxx>
|
|
|
+#include <Standard_UUID.hxx>
|
|
|
+#include <TopExp_Explorer.hxx>
|
|
|
+#include <TopoDS_Face.hxx>
|
|
|
+#include <TopoDS_Shape.hxx>
|
|
|
+#include <TopoDS_Wire.hxx>
|
|
|
+#include <algorithm>
|
|
|
+#include <gp_Ax2.hxx>
|
|
|
+#include <gp_Circ.hxx>
|
|
|
+#include <gp_Lin.hxx>
|
|
|
+#include <gp_Pnt.hxx>
|
|
|
+#include <iostream>
|
|
|
+
|
|
|
+using namespace std;
|
|
|
+
|
|
|
+struct Pipe {
|
|
|
+ Pipe(gp_Pnt p1, gp_Pnt p2, double r)
|
|
|
+ : startP(p1)
|
|
|
+ , endP(p2)
|
|
|
+ , radius(r) {
|
|
|
+ };
|
|
|
+ Pipe(std::string ndstr, gp_Pnt p1, gp_Pnt p2, double r)
|
|
|
+ : nd(ndstr)
|
|
|
+ , startP(p1)
|
|
|
+ , endP(p2)
|
|
|
+ , radius(r) {
|
|
|
+ };
|
|
|
+ std::string id; // 唯一标识
|
|
|
+ std::string nd; // 公称通径
|
|
|
+ gp_Pnt startP; // 起始点
|
|
|
+ gp_Pnt endP; // 结束点
|
|
|
+ double radius = -1; // 公称半径
|
|
|
+ std::string startConnectId; // 起始管接头id
|
|
|
+ std::string endConnectId; // 终点管接头id
|
|
|
+};
|
|
|
+
|
|
|
+struct PipeConnect {
|
|
|
+ PipeConnect() {};
|
|
|
+ PipeConnect(int n, double r1, double r2)
|
|
|
+ : type(n)
|
|
|
+ , radiusD1(r1)
|
|
|
+ , radiusD2(r2) {
|
|
|
+ };
|
|
|
+ PipeConnect(int n, std::string tj, double r1, double r2, double C, double M) // 四通用
|
|
|
+ : type(n)
|
|
|
+ , nd(tj)
|
|
|
+ , radiusD1(r1)
|
|
|
+ , radiusD2(r2)
|
|
|
+ , lengthC(C)
|
|
|
+ , lengthM(M) {
|
|
|
+ };
|
|
|
+ PipeConnect(int n, std::string tj, double r1, double C) // 二通用
|
|
|
+ : type(n)
|
|
|
+ , nd(tj)
|
|
|
+ , radiusD1(r1)
|
|
|
+ , lengthC(C) {
|
|
|
+ };
|
|
|
+ PipeConnect(int n, gp_Pnt p1, double r1, double r2)
|
|
|
+ : type(n)
|
|
|
+ , center(p1)
|
|
|
+ , radiusD1(r1)
|
|
|
+ , radiusD2(r2) {
|
|
|
+ };
|
|
|
+ std::string id; // 唯一标识
|
|
|
+ int type; // 类型 2:弯头 3:三通 4:四通 5:变径管
|
|
|
+ // 1.当type=2时为弯头,此时radiusD1为图例中的0.5*OD,radiusD2和lengthM的值为空,lengthC表示为图例中的A短半径
|
|
|
+ // 2.当type=3或4时,points前两个点对应截面半径为radiusD1,后两个对应radiusD2
|
|
|
+ // 3.当type=5时,points前两个点对应变径管的起始点和结束点
|
|
|
+ std::string nd; // 公称通径
|
|
|
+ double radiusD1 = -1; // 公称半径
|
|
|
+ double radiusD2 = -1; // 公称半径
|
|
|
+ double lengthC = -1; // C/短半径
|
|
|
+ double lengthM = -1; // M
|
|
|
+ gp_Pnt center; // 中心点(管道的交点)
|
|
|
+ vector<gp_Pnt> points; // 截面中心点
|
|
|
+};
|
|
|
+
|
|
|
+struct PipeResult {
|
|
|
+ std::vector<Pipe> pipes;
|
|
|
+ std::vector<PipeConnect> pipeConnects;
|
|
|
+ bool isOk;
|
|
|
+ std::string error;
|
|
|
+};
|
|
|
+
|
|
|
+class CreatePipeTool {
|
|
|
+public:
|
|
|
+ static TopoDS_Wire CreateCircularWire(const gp_Pnt& center, const gp_Dir& normal, double radius)
|
|
|
+ {
|
|
|
+ if (radius <= 0) {
|
|
|
+ return {};
|
|
|
+ }
|
|
|
+ gp_Ax2 axis2(center, normal);
|
|
|
+ gp_Circ circle = gp_Circ(axis2, radius);
|
|
|
+ BRepBuilderAPI_MakeEdge edgeMaker(circle);
|
|
|
+ TopoDS_Edge edge = edgeMaker;
|
|
|
+ if (!edgeMaker.IsDone()) {
|
|
|
+ throw std::runtime_error("Failed to create edge from circle.");
|
|
|
+ }
|
|
|
+ BRepBuilderAPI_MakeWire wireMaker(edge);
|
|
|
+ TopoDS_Wire wire = wireMaker;
|
|
|
+ if (!wireMaker.IsDone()) {
|
|
|
+ throw std::runtime_error("Failed to create wire from edge.");
|
|
|
+ }
|
|
|
+ return wire;
|
|
|
+ }
|
|
|
+
|
|
|
+ static ShapeResult getPipe(Pipe pipe)
|
|
|
+ {
|
|
|
+ ShapeResult result;
|
|
|
+
|
|
|
+ gp_Vec vec(pipe.endP.XYZ() - pipe.startP.XYZ());
|
|
|
+ gp_Dir dir(vec);
|
|
|
+ TopoDS_Wire wire = CreateCircularWire(pipe.startP, dir, pipe.radius);
|
|
|
+ TopoDS_Face face = BRepBuilderAPI_MakeFace(wire);
|
|
|
+ BRepPrimAPI_MakePrism prism(face, vec);
|
|
|
+ result.shape = prism.Shape();
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+ static ShapeResult getPipeChange(PipeConnect pipeCon)
|
|
|
+ {
|
|
|
+ ShapeResult result;
|
|
|
+ if (pipeCon.points.size() < 2) {
|
|
|
+ result.isOk = false;
|
|
|
+ result.error += "pipeCon.points.size() < 2 \n";
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+ try {
|
|
|
+ gp_Vec vec(pipeCon.points[1].XYZ() - pipeCon.points[0].XYZ());
|
|
|
+ gp_Dir dir(vec);
|
|
|
+ TopoDS_Wire wire1 = CreateCircularWire(pipeCon.points[0], dir, pipeCon.radiusD1);
|
|
|
+ TopoDS_Wire wire2 = CreateCircularWire(pipeCon.points[1], dir, pipeCon.radiusD2);
|
|
|
+ BRepOffsetAPI_ThruSections generator(Standard_True); // 标志是否生成Solid
|
|
|
+ generator.AddWire(wire1);
|
|
|
+ generator.AddWire(wire2);
|
|
|
+ result.shape = generator.Shape();
|
|
|
+ }
|
|
|
+ catch (const std::exception& e) {
|
|
|
+ result.isOk = false;
|
|
|
+ std::string ee = e.what();
|
|
|
+ result.error += "Error: " + ee + "\n";
|
|
|
+ }
|
|
|
+
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+ static ShapeResult FuseShapes(const TopoDS_Shape& shape1, const TopoDS_Shape& shape2)
|
|
|
+ {
|
|
|
+ ShapeResult result;
|
|
|
+ try {
|
|
|
+ BRepAlgoAPI_Fuse fuse(shape1, shape2);
|
|
|
+ if (!fuse.IsDone()) {
|
|
|
+ result.error += "Boolean operation failed.\n";
|
|
|
+ throw std::runtime_error("");
|
|
|
+ }
|
|
|
+ result.shape = fuse.Shape();
|
|
|
+ }
|
|
|
+ catch (const std::exception& e) {
|
|
|
+ result.isOk = false;
|
|
|
+ std::string ee = e.what();
|
|
|
+ result.error += "Error: " + ee + "\n";
|
|
|
+ }
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+ static ShapeResult CutShapes(const TopoDS_Shape& shape1, const TopoDS_Shape& shape2)
|
|
|
+ {
|
|
|
+ ShapeResult result;
|
|
|
+ try {
|
|
|
+ BRepAlgoAPI_Cut cut(shape1, shape2);
|
|
|
+ if (!cut.IsDone()) {
|
|
|
+ result.error += "Boolean operation failed.\n";
|
|
|
+ throw std::runtime_error("");
|
|
|
+ }
|
|
|
+ result.shape = cut.Shape();
|
|
|
+ }
|
|
|
+ catch (const std::exception& e) {
|
|
|
+ result.isOk = false;
|
|
|
+ std::string ee = e.what();
|
|
|
+ result.error += "Error: " + ee + "\n";
|
|
|
+ }
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+ // 根据参数计算管道shape
|
|
|
+ static TopoDS_Shape getCylinder(Pipe pipe)
|
|
|
+ {
|
|
|
+ gp_Vec vec(pipe.endP.XYZ() - pipe.startP.XYZ());
|
|
|
+ gp_Dir dir(vec);
|
|
|
+ TopoDS_Wire wire = CreateCircularWire(pipe.startP, dir, pipe.radius);
|
|
|
+ TopoDS_Face Face = BRepBuilderAPI_MakeFace(wire);
|
|
|
+ BRepPrimAPI_MakePrism prism(Face, vec);
|
|
|
+ return prism.Shape();
|
|
|
+ }
|
|
|
+
|
|
|
+
|
|
|
+ static ShapeResult getPipeConnect3Part(PipeConnect pipeCon, int num)
|
|
|
+ {
|
|
|
+ ShapeResult result;
|
|
|
+ try {
|
|
|
+ gp_Pnt startP(0, 0, 0);
|
|
|
+ gp_Pnt endP(0, 0, 50);
|
|
|
+ Pipe pipe1(startP, endP, 30);
|
|
|
+
|
|
|
+ gp_Pnt startP2(0, 0, 25);
|
|
|
+ gp_Pnt endP2(40, 0, 25);
|
|
|
+ Pipe pipe2(startP2, endP2, 20);
|
|
|
+
|
|
|
+ if (num == 0) {
|
|
|
+ ShapeResult res1 = getPipe(pipe1);
|
|
|
+ if (!res1.isOk) {
|
|
|
+ result = res1;
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+ TopoDS_Shape shape2 = getCylinder(pipe2);
|
|
|
+ result = CutShapes(res1.shape, shape2);
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ ShapeResult res1 = getPipe(pipe2);
|
|
|
+ if (!res1.isOk) {
|
|
|
+ result = res1;
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+ TopoDS_Shape shape2 = getCylinder(pipe1);
|
|
|
+ result = CutShapes(res1.shape, shape2);
|
|
|
+ }
|
|
|
+ }
|
|
|
+ catch (const std::exception& e) {
|
|
|
+ result.isOk = false;
|
|
|
+ std::string ee = e.what();
|
|
|
+ result.error += "Error: " + ee + "\n";
|
|
|
+ }
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+ static ShapeResult getPipeConnect3(PipeConnect pipeCon)
|
|
|
+ {
|
|
|
+ ShapeResult result;
|
|
|
+ if (pipeCon.points.size() < 3) {
|
|
|
+ result.isOk = false;
|
|
|
+ result.error += "pipeCon.points.size() < 3 \n";
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+ try {
|
|
|
+ // ShapeResult res1 = getPipeConnect3Part(pipeCon, 0);
|
|
|
+ // ShapeResult res2 = getPipeConnect3Part(pipeCon, 1);
|
|
|
+ Pipe pipe1(pipeCon.points[0], pipeCon.points[1], pipeCon.radiusD1);
|
|
|
+ Pipe pipe2(pipeCon.points[2], pipeCon.center, pipeCon.radiusD2);
|
|
|
+ ShapeResult res1 = getPipe(pipe1);
|
|
|
+ ShapeResult res2 = getPipe(pipe2);
|
|
|
+ result = FuseShapes(res1.shape, res2.shape);
|
|
|
+ }
|
|
|
+ catch (const std::exception& e) {
|
|
|
+ result.isOk = false;
|
|
|
+ std::string ee = e.what();
|
|
|
+ result.error += "Error: " + ee + "\n";
|
|
|
+ }
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+ static ShapeResult getPipeConnect4(PipeConnect pipeCon)
|
|
|
+ {
|
|
|
+ ShapeResult result;
|
|
|
+ if (pipeCon.points.size() < 4) {
|
|
|
+ result.isOk = false;
|
|
|
+ result.error += "pipeCon.points.size() < 4 \n";
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+ try {
|
|
|
+ Pipe pipe1(pipeCon.points[0], pipeCon.points[1], pipeCon.radiusD1);
|
|
|
+ Pipe pipe2(pipeCon.points[2], pipeCon.points[3], pipeCon.radiusD2);
|
|
|
+ ShapeResult res1 = getPipe(pipe1);
|
|
|
+ ShapeResult res2 = getPipe(pipe2);
|
|
|
+ result = FuseShapes(res1.shape, res2.shape);
|
|
|
+ }
|
|
|
+ catch (const std::exception& e) {
|
|
|
+ result.isOk = false;
|
|
|
+ std::string ee = e.what();
|
|
|
+ result.error += "Error: " + ee + "\n";
|
|
|
+ }
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+ // 创建一个圆弧路径
|
|
|
+ static TopoDS_Wire CreateWireFromArc(
|
|
|
+ const gp_Pnt& startPt, const gp_Pnt& circleCenter, const gp_Pnt& endPt, double radius)
|
|
|
+ {
|
|
|
+ // 使用GC_MakeArcOfCircle创建圆弧
|
|
|
+ gp_Vec vec1(startPt.XYZ() - circleCenter.XYZ());
|
|
|
+ gp_Vec vec2(endPt.XYZ() - circleCenter.XYZ());
|
|
|
+ gp_Vec midVec = vec1 + vec2;
|
|
|
+ midVec.Normalize();
|
|
|
+ midVec.Multiply(radius);
|
|
|
+ gp_Pnt midPt = circleCenter.Translated(midVec);
|
|
|
+ GC_MakeArcOfCircle mkArc(startPt, midPt, endPt);
|
|
|
+ if (!mkArc.IsDone()) {
|
|
|
+ throw std::runtime_error("Failed to create arc of circle.");
|
|
|
+ }
|
|
|
+
|
|
|
+ Handle(Geom_TrimmedCurve) arc = mkArc.Value();
|
|
|
+ BRepBuilderAPI_MakeEdge edgeMaker(arc);
|
|
|
+ if (!edgeMaker.IsDone()) {
|
|
|
+ throw std::runtime_error("Failed to create edge from arc.");
|
|
|
+ }
|
|
|
+ TopoDS_Edge edge = edgeMaker;
|
|
|
+
|
|
|
+ BRepBuilderAPI_MakeWire wireMaker(edge);
|
|
|
+ if (!wireMaker.IsDone()) {
|
|
|
+ throw std::runtime_error("Failed to create wire from edge.");
|
|
|
+ }
|
|
|
+
|
|
|
+ return wireMaker.Wire();
|
|
|
+ }
|
|
|
+
|
|
|
+ // 创建一个圆形截面
|
|
|
+ static TopoDS_Wire CreateCircularSection(const gp_Pnt& center, gp_Dir normal, double radius)
|
|
|
+ {
|
|
|
+ gp_Ax2 axis2(center, normal);
|
|
|
+ gp_Circ circle = gp_Circ(axis2, radius);
|
|
|
+ BRepBuilderAPI_MakeEdge edgeMaker(circle);
|
|
|
+ TopoDS_Edge edge = edgeMaker;
|
|
|
+ BRepBuilderAPI_MakeWire wireMaker(edge);
|
|
|
+ return wireMaker.Wire();
|
|
|
+ }
|
|
|
+
|
|
|
+ // 执行管道操作(沿路径拉伸)
|
|
|
+ static TopoDS_Shape SweepAlongPath(const TopoDS_Wire& section, const TopoDS_Wire& path)
|
|
|
+ {
|
|
|
+ TopoDS_Face face = BRepBuilderAPI_MakeFace(section);
|
|
|
+ BRepOffsetAPI_MakePipe pipeMaker(path, face);
|
|
|
+ return pipeMaker.Shape();
|
|
|
+ }
|
|
|
+
|
|
|
+ static ShapeResult getPipeConnect2(PipeConnect pipeCon)
|
|
|
+ {
|
|
|
+ ShapeResult result;
|
|
|
+ if (pipeCon.points.size() < 2) {
|
|
|
+ result.isOk = false;
|
|
|
+ result.error += "pipeCon.points.size() < 2 \n";
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+ if (pipeCon.lengthC < 0) {
|
|
|
+ result.isOk = false;
|
|
|
+ result.error += "短半径值无效 \n";
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+ try {
|
|
|
+ gp_Vec vec1(pipeCon.center.XYZ() - pipeCon.points[0].XYZ());
|
|
|
+ gp_Dir dir1(vec1);
|
|
|
+ gp_Vec vec2(pipeCon.points[1].XYZ() - pipeCon.center.XYZ());
|
|
|
+ gp_Dir dir2(vec2);
|
|
|
+ TopoDS_Wire cir = CreateCircularSection(pipeCon.points[0], vec1, pipeCon.radiusD1);
|
|
|
+ gp_Vec vecToCenter(dir2);
|
|
|
+ vecToCenter *= pipeCon.lengthC;
|
|
|
+ gp_Pnt circleCenter = pipeCon.points[0].Translated(vecToCenter);
|
|
|
+ TopoDS_Wire path = CreateWireFromArc(pipeCon.points[0], circleCenter, pipeCon.points[1], pipeCon.lengthC);
|
|
|
+
|
|
|
+ result.shape = /*path*/ SweepAlongPath(cir, path);
|
|
|
+ }
|
|
|
+ catch (const std::exception& e) {
|
|
|
+ std::string ee = e.what();
|
|
|
+ result.error += "Error: " + ee + "\n";
|
|
|
+ }
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+
|
|
|
+ // 根据参数计算管道接头和变径管
|
|
|
+ static ShapeResult getPipeConnect(PipeConnect pipeCon)
|
|
|
+ {
|
|
|
+ ShapeResult result;
|
|
|
+ switch (pipeCon.type) {
|
|
|
+ case 2: {
|
|
|
+ result = getPipeConnect2(pipeCon);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ case 3: {
|
|
|
+ result = getPipeConnect3(pipeCon);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ case 4: {
|
|
|
+ result = getPipeConnect4(pipeCon);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ case 5: {
|
|
|
+ result = getPipeChange(pipeCon);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+ std::string GenerateUUID()
|
|
|
+ {
|
|
|
+ // 生成一个新的随机UUID
|
|
|
+
|
|
|
+ // 将UUID转换为字符串形式以便打印
|
|
|
+ std::string uuidStr /*= aUUID.()*/;
|
|
|
+
|
|
|
+ return uuidStr;
|
|
|
+ }
|
|
|
+
|
|
|
+ // 计算两条直线的交点
|
|
|
+ static bool calculateIntersection(gp_Pnt& intersectionPoint, const gp_Lin& line1, const gp_Lin& line2)
|
|
|
+ {
|
|
|
+ // 将直线转换为参数方程的形式
|
|
|
+ gp_Pnt origin1 = line1.Location();
|
|
|
+ gp_Dir direction1 = line1.Direction();
|
|
|
+ gp_Pnt origin2 = line2.Location();
|
|
|
+ gp_Dir direction2 = line2.Direction();
|
|
|
+
|
|
|
+ // 使用向量数学计算交点
|
|
|
+ gp_Vec v1(origin1, origin2);
|
|
|
+ gp_Vec dirVec1(direction1);
|
|
|
+ gp_Vec dirVec2(direction2);
|
|
|
+
|
|
|
+ // 计算分母,两个方向向量的叉乘大小
|
|
|
+ gp_Vec crossProduct = dirVec1.Crossed(dirVec2);
|
|
|
+ double denom = crossProduct.Magnitude(); // 分母应该是叉乘向量的模
|
|
|
+
|
|
|
+ if (std::abs(denom) < 1e-6) { // 平行或共线
|
|
|
+ std::cerr << "Lines are parallel or coincident." << std::endl;
|
|
|
+ return false; // 返回默认构造的点作为错误指示
|
|
|
+ }
|
|
|
+
|
|
|
+ // 计算t参数,即从line1的原点到交点的距离参数
|
|
|
+ double t = (v1.Crossed(dirVec2)).Magnitude() / denom;
|
|
|
+ // 计算line1上的交点
|
|
|
+ gp_Vec vecOnLine1(dirVec1);
|
|
|
+ vecOnLine1.Multiply(t);
|
|
|
+ intersectionPoint = origin1.Translated(vecOnLine1);
|
|
|
+ return true;
|
|
|
+ }
|
|
|
+
|
|
|
+ // 求交点
|
|
|
+ static bool computeInterPt(gp_Pnt& intersectionPoint, const vector<Pipe>& pipes)
|
|
|
+ {
|
|
|
+ if (pipes.size() < 2)
|
|
|
+ return false;
|
|
|
+
|
|
|
+ gp_Lin line1(pipes.front().startP, gp_Dir(gp_Vec(pipes.front().startP, pipes.front().endP)));
|
|
|
+ gp_Lin line2(pipes[1].startP, gp_Dir(gp_Vec(pipes[1].startP, pipes[1].endP)));
|
|
|
+ if (!calculateIntersection(intersectionPoint, line1, line2)) {
|
|
|
+ std::cout << "No intersection found." << std::endl;
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+ return true;
|
|
|
+ }
|
|
|
+
|
|
|
+ static bool AreLinesCollinear(const gp_Lin& line1, const gp_Lin& line2, double tolerance = 1e-7)
|
|
|
+ {
|
|
|
+ // 获取两条直线的方向向量
|
|
|
+ gp_Dir dir1 = line1.Direction();
|
|
|
+ gp_Dir dir2 = line2.Direction();
|
|
|
+ // 检查方向向量是否相同或相反
|
|
|
+ if (!dir1.IsEqual(dir2, tolerance) && !dir1.IsOpposite(dir2, tolerance)) {
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+ // 获取line1上的一个点并检查它是否在line2上
|
|
|
+ gp_Pnt pointOnLine1 = line1.Location();
|
|
|
+ double u = 0.0;
|
|
|
+ return line2.Contains(pointOnLine1, u);
|
|
|
+ }
|
|
|
+
|
|
|
+ static bool IsPipesCollinear(const vector<Pipe>& pipes)
|
|
|
+ {
|
|
|
+ if (pipes.size() < 2)
|
|
|
+ return false;
|
|
|
+
|
|
|
+ gp_Lin line1(pipes.front().startP, gp_Dir(gp_Vec(pipes.front().startP, pipes.front().endP)));
|
|
|
+ gp_Lin line2(pipes[1].startP, gp_Dir(gp_Vec(pipes[1].startP, pipes[1].endP)));
|
|
|
+ return AreLinesCollinear(line1, line2);
|
|
|
+ }
|
|
|
+ static bool isAlmostEqual(double a, double b, double tolerance = 1e-6)
|
|
|
+ {
|
|
|
+ if (std::abs(a - b) <= tolerance)
|
|
|
+ return true;
|
|
|
+
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+
|
|
|
+ static std::vector<PipeConnect> getAllPipeConnect4()
|
|
|
+ {
|
|
|
+ std::vector<PipeConnect> vecPipeConnect4;
|
|
|
+ PipeConnect con4_50_50_50(4, "50*50*50", 57 * 0.5, 57 * 0.5, 64, 64);
|
|
|
+ PipeConnect con4_50_50_40(4, "50*50*40", 57 * 0.5, 45 * 0.5, 64, 60);
|
|
|
+
|
|
|
+ vecPipeConnect4.insert(vecPipeConnect4.end(), { con4_50_50_50, con4_50_50_40 });
|
|
|
+ return vecPipeConnect4;
|
|
|
+ }
|
|
|
+
|
|
|
+ static std::vector<PipeConnect> getAllPipeConnect5()
|
|
|
+ {
|
|
|
+ std::vector<PipeConnect> vecPipeConnect5;
|
|
|
+ //PipeConnect con5_40_32(5, "40*32", 48.3 * 0.5, 42.4 * 0.5, 64, 64);
|
|
|
+ //PipeConnect con5_40_25(5, "40*25", 48.3 * 0.5, 33.7 * 0.5, 64, 64);
|
|
|
+ //PipeConnect con5_50_40(5, "50*40", 60.3 * 0.5, 48.3 * 0.5, 76, 76);
|
|
|
+ //PipeConnect con5_50_32(5, "50*32", 60.3 * 0.5, 42.4 * 0.5, 76, 76);
|
|
|
+ PipeConnect con5_40_32(5, "40*32", 45 * 0.5, 38 * 0.5, 64, 64);
|
|
|
+ PipeConnect con5_40_25(5, "40*25", 45 * 0.5, 32 * 0.5, 64, 64);
|
|
|
+ PipeConnect con5_50_40(5, "50*40", 57 * 0.5, 45 * 0.5, 76, 76);
|
|
|
+ PipeConnect con5_50_32(5, "50*32", 57 * 0.5, 38 * 0.5, 76, 76);
|
|
|
+
|
|
|
+ vecPipeConnect5.insert(vecPipeConnect5.end(), { con5_40_32, con5_40_25, con5_50_40, con5_50_32 });
|
|
|
+ return vecPipeConnect5;
|
|
|
+ }
|
|
|
+
|
|
|
+ static std::vector<PipeConnect> getAllPipeConnect2()
|
|
|
+ {
|
|
|
+ std::vector<PipeConnect> vecPipeConnect2;
|
|
|
+ PipeConnect con4_50(2, "50", 57 * 0.5, 50);
|
|
|
+ PipeConnect con4_40(2, "40", 45 * 0.5, 40);
|
|
|
+
|
|
|
+ vecPipeConnect2.insert(vecPipeConnect2.end(), { con4_50, con4_40 });
|
|
|
+ return vecPipeConnect2;
|
|
|
+ }
|
|
|
+
|
|
|
+ static PipeConnect getPipeConnect4(bool& isneedChange1, bool& isneedChange2, double r1, double r2)
|
|
|
+ {
|
|
|
+ PipeConnect conRes;
|
|
|
+ conRes.type = 4;
|
|
|
+ std::vector<PipeConnect> vecPipeConnect4 = getAllPipeConnect4();
|
|
|
+ if (vecPipeConnect4.size() < 1) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ std::vector<int> numTrue1, numTrue2;
|
|
|
+ for (int i = 0; i < vecPipeConnect4.size(); i++) {
|
|
|
+ PipeConnect con = vecPipeConnect4[i];
|
|
|
+ int num = 0;
|
|
|
+ if (isAlmostEqual(con.radiusD1, r1))
|
|
|
+ num++;
|
|
|
+ if (isAlmostEqual(con.radiusD2, r2))
|
|
|
+ num++;
|
|
|
+ numTrue1.push_back(num);
|
|
|
+ }
|
|
|
+ for (int i = 0; i < vecPipeConnect4.size(); i++) {
|
|
|
+ PipeConnect con = vecPipeConnect4[i];
|
|
|
+ int num = 0;
|
|
|
+ if (isAlmostEqual(con.radiusD1, r2))
|
|
|
+ num++;
|
|
|
+ if (isAlmostEqual(con.radiusD2, r1))
|
|
|
+ num++;
|
|
|
+ numTrue2.push_back(num);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (numTrue1.empty()) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ int maxIndex1 = 0;
|
|
|
+ int maxValue1 = numTrue1[0];
|
|
|
+ for (int i = 1; i < numTrue1.size(); ++i) {
|
|
|
+ if (numTrue1[i] > maxValue1) {
|
|
|
+ maxValue1 = numTrue1[i];
|
|
|
+ maxIndex1 = i;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (numTrue2.empty()) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ int maxIndex2 = 0;
|
|
|
+ int maxValue2 = numTrue2[0];
|
|
|
+ for (int i = 1; i < numTrue2.size(); ++i) {
|
|
|
+ if (numTrue2[i] > maxValue2) {
|
|
|
+ maxValue2 = numTrue2[i];
|
|
|
+ maxIndex2 = i;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (maxValue1 == 0 && maxValue2 == 0) {
|
|
|
+ return vecPipeConnect4[0];
|
|
|
+ }
|
|
|
+
|
|
|
+ if (maxIndex1 >= maxIndex2) {
|
|
|
+ conRes = vecPipeConnect4[maxIndex1];
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ conRes.nd = vecPipeConnect4[maxIndex2].nd;
|
|
|
+ conRes.radiusD1 = vecPipeConnect4[maxIndex2].radiusD2;
|
|
|
+ conRes.radiusD2 = vecPipeConnect4[maxIndex2].radiusD1;
|
|
|
+ conRes.lengthC = vecPipeConnect4[maxIndex2].lengthM;
|
|
|
+ conRes.lengthM = vecPipeConnect4[maxIndex2].lengthC;
|
|
|
+ }
|
|
|
+ if (isAlmostEqual(conRes.radiusD1, r1))
|
|
|
+ isneedChange1 = false;
|
|
|
+ if (isAlmostEqual(conRes.radiusD2, r2))
|
|
|
+ isneedChange2 = false;
|
|
|
+ conRes.id = "newConnect"; // 用UUID
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+
|
|
|
+ static std::string getNominalDiameter1(const PipeConnect& con)
|
|
|
+ {
|
|
|
+ std::string str = con.nd;
|
|
|
+ std::string result = str;
|
|
|
+ size_t pos = str.find('*');
|
|
|
+ if (pos != std::string::npos && pos != 0) {
|
|
|
+ result = str.substr(0, pos);
|
|
|
+ }
|
|
|
+
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+ static std::string getNominalDiameter2(const PipeConnect& con)
|
|
|
+ {
|
|
|
+ std::string str = con.nd;
|
|
|
+ std::string result = str;
|
|
|
+ size_t pos = str.rfind('*');
|
|
|
+ if (pos != std::string::npos && pos != str.length() - 1) {
|
|
|
+ result = str.substr(pos + 1);
|
|
|
+ }
|
|
|
+
|
|
|
+ return result;
|
|
|
+ }
|
|
|
+
|
|
|
+ static PipeConnect getPipeConnect5(bool& isexist, std::string D1, std::string D2)
|
|
|
+ {
|
|
|
+ PipeConnect conRes;
|
|
|
+ conRes.type = 5;
|
|
|
+ std::vector<PipeConnect> vecPipeConnect5 = getAllPipeConnect5();
|
|
|
+ if (vecPipeConnect5.size() < 1) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+
|
|
|
+ for (int i = 0; i < vecPipeConnect5.size(); i++) {
|
|
|
+ PipeConnect con = vecPipeConnect5[i];
|
|
|
+ if ((getNominalDiameter1(con) == D1 && getNominalDiameter2(con) == D2)
|
|
|
+ || (getNominalDiameter1(con) == D2 && getNominalDiameter2(con) == D1)) {
|
|
|
+ isexist = true;
|
|
|
+ conRes = con;
|
|
|
+ conRes.id = "newConnect"; // 用UUID
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ isexist = false;
|
|
|
+ conRes.id = "newConnect"; // 用UUID
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+
|
|
|
+ static PipeConnect getPipeConnect4(bool& isneedChange1, bool& isneedChange2, std::string D1, std::string D2)
|
|
|
+ {
|
|
|
+ PipeConnect conRes;
|
|
|
+ conRes.type = 4;
|
|
|
+ std::vector<PipeConnect> vecPipeConnect4 = getAllPipeConnect4();
|
|
|
+ if (vecPipeConnect4.size() < 1) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ std::vector<int> numTrue1, numTrue2;
|
|
|
+ for (int i = 0; i < vecPipeConnect4.size(); i++) {
|
|
|
+ PipeConnect con = vecPipeConnect4[i];
|
|
|
+
|
|
|
+ int num = 0;
|
|
|
+ if (getNominalDiameter1(con) == D1)
|
|
|
+ num++;
|
|
|
+ if (getNominalDiameter2(con) == D2)
|
|
|
+ num++;
|
|
|
+ numTrue1.push_back(num);
|
|
|
+ }
|
|
|
+ for (int i = 0; i < vecPipeConnect4.size(); i++) {
|
|
|
+ PipeConnect con = vecPipeConnect4[i];
|
|
|
+ int num = 0;
|
|
|
+ if (getNominalDiameter1(con) == D2)
|
|
|
+ num++;
|
|
|
+ if (getNominalDiameter2(con) == D1)
|
|
|
+ num++;
|
|
|
+ numTrue2.push_back(num);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (numTrue1.empty()) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ int maxIndex1 = 0;
|
|
|
+ int maxValue1 = numTrue1[0];
|
|
|
+ for (int i = 1; i < numTrue1.size(); ++i) {
|
|
|
+ if (numTrue1[i] > maxValue1) {
|
|
|
+ maxValue1 = numTrue1[i];
|
|
|
+ maxIndex1 = i;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (numTrue2.empty()) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ int maxIndex2 = 0;
|
|
|
+ int maxValue2 = numTrue2[0];
|
|
|
+ for (int i = 1; i < numTrue2.size(); ++i) {
|
|
|
+ if (numTrue2[i] > maxValue2) {
|
|
|
+ maxValue2 = numTrue2[i];
|
|
|
+ maxIndex2 = i;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (maxValue1 == 0 && maxValue2 == 0) {
|
|
|
+ return vecPipeConnect4[0];
|
|
|
+ }
|
|
|
+
|
|
|
+ if (maxValue1 >= maxValue2) {
|
|
|
+ conRes = vecPipeConnect4[maxIndex1];
|
|
|
+ if (getNominalDiameter1(conRes) == D1)
|
|
|
+ isneedChange1 = false;
|
|
|
+ if (getNominalDiameter2(conRes) == D2)
|
|
|
+ isneedChange2 = false;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ conRes.nd = vecPipeConnect4[maxIndex2].nd;
|
|
|
+ conRes.radiusD1 = vecPipeConnect4[maxIndex2].radiusD2;
|
|
|
+ conRes.radiusD2 = vecPipeConnect4[maxIndex2].radiusD1;
|
|
|
+ conRes.lengthC = vecPipeConnect4[maxIndex2].lengthM;
|
|
|
+ conRes.lengthM = vecPipeConnect4[maxIndex2].lengthC;
|
|
|
+ if (getNominalDiameter2(conRes) == D1)
|
|
|
+ isneedChange1 = false;
|
|
|
+ if (getNominalDiameter1(conRes) == D2)
|
|
|
+ isneedChange2 = false;
|
|
|
+ }
|
|
|
+
|
|
|
+ conRes.id = "newConnect"; // 用UUID
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+
|
|
|
+ static PipeConnect getPipeConnect3(bool& isneedChange1, bool& isneedChange2, double D1, double D2)
|
|
|
+ {
|
|
|
+ PipeConnect conRes;
|
|
|
+ std::vector<PipeConnect> vecPipeConnect4 = getAllPipeConnect4();
|
|
|
+ if (vecPipeConnect4.size() < 1) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ std::vector<int> numTrue1;
|
|
|
+ for (int i = 0; i < vecPipeConnect4.size(); i++) {
|
|
|
+ PipeConnect con = vecPipeConnect4[i];
|
|
|
+ int num = 0;
|
|
|
+ if (isAlmostEqual(con.radiusD1, D1))
|
|
|
+ num++;
|
|
|
+ if (isAlmostEqual(con.radiusD2, D2))
|
|
|
+ num++;
|
|
|
+ numTrue1.push_back(num);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (numTrue1.empty()) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ int maxIndex1 = 0;
|
|
|
+ int maxValue1 = numTrue1[0];
|
|
|
+ for (int i = 1; i < numTrue1.size(); ++i) {
|
|
|
+ if (numTrue1[i] > maxValue1) {
|
|
|
+ maxValue1 = numTrue1[i];
|
|
|
+ maxIndex1 = i;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (maxValue1 == 0) {
|
|
|
+ return vecPipeConnect4[0];
|
|
|
+ }
|
|
|
+ conRes = vecPipeConnect4[maxIndex1];
|
|
|
+ conRes.type = 3;
|
|
|
+ conRes.id = "newConnect"; // 用UUID
|
|
|
+ if (isAlmostEqual(conRes.radiusD1, D1))
|
|
|
+ isneedChange1 = false;
|
|
|
+ if (isAlmostEqual(conRes.radiusD2, D2))
|
|
|
+ isneedChange2 = false;
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+
|
|
|
+ static PipeConnect getPipeConnect3(bool& isneedChange1, bool& isneedChange2, std::string D1, std::string D2)
|
|
|
+ {
|
|
|
+ PipeConnect conRes;
|
|
|
+ std::vector<PipeConnect> vecPipeConnect4 = getAllPipeConnect4();
|
|
|
+ if (vecPipeConnect4.size() < 1) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ std::vector<int> numTrue1;
|
|
|
+ for (int i = 0; i < vecPipeConnect4.size(); i++) {
|
|
|
+ PipeConnect con = vecPipeConnect4[i];
|
|
|
+ int num = 0;
|
|
|
+ if (getNominalDiameter1(con) == D1)
|
|
|
+ num++;
|
|
|
+ if (getNominalDiameter2(con) == D2)
|
|
|
+ num++;
|
|
|
+ numTrue1.push_back(num);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (numTrue1.empty()) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+
|
|
|
+ int maxIndex1 = 0;
|
|
|
+ int maxValue1 = numTrue1[0];
|
|
|
+ for (int i = 1; i < numTrue1.size(); ++i) {
|
|
|
+ if (numTrue1[i] > maxValue1) {
|
|
|
+ maxValue1 = numTrue1[i];
|
|
|
+ maxIndex1 = i;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (maxValue1 == 0) {
|
|
|
+ return vecPipeConnect4[0];
|
|
|
+ }
|
|
|
+ conRes = vecPipeConnect4[maxIndex1];
|
|
|
+ conRes.type = 3;
|
|
|
+ conRes.id = "newConnect"; // 用UUID
|
|
|
+ if (getNominalDiameter1(conRes) == D1)
|
|
|
+ isneedChange1 = false;
|
|
|
+ if (getNominalDiameter2(conRes) == D2)
|
|
|
+ isneedChange2 = false;
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+
|
|
|
+ static PipeConnect getPipeConnect2(bool& isneedChange1, bool& isneedChange2, double D1, double D2)
|
|
|
+ {
|
|
|
+ PipeConnect conRes;
|
|
|
+ conRes.type = 2;
|
|
|
+ std::vector<PipeConnect> vecPipeConnect2 = getAllPipeConnect2();
|
|
|
+ if (vecPipeConnect2.size() < 1) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ std::vector<int> numTrue1;
|
|
|
+ for (int i = 0; i < vecPipeConnect2.size(); i++) {
|
|
|
+ PipeConnect con = vecPipeConnect2[i];
|
|
|
+ int num = 0;
|
|
|
+ if (isAlmostEqual(con.radiusD1, D1))
|
|
|
+ num++;
|
|
|
+ if (isAlmostEqual(con.radiusD1, D2))
|
|
|
+ num++;
|
|
|
+ numTrue1.push_back(num);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (numTrue1.empty()) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ int maxIndex1 = 0;
|
|
|
+ int maxValue1 = numTrue1[0];
|
|
|
+ for (int i = 1; i < numTrue1.size(); ++i) {
|
|
|
+ if (numTrue1[i] > maxValue1) {
|
|
|
+ maxValue1 = numTrue1[i];
|
|
|
+ maxIndex1 = i;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (maxValue1 == 0) {
|
|
|
+ return vecPipeConnect2[0];
|
|
|
+ }
|
|
|
+ conRes = vecPipeConnect2[maxIndex1];
|
|
|
+ conRes.id = "newConnect"; // 用UUID
|
|
|
+ if (isAlmostEqual(conRes.radiusD1, D1))
|
|
|
+ isneedChange1 = false;
|
|
|
+ if (isAlmostEqual(conRes.radiusD1, D2))
|
|
|
+ isneedChange2 = false;
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+
|
|
|
+ static PipeConnect getPipeConnect2(bool& isneedChange1, bool& isneedChange2, std::string D1, std::string D2)
|
|
|
+ {
|
|
|
+ PipeConnect conRes;
|
|
|
+ conRes.type = 2;
|
|
|
+ std::vector<PipeConnect> vecPipeConnect2 = getAllPipeConnect2();
|
|
|
+ if (vecPipeConnect2.size() < 1) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ std::vector<int> numTrue1;
|
|
|
+ for (int i = 0; i < vecPipeConnect2.size(); i++) {
|
|
|
+ PipeConnect con = vecPipeConnect2[i];
|
|
|
+ int num = 0;
|
|
|
+ if (getNominalDiameter1(con) == D1)
|
|
|
+ num++;
|
|
|
+ if (getNominalDiameter1(con) == D2)
|
|
|
+ num++;
|
|
|
+ numTrue1.push_back(num);
|
|
|
+ }
|
|
|
+
|
|
|
+ if (numTrue1.empty()) {
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+ int maxIndex1 = 0;
|
|
|
+ int maxValue1 = numTrue1[0];
|
|
|
+ for (int i = 1; i < numTrue1.size(); ++i) {
|
|
|
+ if (numTrue1[i] > maxValue1) {
|
|
|
+ maxValue1 = numTrue1[i];
|
|
|
+ maxIndex1 = i;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ if (maxValue1 == 0) {
|
|
|
+ return vecPipeConnect2[0];
|
|
|
+ }
|
|
|
+ conRes = vecPipeConnect2[maxIndex1];
|
|
|
+ conRes.id = "newConnect"; // 用UUID
|
|
|
+ if (getNominalDiameter1(conRes) == D1)
|
|
|
+ isneedChange1 = false;
|
|
|
+ if (getNominalDiameter1(conRes) == D2)
|
|
|
+ isneedChange2 = false;
|
|
|
+ return conRes;
|
|
|
+ }
|
|
|
+
|
|
|
+ static void AdjustPipesSequence(vector<Pipe>& pipes)
|
|
|
+ {
|
|
|
+ // 调整顺序:原管道(黄色)在前,新管道(红色)在后 (没id代表管道需要新增,有id代表需要修改)
|
|
|
+ if (pipes.size() < 2)
|
|
|
+ return;
|
|
|
+ if (pipes[0].id.empty() && !pipes[1].id.empty()) {
|
|
|
+ std::reverse(pipes.begin(), pipes.end());
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ static void countPipesByPart2Pipe(vector<Pipe>& pipes, vector<PipeConnect>& pipeCons)
|
|
|
+ {
|
|
|
+ if (pipes.size() < 2)
|
|
|
+ return;
|
|
|
+
|
|
|
+ AdjustPipesSequence(pipes);
|
|
|
+
|
|
|
+ gp_Pnt p1 = pipes[0].startP;
|
|
|
+ gp_Pnt p2 = pipes[0].endP;
|
|
|
+ gp_Pnt p3 = pipes[1].startP;
|
|
|
+ gp_Pnt p4 = pipes[1].endP;
|
|
|
+ double lenLine1 = p1.Distance(p2);
|
|
|
+ double lenLine2 = p3.Distance(p4);
|
|
|
+
|
|
|
+ gp_Pnt intersectionPoint;
|
|
|
+ bool isPipesCollinear = IsPipesCollinear(pipes);
|
|
|
+ if (isPipesCollinear) // 共线
|
|
|
+ {
|
|
|
+ gp_Pnt pipe1nearPt = p1.Distance(p3) < p2.Distance(p3) ? p1 : p2;
|
|
|
+ gp_Pnt pipe2nearPt = p3.Distance(pipe1nearPt) < p4.Distance(p3) ? p3 : p4;
|
|
|
+ intersectionPoint = gp_Pnt((pipe1nearPt.X() + pipe2nearPt.X()) * 0.5,
|
|
|
+ (pipe1nearPt.Y() + pipe2nearPt.Y()) * 0.5,
|
|
|
+ (pipe1nearPt.Z() + pipe2nearPt.Z()) * 0.5);
|
|
|
+ }
|
|
|
+ computeInterPt(intersectionPoint, pipes);
|
|
|
+ double dis_p1_int = p1.Distance(intersectionPoint);
|
|
|
+ double dis_p2_int = p2.Distance(intersectionPoint);
|
|
|
+ double dis_p3_int = p3.Distance(intersectionPoint);
|
|
|
+ double dis_p4_int = p4.Distance(intersectionPoint);
|
|
|
+ bool intPonLine1 = dis_p1_int + dis_p2_int - lenLine1 <= 1e-6 ? true : false;
|
|
|
+ bool intPonLine2 = dis_p3_int + dis_p4_int - lenLine2 <= 1e-6 ? true : false;
|
|
|
+
|
|
|
+ auto computeNewPt = [intersectionPoint](gp_Vec vec, double len) {
|
|
|
+ vec.Normalize();
|
|
|
+ vec.Multiply(len);
|
|
|
+ gp_Pnt line1newPt = intersectionPoint.Translated(vec);
|
|
|
+ return line1newPt;
|
|
|
+ };
|
|
|
+
|
|
|
+ if (isPipesCollinear) // 共线
|
|
|
+ {
|
|
|
+ if (pipes[0].nd == pipes[1].nd)
|
|
|
+ {
|
|
|
+ if (dis_p1_int < dis_p2_int) {
|
|
|
+ pipes[0].startP = dis_p3_int > dis_p4_int ? p3 : p4;
|
|
|
+ pipes[0].startConnectId = dis_p3_int > dis_p4_int ? pipes[1].startConnectId : pipes[1].endConnectId;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[0].endP = dis_p3_int > dis_p4_int ? p3 : p4;
|
|
|
+ pipes[0].endConnectId = dis_p3_int > dis_p4_int ? pipes[1].startConnectId : pipes[1].endConnectId;
|
|
|
+ }
|
|
|
+ pipes.erase(pipes.begin() + 1);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ bool isexist = true;
|
|
|
+ PipeConnect newChange1 = getPipeConnect5(isexist, pipes[0].nd, pipes[1].nd);
|
|
|
+ if (!isexist)
|
|
|
+ {
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ gp_Pnt pipe1farPt = p1.Distance(p3) > p2.Distance(p3) ? p1 : p2;
|
|
|
+ gp_Pnt pipe2farPt = p3.Distance(pipe1farPt) > p4.Distance(p3) ? p3 : p4;
|
|
|
+ gp_Vec vec1 = gp_Vec(pipe2farPt.XYZ() - pipe1farPt.XYZ());
|
|
|
+ gp_Pnt changeStartPt = computeNewPt(vec1, -(newChange1.lengthC * 0.5));
|
|
|
+ gp_Pnt changeEndPt = computeNewPt(vec1, (newChange1.lengthC * 0.5));
|
|
|
+ if (pipes[0].radius > pipes[0].radius) {
|
|
|
+ newChange1.points.insert(newChange1.points.end(), { changeStartPt, changeEndPt });
|
|
|
+ }
|
|
|
+ else
|
|
|
+ {
|
|
|
+ newChange1.points.insert(newChange1.points.end(), { changeEndPt, changeStartPt });
|
|
|
+ }
|
|
|
+ pipeCons.push_back(newChange1);
|
|
|
+
|
|
|
+ if (dis_p1_int < dis_p2_int) {
|
|
|
+ pipes[0].startP = changeStartPt;
|
|
|
+ pipes[0].startConnectId = newChange1.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[0].endP = changeStartPt;
|
|
|
+ pipes[0].endConnectId = newChange1.id;
|
|
|
+ }
|
|
|
+ if (dis_p3_int < dis_p4_int) {
|
|
|
+ pipes[1].startP = changeEndPt;
|
|
|
+ pipes[1].startConnectId = newChange1.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[1].endP = changeEndPt;
|
|
|
+ pipes[1].endConnectId = newChange1.id;
|
|
|
+ }
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ // 查表
|
|
|
+ bool isneedChange1 = true;
|
|
|
+ bool isneedChange2 = true;
|
|
|
+ PipeConnect Con4 = getPipeConnect4(isneedChange1, isneedChange2, pipes[0].nd, pipes[1].nd);
|
|
|
+
|
|
|
+ bool isOver = false;
|
|
|
+ // 截断后为新增管道
|
|
|
+ auto insertPipe = [&pipes](Pipe& pipe, gp_Pnt newPipeStartPt, gp_Pnt pipeNewEndPt, std::string connectId) {
|
|
|
+ Pipe newPipe1(newPipeStartPt, pipe.endP, pipe.radius);
|
|
|
+ newPipe1.startConnectId = connectId;
|
|
|
+ pipes.push_back(newPipe1);
|
|
|
+ // pipe.endP = pipeNewEndPt;
|
|
|
+ // pipe.endConnectId = connectId;
|
|
|
+ };
|
|
|
+ // ChangePipe起点是接头、终点是管道
|
|
|
+ auto insert2ChangePipe1Pipe =
|
|
|
+ [&](Pipe& pipe, gp_Pnt pt1, gp_Pnt pt2, gp_Vec vec1, gp_Vec vec2, std::string strConDiameter, double lenCM) {
|
|
|
+ bool isexist = false;
|
|
|
+ PipeConnect newChange1 = getPipeConnect5(isexist, strConDiameter, pipe.nd);
|
|
|
+ if (!isexist) {
|
|
|
+ std::cout << "The PipeChange is not existed " << std::endl;
|
|
|
+ isOver = true;
|
|
|
+ }
|
|
|
+ gp_Pnt changeEndPt1 = computeNewPt(vec1, lenCM + newChange1.lengthC);
|
|
|
+ newChange1.points.insert(newChange1.points.end(), { pt1, changeEndPt1 });
|
|
|
+ pipeCons.push_back(newChange1);
|
|
|
+
|
|
|
+ PipeConnect newChange2 = getPipeConnect5(isexist, strConDiameter, pipe.nd);
|
|
|
+ if (!isexist) {
|
|
|
+ std::cout << "The PipeChange is not existed " << std::endl;
|
|
|
+ isOver = true;
|
|
|
+ }
|
|
|
+ gp_Pnt changeEndPt2 = computeNewPt(vec2, lenCM + newChange2.lengthC);
|
|
|
+ newChange2.points.insert(newChange2.points.end(), { pt2, changeEndPt2 });
|
|
|
+ pipeCons.push_back(newChange2);
|
|
|
+
|
|
|
+ Pipe newPipe1(changeEndPt2, pipe.endP, pipe.radius);
|
|
|
+ newPipe1.startConnectId = newChange2.id;
|
|
|
+ pipes.push_back(newPipe1);
|
|
|
+
|
|
|
+ return std::pair<gp_Pnt, std::string>(changeEndPt1, newChange1.id);
|
|
|
+ };
|
|
|
+
|
|
|
+ auto insertOneChangePipe
|
|
|
+ = [&](Pipe& pipe, gp_Pnt conPt, gp_Vec vecInterPt2Pt, std::string strConDiameter, double lenCM) {
|
|
|
+ bool isexist = false;
|
|
|
+ PipeConnect newChange1 = getPipeConnect5(isexist, strConDiameter, pipe.nd);
|
|
|
+ if (!isexist) {
|
|
|
+ std::cout << "The PipeChange is not existed " << std::endl;
|
|
|
+ isOver = true;
|
|
|
+ }
|
|
|
+ gp_Pnt changeEndPt1 = computeNewPt(vecInterPt2Pt, lenCM + newChange1.lengthC);
|
|
|
+ newChange1.points.insert(newChange1.points.end(), { conPt, changeEndPt1 });
|
|
|
+ pipeCons.push_back(newChange1);
|
|
|
+ };
|
|
|
+ // 先检查是否能形成四通、不行再看能否形成三通、最后二通(弯头)
|
|
|
+ if (intPonLine1 && intPonLine2 && !Con4.nd.empty() && dis_p1_int >= Con4.lengthC && dis_p2_int >= Con4.lengthC
|
|
|
+ && dis_p3_int >= Con4.lengthM && dis_p4_int >= Con4.lengthM) // 四通
|
|
|
+ {
|
|
|
+ gp_Vec vec1 = gp_Vec(p1.XYZ() - intersectionPoint.XYZ());
|
|
|
+ gp_Pnt conPt1 = computeNewPt(vec1, Con4.lengthC);
|
|
|
+ gp_Vec vec2 = gp_Vec(p2.XYZ() - intersectionPoint.XYZ());
|
|
|
+ gp_Pnt conPt2 = computeNewPt(vec2, Con4.lengthC);
|
|
|
+ gp_Vec vec3 = gp_Vec(p3.XYZ() - intersectionPoint.XYZ());
|
|
|
+ gp_Pnt conPt3 = computeNewPt(vec3, Con4.lengthM);
|
|
|
+ gp_Vec vec4 = gp_Vec(p4.XYZ() - intersectionPoint.XYZ());
|
|
|
+ gp_Pnt conPt4 = computeNewPt(vec4, Con4.lengthM);
|
|
|
+ Con4.points.insert(Con4.points.end(), { conPt1, conPt2, conPt3, conPt4 });
|
|
|
+ Con4.center = intersectionPoint;
|
|
|
+ pipeCons.push_back(Con4);
|
|
|
+
|
|
|
+ if (!isneedChange1) {
|
|
|
+ // 现有条件不足以证明应该把Con4.id给startConnectId还是endConnectId
|
|
|
+ // 新增管道
|
|
|
+ insertPipe(pipes[0], conPt2, conPt1, Con4.id);
|
|
|
+ pipes[0].endP = conPt1;
|
|
|
+ pipes[0].endConnectId = Con4.id;
|
|
|
+
|
|
|
+ if (!isneedChange2) {
|
|
|
+ insertPipe(pipes[1], conPt4, conPt3, Con4.id);
|
|
|
+ pipes[1].endP = conPt3;
|
|
|
+ pipes[1].endConnectId = Con4.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ // 2需要接变径管
|
|
|
+ std::pair<gp_Pnt, std::string> pair = insert2ChangePipe1Pipe(
|
|
|
+ pipes[1], conPt3, conPt4, vec3, vec4, getNominalDiameter2(Con4), Con4.lengthM);
|
|
|
+ if (isOver)
|
|
|
+ {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ pipes[1].endP = pair.first;
|
|
|
+ pipes[1].endConnectId = pair.second;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ std::pair<gp_Pnt, std::string> pair = insert2ChangePipe1Pipe(
|
|
|
+ pipes[0], conPt1, conPt2, vec1, vec2, getNominalDiameter1(Con4), Con4.lengthC);
|
|
|
+ if (isOver) {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ pipes[0].endP = pair.first;
|
|
|
+ pipes[0].endConnectId = pair.second;
|
|
|
+
|
|
|
+ if (!isneedChange2) {
|
|
|
+ insertPipe(pipes[1], conPt4, conPt3, Con4.id);
|
|
|
+ pipes[1].endP = conPt3;
|
|
|
+ pipes[1].endConnectId = Con4.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ std::pair<gp_Pnt, std::string> pair = insert2ChangePipe1Pipe(
|
|
|
+ pipes[1], conPt3, conPt4, vec3, vec4, getNominalDiameter2(Con4), Con4.lengthM);
|
|
|
+ if (isOver) {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ pipes[1].endP = pair.first;
|
|
|
+ pipes[1].endConnectId = pair.second;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ // 三通和四通规格一样
|
|
|
+ else if ((intPonLine1 && dis_p1_int >= Con4.lengthC && dis_p2_int >= Con4.lengthC)
|
|
|
+ || (intPonLine2 && dis_p3_int >= Con4.lengthM && dis_p4_int >= Con4.lengthM)) // 三通
|
|
|
+ {
|
|
|
+ bool isneedChange1 = true;
|
|
|
+ bool isneedChange2 = true;
|
|
|
+ if (intPonLine1 && dis_p1_int >= Con4.lengthC && dis_p2_int >= Con4.lengthC) {
|
|
|
+ PipeConnect Con3 = getPipeConnect3(isneedChange1, isneedChange2, pipes[0].nd, pipes[1].nd);
|
|
|
+ gp_Vec vec1 = gp_Vec(p1.XYZ() - intersectionPoint.XYZ());
|
|
|
+ gp_Pnt conPt1 = computeNewPt(vec1, Con3.lengthC);
|
|
|
+ gp_Vec vec2 = gp_Vec(p2.XYZ() - intersectionPoint.XYZ());
|
|
|
+ gp_Pnt conPt2 = computeNewPt(vec2, Con3.lengthC);
|
|
|
+ gp_Vec vecLine2;
|
|
|
+ if (dis_p3_int < dis_p4_int) {
|
|
|
+ vecLine2 = gp_Vec(p4.XYZ() - intersectionPoint.XYZ());
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ vecLine2 = gp_Vec(p3.XYZ() - intersectionPoint.XYZ());
|
|
|
+ }
|
|
|
+ gp_Pnt conLine2Pt = computeNewPt(vecLine2, Con3.lengthM);
|
|
|
+ Con3.points.insert(Con3.points.end(), { conPt1, conPt2, conLine2Pt });
|
|
|
+ Con3.center = intersectionPoint;
|
|
|
+ pipeCons.push_back(Con3);
|
|
|
+
|
|
|
+ if (!isneedChange1) {
|
|
|
+ insertPipe(pipes[0], conPt2, conPt1, Con3.id);
|
|
|
+ pipes[0].endP = conPt1;
|
|
|
+ pipes[0].endConnectId = Con3.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ std::pair<gp_Pnt, std::string> pair = insert2ChangePipe1Pipe(
|
|
|
+ pipes[0], conPt1, conPt2, vec1, vec2, getNominalDiameter1(Con3), Con3.lengthC);
|
|
|
+ if (isOver) {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ pipes[0].endP = pair.first;
|
|
|
+ pipes[0].endConnectId = pair.second;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!isneedChange2) {
|
|
|
+ if (dis_p3_int < dis_p4_int) {
|
|
|
+ pipes[1].startP = conLine2Pt;
|
|
|
+ pipes[1].startConnectId = Con3.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[1].endP = conLine2Pt;
|
|
|
+ pipes[1].endConnectId = Con3.id;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ insertOneChangePipe(pipes[1], conLine2Pt, vecLine2, getNominalDiameter2(Con3), Con3.lengthM);
|
|
|
+ if (isOver) {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (dis_p3_int < dis_p4_int) {
|
|
|
+ pipes[1].startP = conLine2Pt;
|
|
|
+ pipes[1].startConnectId = Con3.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[1].endP = conLine2Pt;
|
|
|
+ pipes[1].endConnectId = Con3.id;
|
|
|
+ }
|
|
|
+
|
|
|
+ std::pair<gp_Pnt, std::string> pair = insert2ChangePipe1Pipe(
|
|
|
+ pipes[0], conPt1, conPt2, vec1, vec2, getNominalDiameter1(Con3), Con3.lengthC);
|
|
|
+ if (isOver) {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ pipes[0].endP = pair.first;
|
|
|
+ pipes[0].endConnectId = pair.second;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else // Line2被贯穿
|
|
|
+ {
|
|
|
+ PipeConnect Con3 = getPipeConnect3(isneedChange2, isneedChange1, pipes[1].nd, pipes[0].nd);
|
|
|
+ gp_Vec vecLine1; // 此时向量应用远端的
|
|
|
+ if (dis_p1_int < dis_p2_int) {
|
|
|
+ vecLine1 = gp_Vec(p2.XYZ() - intersectionPoint.XYZ());
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ vecLine1 = gp_Vec(p1.XYZ() - intersectionPoint.XYZ());
|
|
|
+ }
|
|
|
+ gp_Pnt conLine1Pt = computeNewPt(vecLine1, Con3.lengthC);
|
|
|
+ gp_Vec vec3 = gp_Vec(p3.XYZ() - intersectionPoint.XYZ());
|
|
|
+ gp_Pnt conPt3 = computeNewPt(vec3, Con3.lengthM);
|
|
|
+ gp_Vec vec4 = gp_Vec(p4.XYZ() - intersectionPoint.XYZ());
|
|
|
+ gp_Pnt conPt4 = computeNewPt(vec4, Con3.lengthM);
|
|
|
+ if (!isneedChange2) {
|
|
|
+ insertPipe(pipes[1], conPt4, conPt3, Con3.id);
|
|
|
+ pipes[1].endP = conPt3;
|
|
|
+ pipes[1].endConnectId = Con3.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ std::pair<gp_Pnt, std::string> pair = insert2ChangePipe1Pipe(
|
|
|
+ pipes[1], conPt3, conPt4, vec3, vec4, getNominalDiameter1(Con3), Con3.lengthC);
|
|
|
+ if (isOver) {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ pipes[1].endP = pair.first;
|
|
|
+ pipes[1].endConnectId = pair.second;
|
|
|
+ }
|
|
|
+ Con3.points.insert(Con3.points.end(), { conPt3, conPt4, conLine1Pt });
|
|
|
+ Con3.center = intersectionPoint;
|
|
|
+ pipeCons.push_back(Con3);
|
|
|
+
|
|
|
+ if (!isneedChange1) {
|
|
|
+ if (dis_p1_int < dis_p2_int) {
|
|
|
+ pipes[0].startP = conLine1Pt;
|
|
|
+ pipes[0].startConnectId = Con3.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[0].endP = conLine1Pt;
|
|
|
+ pipes[0].endConnectId = Con3.id;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ insertOneChangePipe(pipes[0], conLine1Pt, vecLine1, getNominalDiameter1(Con3), Con3.lengthM);
|
|
|
+ if (isOver) {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (dis_p1_int < dis_p2_int) {
|
|
|
+ pipes[0].startP = conLine1Pt;
|
|
|
+ pipes[0].startConnectId = Con3.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[0].endP = conLine1Pt;
|
|
|
+ pipes[0].endConnectId = Con3.id;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else // 二通接头
|
|
|
+ {
|
|
|
+ bool isneedChange1 = true;
|
|
|
+ bool isneedChange2 = true;
|
|
|
+ PipeConnect Con2 = getPipeConnect2(isneedChange1, isneedChange2, pipes[0].nd, pipes[1].nd);
|
|
|
+ gp_Vec vec1; // 此时向量应用远端的
|
|
|
+ if (dis_p1_int < dis_p2_int) {
|
|
|
+ vec1 = gp_Vec(p2.XYZ() - intersectionPoint.XYZ());
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ vec1 = gp_Vec(p1.XYZ() - intersectionPoint.XYZ());
|
|
|
+ }
|
|
|
+ gp_Pnt con2StartPt = computeNewPt(vec1, Con2.lengthC);
|
|
|
+ gp_Vec vec2;
|
|
|
+ if (dis_p3_int < dis_p4_int) {
|
|
|
+ vec2 = gp_Vec(p4.XYZ() - intersectionPoint.XYZ());
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ vec2 = gp_Vec(p3.XYZ() - intersectionPoint.XYZ());
|
|
|
+ }
|
|
|
+ gp_Pnt con2EndPt = computeNewPt(vec2, Con2.lengthC);
|
|
|
+ Con2.points.push_back(con2StartPt);
|
|
|
+ Con2.points.push_back(con2EndPt);
|
|
|
+ Con2.center = intersectionPoint;
|
|
|
+ pipeCons.push_back(Con2);
|
|
|
+
|
|
|
+ if (!isneedChange1) {
|
|
|
+ if (dis_p1_int < dis_p2_int) {
|
|
|
+ pipes.front().startP = con2StartPt;
|
|
|
+ pipes.front().startConnectId = Con2.id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes.front().endP = con2StartPt;
|
|
|
+ pipes.front().endConnectId = Con2.id;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!isneedChange2) {
|
|
|
+ if (dis_p3_int < dis_p4_int) {
|
|
|
+ pipes[1].startP = con2EndPt;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[1].endP = con2EndPt;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ insertOneChangePipe(pipes[1], con2EndPt, vec2, getNominalDiameter1(Con2), Con2.lengthC);
|
|
|
+ if (isOver) {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (dis_p3_int < dis_p4_int) {
|
|
|
+ pipes[1].startP = pipeCons.back().points.back();
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[1].endP = pipeCons.back().points.back();
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ // 1需要接变径管
|
|
|
+ insertOneChangePipe(pipes[0], con2StartPt, vec1, getNominalDiameter1(Con2), Con2.lengthC);
|
|
|
+ if (isOver) {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (dis_p1_int < dis_p2_int) {
|
|
|
+ pipes.front().startP = pipeCons.back().points.back();
|
|
|
+ pipes.front().startConnectId = pipeCons.back().id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes.front().endP = pipeCons.back().points.back();
|
|
|
+ pipes.front().endConnectId = pipeCons.back().id;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (!isneedChange2) {
|
|
|
+ if (dis_p3_int < dis_p4_int) {
|
|
|
+ pipes[1].startP = con2EndPt;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[1].endP = con2EndPt;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ // 2也需要接变径管
|
|
|
+ insertOneChangePipe(pipes[1], con2StartPt, vec1, getNominalDiameter1(Con2), Con2.lengthC);
|
|
|
+ if (isOver) {
|
|
|
+ pipeCons.clear();
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ if (dis_p3_int < dis_p4_int) {
|
|
|
+ pipes[1].startP = pipeCons.back().points.back();
|
|
|
+ pipes[1].startConnectId = pipeCons.back().id;
|
|
|
+ }
|
|
|
+ else {
|
|
|
+ pipes[1].endP = pipeCons.back().points.back();
|
|
|
+ pipes[1].endConnectId = pipeCons.back().id;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ static PipeResult countPipesByPart(vector<Pipe>& pipes, vector<PipeConnect>& pipeCons)
|
|
|
+ {
|
|
|
+ int num = (int)pipes.size();
|
|
|
+ if (num < 2)
|
|
|
+ return PipeResult{ pipes ,pipeCons ,false,"" };
|
|
|
+
|
|
|
+ switch (num) {
|
|
|
+ case 2: {
|
|
|
+ countPipesByPart2Pipe(pipes, pipeCons);
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ default:
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ return PipeResult{ pipes ,pipeCons ,true,"" };
|
|
|
+ }
|
|
|
+};
|
|
|
+
|