778 lines
26 KiB
C++
778 lines
26 KiB
C++
/***************************************************************************
|
|
* Copyright (c) 2011 Werner Mayer <wmayer[at]users.sourceforge.net> *
|
|
* *
|
|
* 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 *
|
|
* *
|
|
***************************************************************************/
|
|
|
|
|
|
#include "PreCompiled.h"
|
|
#include <gp_Pnt.hxx>
|
|
#include <BRepExtrema_DistShapeShape.hxx>
|
|
#include <BRepBuilderAPI_MakeVertex.hxx>
|
|
#include <TopoDS_Vertex.hxx>
|
|
|
|
#include <QEventLoop>
|
|
#include <QFuture>
|
|
#include <QFutureWatcher>
|
|
#include <QtConcurrentMap>
|
|
|
|
#include <boost/signals.hpp>
|
|
#include <boost/bind.hpp>
|
|
|
|
#include <Base/Console.h>
|
|
#include <Base/Exception.h>
|
|
#include <Base/FutureWatcherProgress.h>
|
|
#include <Base/Parameter.h>
|
|
#include <Base/Sequencer.h>
|
|
#include <Base/Tools.h>
|
|
#include <App/Application.h>
|
|
#include <Mod/Mesh/App/Mesh.h>
|
|
#include <Mod/Mesh/App/MeshFeature.h>
|
|
#include <Mod/Mesh/App/Core/Algorithm.h>
|
|
#include <Mod/Mesh/App/Core/Grid.h>
|
|
#include <Mod/Mesh/App/Core/Iterator.h>
|
|
#include <Mod/Mesh/App/Core/MeshKernel.h>
|
|
#include <Mod/Points/App/PointsFeature.h>
|
|
#include <Mod/Points/App/PointsGrid.h>
|
|
#include <Mod/Part/App/PartFeature.h>
|
|
|
|
#include "InspectionFeature.h"
|
|
|
|
|
|
using namespace Inspection;
|
|
|
|
InspectActualMesh::InspectActualMesh(const Mesh::MeshObject& rMesh) : _iter(rMesh.getKernel())
|
|
{
|
|
this->_count = rMesh.countPoints();
|
|
this->_iter.Transform(rMesh.getTransform());
|
|
}
|
|
|
|
InspectActualMesh::~InspectActualMesh()
|
|
{
|
|
}
|
|
|
|
unsigned long InspectActualMesh::countPoints() const
|
|
{
|
|
return this->_count;
|
|
}
|
|
|
|
Base::Vector3f InspectActualMesh::getPoint(unsigned long index)
|
|
{
|
|
_iter.Set(index);
|
|
return *_iter;
|
|
}
|
|
|
|
// ----------------------------------------------------------------
|
|
|
|
InspectActualPoints::InspectActualPoints(const Points::PointKernel& rPoints) : _rKernel(rPoints)
|
|
{
|
|
}
|
|
|
|
unsigned long InspectActualPoints::countPoints() const
|
|
{
|
|
return _rKernel.size();
|
|
}
|
|
|
|
Base::Vector3f InspectActualPoints::getPoint(unsigned long index)
|
|
{
|
|
Base::Vector3d p = _rKernel.getPoint(index);
|
|
return Base::Vector3f((float)p.x,(float)p.y,(float)p.z);
|
|
}
|
|
|
|
// ----------------------------------------------------------------
|
|
|
|
InspectActualShape::InspectActualShape(const Part::TopoShape& shape) : _rShape(shape)
|
|
{
|
|
ParameterGrp::handle hGrp = App::GetApplication().GetParameterGroupByPath
|
|
("User parameter:BaseApp/Preferences/Mod/Part");
|
|
float deviation = hGrp->GetFloat("MeshDeviation",0.2);
|
|
|
|
Base::BoundBox3d bbox = _rShape.getBoundBox();
|
|
Standard_Real deflection = (bbox.LengthX() + bbox.LengthY() + bbox.LengthZ())/300.0 * deviation;
|
|
|
|
std::vector<Data::ComplexGeoData::Facet> f;
|
|
_rShape.getFaces(points, f, (float)deflection);
|
|
}
|
|
|
|
unsigned long InspectActualShape::countPoints() const
|
|
{
|
|
return points.size();
|
|
}
|
|
|
|
Base::Vector3f InspectActualShape::getPoint(unsigned long index)
|
|
{
|
|
return Base::toVector<float>(points[index]);
|
|
}
|
|
|
|
// ----------------------------------------------------------------
|
|
|
|
namespace Inspection {
|
|
class MeshInspectGrid : public MeshCore::MeshGrid
|
|
{
|
|
public:
|
|
MeshInspectGrid (const MeshCore::MeshKernel &mesh, float fGridLen, const Base::Matrix4D& m)
|
|
: MeshCore::MeshGrid(mesh), _transform(m)
|
|
{
|
|
Base::BoundBox3f clBBMesh = _pclMesh->GetBoundBox().Transformed(m);
|
|
Rebuild(std::max<unsigned long>((unsigned long)(clBBMesh.LengthX() / fGridLen), 1),
|
|
std::max<unsigned long>((unsigned long)(clBBMesh.LengthY() / fGridLen), 1),
|
|
std::max<unsigned long>((unsigned long)(clBBMesh.LengthZ() / fGridLen), 1));
|
|
}
|
|
|
|
void Validate (const MeshCore::MeshKernel&)
|
|
{
|
|
// do nothing
|
|
}
|
|
|
|
void Validate (void)
|
|
{
|
|
// do nothing
|
|
}
|
|
|
|
bool Verify() const
|
|
{
|
|
// do nothing
|
|
return true;
|
|
}
|
|
|
|
protected:
|
|
void CalculateGridLength (unsigned long ulCtGrid, unsigned long ulMaxGrids)
|
|
{
|
|
// do nothing
|
|
}
|
|
|
|
void CalculateGridLength (int iCtGridPerAxis)
|
|
{
|
|
// do nothing
|
|
}
|
|
|
|
unsigned long HasElements (void) const
|
|
{
|
|
return _pclMesh->CountFacets();
|
|
}
|
|
|
|
void Pos (const Base::Vector3f &rclPoint, unsigned long &rulX, unsigned long &rulY, unsigned long &rulZ) const
|
|
{
|
|
rulX = (unsigned long)((rclPoint.x - _fMinX) / _fGridLenX);
|
|
rulY = (unsigned long)((rclPoint.y - _fMinY) / _fGridLenY);
|
|
rulZ = (unsigned long)((rclPoint.z - _fMinZ) / _fGridLenZ);
|
|
|
|
assert((rulX < _ulCtGridsX) && (rulY < _ulCtGridsY) && (rulZ < _ulCtGridsZ));
|
|
}
|
|
|
|
void AddFacet (const MeshCore::MeshGeomFacet &rclFacet, unsigned long ulFacetIndex)
|
|
{
|
|
unsigned long ulX, ulY, ulZ;
|
|
unsigned long ulX1, ulY1, ulZ1, ulX2, ulY2, ulZ2;
|
|
|
|
Base::BoundBox3f clBB;
|
|
clBB &= rclFacet._aclPoints[0];
|
|
clBB &= rclFacet._aclPoints[1];
|
|
clBB &= rclFacet._aclPoints[2];
|
|
|
|
Pos(Base::Vector3f(clBB.MinX,clBB.MinY,clBB.MinZ), ulX1, ulY1, ulZ1);
|
|
Pos(Base::Vector3f(clBB.MaxX,clBB.MaxY,clBB.MaxZ), ulX2, ulY2, ulZ2);
|
|
|
|
|
|
if ((ulX1 < ulX2) || (ulY1 < ulY2) || (ulZ1 < ulZ2)) {
|
|
for (ulX = ulX1; ulX <= ulX2; ulX++) {
|
|
for (ulY = ulY1; ulY <= ulY2; ulY++) {
|
|
for (ulZ = ulZ1; ulZ <= ulZ2; ulZ++) {
|
|
if (rclFacet.IntersectBoundingBox(GetBoundBox(ulX, ulY, ulZ)))
|
|
_aulGrid[ulX][ulY][ulZ].insert(ulFacetIndex);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
else
|
|
_aulGrid[ulX1][ulY1][ulZ1].insert(ulFacetIndex);
|
|
}
|
|
|
|
void InitGrid (void)
|
|
{
|
|
unsigned long i, j;
|
|
|
|
Base::BoundBox3f clBBMesh = _pclMesh->GetBoundBox().Transformed(_transform);
|
|
|
|
float fLengthX = clBBMesh.LengthX();
|
|
float fLengthY = clBBMesh.LengthY();
|
|
float fLengthZ = clBBMesh.LengthZ();
|
|
|
|
_fGridLenX = (1.0f + fLengthX) / float(_ulCtGridsX);
|
|
_fMinX = clBBMesh.MinX - 0.5f;
|
|
|
|
_fGridLenY = (1.0f + fLengthY) / float(_ulCtGridsY);
|
|
_fMinY = clBBMesh.MinY - 0.5f;
|
|
|
|
_fGridLenZ = (1.0f + fLengthZ) / float(_ulCtGridsZ);
|
|
_fMinZ = clBBMesh.MinZ - 0.5f;
|
|
|
|
_aulGrid.clear();
|
|
_aulGrid.resize(_ulCtGridsX);
|
|
for (i = 0; i < _ulCtGridsX; i++) {
|
|
_aulGrid[i].resize(_ulCtGridsY);
|
|
for (j = 0; j < _ulCtGridsY; j++)
|
|
_aulGrid[i][j].resize(_ulCtGridsZ);
|
|
}
|
|
}
|
|
|
|
void RebuildGrid (void)
|
|
{
|
|
_ulCtElements = _pclMesh->CountFacets();
|
|
InitGrid();
|
|
|
|
unsigned long i = 0;
|
|
MeshCore::MeshFacetIterator clFIter(*_pclMesh);
|
|
clFIter.Transform(_transform);
|
|
for (clFIter.Init(); clFIter.More(); clFIter.Next()) {
|
|
AddFacet(*clFIter, i++);
|
|
}
|
|
}
|
|
|
|
private:
|
|
Base::Matrix4D _transform;
|
|
};
|
|
}
|
|
|
|
InspectNominalMesh::InspectNominalMesh(const Mesh::MeshObject& rMesh, float offset) : _iter(rMesh.getKernel())
|
|
{
|
|
const MeshCore::MeshKernel& kernel = rMesh.getKernel();
|
|
_iter.Transform(rMesh.getTransform());
|
|
|
|
// Max. limit of grid elements
|
|
float fMaxGridElements=8000000.0f;
|
|
Base::BoundBox3f box = kernel.GetBoundBox().Transformed(rMesh.getTransform());
|
|
|
|
// estimate the minimum allowed grid length
|
|
float fMinGridLen = (float)pow((box.LengthX()*box.LengthY()*box.LengthZ()/fMaxGridElements), 0.3333f);
|
|
float fGridLen = 5.0f * MeshCore::MeshAlgorithm(kernel).GetAverageEdgeLength();
|
|
|
|
// We want to avoid to get too small grid elements otherwise building up the grid structure would take
|
|
// too much time and memory.
|
|
// Having quite a dense grid speeds up more the following algorithms extremely. Due to the issue above it's
|
|
// always a compromise between speed and memory usage.
|
|
fGridLen = std::max<float>(fMinGridLen, fGridLen);
|
|
|
|
// build up grid structure to speed up algorithms
|
|
_pGrid = new MeshInspectGrid(kernel, fGridLen, rMesh.getTransform());
|
|
_box = box;
|
|
_box.Enlarge(offset);
|
|
}
|
|
|
|
InspectNominalMesh::~InspectNominalMesh()
|
|
{
|
|
delete this->_pGrid;
|
|
}
|
|
|
|
float InspectNominalMesh::getDistance(const Base::Vector3f& point)
|
|
{
|
|
if (!_box.IsInBox(point))
|
|
return FLT_MAX; // must be inside bbox
|
|
|
|
std::vector<unsigned long> indices;
|
|
//_pGrid->GetElements(point, indices);
|
|
if (indices.empty()) {
|
|
std::set<unsigned long> inds;
|
|
_pGrid->MeshGrid::SearchNearestFromPoint(point, inds);
|
|
indices.insert(indices.begin(), inds.begin(), inds.end());
|
|
}
|
|
|
|
float fMinDist=FLT_MAX;
|
|
bool positive = true;
|
|
for (std::vector<unsigned long>::iterator it = indices.begin(); it != indices.end(); ++it) {
|
|
_iter.Set(*it);
|
|
float fDist = _iter->DistanceToPoint(point);
|
|
if (fabs(fDist) < fabs(fMinDist)) {
|
|
fMinDist = fDist;
|
|
positive = point.DistanceToPlane(_iter->_aclPoints[0], _iter->GetNormal()) > 0;
|
|
}
|
|
}
|
|
|
|
if (!positive)
|
|
fMinDist = -fMinDist;
|
|
return fMinDist;
|
|
}
|
|
|
|
// ----------------------------------------------------------------
|
|
|
|
InspectNominalFastMesh::InspectNominalFastMesh(const Mesh::MeshObject& rMesh, float offset) : _iter(rMesh.getKernel())
|
|
{
|
|
const MeshCore::MeshKernel& kernel = rMesh.getKernel();
|
|
_iter.Transform(rMesh.getTransform());
|
|
|
|
// Max. limit of grid elements
|
|
float fMaxGridElements=8000000.0f;
|
|
Base::BoundBox3f box = kernel.GetBoundBox().Transformed(rMesh.getTransform());
|
|
|
|
// estimate the minimum allowed grid length
|
|
float fMinGridLen = (float)pow((box.LengthX()*box.LengthY()*box.LengthZ()/fMaxGridElements), 0.3333f);
|
|
float fGridLen = 5.0f * MeshCore::MeshAlgorithm(kernel).GetAverageEdgeLength();
|
|
|
|
// We want to avoid to get too small grid elements otherwise building up the grid structure would take
|
|
// too much time and memory.
|
|
// Having quite a dense grid speeds up more the following algorithms extremely. Due to the issue above it's
|
|
// always a compromise between speed and memory usage.
|
|
fGridLen = std::max<float>(fMinGridLen, fGridLen);
|
|
|
|
// build up grid structure to speed up algorithms
|
|
_pGrid = new MeshInspectGrid(kernel, fGridLen, rMesh.getTransform());
|
|
_box = box;
|
|
_box.Enlarge(offset);
|
|
max_level = (unsigned long)(offset/fGridLen);
|
|
}
|
|
|
|
InspectNominalFastMesh::~InspectNominalFastMesh()
|
|
{
|
|
delete this->_pGrid;
|
|
}
|
|
|
|
/**
|
|
* This algorithm is not that exact as that from InspectNominalMesh but is by
|
|
* factors faster and sufficient for many cases.
|
|
*/
|
|
float InspectNominalFastMesh::getDistance(const Base::Vector3f& point)
|
|
{
|
|
if (!_box.IsInBox(point))
|
|
return FLT_MAX; // must be inside bbox
|
|
|
|
std::set<unsigned long> indices;
|
|
#if 0 // a point in a neighbour grid can be nearer
|
|
std::vector<unsigned long> elements;
|
|
_pGrid->GetElements(point, elements);
|
|
indices.insert(elements.begin(), elements.end());
|
|
#else
|
|
unsigned long ulX, ulY, ulZ;
|
|
_pGrid->Position(point, ulX, ulY, ulZ);
|
|
unsigned long ulLevel = 0;
|
|
while (indices.size() == 0 && ulLevel <= max_level)
|
|
_pGrid->GetHull(ulX, ulY, ulZ, ulLevel++, indices);
|
|
if (indices.size() == 0 || ulLevel==1)
|
|
_pGrid->GetHull(ulX, ulY, ulZ, ulLevel, indices);
|
|
#endif
|
|
|
|
float fMinDist=FLT_MAX;
|
|
bool positive = true;
|
|
for (std::set<unsigned long>::iterator it = indices.begin(); it != indices.end(); ++it) {
|
|
_iter.Set(*it);
|
|
float fDist = _iter->DistanceToPoint(point);
|
|
if (fabs(fDist) < fabs(fMinDist)) {
|
|
fMinDist = fDist;
|
|
positive = point.DistanceToPlane(_iter->_aclPoints[0], _iter->GetNormal()) > 0;
|
|
}
|
|
}
|
|
|
|
if (!positive)
|
|
fMinDist = -fMinDist;
|
|
return fMinDist;
|
|
}
|
|
|
|
// ----------------------------------------------------------------
|
|
|
|
InspectNominalPoints::InspectNominalPoints(const Points::PointKernel& Kernel, float offset) : _rKernel(Kernel)
|
|
{
|
|
int uGridPerAxis = 50; // totally 125.000 grid elements
|
|
this->_pGrid = new Points::PointsGrid (Kernel, uGridPerAxis);
|
|
}
|
|
|
|
InspectNominalPoints::~InspectNominalPoints()
|
|
{
|
|
delete this->_pGrid;
|
|
}
|
|
|
|
float InspectNominalPoints::getDistance(const Base::Vector3f& point)
|
|
{
|
|
//TODO: Make faster
|
|
std::set<unsigned long> indices;
|
|
unsigned long x,y,z;
|
|
Base::Vector3d pointd(point.x,point.y,point.z);
|
|
_pGrid->Position(pointd, x, y, z);
|
|
_pGrid->GetElements(x,y,z,indices);
|
|
|
|
double fMinDist=DBL_MAX;
|
|
for (std::set<unsigned long>::iterator it = indices.begin(); it != indices.end(); ++it) {
|
|
Base::Vector3d pt = _rKernel.getPoint(*it);
|
|
double fDist = Base::Distance(pointd, pt);
|
|
if (fDist < fMinDist) {
|
|
fMinDist = fDist;
|
|
}
|
|
}
|
|
|
|
return (float)fMinDist;
|
|
}
|
|
|
|
// ----------------------------------------------------------------
|
|
|
|
InspectNominalShape::InspectNominalShape(const TopoDS_Shape& shape, float radius) : _rShape(shape)
|
|
{
|
|
distss = new BRepExtrema_DistShapeShape();
|
|
distss->LoadS1(_rShape);
|
|
//distss->SetDeflection(radius);
|
|
}
|
|
|
|
InspectNominalShape::~InspectNominalShape()
|
|
{
|
|
delete distss;
|
|
}
|
|
|
|
float InspectNominalShape::getDistance(const Base::Vector3f& point)
|
|
{
|
|
BRepBuilderAPI_MakeVertex mkVert(gp_Pnt(point.x,point.y,point.z));
|
|
distss->LoadS2(mkVert.Vertex());
|
|
float fMinDist=FLT_MAX;
|
|
if (distss->Perform() && distss->NbSolution() > 0)
|
|
fMinDist = (float)distss->Value();
|
|
return fMinDist;
|
|
}
|
|
|
|
// ----------------------------------------------------------------
|
|
|
|
TYPESYSTEM_SOURCE(Inspection::PropertyDistanceList, App::PropertyLists);
|
|
|
|
PropertyDistanceList::PropertyDistanceList()
|
|
{
|
|
|
|
}
|
|
|
|
PropertyDistanceList::~PropertyDistanceList()
|
|
{
|
|
|
|
}
|
|
|
|
void PropertyDistanceList::setSize(int newSize)
|
|
{
|
|
_lValueList.resize(newSize);
|
|
}
|
|
|
|
int PropertyDistanceList::getSize(void) const
|
|
{
|
|
return static_cast<int>(_lValueList.size());
|
|
}
|
|
|
|
void PropertyDistanceList::setValue(float lValue)
|
|
{
|
|
aboutToSetValue();
|
|
_lValueList.resize(1);
|
|
_lValueList[0]=lValue;
|
|
hasSetValue();
|
|
}
|
|
|
|
void PropertyDistanceList::setValues(const std::vector<float>& values)
|
|
{
|
|
aboutToSetValue();
|
|
_lValueList = values;
|
|
hasSetValue();
|
|
}
|
|
|
|
PyObject *PropertyDistanceList::getPyObject(void)
|
|
{
|
|
PyObject* list = PyList_New(getSize());
|
|
for (int i = 0;i<getSize(); i++)
|
|
PyList_SetItem( list, i, PyFloat_FromDouble(_lValueList[i]));
|
|
return list;
|
|
}
|
|
|
|
void PropertyDistanceList::setPyObject(PyObject *value)
|
|
{
|
|
if (PyList_Check(value)) {
|
|
Py_ssize_t nSize = PyList_Size(value);
|
|
std::vector<float> values;
|
|
values.resize(nSize);
|
|
|
|
for (Py_ssize_t i=0; i<nSize;++i) {
|
|
PyObject* item = PyList_GetItem(value, i);
|
|
if (!PyFloat_Check(item)) {
|
|
std::string error = std::string("type in list must be float, not ");
|
|
error += item->ob_type->tp_name;
|
|
throw Py::TypeError(error);
|
|
}
|
|
|
|
values[i] = (float)PyFloat_AsDouble(item);
|
|
}
|
|
|
|
setValues(values);
|
|
}
|
|
else if (PyFloat_Check(value)) {
|
|
setValue((float)PyFloat_AsDouble(value));
|
|
}
|
|
else {
|
|
std::string error = std::string("type must be float or list of float, not ");
|
|
error += value->ob_type->tp_name;
|
|
throw Py::TypeError(error);
|
|
}
|
|
}
|
|
|
|
void PropertyDistanceList::Save (Base::Writer &writer) const
|
|
{
|
|
if (writer.isForceXML()) {
|
|
writer.Stream() << writer.ind() << "<FloatList count=\"" << getSize() <<"\">" << endl;
|
|
writer.incInd();
|
|
for(int i = 0;i<getSize(); i++)
|
|
writer.Stream() << writer.ind() << "<F v=\"" << _lValueList[i] <<"\"/>" << endl; ;
|
|
writer.decInd();
|
|
writer.Stream() << writer.ind() <<"</FloatList>" << endl ;
|
|
}
|
|
else {
|
|
writer.Stream() << writer.ind() << "<FloatList file=\"" <<
|
|
writer.addFile(getName(), this) << "\"/>" << std::endl;
|
|
}
|
|
}
|
|
|
|
void PropertyDistanceList::Restore(Base::XMLReader &reader)
|
|
{
|
|
reader.readElement("FloatList");
|
|
std::string file (reader.getAttribute("file") );
|
|
|
|
if (!file.empty()) {
|
|
// initate a file read
|
|
reader.addFile(file.c_str(),this);
|
|
}
|
|
}
|
|
|
|
void PropertyDistanceList::SaveDocFile (Base::Writer &writer) const
|
|
{
|
|
Base::OutputStream str(writer.Stream());
|
|
uint32_t uCt = (uint32_t)getSize();
|
|
str << uCt;
|
|
for (std::vector<float>::const_iterator it = _lValueList.begin(); it != _lValueList.end(); ++it) {
|
|
str << *it;
|
|
}
|
|
}
|
|
|
|
void PropertyDistanceList::RestoreDocFile(Base::Reader &reader)
|
|
{
|
|
Base::InputStream str(reader);
|
|
uint32_t uCt=0;
|
|
str >> uCt;
|
|
std::vector<float> values(uCt);
|
|
for (std::vector<float>::iterator it = values.begin(); it != values.end(); ++it) {
|
|
str >> *it;
|
|
}
|
|
setValues(values);
|
|
}
|
|
|
|
App::Property *PropertyDistanceList::Copy(void) const
|
|
{
|
|
PropertyDistanceList *p= new PropertyDistanceList();
|
|
p->_lValueList = _lValueList;
|
|
return p;
|
|
}
|
|
|
|
void PropertyDistanceList::Paste(const App::Property &from)
|
|
{
|
|
aboutToSetValue();
|
|
_lValueList = dynamic_cast<const PropertyDistanceList&>(from)._lValueList;
|
|
hasSetValue();
|
|
}
|
|
|
|
unsigned int PropertyDistanceList::getMemSize (void) const
|
|
{
|
|
return static_cast<unsigned int>(_lValueList.size() * sizeof(float));
|
|
}
|
|
|
|
// ----------------------------------------------------------------
|
|
|
|
// helper class to use Qt's concurrent framework
|
|
struct DistanceInspection
|
|
{
|
|
|
|
DistanceInspection(float radius, InspectActualGeometry* a,
|
|
std::vector<InspectNominalGeometry*> n)
|
|
: radius(radius), actual(a), nominal(n)
|
|
{
|
|
}
|
|
float mapped(unsigned long index)
|
|
{
|
|
Base::Vector3f pnt = actual->getPoint(index);
|
|
|
|
float fMinDist=FLT_MAX;
|
|
for (std::vector<InspectNominalGeometry*>::iterator it = nominal.begin(); it != nominal.end(); ++it) {
|
|
float fDist = (*it)->getDistance(pnt);
|
|
if (fabs(fDist) < fabs(fMinDist))
|
|
fMinDist = fDist;
|
|
}
|
|
|
|
if (fMinDist > this->radius)
|
|
fMinDist = FLT_MAX;
|
|
else if (-fMinDist > this->radius)
|
|
fMinDist = -FLT_MAX;
|
|
|
|
return fMinDist;
|
|
}
|
|
|
|
float radius;
|
|
InspectActualGeometry* actual;
|
|
std::vector<InspectNominalGeometry*> nominal;
|
|
};
|
|
|
|
PROPERTY_SOURCE(Inspection::Feature, App::DocumentObject)
|
|
|
|
Feature::Feature()
|
|
{
|
|
ADD_PROPERTY(SearchRadius,(0.05));
|
|
ADD_PROPERTY(Thickness,(0.0));
|
|
ADD_PROPERTY(Actual,(0));
|
|
ADD_PROPERTY(Nominals,(0));
|
|
ADD_PROPERTY(Distances,(0.0));
|
|
}
|
|
|
|
Feature::~Feature()
|
|
{
|
|
}
|
|
|
|
short Feature::mustExecute() const
|
|
{
|
|
if (SearchRadius.isTouched())
|
|
return 1;
|
|
if (Thickness.isTouched())
|
|
return 1;
|
|
if (Actual.isTouched())
|
|
return 1;
|
|
if (Nominals.isTouched())
|
|
return 1;
|
|
return 0;
|
|
}
|
|
|
|
App::DocumentObjectExecReturn* Feature::execute(void)
|
|
{
|
|
App::DocumentObject* pcActual = Actual.getValue();
|
|
if (!pcActual)
|
|
throw Base::Exception("No actual geometry to inspect specified");
|
|
|
|
InspectActualGeometry* actual = 0;
|
|
if (pcActual->getTypeId().isDerivedFrom(Mesh::Feature::getClassTypeId())) {
|
|
Mesh::Feature* mesh = static_cast<Mesh::Feature*>(pcActual);
|
|
actual = new InspectActualMesh(mesh->Mesh.getValue());
|
|
}
|
|
else if (pcActual->getTypeId().isDerivedFrom(Points::Feature::getClassTypeId())) {
|
|
Points::Feature* pts = static_cast<Points::Feature*>(pcActual);
|
|
actual = new InspectActualPoints(pts->Points.getValue());
|
|
}
|
|
else if (pcActual->getTypeId().isDerivedFrom(Part::Feature::getClassTypeId())) {
|
|
Part::Feature* part = static_cast<Part::Feature*>(pcActual);
|
|
actual = new InspectActualShape(part->Shape.getShape());
|
|
}
|
|
else {
|
|
throw Base::Exception("Unknown geometric type");
|
|
}
|
|
|
|
// get a list of nominals
|
|
std::vector<InspectNominalGeometry*> inspectNominal;
|
|
const std::vector<App::DocumentObject*>& nominals = Nominals.getValues();
|
|
for (std::vector<App::DocumentObject*>::const_iterator it = nominals.begin(); it != nominals.end(); ++it) {
|
|
InspectNominalGeometry* nominal = 0;
|
|
if ((*it)->getTypeId().isDerivedFrom(Mesh::Feature::getClassTypeId())) {
|
|
Mesh::Feature* mesh = static_cast<Mesh::Feature*>(*it);
|
|
nominal = new InspectNominalMesh(mesh->Mesh.getValue(), this->SearchRadius.getValue());
|
|
}
|
|
else if ((*it)->getTypeId().isDerivedFrom(Points::Feature::getClassTypeId())) {
|
|
Points::Feature* pts = static_cast<Points::Feature*>(*it);
|
|
nominal = new InspectNominalPoints(pts->Points.getValue(), this->SearchRadius.getValue());
|
|
}
|
|
else if ((*it)->getTypeId().isDerivedFrom(Part::Feature::getClassTypeId())) {
|
|
Part::Feature* part = static_cast<Part::Feature*>(*it);
|
|
nominal = new InspectNominalShape(part->Shape.getValue(), this->SearchRadius.getValue());
|
|
}
|
|
|
|
if (nominal)
|
|
inspectNominal.push_back(nominal);
|
|
}
|
|
|
|
#if 0 // test with some huge data sets
|
|
Standard::SetReentrant(Standard_True);
|
|
std::vector<unsigned long> index(actual->countPoints());
|
|
std::generate(index.begin(), index.end(), Base::iotaGen<unsigned long>(0));
|
|
DistanceInspection check(this->SearchRadius.getValue(), actual, inspectNominal);
|
|
QFuture<float> future = QtConcurrent::mapped
|
|
(index, boost::bind(&DistanceInspection::mapped, &check, _1));
|
|
//future.waitForFinished(); // blocks the GUI
|
|
Base::FutureWatcherProgress progress("Inspecting...", actual->countPoints());
|
|
QFutureWatcher<float> watcher;
|
|
QObject::connect(&watcher, SIGNAL(progressValueChanged(int)),
|
|
&progress, SLOT(progressValueChanged(int)));
|
|
watcher.setFuture(future);
|
|
|
|
// keep it responsive during computation
|
|
QEventLoop loop;
|
|
QObject::connect(&watcher, SIGNAL(finished()), &loop, SLOT(quit()));
|
|
loop.exec();
|
|
|
|
std::vector<float> vals;
|
|
vals.insert(vals.end(), future.begin(), future.end());
|
|
#else
|
|
unsigned long count = actual->countPoints();
|
|
std::stringstream str;
|
|
str << "Inspecting " << this->Label.getValue() << "...";
|
|
Base::SequencerLauncher seq(str.str().c_str(), count);
|
|
|
|
std::vector<float> vals(count);
|
|
for (unsigned long index = 0; index < count; index++) {
|
|
Base::Vector3f pnt = actual->getPoint(index);
|
|
|
|
float fMinDist=FLT_MAX;
|
|
for (std::vector<InspectNominalGeometry*>::iterator it = inspectNominal.begin(); it != inspectNominal.end(); ++it) {
|
|
float fDist = (*it)->getDistance(pnt);
|
|
if (fabs(fDist) < fabs(fMinDist))
|
|
fMinDist = fDist;
|
|
}
|
|
|
|
if (fMinDist > this->SearchRadius.getValue())
|
|
fMinDist = FLT_MAX;
|
|
else if (-fMinDist > this->SearchRadius.getValue())
|
|
fMinDist = -FLT_MAX;
|
|
vals[index] = fMinDist;
|
|
seq.next();
|
|
}
|
|
#endif
|
|
|
|
Distances.setValues(vals);
|
|
|
|
float fRMS = 0;
|
|
int countRMS = 0;
|
|
for (std::vector<float>::iterator it = vals.begin(); it != vals.end(); ++it) {
|
|
if (fabs(*it) < FLT_MAX) {
|
|
fRMS += (*it) * (*it);
|
|
countRMS++;
|
|
}
|
|
}
|
|
|
|
fRMS = fRMS / countRMS;
|
|
fRMS = sqrt(fRMS);
|
|
Base::Console().Message("RMS value for '%s' with search radius=%.4f is: %.4f\n",
|
|
this->Label.getValue(), this->SearchRadius.getValue(), fRMS);
|
|
|
|
delete actual;
|
|
for (std::vector<InspectNominalGeometry*>::iterator it = inspectNominal.begin(); it != inspectNominal.end(); ++it)
|
|
delete *it;
|
|
|
|
return 0;
|
|
}
|
|
|
|
// ----------------------------------------------------------------
|
|
|
|
PROPERTY_SOURCE(Inspection::Group, App::DocumentObjectGroup)
|
|
|
|
|
|
Group::Group()
|
|
{
|
|
}
|
|
|
|
Group::~Group()
|
|
{
|
|
}
|