//======================================================================= //function : PreciseBoundingBox //purpose : //======================================================================= Standard_Boolean GEOMUtils::PreciseBoundingBox (const TopoDS_Shape &theShape, Bnd_Box &theBox) { if ( theBox.IsVoid() ) BRepBndLib::Add( theShape, theBox ); if ( theBox.IsVoid() ) return Standard_False; Standard_Real aBound[6]; theBox.Get(aBound[0], aBound[2], aBound[4], aBound[1], aBound[3], aBound[5]); Standard_Integer i; const gp_Pnt aMid(0.5*(aBound[1] + aBound[0]), // XMid 0.5*(aBound[3] + aBound[2]), // YMid 0.5*(aBound[5] + aBound[4])); // ZMid const gp_XYZ aSize(aBound[1] - aBound[0], // DX aBound[3] - aBound[2], // DY aBound[5] - aBound[4]); // DZ const gp_Pnt aPnt[6] = { gp_Pnt(aBound[0] - (aBound[1] - aBound[0]), aMid.Y(), aMid.Z()), // XMin gp_Pnt(aBound[1] + (aBound[1] - aBound[0]), aMid.Y(), aMid.Z()), // XMax gp_Pnt(aMid.X(), aBound[2] - (aBound[3] - aBound[2]), aMid.Z()), // YMin gp_Pnt(aMid.X(), aBound[3] + (aBound[3] - aBound[2]), aMid.Z()), // YMax gp_Pnt(aMid.X(), aMid.Y(), aBound[4] - (aBound[5] - aBound[4])), // ZMin gp_Pnt(aMid.X(), aMid.Y(), aBound[5] + (aBound[5] - aBound[4])) // ZMax }; const gp_Dir aDir[3] = { gp::DX(), gp::DY(), gp::DZ() }; const Standard_Real aPlnSize[3] = { 0.5*Max(aSize.Y(), aSize.Z()), // XMin, XMax planes 0.5*Max(aSize.X(), aSize.Z()), // YMin, YMax planes 0.5*Max(aSize.X(), aSize.Y()) // ZMin, ZMax planes }; gp_Pnt aPMin[2]; for (i = 0; i < 6; i++) { const Standard_Integer iHalf = i/2; const gp_Pln aPln(aPnt[i], aDir[iHalf]); BRepBuilderAPI_MakeFace aMkFace(aPln, -aPlnSize[iHalf], aPlnSize[iHalf], -aPlnSize[iHalf], aPlnSize[iHalf]); if (!aMkFace.IsDone()) { return Standard_False; } TopoDS_Shape aFace = aMkFace.Shape(); // Get minimal distance between planar face and shape. Standard_Real aMinDist = GEOMUtils::GetMinDistance(aFace, theShape, aPMin[0], aPMin[1]); if (aMinDist < 0.) { return Standard_False; } aBound[i] = aPMin[1].Coord(iHalf + 1); } // Update Bounding box with the new values. theBox.SetVoid(); theBox.Update(aBound[0], aBound[2], aBound[4], aBound[1], aBound[3], aBound[5]); return Standard_True; }
bool RoomLayoutPillarController::PreRender3D() { auto& imp_ = *ImpUPtr_; plane3df plan(0,0,0,0,1,0); auto line = GetRenderContextSPtr()->Smgr_->getSceneCollisionManager()->getRayFromScreenCoordinates(imp_.CursorIPos_); plan.getIntersectionWithLine(line.start, line.getVector(), imp_.CurrentPos_); imp_.CurrentPos_.Y = 0; gp_Pnt cursorPnt(imp_.CurrentPos_.X, imp_.CurrentPos_.Y, imp_.CurrentPos_.Z); switch (imp_.State_) { case EPilarState::EPS_SWEEPING: { if ( GetPickingODL().expired() ) { break; } auto activePilar = std::static_pointer_cast<PillarODL>(GetPickingODL().lock()); activePilar->SetSweeping(true); if ( imp_.CtrllHolding_ ) { imp_.State_ = EPilarState::EPS_MODIFY_INIT; break; } if ( imp_.LMousePressDown_ ) { auto box = activePilar->GetBaseBndBox(); auto pos = activePilar->GetTranslation(); Standard_Real xMin,xMax,yMin,yMax,zMin,zMax; box.Get(xMin, yMin, zMin, xMax, yMax, zMax); imp_.EventInfo_ = SEventPillarInfo(); imp_.EventInfo_->XLength_ = static_cast<float>(xMax-xMin); imp_.EventInfo_->YLength_ = static_cast<float>(yMax-yMin); imp_.EventInfo_->ZLength_ = static_cast<float>(zMax-zMin); imp_.EventInfo_->OffsetHeight_ = activePilar->GetOffsetHeight(); imp_.SavePos_ = imp_.CurrentPos_; imp_.State_ = EPilarState::EPS_MOUSEHOLDING; } } break; case EPilarState::EPS_MODIFY_INIT: { auto activePilar = std::static_pointer_cast<PillarODL>(GetPickingODL().lock()); activePilar->SetSweeping(true); if ( !imp_.CtrllHolding_ ) { GetRenderContextSPtr()->CursorControl_->setActiveIcon(gui::ECI_NORMAL); imp_.State_ = EPilarState::EPS_SWEEPING; imp_.CtrllHolding_ = false; break; } auto box = activePilar->GetBaseBndBox(); Standard_Real xMin,xMax,yMin,yMax,zMin,zMax; box.Get(xMin, yMin, zMin, xMax, yMax, zMax); auto modifyAlign = 100; Bnd_Box smallBox,bigBox; smallBox.Update(xMin+modifyAlign < 0 ? xMin+modifyAlign : 0, yMin+modifyAlign < 0 ? yMin+modifyAlign : 0, zMin+modifyAlign < 0 ? zMin+modifyAlign : 0, xMax-modifyAlign > 0 ? xMax-modifyAlign : 0, yMax-modifyAlign > 0 ? yMax-modifyAlign : 0, zMax-modifyAlign > 0 ? zMax-modifyAlign : 0); bigBox.Update(xMin-modifyAlign, yMin-modifyAlign, zMin-modifyAlign, xMax+modifyAlign, yMax+modifyAlign, zMax+modifyAlign); auto relationCursorPnt = cursorPnt.Transformed(activePilar->GetAbsoluteTransform().Inverted()); relationCursorPnt.SetY(0); if ( Standard_True == bigBox.IsOut(relationCursorPnt) ) { GetRenderContextSPtr()->CursorControl_->setActiveIcon(gui::ECI_NORMAL); imp_.State_ = EPilarState::EPS_SWEEPING; imp_.CtrllHolding_ = false; break; } if ( Standard_False == smallBox.IsOut(relationCursorPnt) ) { GetRenderContextSPtr()->CursorControl_->setActiveIcon(gui::ECI_NORMAL); break; } gp_Dir cursorDir = gp_Vec(gp::Origin(), relationCursorPnt); { auto rad = gp::DX().AngleWithRef(cursorDir, gp::DY()); rad = rad < 0 ? M_PI * 2 + rad : rad; auto mod = std::fmod(rad, M_PI_2); if ( mod < M_PI_4 ) { rad -= mod; } else { rad = rad - mod + M_PI_2; } cursorDir = gp::DX().Rotated(gp::OY(), rad); mod = std::fmod(rad, M_PI); if ( mod < Precision::Angular() ) { GetRenderContextSPtr()->CursorControl_->setActiveIcon(gui::ECI_SIZEWE); } else { GetRenderContextSPtr()->CursorControl_->setActiveIcon(gui::ECI_SIZENS); } } if ( imp_.LMousePressDown_ ) { auto edge = BRepBuilderAPI_MakeEdge(gp_Lin(gp::Origin().Transformed(activePilar->GetAbsoluteTransform()), cursorDir.Transformed(activePilar->GetAbsoluteTransform()))).Edge(); BRepAdaptor_Curve moveBC(edge); GeomAPI_ProjectPointOnCurve ppc(relationCursorPnt.Transformed(activePilar->GetAbsoluteTransform()), moveBC.Curve().Curve()); imp_.ModifyEdge_ = moveBC; imp_.ModifyPar_ = ppc.LowerDistanceParameter(); imp_.State_ = EPilarState::EPS_MODIFY; break; } } break; case EPilarState::EPS_MODIFY: { auto activePilar = std::static_pointer_cast<PillarODL>(GetPickingODL().lock()); activePilar->SetPicking(true); if ( imp_.LMouseLeftUp_ ) { activePilar->UpdateMesh(); imp_.State_ = EPilarState::EPS_SWEEPING; break; } GeomAPI_ProjectPointOnCurve ppcCur(cursorPnt, imp_.ModifyEdge_.Curve().Curve()); auto curPar = ppcCur.LowerDistanceParameter(); if ( std::abs(curPar - imp_.ModifyPar_) < Precision::Confusion() ) { break; } //偏移的起始点、终点(绝对) gp_Pnt fromPnt,toPnt; imp_.ModifyEdge_.D0(imp_.ModifyPar_, fromPnt); imp_.ModifyEdge_.D0(curPar, toPnt); gp_Vec moveOffset(fromPnt, toPnt); auto relationMoveOffset = moveOffset.Transformed(activePilar->GetAbsoluteTransform().Inverted()); auto modifyDir = imp_.ModifyEdge_.Line().Direction().Transformed(activePilar->GetAbsoluteTransform().Inverted()); auto modifyOffset = relationMoveOffset; { modifyOffset.SetX(modifyOffset.X() * modifyDir.X()); modifyOffset.SetY(modifyOffset.Y() * modifyDir.Y()); modifyOffset.SetZ(modifyOffset.Z() * modifyDir.Z()); } auto curPillarSize = activePilar->GetSize(); if ( Standard_False == imp_.ModifyEdge_.Line().Direction().IsEqual(gp_Dir(moveOffset), Precision::Angular()) ) {//防止大小缩成0 auto testSize = curPillarSize + modifyOffset.XYZ(); auto minSize = 100; auto alignSize = testSize - gp_XYZ(minSize,minSize,minSize); if ( alignSize.X() < Precision::Confusion() || alignSize.Y() < Precision::Confusion() || alignSize.Z() < Precision::Confusion() ) { break; } } Bnd_Box pillarBox; auto pillarBoxSize = curPillarSize + modifyOffset.XYZ(); gp_Trsf pillarTranslation,pillarRotation,pillarTransformation; { pillarBox.Update(-pillarBoxSize.X()/2, -pillarBoxSize.Y()/2, -pillarBoxSize.Z()/2, pillarBoxSize.X()/2, pillarBoxSize.Y()/2, pillarBoxSize.Z()/2); auto translation = activePilar->GetTranslation() + relationMoveOffset.XYZ()/2; pillarTranslation.SetTranslationPart(translation); pillarRotation.SetRotation(activePilar->GetRotation()); } pillarTransformation = pillarTranslation * pillarRotation; auto offsetHeight = activePilar->GetOffsetHeight(); //新的位置 gp_Pnt newPnt = gp::Origin().Transformed(pillarTransformation); //吸附距离 static auto alignDis = 200.0; //当前的吸附物体 auto alignODLs = activePilar->GetAlignList(); alignODLs.erase(std::remove_if(alignODLs.begin(), alignODLs.end(), [&pillarBox,&pillarTransformation](const BaseODLSPtr& alignODL) { if ( !alignODL ) { return true; } return alignODL->GetBaseBndBox().Distance(pillarBox.Transformed(alignODL->GetAbsoluteTransform().Inverted() * pillarTransformation)) > alignDis; }), alignODLs.end()); activePilar->SetAlignList(BaseODLList()); std::multimap<double,BaseODLSPtr> disMap; for ( auto& curODL : RootODL_.lock()->GetChildrenList() ) { if ( EODLT_PILLAR != curODL->GetType() && EODLT_WALL != curODL->GetType() ) { continue; } if ( std::find(alignODLs.begin(), alignODLs.end(), curODL) != alignODLs.end() ) { continue; } if ( EODLT_PILLAR == curODL->GetType() && curODL == activePilar ) { continue; } auto dis = curODL->GetBaseBndBox().Distance(pillarBox.Transformed(curODL->GetAbsoluteTransform().Inverted() * pillarTransformation)); if ( dis > alignDis ) { continue; } disMap.emplace(dis, curODL); } for ( auto& curODL : disMap ) { alignODLs.push_back(curODL.second); } for ( auto& curODL : alignODLs ) { auto alignTransformation = curODL->GetAbsoluteTransform(); //调整柱box的旋转 auto activeRotationPillarBox = pillarBox; { gp_Trsf tfsODL; tfsODL.SetRotation(alignTransformation.GetRotation()); activeRotationPillarBox = activeRotationPillarBox.Transformed(tfsODL.Inverted() * pillarRotation); } Bnd_Box movingBox,alignODLBox; { auto curBox = curODL->GetBaseBndBox(); Standard_Real xAlignMin,yAlignMin,zAlignMin,xAlignMax,yAlignMax,zAlignMax; curBox.Get(xAlignMin, yAlignMin, zAlignMin, xAlignMax, yAlignMax, zAlignMax); Standard_Real xPillarMin,yPillarMin,zPillarMin,xPillarMax,yPillarMax,zPillarMax; activeRotationPillarBox.Get(xPillarMin, yPillarMin, zPillarMin, xPillarMax, yPillarMax, zPillarMax); movingBox.Update(xAlignMin+xPillarMin, yAlignMin+yPillarMin, zAlignMin+zPillarMin, xAlignMax+xPillarMax, yAlignMax+yPillarMax, zAlignMax+zPillarMax); alignODLBox.Update(xAlignMin+xPillarMin-alignDis, yAlignMin+yPillarMin-alignDis, zAlignMin+zPillarMin-alignDis, xAlignMax+xPillarMax+alignDis, yAlignMax+yPillarMax+alignDis, zAlignMax+zPillarMax+alignDis); } auto inODLPnt = newPnt.Transformed(curODL->GetAbsoluteTransform().Inverted()); if ( Standard_True == alignODLBox.IsOut(inODLPnt) ) { continue; } //当前被停靠物体的box shape Standard_Real xMin,yMin,zMin,xMax,yMax,zMax; movingBox.Get(xMin, yMin, zMin, xMax, yMax, zMax); auto alignBoxShape = BRepPrimAPI_MakeBox(gp_Pnt(xMin, yMin, zMin), gp_Pnt(xMax, yMax, zMax)).Shape(); TopExp_Explorer exp(alignBoxShape, TopAbs_SHELL); BRepExtrema_DistShapeShape dss(imp_.ModifyEdge_.Edge().Moved(curODL->GetAbsoluteTransform().Inverted()), exp.Current()); auto needContinue = false; std::map<double, gp_Pnt> tmp; for ( auto index=1; index<=dss.NbSolution(); ++index ) { if ( dss.SupportTypeShape2(index) == BRepExtrema_IsOnEdge ) { activePilar->AddAlign(curODL); needContinue = true; break; } auto pntOnEdge = dss.PointOnShape1(index); auto pntOnBox = dss.PointOnShape2(index); if ( pntOnEdge.Distance(pntOnBox) > Precision::Confusion() ) { continue; } tmp.emplace(pntOnEdge.Distance(inODLPnt), pntOnEdge); } if ( needContinue ) { continue; } auto foundPnt = tmp.begin()->second.Transformed(curODL->GetAbsoluteTransform()); if ( foundPnt.Distance(newPnt) < 1) { activePilar->AddAlign(curODL); continue; } else { newPnt = foundPnt; break; } } auto finalOffset = gp_Vec(pillarTranslation.TranslationPart(), newPnt); auto finalRelationOffset = finalOffset.Transformed(pillarTransformation.Inverted()); auto finalModifyOffset = finalRelationOffset; { finalModifyOffset.SetX(finalModifyOffset.X()*modifyDir.X()); finalModifyOffset.SetY(finalModifyOffset.Y()*modifyDir.Y()); finalModifyOffset.SetZ(finalModifyOffset.Z()*modifyDir.Z()); } auto finalSize = pillarBoxSize + finalModifyOffset.XYZ(); auto finalTranslation = pillarTranslation.TranslationPart() + finalRelationOffset.XYZ()/2; activePilar->SetSize(finalSize); activePilar->SetTranslation(finalTranslation); { vector3df newPos(static_cast<float>(finalTranslation.X()), static_cast<float>(finalTranslation.Y()), static_cast<float>(finalTranslation.Z())); activePilar->GetDataSceneNode()->setPosition(newPos); } activePilar->Update2DMesh(); imp_.ModifyPar_ = curPar; } break; case EPilarState::EPS_MOUSEHOLDING: { auto activePillar = std::static_pointer_cast<PillarODL>(GetPickingODL().lock()); activePillar->SetPicking(true); if ( imp_.SavePos_.getDistanceFromSQ(imp_.CurrentPos_) > 100 * 100 ) { imp_.State_ = EPilarState::EPS_MOVING; imp_.Valid_ = true; } else if ( imp_.LMouseLeftUp_ ) { imp_.PropertyCallBack_ = boost::none; imp_.State_ = EPilarState::EPS_PROPERTY; auto pointer = reinterpret_cast<int>(static_cast<void*>(&(*imp_.EventInfo_))); ::PostMessage((HWND)GetRenderContextSPtr()->GetHandle(), WM_IRR_DLG_MSG, WM_USER_ROOMLAYOUT_PILLAR_PROPERTY, pointer); } } break; case EPilarState::EPS_PROPERTY: { if ( !imp_.PropertyCallBack_ ) { break; } auto activePillar = std::static_pointer_cast<PillarODL>(GetPickingODL().lock()); switch (*(imp_.PropertyCallBack_)) { case EUT_ROOMLAYOUT_PILLAR_NONE: { imp_.State_ = EPilarState::EPS_SWEEPING; } break; case EUT_ROOMLAYOUT_PILLAR_UPDATE: { activePillar->SetSize(imp_.EventInfo_->XLength_, imp_.EventInfo_->YLength_, imp_.EventInfo_->ZLength_); activePillar->SetOffsetHeight(imp_.EventInfo_->OffsetHeight_); { auto curTrans = activePillar->GetTranslation(); curTrans.SetY(imp_.EventInfo_->YLength_/2 + imp_.EventInfo_->OffsetHeight_); activePillar->SetTranslation(curTrans); auto curPos = activePillar->GetDataSceneNode()->getPosition(); curPos.Y = static_cast<float>(imp_.EventInfo_->YLength_/2 + imp_.EventInfo_->OffsetHeight_); activePillar->GetDataSceneNode()->setPosition(curPos); } activePillar->UpdateMesh(); imp_.State_ = EPilarState::EPS_SWEEPING; } break; case EUT_ROOMLAYOUT_PILLAR_MOVE: { imp_.State_ = EPilarState::EPS_MOVING; } break; case EUT_ROOMLAYOUT_PILLAR_DELETE: { activePillar->RemoveFromParent(); imp_.State_ = EPilarState::EPS_SWEEPING; } break; default: assert(0); break; } } break; case EPilarState::EPS_CREATING_INIT: { assert(imp_.EventInfo_); auto newPilar = PillarODL::Create<PillarODL>(GetRenderContextSPtr()); newPilar->SetSize(imp_.EventInfo_->XLength_, imp_.EventInfo_->YLength_, imp_.EventInfo_->ZLength_); newPilar->SetOffsetHeight(imp_.EventInfo_->OffsetHeight_); newPilar->UpdateMesh(); RootODL_.lock()->AddChild(newPilar); auto newPos = imp_.CurrentPos_; newPos.Y = imp_.EventInfo_->YLength_/2; newPilar->SetTranslation(gp_XYZ(newPos.X, newPos.Y, newPos.Z)); newPilar->GetDataSceneNode()->setPosition(newPos); SetPickingODL(newPilar); imp_.State_ = EPilarState::EPS_MOVING; } break; case EPilarState::EPS_MOVING: { auto activePilar = std::static_pointer_cast<PillarODL>(GetPickingODL().lock()); activePilar->SetPicking(true); activePilar->SetVaildPosition(imp_.Valid_); if ( imp_.LMouseLeftUp_ ) { if ( imp_.Valid_ ) { ImpUPtr_->Valid_ = false; ImpUPtr_->EventInfo_ = boost::none; imp_.State_ = EPilarState::EPS_SWEEPING; break; } } if ( imp_.EscapePressDown_ ) { activePilar->RemoveFromParent(); imp_.State_ = EPilarState::EPS_SWEEPING; break; } //当前柱的Box auto activeTransitionBox = activePilar->GetBaseBndBox(); { gp_Trsf tfs; tfs.SetTranslationPart(activePilar->GetTranslation()); activeTransitionBox = activeTransitionBox.Transformed(tfs); } activePilar->SetRotation(gp_Quaternion(gp::DZ(), gp::DZ())); activePilar->GetDataSceneNode()->setRotation(vector3df(0)); auto size = activePilar->GetSize(); auto offset = activePilar->GetOffsetHeight(); //新的位置 auto newPos = imp_.CurrentPos_; newPos.Y = static_cast<float>(size.Y()/2) + offset; gp_Pnt newPnt(newPos.X, newPos.Y, newPos.Z); //吸附距离 static auto alignDis = 200.0; //当前的吸附物体 auto alignODLs = activePilar->GetAlignList(); alignODLs.erase(std::remove_if(alignODLs.begin(), alignODLs.end(), [&activePilar, &activeTransitionBox](const BaseODLSPtr& alignODL) { if ( !alignODL ) { return true; } return alignODL->GetBaseBndBox().Distance(activeTransitionBox.Transformed(alignODL->GetAbsoluteTransform().Inverted())) > alignDis; }), alignODLs.end()); activePilar->SetAlignList(BaseODLList()); std::multimap<double,BaseODLSPtr> disMap; for ( auto& curODL : RootODL_.lock()->GetChildrenList() ) { if ( EODLT_PILLAR != curODL->GetType() && EODLT_WALL != curODL->GetType() ) { continue; } if ( std::find(alignODLs.begin(), alignODLs.end(), curODL) != alignODLs.end() ) { continue; } if ( EODLT_PILLAR == curODL->GetType() && curODL == activePilar ) { continue; } auto dis = curODL->GetBaseBndBox().Distance(activeTransitionBox.Transformed(curODL->GetAbsoluteTransform().Inverted())); if ( dis > alignDis ) { continue; } disMap.emplace(dis, curODL); } for ( auto& curODL : disMap ) { alignODLs.push_back(curODL.second); } //锁定旋转 auto lockRotation = false; //锁定位置 auto lockPosition = false; //移动方向 TopoDS_Edge movingEdge; for ( auto& curODL : alignODLs ) { auto alignTransformation = curODL->GetAbsoluteTransform(); //如果锁定了旋转,则调整柱的box auto activeRotationPillarBox = activePilar->GetBaseBndBox(); if ( lockRotation ) { gp_Trsf tfsODL, tfsPillar; tfsODL.SetRotation(alignTransformation.GetRotation()); tfsPillar.SetRotation(activePilar->GetRotation()); activeRotationPillarBox = activeRotationPillarBox.Transformed(tfsODL.Inverted() * tfsPillar); } Bnd_Box movingBox; { auto curBox = curODL->GetBaseBndBox(); Standard_Real xAlignMin,yAlignMin,zAlignMin,xAlignMax,yAlignMax,zAlignMax; curBox.Get(xAlignMin, yAlignMin, zAlignMin, xAlignMax, yAlignMax, zAlignMax); Standard_Real xPillarMin,yPillarMin,zPillarMin,xPillarMax,yPillarMax,zPillarMax; activeRotationPillarBox.Get(xPillarMin, yPillarMin, zPillarMin, xPillarMax, yPillarMax, zPillarMax); movingBox.Update(xAlignMin+xPillarMin, yAlignMin+yPillarMin, zAlignMin+zPillarMin, xAlignMax+xPillarMax, yAlignMax+yPillarMax, zAlignMax+zPillarMax); } auto inODLPnt = newPnt.Transformed(curODL->GetAbsoluteTransform().Inverted()); //当位置锁定了以后,只需要判断是不是相交 if ( lockPosition ) { if ( Standard_True == movingBox.IsOut(inODLPnt) ) { continue; } Bnd_Box pntBox; pntBox.Add(inODLPnt); if ( pntBox.Distance(movingBox) < Precision::Confusion() ) { continue; } imp_.Valid_ = false; break; } Bnd_Box alignODLBox; { auto curBox = curODL->GetBaseBndBox(); Standard_Real xAlignMin,yAlignMin,zAlignMin,xAlignMax,yAlignMax,zAlignMax; curBox.Get(xAlignMin, yAlignMin, zAlignMin, xAlignMax, yAlignMax, zAlignMax); Standard_Real xPillarMin,yPillarMin,zPillarMin,xPillarMax,yPillarMax,zPillarMax; activeRotationPillarBox.Get(xPillarMin, yPillarMin, zPillarMin, xPillarMax, yPillarMax, zPillarMax); alignODLBox.Update(xAlignMin+xPillarMin-alignDis, yAlignMin+yPillarMin-alignDis, zAlignMin+zPillarMin-alignDis, xAlignMax+xPillarMax+alignDis, yAlignMax+yPillarMax+alignDis, zAlignMax+zPillarMax+alignDis); } if ( Standard_True == alignODLBox.IsOut(inODLPnt) ) { continue; } //当前被停靠物体的box shape Standard_Real xMin,yMin,zMin,xMax,yMax,zMax; movingBox.Get(xMin, yMin, zMin, xMax, yMax, zMax); auto alignBoxShape = BRepPrimAPI_MakeBox(gp_Pnt(xMin, yMin, zMin), gp_Pnt(xMax, yMax, zMax)).Shape(); TopExp_Explorer exp(alignBoxShape, TopAbs_SHELL); if ( !lockRotation ) {//找到第一个被停靠物体 BRepExtrema_DistShapeShape dss(BRepBuilderAPI_MakeVertex(inODLPnt).Shape(), exp.Current()); assert(0 != dss.NbSolution()); inODLPnt = dss.PointOnShape2(1); newPnt = inODLPnt.Transformed(curODL->GetAbsoluteTransform()).XYZ(); auto rot = curODL->GetAbsoluteTransform().GetRotation(); Standard_Real rX,rY,rZ; rot.GetEulerAngles(gp_Extrinsic_XYZ, rX, rY, rZ); vector3df rotation(static_cast<float>(irr::core::radToDeg(rX)), static_cast<float>(irr::core::radToDeg(rY)), static_cast<float>(irr::core::radToDeg(rZ))); activePilar->GetDataSceneNode()->setRotation(rotation); activePilar->SetRotation(rot); gp_Dir movingDir; if ( std::abs(std::abs(inODLPnt.X()) - xMax) < Precision::Confusion() ) { movingDir = gp::DZ(); } else { movingDir = gp::DX(); } auto curMovingEdge = BRepBuilderAPI_MakeEdge(gp_Lin(inODLPnt, movingDir)).Edge(); movingEdge = TopoDS::Edge(curMovingEdge.Moved(curODL->GetAbsoluteTransform())); activePilar->AddAlign(curODL); imp_.Valid_ = true; lockRotation = true; } else {//第二个被停靠物体 BRepExtrema_DistShapeShape dss(movingEdge.Moved(curODL->GetAbsoluteTransform().Inverted()), exp.Current()); auto foundSecond = false; std::map<double, gp_Pnt> tmp; for ( auto index=1; index<=dss.NbSolution(); ++index ) { auto pntOnEdge = dss.PointOnShape1(index); auto pntOnBox = dss.PointOnShape2(index); if ( pntOnEdge.Distance(pntOnBox) > Precision::Confusion() ) { continue; } tmp.emplace(pntOnEdge.Distance(inODLPnt), pntOnEdge); foundSecond = true; } if ( !foundSecond ) { imp_.Valid_ = false; break; } newPnt = tmp.begin()->second.Transformed(curODL->GetAbsoluteTransform()); activePilar->AddAlign(curODL); lockPosition = true; } } if ( activePilar->GetAlignList().empty() ) { imp_.Valid_ = true; } newPos.X = static_cast<float>(newPnt.X()); newPos.Y = static_cast<float>(newPnt.Y()); newPos.Z = static_cast<float>(newPnt.Z()); activePilar->GetDataSceneNode()->setPosition(newPos); activePilar->SetTranslation(newPnt.XYZ()); for ( auto& curAlign : activePilar->GetAlignList() ) { curAlign->SetSweeping(true); } } break; default: break; } imp_.LMousePressDown_ = false; imp_.LMouseLeftUp_ = false; imp_.EscapePressDown_ = false; return false; }