[TD]corrupt dim reference detect and correct
This commit is contained in:
wandererfan
262
src/Mod/TechDraw/App/GeometryMatcher.cpp
Normal file
262
src/Mod/TechDraw/App/GeometryMatcher.cpp
Normal file
@@ -0,0 +1,262 @@
|
||||
/***************************************************************************
|
||||
* Copyright (c) 2023 WandererFan <wandererfan@gmail.com> *
|
||||
* *
|
||||
* This file is part of the FreeCAD CAx development system. *
|
||||
* *
|
||||
* This library is free software; you can redistribute it and/or *
|
||||
* modify it under the terms of the GNU Library General Public *
|
||||
* License as published by the Free Software Foundation; either *
|
||||
* version 2 of the License, or (at your option) any later version. *
|
||||
* *
|
||||
* This library is distributed in the hope that it will be useful, *
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
|
||||
* GNU Library General Public License for more details. *
|
||||
* *
|
||||
* You should have received a copy of the GNU Library General Public *
|
||||
* License along with this library; see the file COPYING.LIB. If not, *
|
||||
* write to the Free Software Foundation, Inc., 59 Temple Place, *
|
||||
* Suite 330, Boston, MA 02111-1307, USA *
|
||||
* *
|
||||
***************************************************************************/
|
||||
// a class to handle changes to dimension reference geometry
|
||||
|
||||
// detects changes in reference geometry (2d & 3d) that would invalidate a dimension
|
||||
// identifies replacement view/model geometry
|
||||
|
||||
#include "PreCompiled.h"
|
||||
#ifndef _PreComp_
|
||||
#endif
|
||||
|
||||
#include <BRepAdaptor_Curve.hxx>
|
||||
#include <BRepLProp_CLProps.hxx>
|
||||
#include <BRep_Tool.hxx>
|
||||
#include <gp_Circ.hxx>
|
||||
#include <gp_Elips.hxx>
|
||||
#include <TopExp.hxx>
|
||||
#include <TopoDS_Edge.hxx>
|
||||
#include <TopoDS_Shape.hxx>
|
||||
#include <TopoDS_Vertex.hxx>
|
||||
|
||||
#include <Base/Console.h>
|
||||
#include <Base/Tools.h>
|
||||
|
||||
#include <Mod/Part/App/TopoShape.h>
|
||||
|
||||
#include "GeometryMatcher.h"
|
||||
#include "DrawUtil.h"
|
||||
|
||||
using namespace TechDraw;
|
||||
using DU = DrawUtil;
|
||||
|
||||
// a set of routines for comparing geometry for equality.
|
||||
|
||||
bool GeometryMatcher::compareGeometry(Part::TopoShape shape1, Part::TopoShape shape2)
|
||||
{
|
||||
// Base::Console().Message("GM::compareGeometry()\n");
|
||||
if (shape1.isNull() || shape2.isNull()) {
|
||||
Base::Console().Message("GM::compareGeometry - one or more shapes are null\n");
|
||||
}
|
||||
TopoDS_Shape geom1 = shape1.getShape();
|
||||
TopoDS_Shape geom2 = shape2.getShape();
|
||||
if (geom1.ShapeType() == TopAbs_VERTEX) {
|
||||
return comparePoints(geom1, geom2);
|
||||
}
|
||||
if (geom1.ShapeType() == TopAbs_EDGE) {
|
||||
return compareEdges(geom1, geom2);
|
||||
}
|
||||
return false;
|
||||
}
|
||||
|
||||
bool GeometryMatcher::comparePoints(TopoDS_Shape shape1, TopoDS_Shape shape2)
|
||||
{
|
||||
// Base::Console().Message("GM::comparePoints()\n");
|
||||
if (shape1.ShapeType() != TopAbs_VERTEX ||
|
||||
shape2.ShapeType() != TopAbs_VERTEX) {
|
||||
// can not compare these shapes
|
||||
return false;
|
||||
}
|
||||
auto vert1 = TopoDS::Vertex(shape1);
|
||||
Base::Vector3d point1 = DU::toVector3d(BRep_Tool::Pnt(vert1));
|
||||
auto vert2 = TopoDS::Vertex(shape2);
|
||||
Base::Vector3d point2 = DU::toVector3d(BRep_Tool::Pnt(vert2));
|
||||
if (point1.IsEqual(point2, EWTOLERANCE)) {
|
||||
return true;
|
||||
}
|
||||
return false;
|
||||
}
|
||||
|
||||
bool GeometryMatcher::compareEdges(TopoDS_Shape shape1, TopoDS_Shape shape2)
|
||||
{
|
||||
// Base::Console().Message("GM::compareEdges()\n");
|
||||
if (shape1.ShapeType() != TopAbs_EDGE ||
|
||||
shape2.ShapeType() != TopAbs_EDGE) {
|
||||
// can not compare these shapes
|
||||
// Base::Console().Message("GM::compareEdges - shape is not an edge\n");
|
||||
return false;
|
||||
}
|
||||
TopoDS_Edge edge1 = TopoDS::Edge(shape1);
|
||||
TopoDS_Edge edge2 = TopoDS::Edge(shape2);
|
||||
BRepAdaptor_Curve adapt1(edge1);
|
||||
BRepAdaptor_Curve adapt2(edge2);
|
||||
|
||||
if (adapt1.GetType() == GeomAbs_Line &&
|
||||
adapt2.GetType() == GeomAbs_Line) {
|
||||
return compareLines(edge1, edge2);
|
||||
}
|
||||
|
||||
if (adapt1.GetType() == GeomAbs_Circle &&
|
||||
adapt2.GetType() == GeomAbs_Circle) {
|
||||
if (adapt1.IsClosed() && adapt2.IsClosed()) {
|
||||
return compareCircles(edge1, edge2);
|
||||
} else {
|
||||
return compareCircleArcs(edge1, edge2);
|
||||
}
|
||||
}
|
||||
|
||||
if (adapt1.GetType() == GeomAbs_Ellipse &&
|
||||
adapt2.GetType() == GeomAbs_Ellipse) {
|
||||
if (adapt1.IsClosed() && adapt2.IsClosed()) {
|
||||
return compareEllipses(edge1, edge2);
|
||||
} else {
|
||||
return compareEllipseArcs(edge1, edge2);
|
||||
}
|
||||
}
|
||||
|
||||
if (adapt1.GetType() == GeomAbs_BSplineCurve &&
|
||||
adapt2.GetType() == GeomAbs_BSplineCurve) {
|
||||
return compareBSplines(edge1, edge2);
|
||||
}
|
||||
|
||||
// if we reach this point, we have dissimilar geometry types
|
||||
return compareDifferent(edge1, edge2);
|
||||
}
|
||||
|
||||
bool GeometryMatcher::compareLines(TopoDS_Edge edge1, TopoDS_Edge edge2)
|
||||
{
|
||||
// Base::Console().Message("GM::compareLines()\n");
|
||||
auto start1 = DU::toVector3d(BRep_Tool::Pnt(TopExp::FirstVertex(edge1)));
|
||||
auto end1 = DU::toVector3d(BRep_Tool::Pnt(TopExp::LastVertex(edge1)));
|
||||
auto start2 = DU::toVector3d(BRep_Tool::Pnt(TopExp::FirstVertex(edge2)));
|
||||
auto end2 = DU::toVector3d(BRep_Tool::Pnt(TopExp::LastVertex(edge2)));
|
||||
if (start1.IsEqual(start2, EWTOLERANCE) &&
|
||||
end1.IsEqual(end2, EWTOLERANCE)) {
|
||||
//exact match
|
||||
return true;
|
||||
}
|
||||
return false;
|
||||
}
|
||||
|
||||
bool GeometryMatcher::compareCircles(TopoDS_Edge edge1, TopoDS_Edge edge2)
|
||||
{
|
||||
// Base::Console().Message("GM::compareCircles()\n");
|
||||
BRepAdaptor_Curve adapt1(edge1);
|
||||
BRepAdaptor_Curve adapt2(edge2);
|
||||
gp_Circ circle1 = adapt1.Circle();
|
||||
gp_Circ circle2 = adapt2.Circle();
|
||||
double radius1 = circle1.Radius();
|
||||
double radius2 = circle2.Radius();
|
||||
auto center1 = DU::toVector3d(circle1.Location());
|
||||
auto center2 = DU::toVector3d(circle2.Location());
|
||||
if (DU::fpCompare(radius1, radius2, EWTOLERANCE) &&
|
||||
center1.IsEqual(center2, EWTOLERANCE)) {
|
||||
//exact match
|
||||
return true;
|
||||
}
|
||||
return false;
|
||||
}
|
||||
|
||||
bool GeometryMatcher::compareEllipses(TopoDS_Edge edge1, TopoDS_Edge edge2)
|
||||
{
|
||||
BRepAdaptor_Curve adapt1(edge1);
|
||||
BRepAdaptor_Curve adapt2(edge2);
|
||||
gp_Elips ellipse1 = adapt1.Ellipse();
|
||||
gp_Elips ellipse2 = adapt2.Ellipse();
|
||||
double major1 = ellipse1.MajorRadius();
|
||||
double minor1 = ellipse1.MinorRadius();
|
||||
double major2 = ellipse2.MajorRadius();
|
||||
double minor2 = ellipse2.MinorRadius();
|
||||
auto center1 = DU::toVector3d(ellipse1.Location());
|
||||
auto center2 = DU::toVector3d(ellipse2.Location());
|
||||
if (DU::fpCompare(major1, major2, EWTOLERANCE) &&
|
||||
DU::fpCompare(minor1, minor2, EWTOLERANCE) &&
|
||||
center1.IsEqual(center2, EWTOLERANCE)) {
|
||||
// exact match
|
||||
return true;
|
||||
}
|
||||
return false;
|
||||
}
|
||||
|
||||
// for our purposes, only circles masquerading as bsplines are of interest
|
||||
bool GeometryMatcher::compareBSplines(TopoDS_Edge edge1, TopoDS_Edge edge2)
|
||||
{
|
||||
BRepAdaptor_Curve adapt1(edge1);
|
||||
BRepAdaptor_Curve adapt2(edge2);
|
||||
bool isArc1(false);
|
||||
bool isArc2(false);
|
||||
TopoDS_Edge circleEdge1;
|
||||
TopoDS_Edge circleEdge2;
|
||||
try {
|
||||
circleEdge1 = GeometryUtils::asCircle(edge1, isArc1);
|
||||
circleEdge2 = GeometryUtils::asCircle(edge2, isArc1);
|
||||
}
|
||||
catch (Base::RuntimeError& e) {
|
||||
Base::Console().Error("GeometryMatcher failed to make circles from splines\n");
|
||||
return false;
|
||||
}
|
||||
if (!isArc1 && !isArc2) {
|
||||
// full circles
|
||||
return compareCircles(circleEdge1, circleEdge2);
|
||||
}
|
||||
if (isArc1 && isArc2) {
|
||||
// circular arcs
|
||||
return compareCircleArcs(circleEdge1, circleEdge2);
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
// this is a weak comparison. we should also check center & radius?
|
||||
bool GeometryMatcher::compareCircleArcs(TopoDS_Edge edge1, TopoDS_Edge edge2)
|
||||
{
|
||||
return compareEndPoints(edge1, edge2);
|
||||
}
|
||||
|
||||
bool GeometryMatcher::compareEllipseArcs(TopoDS_Edge edge1, TopoDS_Edge edge2)
|
||||
{
|
||||
return compareEndPoints(edge1, edge2);
|
||||
}
|
||||
|
||||
// this is where we would try to match a bspline against a line or a circle.
|
||||
// not sure how successful this would be. For now, we just say it doesn't match
|
||||
bool GeometryMatcher::compareDifferent(TopoDS_Edge edge1, TopoDS_Edge edge2)
|
||||
{
|
||||
BRepAdaptor_Curve adapt1(edge1);
|
||||
BRepAdaptor_Curve adapt2(edge2);
|
||||
return false;
|
||||
}
|
||||
|
||||
bool GeometryMatcher::compareEndPoints(TopoDS_Edge edge1, TopoDS_Edge edge2)
|
||||
{
|
||||
BRepAdaptor_Curve adapt1(edge1);
|
||||
BRepAdaptor_Curve adapt2(edge2);
|
||||
double pFirst1 = adapt1.FirstParameter();
|
||||
double pLast1 = adapt1.LastParameter();
|
||||
BRepLProp_CLProps props1(adapt1, pFirst1, 0, Precision::Confusion());
|
||||
auto begin1 = DU::toVector3d(props1.Value());
|
||||
props1.SetParameter(pLast1);
|
||||
auto end1 = DU::toVector3d(props1.Value());
|
||||
double pFirst2 = adapt2.FirstParameter();
|
||||
double pLast2 = adapt2.LastParameter();
|
||||
BRepLProp_CLProps props2(adapt2, pFirst2, 0, Precision::Confusion());
|
||||
auto begin2 = DU::toVector3d(props2.Value());
|
||||
props2.SetParameter(pLast2);
|
||||
auto end2 = DU::toVector3d(props2.Value());
|
||||
|
||||
if (begin1.IsEqual(begin2, EWTOLERANCE) &&
|
||||
end1.IsEqual(end2, EWTOLERANCE)) {
|
||||
//exact match
|
||||
return true;
|
||||
}
|
||||
return false;
|
||||
}
|
||||
Reference in New Issue
Block a user