2011-04-01 18:25:49 +02:00
|
|
|
/****************************************************************************
|
|
|
|
* VCGLib o o *
|
|
|
|
* Visual and Computer Graphics Library o o *
|
|
|
|
* _ O _ *
|
2016-06-13 07:29:25 +02:00
|
|
|
* Copyright(C) 2004-2016 \/)\/ *
|
2011-04-01 18:25:49 +02:00
|
|
|
* Visual Computing Lab /\/| *
|
|
|
|
* ISTI - Italian National Research Council | *
|
|
|
|
* \ *
|
|
|
|
* All rights reserved. *
|
|
|
|
* *
|
2014-04-17 10:51:53 +02:00
|
|
|
* This program is free software; you can redistribute it and/or modify *
|
2011-04-01 18:25:49 +02:00
|
|
|
* it under the terms of the GNU General Public License as published by *
|
|
|
|
* the Free Software Foundation; either version 2 of the License, or *
|
|
|
|
* (at your option) any later version. *
|
|
|
|
* *
|
|
|
|
* This program 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 General Public License (http://www.gnu.org/licenses/gpl.txt) *
|
|
|
|
* for more details. *
|
|
|
|
* *
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
|
|
|
|
#ifndef __VCG_TRIMESH_CLOSEST
|
|
|
|
#define __VCG_TRIMESH_CLOSEST
|
|
|
|
#include <math.h>
|
|
|
|
|
|
|
|
#include <vcg/space/point3.h>
|
|
|
|
#include <vcg/space/box3.h>
|
|
|
|
#include <vcg/space/point4.h>
|
2015-12-03 23:58:08 +01:00
|
|
|
#include <vcg/space/index/grid_util.h>
|
|
|
|
#include <vcg/space/index/grid_closest.h>
|
2011-04-01 18:25:49 +02:00
|
|
|
#include <vcg/math/base.h>
|
|
|
|
#include <vcg/simplex/face/distance.h>
|
2015-12-03 23:58:08 +01:00
|
|
|
#include <vcg/simplex/edge/distance.h>
|
2011-04-01 18:25:49 +02:00
|
|
|
#include <vcg/simplex/vertex/distance.h>
|
|
|
|
#include <vcg/space/intersection3.h>
|
|
|
|
#include <vcg/space/index/space_iterators.h>
|
2011-04-01 19:06:03 +02:00
|
|
|
#include <vcg/complex/complex.h>
|
2011-04-01 18:25:49 +02:00
|
|
|
|
|
|
|
namespace vcg {
|
2014-04-17 10:51:53 +02:00
|
|
|
namespace tri {
|
|
|
|
|
|
|
|
//**MARKER CLASSES**//
|
|
|
|
template <class MESH_TYPE,class OBJ_TYPE>
|
|
|
|
class Tmark
|
|
|
|
{
|
|
|
|
MESH_TYPE *m;
|
|
|
|
public:
|
|
|
|
Tmark(){}
|
|
|
|
Tmark( MESH_TYPE *m) {SetMesh(m);}
|
|
|
|
void UnMarkAll(){ vcg::tri::UnMarkAll(*m);}
|
|
|
|
bool IsMarked(OBJ_TYPE* obj){return (vcg::tri::IsMarked(*m,obj));}
|
|
|
|
void Mark(OBJ_TYPE* obj){ vcg::tri::Mark(*m,obj);}
|
|
|
|
void SetMesh(MESH_TYPE *_m)
|
|
|
|
{
|
|
|
|
tri::RequirePerFaceMark(*_m);
|
|
|
|
m=_m;
|
|
|
|
}
|
|
|
|
};
|
|
|
|
|
|
|
|
template <class MESH_TYPE>
|
|
|
|
class FaceTmark:public Tmark<MESH_TYPE,typename MESH_TYPE::FaceType>
|
|
|
|
{
|
|
|
|
public:
|
|
|
|
FaceTmark(){}
|
|
|
|
FaceTmark(MESH_TYPE *m) {this->SetMesh(m);}
|
|
|
|
};
|
2015-12-03 23:58:08 +01:00
|
|
|
|
|
|
|
template <class MESH_TYPE>
|
|
|
|
class EdgeTmark:public Tmark<MESH_TYPE,typename MESH_TYPE::EdgeType>
|
|
|
|
{
|
|
|
|
public:
|
|
|
|
EdgeTmark(){}
|
|
|
|
EdgeTmark(MESH_TYPE *m) {this->SetMesh(m);}
|
|
|
|
};
|
|
|
|
|
2014-04-17 10:51:53 +02:00
|
|
|
|
|
|
|
template <class MESH_TYPE>
|
2015-12-03 23:58:08 +01:00
|
|
|
class EmptyTMark
|
2014-04-17 10:51:53 +02:00
|
|
|
{
|
|
|
|
public:
|
|
|
|
typedef typename MESH_TYPE::VertexType VertexType;
|
2016-10-18 13:38:10 +02:00
|
|
|
typedef typename MESH_TYPE::EdgeType EdgeType;
|
|
|
|
typedef typename MESH_TYPE::FaceType FaceType;
|
2015-12-03 23:58:08 +01:00
|
|
|
inline EmptyTMark(){}
|
|
|
|
inline EmptyTMark(MESH_TYPE *){}
|
2014-04-17 10:51:53 +02:00
|
|
|
inline void UnMarkAll() const {}
|
|
|
|
inline bool IsMarked(VertexType*) const { return false; }
|
|
|
|
inline void Mark(VertexType*) const {}
|
2015-12-03 23:58:08 +01:00
|
|
|
inline bool IsMarked(EdgeType*) const { return false; }
|
|
|
|
inline void Mark(EdgeType*) const {}
|
2016-10-18 13:38:10 +02:00
|
|
|
inline bool IsMarked(FaceType*) const { return false; }
|
|
|
|
inline void Mark(FaceType*) const {}
|
2014-04-17 10:51:53 +02:00
|
|
|
inline void SetMesh(void * /*m=0*/) const {}
|
|
|
|
};
|
|
|
|
|
|
|
|
//**CLOSEST FUNCTION DEFINITION**//
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
|
|
|
aka MetroCore
|
|
|
|
data una mesh m e una ug sulle sue facce trova il punto di m piu' vicino ad
|
|
|
|
un punto dato.
|
|
|
|
*/
|
|
|
|
|
|
|
|
// input: mesh, punto, griglia (gr), distanza limite (mdist)
|
|
|
|
// output: normale (interpolata) alla faccia e punto piu' vicino su di essa, e coord baricentriche del punto trovato
|
|
|
|
|
|
|
|
// Nota che il parametro template GRID non ci dovrebbe essere, visto che deve essere
|
|
|
|
// UGrid<MESH::FaceContainer >, ma non sono riuscito a definirlo implicitamente
|
|
|
|
|
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename MESH::FaceType * GetClosestFaceEP( MESH & mesh, GRID & gr, const typename GRID::CoordType & _p,
|
|
|
|
const typename GRID::ScalarType & _maxDist, typename GRID::ScalarType & _minDist,
|
|
|
|
typename GRID::CoordType & _closestPt, typename GRID::CoordType & _normf,
|
|
|
|
typename GRID::CoordType & _ip)
|
|
|
|
{
|
|
|
|
typedef typename GRID::ScalarType ScalarType;
|
|
|
|
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf(&mesh);
|
|
|
|
vcg::face::PointDistanceEPFunctor<ScalarType> FDistFunct;
|
|
|
|
_minDist=_maxDist;
|
|
|
|
typename MESH::FaceType* bestf= gr.GetClosest(FDistFunct, mf, _p, _maxDist, _minDist, _closestPt);
|
|
|
|
|
|
|
|
if(_maxDist> ScalarType(fabs(_minDist)))
|
|
|
|
{
|
|
|
|
// f=bestf;
|
|
|
|
//calcolo normale con interpolazione trilineare
|
|
|
|
InterpolationParameters<typename MESH::FaceType,typename MESH::ScalarType>(*bestf,bestf->N(),_closestPt, _ip);
|
|
|
|
_normf = (bestf->V(0)->cN())*_ip[0]+
|
|
|
|
(bestf->V(1)->cN())*_ip[1]+
|
|
|
|
(bestf->V(2)->cN())*_ip[2] ;
|
|
|
|
|
|
|
|
_minDist = fabs(_minDist);
|
|
|
|
return(bestf);
|
|
|
|
}
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
2015-09-24 18:41:34 +02:00
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename MESH::FaceType * GetClosestFaceBase( MESH & mesh,GRID & gr,const typename GRID::CoordType & _p,
|
|
|
|
const typename GRID::ScalarType _maxDist,typename GRID::ScalarType & _minDist,
|
|
|
|
typename GRID::CoordType &_closestPt)
|
|
|
|
{
|
|
|
|
typedef typename GRID::ScalarType ScalarType;
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf;
|
|
|
|
mf.SetMesh(&mesh);
|
|
|
|
vcg::face::PointDistanceBaseFunctor<ScalarType> PDistFunct;
|
|
|
|
_minDist=_maxDist;
|
|
|
|
return (gr.GetClosest(PDistFunct,mf,_p,_maxDist,_minDist,_closestPt));
|
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename MESH::FaceType * GetClosestFaceBase( MESH & mesh,GRID & gr,const typename GRID::CoordType & _p,
|
|
|
|
const typename GRID::ScalarType _maxDist,typename GRID::ScalarType & _minDist,
|
|
|
|
typename GRID::CoordType &_closestPt, typename GRID::CoordType & _normf,
|
|
|
|
typename GRID::CoordType & _ip)
|
|
|
|
{
|
|
|
|
typedef typename GRID::ScalarType ScalarType;
|
|
|
|
typename MESH::FaceType * f = GetClosestFaceBase(mesh, gr, _p, _maxDist, _minDist, _closestPt);
|
|
|
|
if(_maxDist> ScalarType(fabs(_minDist)))
|
|
|
|
{
|
|
|
|
// normal computed with trilinear interpolation
|
|
|
|
InterpolationParameters<typename MESH::FaceType,typename MESH::ScalarType>(*f,f->N(),_closestPt, _ip);
|
|
|
|
_normf = (f->V(0)->cN())*_ip[0]+
|
|
|
|
(f->V(1)->cN())*_ip[1]+
|
|
|
|
(f->V(2)->cN())*_ip[2];
|
|
|
|
}
|
|
|
|
return f;
|
|
|
|
}
|
2014-04-17 10:51:53 +02:00
|
|
|
|
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename MESH::FaceType * GetClosestFaceEP( MESH & mesh,GRID & gr,const typename GRID::CoordType & _p,
|
|
|
|
const typename GRID::ScalarType _maxDist, typename GRID::ScalarType & _minDist,
|
|
|
|
typename GRID::CoordType &_closestPt)
|
|
|
|
{
|
|
|
|
typedef typename GRID::ScalarType ScalarType;
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf;
|
|
|
|
mf.SetMesh(&mesh);
|
|
|
|
vcg::face::PointDistanceEPFunctor<ScalarType> PDistFunct;
|
|
|
|
_minDist=_maxDist;
|
|
|
|
return (gr.GetClosest(PDistFunct,mf,_p,_maxDist,_minDist,_closestPt));
|
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename MESH::FaceType * GetClosestFaceNormal(MESH & mesh,GRID & gr,const typename MESH::VertexType & _p,
|
|
|
|
const typename GRID::ScalarType & _maxDist,typename GRID::ScalarType & _minDist,
|
|
|
|
typename GRID::CoordType &_closestPt)
|
|
|
|
{
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf;
|
|
|
|
mf.SetMesh(&mesh);
|
|
|
|
typedef vcg::face::PointNormalDistanceFunctor<typename MESH::VertexType> PDistFunct;
|
|
|
|
PDistFunct fn;
|
|
|
|
_minDist=_maxDist;
|
|
|
|
//return (gr.GetClosest(PDistFunct,mf,_p,_maxDist,_minDist,_closestPt.P()));
|
|
|
|
return (gr.template GetClosest <PDistFunct,MarkerFace>(fn,mf,_p,_maxDist,_minDist,_closestPt));
|
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename MESH::VertexType * GetClosestVertex( MESH & mesh,GRID & gr,const typename GRID::CoordType & _p,
|
|
|
|
const typename GRID::ScalarType & _maxDist,typename GRID::ScalarType & _minDist )
|
|
|
|
{
|
|
|
|
typedef typename GRID::ScalarType ScalarType;
|
|
|
|
typedef Point3<ScalarType> Point3x;
|
2015-12-03 23:58:08 +01:00
|
|
|
typedef EmptyTMark<MESH> MarkerVert;
|
2014-04-17 10:51:53 +02:00
|
|
|
MarkerVert mv;
|
|
|
|
mv.SetMesh(&mesh);
|
|
|
|
typedef vcg::vertex::PointDistanceFunctor<typename MESH::ScalarType> VDistFunct;
|
|
|
|
VDistFunct fn;
|
|
|
|
_minDist=_maxDist;
|
|
|
|
Point3x _closestPt;
|
|
|
|
return (gr.template GetClosest<VDistFunct,MarkerVert>(fn,mv,_p,_maxDist,_minDist,_closestPt));
|
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename MESH::VertexType * GetClosestVertexScale( MESH & mesh,GRID & gr,const typename GRID::CoordType & _p,
|
|
|
|
const typename MESH::CoordType & center, const typename GRID::ScalarType & _maxDist,typename GRID::ScalarType & _minDist )
|
|
|
|
{
|
|
|
|
typedef typename GRID::ScalarType ScalarType;
|
|
|
|
typedef Point3<ScalarType> Point3x;
|
2015-12-03 23:58:08 +01:00
|
|
|
typedef EmptyTMark<MESH> MarkerVert;
|
2014-04-17 10:51:53 +02:00
|
|
|
MarkerVert mv;
|
|
|
|
mv.SetMesh(&mesh);
|
|
|
|
typedef vcg::vertex::PointScaledDistanceFunctor<typename MESH::VertexType> VDistFunct;
|
|
|
|
VDistFunct fn;
|
|
|
|
fn.Cen() = center;
|
|
|
|
_minDist=_maxDist;
|
|
|
|
Point3x _closestPt;
|
|
|
|
return (gr.template GetClosest<VDistFunct,MarkerVert>(fn,mv,_p,_maxDist,_minDist,_closestPt));
|
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename MESH::VertexType * GetClosestVertexNormal( MESH & mesh,GRID & gr,const typename MESH::VertexType & _p,
|
|
|
|
const typename GRID::ScalarType & _maxDist,typename GRID::ScalarType & _minDist )
|
|
|
|
{
|
|
|
|
typedef typename GRID::ScalarType ScalarType;
|
|
|
|
typedef Point3<ScalarType> Point3x;
|
2015-12-03 23:58:08 +01:00
|
|
|
typedef EmptyTMark<MESH> MarkerVert;
|
2014-04-17 10:51:53 +02:00
|
|
|
MarkerVert mv;
|
|
|
|
mv.SetMesh(&mesh);
|
|
|
|
typedef vcg::vertex::PointNormalDistanceFunctor<typename MESH::VertexType> VDistFunct;
|
|
|
|
VDistFunct fn;
|
|
|
|
_minDist=_maxDist;
|
|
|
|
Point3x _closestPt;
|
|
|
|
return (gr.template GetClosest <VDistFunct,MarkerVert>(fn,mv,_p,_maxDist,_minDist,_closestPt));
|
|
|
|
}
|
2011-04-01 18:25:49 +02:00
|
|
|
|
|
|
|
template <class MESH, class GRID, class OBJPTRCONTAINER,class DISTCONTAINER, class POINTCONTAINER>
|
2012-07-06 17:24:04 +02:00
|
|
|
unsigned int GetKClosestFaceEP(MESH & mesh,GRID & gr, const unsigned int _k,
|
2011-04-01 18:25:49 +02:00
|
|
|
const typename GRID::CoordType & _p, const typename GRID::ScalarType & _maxDist,
|
|
|
|
OBJPTRCONTAINER & _objectPtrs,DISTCONTAINER & _distances, POINTCONTAINER & _points)
|
|
|
|
{
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf;
|
|
|
|
mf.SetMesh(&mesh);
|
2012-07-06 17:24:04 +02:00
|
|
|
vcg::face::PointDistanceEPFunctor<typename MESH::ScalarType> FDistFunct;
|
2011-04-01 18:25:49 +02:00
|
|
|
return (gr.GetKClosest /*<vcg::face::PointDistanceFunctor, MarkerFace,OBJPTRCONTAINER,DISTCONTAINER,POINTCONTAINER>*/
|
|
|
|
(FDistFunct,mf,_k,_p,_maxDist,_objectPtrs,_distances,_points));
|
|
|
|
}
|
|
|
|
|
|
|
|
// This version does not require that the face type has the
|
|
|
|
// EdgePlane component and use a less optimized (but more memory efficient) point-triangle distance
|
|
|
|
template <class MESH, class GRID, class OBJPTRCONTAINER,class DISTCONTAINER, class POINTCONTAINER>
|
|
|
|
unsigned int GetKClosestFaceBase(MESH & mesh,GRID & gr, const unsigned int _k,
|
|
|
|
const typename GRID::CoordType & _p, const typename GRID::ScalarType & _maxDist,
|
|
|
|
OBJPTRCONTAINER & _objectPtrs,DISTCONTAINER & _distances, POINTCONTAINER & _points)
|
|
|
|
{
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf;
|
|
|
|
mf.SetMesh(&mesh);
|
|
|
|
vcg::face::PointDistanceBaseFunctor<typename MESH::ScalarType> FDistFunct;
|
|
|
|
return (gr.GetKClosest /*<vcg::face::PointDistanceFunctor, MarkerFace,OBJPTRCONTAINER,DISTCONTAINER,POINTCONTAINER>*/
|
|
|
|
(FDistFunct,mf,_k,_p,_maxDist,_objectPtrs,_distances,_points));
|
|
|
|
}
|
|
|
|
|
2014-04-17 10:51:53 +02:00
|
|
|
template <class MESH, class GRID, class OBJPTRCONTAINER,class DISTCONTAINER, class POINTCONTAINER>
|
|
|
|
unsigned int GetKClosestVertex(MESH & mesh,GRID & gr, const unsigned int _k,
|
|
|
|
const typename GRID::CoordType & _p, const typename GRID::ScalarType & _maxDist,
|
|
|
|
OBJPTRCONTAINER & _objectPtrs,DISTCONTAINER & _distances, POINTCONTAINER & _points)
|
|
|
|
{
|
2015-12-03 23:58:08 +01:00
|
|
|
typedef EmptyTMark<MESH> MarkerVert;
|
2014-04-17 10:51:53 +02:00
|
|
|
MarkerVert mv;
|
|
|
|
mv.SetMesh(&mesh);
|
|
|
|
typedef vcg::vertex::PointDistanceFunctor<typename MESH::ScalarType> VDistFunct;
|
|
|
|
VDistFunct distFunct;
|
|
|
|
return (gr.GetKClosest/* <VDistFunct,MarkerVert,OBJPTRCONTAINER,DISTCONTAINER,POINTCONTAINER>*/
|
|
|
|
(distFunct,mv,_k,_p,_maxDist,_objectPtrs,_distances,_points));
|
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID, class OBJPTRCONTAINER, class DISTCONTAINER, class POINTCONTAINER>
|
|
|
|
unsigned int GetInSphereFaceBase(MESH & mesh,
|
|
|
|
GRID & gr,
|
|
|
|
const typename GRID::CoordType & _p,
|
|
|
|
const typename GRID::ScalarType & _r,
|
|
|
|
OBJPTRCONTAINER & _objectPtrs,
|
|
|
|
DISTCONTAINER & _distances,
|
|
|
|
POINTCONTAINER & _points)
|
|
|
|
{
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf;
|
|
|
|
mf.SetMesh(&mesh);
|
|
|
|
typedef vcg::face::PointDistanceBaseFunctor<typename MESH::ScalarType> FDistFunct;
|
|
|
|
return (gr.GetInSphere/*<FDistFunct,MarkerFace,OBJPTRCONTAINER,DISTCONTAINER,POINTCONTAINER>*/
|
|
|
|
(FDistFunct(),mf,_p,_r,_objectPtrs,_distances,_points));
|
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID, class OBJPTRCONTAINER, class DISTCONTAINER, class POINTCONTAINER>
|
|
|
|
unsigned int GetInSphereVertex(MESH & mesh,
|
|
|
|
GRID & gr,
|
|
|
|
const typename GRID::CoordType & _p,
|
|
|
|
const typename GRID::ScalarType & _r,
|
|
|
|
OBJPTRCONTAINER & _objectPtrs,
|
|
|
|
DISTCONTAINER & _distances,
|
|
|
|
POINTCONTAINER & _points)
|
|
|
|
{
|
2015-12-03 23:58:08 +01:00
|
|
|
typedef EmptyTMark<MESH> MarkerVert;
|
2014-04-17 10:51:53 +02:00
|
|
|
MarkerVert mv;
|
|
|
|
mv.SetMesh(&mesh);
|
|
|
|
typedef vcg::vertex::PointDistanceFunctor<typename MESH::ScalarType> VDistFunct;
|
|
|
|
VDistFunct fn;
|
|
|
|
return (gr.GetInSphere/*<VDistFunct,MarkerVert,OBJPTRCONTAINER,DISTCONTAINER,POINTCONTAINER>*/
|
|
|
|
(fn, mv,_p,_r,_objectPtrs,_distances,_points));
|
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID, class OBJPTRCONTAINER>
|
|
|
|
unsigned int GetInBoxFace(MESH & mesh,
|
|
|
|
GRID & gr,
|
|
|
|
const vcg::Box3<typename GRID::ScalarType> _bbox,
|
|
|
|
OBJPTRCONTAINER & _objectPtrs)
|
|
|
|
{
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf(&mesh);
|
|
|
|
return(gr.GetInBox/*<MarkerFace,OBJPTRCONTAINER>*/(mf,_bbox,_objectPtrs));
|
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID, class OBJPTRCONTAINER>
|
|
|
|
unsigned int GetInBoxVertex(MESH & mesh,
|
|
|
|
GRID & gr,
|
|
|
|
const vcg::Box3<typename GRID::ScalarType> _bbox,
|
|
|
|
OBJPTRCONTAINER & _objectPtrs)
|
|
|
|
{
|
2015-12-03 23:58:08 +01:00
|
|
|
typedef EmptyTMark<MESH> MarkerVert;
|
2014-04-17 10:51:53 +02:00
|
|
|
MarkerVert mv;
|
|
|
|
mv.SetMesh(&mesh);
|
|
|
|
return(gr.GetInBox/*<MarkerVert,OBJPTRCONTAINER>*/(mv,_bbox,_objectPtrs));
|
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename GRID::ObjPtr DoRay(MESH & mesh,GRID & gr, const Ray3<typename GRID::ScalarType> & _ray,
|
|
|
|
const typename GRID::ScalarType & _maxDist, typename GRID::ScalarType & _t)
|
|
|
|
{
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf;
|
|
|
|
mf.SetMesh(&mesh);
|
|
|
|
Ray3<typename GRID::ScalarType> _ray1=_ray;
|
|
|
|
_ray1.Normalize();
|
|
|
|
typedef vcg::RayTriangleIntersectionFunctor<true> FintFunct;
|
2011-04-01 18:25:49 +02:00
|
|
|
FintFunct ff;
|
|
|
|
return(gr.DoRay(ff,mf,_ray1,_maxDist,_t));
|
2014-04-17 10:51:53 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename GRID::ObjPtr DoRay(MESH & mesh,GRID & gr, const Ray3<typename GRID::ScalarType> & _ray,
|
|
|
|
const typename GRID::ScalarType & _maxDist,
|
|
|
|
typename GRID::ScalarType & _t,
|
|
|
|
typename GRID::CoordType & _normf)
|
|
|
|
{
|
|
|
|
typedef typename MESH::FaceType FaceType;
|
|
|
|
typedef typename MESH::ScalarType ScalarType;
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf;
|
|
|
|
mf.SetMesh(&mesh);
|
|
|
|
typedef vcg::RayTriangleIntersectionFunctor<true> FintFunct;
|
2011-04-01 18:25:49 +02:00
|
|
|
FintFunct fintfunct;
|
2014-04-17 10:51:53 +02:00
|
|
|
Ray3<typename GRID::ScalarType> _ray1=_ray;
|
|
|
|
_ray1.Normalize();
|
2011-04-01 18:25:49 +02:00
|
|
|
FaceType *f=gr.DoRay(fintfunct,mf,_ray1,_maxDist,_t);
|
2014-04-17 10:51:53 +02:00
|
|
|
typename GRID::CoordType dir=_ray.Direction();
|
|
|
|
dir.Normalize();
|
|
|
|
typename GRID::CoordType int_point=_ray.Origin()+_ray1.Direction()*_t;
|
|
|
|
if (f!=NULL)
|
|
|
|
{
|
2012-02-14 13:13:38 +01:00
|
|
|
Point3<typename GRID::ScalarType> bary;
|
|
|
|
InterpolationParameters<FaceType,ScalarType>(*f,f->N(),int_point, bary);
|
|
|
|
|
|
|
|
_normf = (f->V(0)->cN())*bary.X()+
|
|
|
|
(f->V(1)->cN())*bary.Y()+
|
|
|
|
(f->V(2)->cN())*bary.Z() ;
|
2014-04-17 10:51:53 +02:00
|
|
|
}
|
|
|
|
return f;
|
|
|
|
}
|
|
|
|
|
|
|
|
///Iteratively Do Ray sampling on spherical coordinates
|
|
|
|
///sampling along the two angles
|
|
|
|
template <class MESH, class GRID, class OBJPTRCONTAINER, class COORDCONTAINER>
|
|
|
|
void RaySpherical(MESH & mesh,GRID & gr, const Ray3<typename GRID::ScalarType> & _ray,
|
|
|
|
const typename GRID::ScalarType & _maxDist,
|
|
|
|
const typename GRID::ScalarType & _theta_interval,
|
|
|
|
const typename GRID::ScalarType & _phi_interval,
|
|
|
|
const int &n_samples,
|
|
|
|
OBJPTRCONTAINER & _objectPtrs,
|
|
|
|
COORDCONTAINER & _pos,
|
|
|
|
COORDCONTAINER & _norm)
|
|
|
|
{
|
|
|
|
typedef typename MESH::FaceType FaceType;
|
|
|
|
typedef typename MESH::ScalarType ScalarType;
|
|
|
|
ScalarType delta_theta=_theta_interval/(ScalarType)(n_samples*2);
|
2011-04-01 18:25:49 +02:00
|
|
|
ScalarType delta_phi =_phi_interval/(ScalarType)(n_samples*2);
|
|
|
|
ScalarType theta_init,phi_init,ro;
|
|
|
|
typename GRID::CoordType dir0=_ray.Direction();
|
|
|
|
dir0.ToPolarRad(ro,theta_init,phi_init);
|
2014-04-17 10:51:53 +02:00
|
|
|
for (int x=-n_samples;x<=n_samples;x++)
|
|
|
|
for (int y=-n_samples;y<=n_samples;y++)
|
|
|
|
{
|
|
|
|
ScalarType theta=theta_init+x*delta_theta;
|
2011-04-01 18:25:49 +02:00
|
|
|
if (theta<0) theta=2.0*M_PI-theta;
|
|
|
|
ScalarType phi=phi_init+y*delta_phi;
|
|
|
|
|
|
|
|
typename GRID::CoordType dir;
|
|
|
|
dir.FromxPolar(ro,theta,phi);
|
2014-04-17 10:51:53 +02:00
|
|
|
dir.Normalize();
|
|
|
|
Ray3<typename GRID::ScalarType> curr_ray(_ray.Origin(),dir);
|
2011-04-01 18:25:49 +02:00
|
|
|
typename GRID::ScalarType _t;
|
|
|
|
typename GRID::ObjPtr f=NULL;
|
2014-04-17 10:51:53 +02:00
|
|
|
f=DoRay(mesh,gr,curr_ray,_maxDist,_t);
|
|
|
|
if (f!=NULL)
|
|
|
|
{
|
2011-04-01 18:25:49 +02:00
|
|
|
typename GRID::CoordType pos=curr_ray.Origin()+curr_ray.Direction()*_t;
|
2014-04-17 10:51:53 +02:00
|
|
|
_objectPtrs.push_back(f);
|
|
|
|
_pos.push_back(pos);
|
|
|
|
|
|
|
|
///find the normal
|
|
|
|
typename GRID::ScalarType alfa,beta,gamma;
|
|
|
|
InterpolationParameters<FaceType,ScalarType>(*f,*f.N(),pos, alfa, beta, gamma);
|
|
|
|
typename GRID::CoordType norm = (f->V(0)->cN())*alfa+
|
|
|
|
(f->V(1)->cN())*beta+
|
|
|
|
(f->V(2)->cN())*gamma ;
|
|
|
|
_norm.push_back(norm);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
//**ITERATORS DEFINITION**//
|
|
|
|
|
|
|
|
template <class GRID,class MESH>
|
|
|
|
class ClosestFaceEPIterator:public vcg::ClosestIterator<GRID,
|
|
|
|
vcg::face::PointDistanceEPFunctor<typename MESH::ScalarType>, FaceTmark<MESH> >
|
|
|
|
{
|
|
|
|
public:
|
|
|
|
typedef GRID GridType;
|
|
|
|
typedef MESH MeshType;
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
typedef vcg::face::PointDistanceEPFunctor<typename MESH::ScalarType> PDistFunct;
|
|
|
|
typedef vcg::ClosestIterator<GRID,PDistFunct, FaceTmark<MESH> > ClosestBaseType;
|
|
|
|
typedef typename MESH::FaceType FaceType;
|
|
|
|
typedef typename MESH::ScalarType ScalarType;
|
|
|
|
|
|
|
|
//ClosestFaceIterator(GridType &_Si):ClosestBaseType(_Si,PDistFunct<FaceType,ScalarType>()){}
|
|
|
|
ClosestFaceEPIterator(GridType &_Si):ClosestBaseType(_Si,PDistFunct()){}
|
2011-04-01 18:25:49 +02:00
|
|
|
|
|
|
|
// Commented out: it seems unuseful and make gcc complain. p.
|
|
|
|
void SetMesh(MeshType *m)
|
2014-04-17 10:51:53 +02:00
|
|
|
{this->tm.SetMesh(m);}
|
|
|
|
};
|
|
|
|
|
|
|
|
template <class GRID,class MESH>
|
2015-12-03 23:58:08 +01:00
|
|
|
class ClosestVertexIterator:public vcg::ClosestIterator<GRID, vcg::vertex::PointDistanceFunctor<typename MESH::ScalarType>, EmptyTMark<MESH> >
|
2014-04-17 10:51:53 +02:00
|
|
|
{
|
|
|
|
public:
|
|
|
|
typedef GRID GridType;
|
|
|
|
typedef MESH MeshType;
|
2015-12-03 23:58:08 +01:00
|
|
|
typedef EmptyTMark<MESH> MarkerVert;
|
2014-04-17 10:51:53 +02:00
|
|
|
typedef vcg::vertex::PointDistanceFunctor<typename MESH::ScalarType> VDistFunct;
|
2015-12-03 23:58:08 +01:00
|
|
|
typedef vcg::ClosestIterator<GRID, VDistFunct, EmptyTMark<MESH> > ClosestBaseType;
|
2011-04-01 18:25:49 +02:00
|
|
|
VDistFunct fn;
|
2014-04-17 10:51:53 +02:00
|
|
|
ClosestVertexIterator(GridType &_Si):ClosestBaseType(_Si,fn){}
|
2011-04-01 18:25:49 +02:00
|
|
|
|
|
|
|
// Commented out: it seems unuseful and make gcc complain. p.
|
2014-04-17 10:51:53 +02:00
|
|
|
void SetMesh(MeshType *m)
|
|
|
|
{this->tm.SetMesh(m);}
|
|
|
|
};
|
|
|
|
|
|
|
|
template <class GRID,class MESH>
|
|
|
|
class TriRayIterator:public vcg::RayIterator<GRID,vcg::RayTriangleIntersectionFunctor<true>,FaceTmark<MESH> >
|
|
|
|
{
|
|
|
|
public:
|
|
|
|
typedef GRID GridType;
|
|
|
|
typedef MESH MeshType;
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
typedef vcg::RayTriangleIntersectionFunctor<true> FintFunct;
|
|
|
|
typedef vcg::RayIterator<GRID,FintFunct, FaceTmark<MESH> > RayBaseType;
|
|
|
|
typedef typename MESH::FaceType FaceType;
|
|
|
|
typedef typename MESH::ScalarType ScalarType;
|
|
|
|
|
|
|
|
TriRayIterator(GridType &_Si,const ScalarType &max_d):RayBaseType(_Si,FintFunct(),max_d){}
|
2011-04-01 18:25:49 +02:00
|
|
|
|
|
|
|
// Commented out: it seems unuseful and make gcc complain. p.
|
2014-04-17 10:51:53 +02:00
|
|
|
void SetMesh(MeshType *m)
|
|
|
|
{this->tm.SetMesh(m);}
|
2011-04-01 18:25:49 +02:00
|
|
|
|
2014-04-17 10:51:53 +02:00
|
|
|
};
|
2011-04-01 18:25:49 +02:00
|
|
|
|
2014-10-09 14:53:40 +02:00
|
|
|
/// this is for meshes with 2D coordinates
|
|
|
|
template <class MESH, class GRID>
|
2015-12-03 23:58:08 +01:00
|
|
|
typename MESH::EdgeType * GetClosestEdge2DBase( MESH & mesh,GRID & gr,const typename GRID::CoordType & _p,
|
2014-10-09 14:53:40 +02:00
|
|
|
const typename GRID::ScalarType _maxDist,typename GRID::ScalarType & _minDist,
|
|
|
|
typename GRID::CoordType &_closestPt)
|
|
|
|
{
|
|
|
|
typedef typename GRID::ScalarType ScalarType;
|
|
|
|
typedef FaceTmark<MESH> MarkerFace;
|
|
|
|
MarkerFace mf;
|
|
|
|
mf.SetMesh(&mesh);
|
|
|
|
vcg::PointSegment2DEPFunctor<ScalarType> PDistFunct;
|
|
|
|
_minDist=_maxDist;
|
|
|
|
return (gr.GetClosest(PDistFunct,mf,_p,_maxDist,_minDist,_closestPt));
|
|
|
|
}
|
|
|
|
|
2015-12-03 23:58:08 +01:00
|
|
|
/// this is for meshes with 3D coordinates
|
|
|
|
template <class MESH, class GRID>
|
|
|
|
typename MESH::EdgeType * GetClosestEdgeBase( MESH & mesh,GRID & gr,const typename GRID::CoordType & _p,
|
|
|
|
const typename GRID::ScalarType _maxDist,typename GRID::ScalarType & _minDist,
|
|
|
|
typename GRID::CoordType &_closestPt)
|
|
|
|
{
|
|
|
|
typedef typename GRID::ScalarType ScalarType;
|
|
|
|
typedef EmptyTMark<MESH> MarkerEdge;
|
|
|
|
MarkerEdge mf;
|
|
|
|
mf.SetMesh(&mesh);
|
|
|
|
vcg::edge::PointDistanceFunctor<ScalarType> PDistFunct;
|
|
|
|
_minDist=_maxDist;
|
|
|
|
// return (gr.GetClosest(PDistFunct,mf,_p,_maxDist,_minDist,_closestPt));
|
|
|
|
return vcg::GridClosest(gr,PDistFunct,mf, _p,_maxDist,_minDist,_closestPt);
|
|
|
|
}
|
2014-10-09 14:53:40 +02:00
|
|
|
|
2014-04-17 10:51:53 +02:00
|
|
|
} // end namespace tri
|
2011-04-01 18:25:49 +02:00
|
|
|
} // end namespace vcg
|
|
|
|
|
|
|
|
#endif
|