635 lines
20 KiB
C++
635 lines
20 KiB
C++
/****************************************************************************
|
|
* VCGLib o o *
|
|
* Visual and Computer Graphics Library o o *
|
|
* _ O _ *
|
|
* Copyright(C) 2004 \/)\/ *
|
|
* Visual Computing Lab /\/| *
|
|
* ISTI - Italian National Research Council | *
|
|
* \ *
|
|
* All rights reserved. *
|
|
* *
|
|
* This program is free software; you can redistribute it and/or modify *
|
|
* 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. *
|
|
* *
|
|
****************************************************************************/
|
|
/****************************************************************************
|
|
History
|
|
|
|
$Log: not supported by cvs2svn $
|
|
Revision 1.37 2007/07/16 15:13:39 cignoni
|
|
Splitted initialiazation functions of grid to add flexibility in the creation
|
|
|
|
Revision 1.36 2005/12/02 00:43:31 cignoni
|
|
Forgotten a base deferencing like the previous one
|
|
Note also the different possible sintax with this-> instead of the base class name
|
|
|
|
Revision 1.35 2005/12/02 00:25:13 cignoni
|
|
Added and removed typenames for gcc compiling.
|
|
Added base class qualifier for referencing the elemntes of the templated base class (BasicGrid)
|
|
it seems to be needed by the standard
|
|
|
|
Revision 1.34 2005/11/30 16:01:25 m_di_benedetto
|
|
Added std:: namespace for max() and min().
|
|
|
|
Revision 1.33 2005/11/30 10:32:44 m_di_benedetto
|
|
Added (int) cast to std::distance to prevent compiler warning message.
|
|
|
|
Revision 1.32 2005/11/10 15:44:17 cignoni
|
|
Added casts to remove warnings
|
|
|
|
Revision 1.31 2005/10/07 13:27:22 turini
|
|
Minor changes in Set method: added use of template scalar type computing BBox.
|
|
|
|
Revision 1.30 2005/10/05 17:05:08 pietroni
|
|
corrected bug on Set Function .... bbox must be exetended in order to have'nt any object on his borde
|
|
|
|
Revision 1.29 2005/10/03 13:57:56 pietroni
|
|
added GetInSphere and GetInBox functions
|
|
|
|
Revision 1.28 2005/10/02 23:15:26 cignoni
|
|
Inveted the boolean sign of an assert in Grid()
|
|
|
|
Revision 1.27 2005/09/30 15:07:28 cignoni
|
|
Reordered grid access functions
|
|
Added possibility of setting BBox explicitly in Set(...)
|
|
|
|
Revision 1.26 2005/09/30 13:15:21 pietroni
|
|
added wrapping to functions defined in GridClosest:
|
|
- GetClosest
|
|
- GetKClosest
|
|
- DoRay
|
|
|
|
Revision 1.25 2005/09/21 09:22:51 pietroni
|
|
removed closest functions. Closest function is now on index\\Closest.h
|
|
Users must use trimesh\\closest.h to perform spatial query.
|
|
|
|
Revision 1.24 2005/09/16 11:57:15 cignoni
|
|
Removed two wrong typenames
|
|
|
|
Revision 1.23 2005/09/15 13:16:42 spinelli
|
|
fixed bugs
|
|
|
|
Revision 1.22 2005/09/15 11:14:39 pietroni
|
|
minor changes
|
|
|
|
Revision 1.21 2005/09/14 13:27:38 spinelli
|
|
minor changes
|
|
|
|
Revision 1.20 2005/09/14 12:57:52 pietroni
|
|
canged template parameters for Closest Function (use of TempMark class)
|
|
|
|
Revision 1.19 2005/09/14 09:05:32 pietroni
|
|
added * operator to Link
|
|
modified getClosest in order to use Temporary mark
|
|
corrected bug on functor calling compilation
|
|
|
|
Revision 1.18 2005/09/09 11:29:21 m_di_benedetto
|
|
Modified old GetClosest() to respect old min_dist semantic (in/out) and removed #included <limits>
|
|
|
|
Revision 1.17 2005/09/09 11:11:15 m_di_benedetto
|
|
#included <limits> for std::numeric_limits<ScalarType>::max() and corrected parameters bug in old GetClosest();
|
|
|
|
Revision 1.16 2005/09/09 11:01:02 m_di_benedetto
|
|
Modified GetClosest(): now it uses a functor for distance calculation.
|
|
Added comments and a GetClosest() method with backward compatibility.
|
|
|
|
Revision 1.15 2005/08/26 09:27:58 cignoni
|
|
Added a templated version of SetBBox
|
|
|
|
Revision 1.14 2005/08/02 11:18:36 pietroni
|
|
exetended form BasicGrid, changed type of t in class Link (from Iterator to Pointer to the object)
|
|
|
|
Revision 1.13 2005/04/14 17:23:08 ponchio
|
|
*** empty log message ***
|
|
|
|
Revision 1.12 2005/03/15 11:43:18 cignoni
|
|
Removed BestDim function from the grid_static_ptr class and moved to a indipendent file (grid_util.h) for sake of generality.
|
|
|
|
Revision 1.11 2005/01/03 11:21:26 cignoni
|
|
Added some casts
|
|
|
|
Revision 1.10 2004/09/28 10:25:05 ponchio
|
|
SetBox minimal change.
|
|
|
|
Revision 1.9 2004/09/23 14:29:42 ponchio
|
|
Small bugs fixed.
|
|
|
|
Revision 1.8 2004/09/23 13:44:25 ponchio
|
|
Removed SetSafeBBox. SetBBox is now safe enough.
|
|
|
|
Revision 1.7 2004/09/09 12:44:39 fasano
|
|
included stdio.h
|
|
|
|
Revision 1.6 2004/09/09 08:39:29 ganovelli
|
|
minor changes for gcc
|
|
|
|
Revision 1.5 2004/06/25 18:34:23 ganovelli
|
|
added Grid to return all the cells sharing a specified edge
|
|
|
|
Revision 1.4 2004/06/23 15:49:03 ponchio
|
|
Added some help and inndentation
|
|
|
|
Revision 1.3 2004/05/12 18:50:58 ganovelli
|
|
changed calls to Dist
|
|
|
|
Revision 1.2 2004/05/11 14:33:46 ganovelli
|
|
changed to grid_static_obj to grid_static_ptr
|
|
|
|
Revision 1.1 2004/05/10 14:44:13 ganovelli
|
|
created
|
|
|
|
Revision 1.1 2004/03/08 09:21:31 cignoni
|
|
Initial commit
|
|
|
|
****************************************************************************/
|
|
|
|
#ifndef __VCGLIB_UGRID
|
|
#define __VCGLIB_UGRID
|
|
|
|
#include <vector>
|
|
#include <algorithm>
|
|
#include <stdio.h>
|
|
|
|
#include <vcg/space/box3.h>
|
|
#include <vcg/space/line3.h>
|
|
#include <vcg/space/index/grid_util.h>
|
|
#include <vcg/space/index/grid_closest.h>
|
|
#include <vcg/simplex/face/distance.h>
|
|
|
|
namespace vcg {
|
|
|
|
/** Static Uniform Grid
|
|
A spatial search structure for a accessing a container of objects.
|
|
It is based on a uniform grid overlayed over a protion of space.
|
|
The grid partion the space into cells. Cells contains just pointers
|
|
to the object that are stored elsewhere.
|
|
The set of objects is meant to be static and pointer stable.
|
|
|
|
Useful for situation were many space related query are issued over
|
|
the same dataset (ray tracing, measuring distances between meshes,
|
|
re-detailing ecc.).
|
|
Works well for distribution that ar reasonably uniform.
|
|
How to use it:
|
|
ContainerType must have a 'value_type' typedef inside.
|
|
(stl containers already have it)
|
|
|
|
Objects pointed by cells (of kind 'value_type') must have
|
|
a 'ScalarType' typedef (float or double usually)
|
|
and a member function:
|
|
|
|
void GetBBox(Box3<ScalarType> &b)
|
|
which return the bounding box of the object
|
|
|
|
When using the GetClosest() method, the user must supply a functor object
|
|
(whose type is a method template argument) which expose the following
|
|
operator ():
|
|
|
|
bool operator () (const ObjType & obj, const Point3f & point, ScalarType & mindist, Point3f & result);
|
|
which return true if the distance from point to the object 'obj' is < mindist
|
|
and set mindist to said distance, and result must be set as the closest
|
|
point of the object to point)
|
|
*/
|
|
|
|
template < class OBJTYPE, class FLT=float >
|
|
class GridStaticPtr: public BasicGrid<FLT>, SpatialIndex<OBJTYPE,FLT>
|
|
{
|
|
public:
|
|
typedef OBJTYPE ObjType;
|
|
typedef ObjType* ObjPtr;
|
|
typedef typename ObjType::ScalarType ScalarType;
|
|
typedef Point3<ScalarType> CoordType;
|
|
typedef Box3<ScalarType> Box3x;
|
|
typedef Line3<ScalarType> Line3x;
|
|
typedef GridStaticPtr<OBJTYPE,FLT> GridPtrType;
|
|
typedef BasicGrid<FLT> BT;
|
|
|
|
/** Internal class for keeping the first pointer of object.
|
|
Definizione Link dentro la griglia. Classe di supporto per GridStaticObj.
|
|
*/
|
|
class Link
|
|
{
|
|
public:
|
|
/// Costruttore di default
|
|
inline Link(){};
|
|
/// Costruttore con inizializzatori
|
|
inline Link(ObjPtr nt, const int ni ){
|
|
assert(ni>=0);
|
|
t = nt;
|
|
i = ni;
|
|
};
|
|
|
|
|
|
inline bool operator < ( const Link & l ) const{ return i < l.i; }
|
|
inline bool operator <= ( const Link & l ) const{ return i <= l.i; }
|
|
inline bool operator > ( const Link & l ) const{ return i > l.i; }
|
|
inline bool operator >= ( const Link & l ) const{ return i >= l.i; }
|
|
inline bool operator == ( const Link & l ) const{ return i == l.i; }
|
|
inline bool operator != ( const Link & l ) const{ return i != l.i; }
|
|
|
|
inline ObjPtr & Elem() {
|
|
return t;
|
|
}
|
|
|
|
ObjType &operator *(){return *(t);}
|
|
|
|
inline int & Index() {
|
|
return i;
|
|
}
|
|
|
|
private:
|
|
/// Puntatore all'elemento T
|
|
ObjPtr t;
|
|
/// Indirizzo del voxel dentro la griglia
|
|
int i;
|
|
|
|
|
|
};//end class Link
|
|
|
|
typedef Link* Cell;
|
|
typedef Cell CellIterator;
|
|
|
|
std::vector<Link> links; /// Insieme di tutti i links
|
|
|
|
std::vector<Cell> grid; /// Griglia vera e propria
|
|
|
|
|
|
|
|
|
|
/// Date le coordinate di un grid point (corner minx,miy,minz) ritorna le celle che condividono
|
|
/// l'edge cell che parte dal grid point in direzione axis
|
|
inline void Grid( Point3i p, const int axis,
|
|
std::vector<Cell*> & cl)
|
|
{
|
|
#ifndef NDEBUG
|
|
if ( p[0]<0 || p[0] > BT::siz[0] ||
|
|
p[1]<0 || p[1]> BT::siz[1] ||
|
|
p[2]<0 || p[2]> BT::siz[2] )
|
|
assert(0);
|
|
//return NULL;
|
|
else
|
|
#endif
|
|
assert(((unsigned int) p[0]+BT::siz[0]*p[1]+BT::siz[1]*p[2])<grid.size());
|
|
|
|
int axis0 = (axis+1)%3;
|
|
int axis1 = (axis+2)%3;
|
|
int i,j,x,y;
|
|
x = p[axis0];
|
|
y = p[axis1];
|
|
for(i = std::max(x-1,0); i <= std::min( x,BT::siz[axis0]-1);++i)
|
|
for(j = std::max(y-1,0); j <= std::min( y,this->siz[axis1]-1);++j){
|
|
p[axis0]=i;
|
|
p[axis1]=j;
|
|
cl.push_back(Grid(p[0]+BT::siz[0]*(p[1]+BT::siz[1]*p[2])));
|
|
}
|
|
}
|
|
|
|
|
|
////////////////
|
|
// Official access functions
|
|
////////////////
|
|
/// BY CELL
|
|
Cell* Grid(const int i) {
|
|
return &grid[i];
|
|
}
|
|
|
|
void Grid( const Cell* g, Cell & first, Cell & last )
|
|
{
|
|
first = *g;
|
|
last = *(g+1);
|
|
}
|
|
|
|
/// BY INTEGER COORDS
|
|
inline Cell* Grid( const int x, const int y, const int z )
|
|
{
|
|
assert(!( x<0 || x>=BT::siz[0] || y<0 || y>=BT::siz[1] || z<0 || z>=BT::siz[2] ));
|
|
assert(grid.size()>0);
|
|
return &*grid.begin() + ( x+BT::siz[0]*(y+BT::siz[1]*z) );
|
|
}
|
|
|
|
inline Cell* Grid( const Point3i &pi)
|
|
{
|
|
return Grid(pi[0],pi[1],pi[2]);
|
|
}
|
|
|
|
void Grid( const int x, const int y, const int z, Cell & first, Cell & last )
|
|
{
|
|
Cell* g = Grid(x,y,z);
|
|
first = *g;
|
|
last = *(g+1);
|
|
}
|
|
|
|
void Grid( const Point3<ScalarType> & p, Cell & first, Cell & last )
|
|
{
|
|
Cell* g = Grid(GridP(p));
|
|
|
|
first = *g;
|
|
last = *(g+1);
|
|
}
|
|
|
|
|
|
/// Set the bounding box of the grid
|
|
///We need some extra space for numerical precision.
|
|
template <class Box3Type>
|
|
void SetBBox( const Box3Type & b )
|
|
{
|
|
this->bbox.Import( b );
|
|
ScalarType t = this->bbox.Diag()/100.0;
|
|
if(t == 0) t = ScalarType(1e-20); // <--- Some doubts on this (Cigno 5/1/04)
|
|
this->bbox.Offset(t);
|
|
this->dim = this->bbox.max - this->bbox.min;
|
|
}
|
|
|
|
|
|
|
|
void ShowStats(FILE *fp)
|
|
{
|
|
// Conto le entry
|
|
//int nentry = 0;
|
|
//Hist H;
|
|
//H.SetRange(0,1000,1000);
|
|
//int pg;
|
|
//for(pg=0;pg<grid.size()-1;++pg)
|
|
// if( grid[pg]!=grid[pg+1] )
|
|
// {
|
|
// ++nentry;
|
|
// H.Add(grid[pg+1]-grid[pg]);
|
|
// }
|
|
|
|
// fprintf(fp,"Uniform Grid: %d x %d x %d (%d voxels), %.1f%% full, %d links \nNon empty Cell Occupancy Distribution Avg: %f (%4.0f %4.0f %4.0f) \n",
|
|
// siz[0],siz[1],siz[2],grid.size()-1,
|
|
// double(nentry)*100.0/(grid.size()-1),links.size(),H.Avg(),H.Percentile(.25),H.Percentile(.5),H.Percentile(.75)
|
|
//
|
|
//);
|
|
}
|
|
|
|
template <class OBJITER>
|
|
inline void Set(const OBJITER & _oBegin, const OBJITER & _oEnd)
|
|
{
|
|
Box3<FLT> _bbox;
|
|
Box3<FLT> b;
|
|
OBJITER i;
|
|
for(i = _oBegin; i!= _oEnd; ++i)
|
|
{
|
|
(*i).GetBBox(b);
|
|
_bbox.Add(b);
|
|
}
|
|
///inflate the bb calculated
|
|
int _size=(int)std::distance<OBJITER>(_oBegin,_oEnd);
|
|
ScalarType infl=_bbox.Diag()/_size;
|
|
_bbox.min-=vcg::Point3<FLT>(infl,infl,infl);
|
|
_bbox.max+=vcg::Point3<FLT>(infl,infl,infl);
|
|
|
|
Set(_oBegin,_oEnd,_bbox);
|
|
}
|
|
|
|
|
|
|
|
// This function automatically compute a reasonable size for the uniform grid providing the side (radius) of the cell
|
|
//
|
|
// Note that the bbox must be already 'inflated' so to be sure that no object will fall on the border of the grid.
|
|
|
|
template <class OBJITER>
|
|
inline void Set(const OBJITER & _oBegin, const OBJITER & _oEnd, const Box3x &_bbox, FLT radius)
|
|
{
|
|
Point3i _siz;
|
|
Point3<FLT> _dim = _bbox.max - _bbox.min;
|
|
_dim/=radius;
|
|
assert(_dim[0]>0 && _dim[1]>0 && _dim[2]>0 );
|
|
_siz[0] = (int)ceil(_dim[0]);
|
|
_siz[1] = (int)ceil(_dim[1]);
|
|
_siz[2] = (int)ceil(_dim[2]);
|
|
|
|
Point3<FLT> offset=Point3<FLT>::Construct(_siz);
|
|
offset*=radius;
|
|
offset -= (_bbox.max - _bbox.min);
|
|
offset /=2;
|
|
|
|
assert( offset[0]>=0 && offset[1]>=0 && offset[2]>=0 );
|
|
|
|
Box3x bb = _bbox;
|
|
bb.min -= offset;
|
|
bb.max += offset;
|
|
|
|
Set(_oBegin,_oEnd, bb,_siz);
|
|
}
|
|
|
|
|
|
// This function automatically compute a reasonable size for the uniform grid such that the number of cells is
|
|
// the same of the nubmer of elements to be inserted in the grid.
|
|
//
|
|
// Note that the bbox must be already 'inflated' so to be sure that no object will fall on the border of the grid.
|
|
|
|
template <class OBJITER>
|
|
inline void Set(const OBJITER & _oBegin, const OBJITER & _oEnd, const Box3x &_bbox)
|
|
{
|
|
int _size=(int)std::distance<OBJITER>(_oBegin,_oEnd);
|
|
Point3<FLT> _dim = _bbox.max - _bbox.min;
|
|
Point3i _siz;
|
|
BestDim( _size, _dim, _siz );
|
|
|
|
Set(_oBegin,_oEnd,_bbox,_siz);
|
|
}
|
|
|
|
|
|
template <class OBJITER>
|
|
inline void Set(const OBJITER & _oBegin, const OBJITER & _oEnd, const Box3x &_bbox, Point3i _siz)
|
|
{
|
|
OBJITER i;
|
|
|
|
this->bbox=_bbox;
|
|
this->siz=_siz;
|
|
|
|
// find voxel size starting from the provided bbox and grid size.
|
|
|
|
this->dim = this->bbox.max - this->bbox.min;
|
|
this->voxel[0] = this->dim[0]/this->siz[0];
|
|
this->voxel[1] = this->dim[1]/this->siz[1];
|
|
this->voxel[2] = this->dim[2]/this->siz[2];
|
|
|
|
// "Alloca" la griglia: +1 per la sentinella
|
|
grid.resize( this->siz[0]*this->siz[1]*this->siz[2]+1 );
|
|
|
|
// Ciclo inserimento dei tetraedri: creazione link
|
|
links.clear();
|
|
for(i=_oBegin; i!=_oEnd; ++i)
|
|
{
|
|
Box3x bb; // Boundig box del tetraedro corrente
|
|
(*i).GetBBox(bb);
|
|
bb.Intersect(this->bbox);
|
|
if(! bb.IsNull() )
|
|
{
|
|
|
|
Box3i ib; // Boundig box in voxels
|
|
this->BoxToIBox( bb,ib );
|
|
int x,y,z;
|
|
for(z=ib.min[2];z<=ib.max[2];++z)
|
|
{
|
|
int bz = z*this->siz[1];
|
|
for(y=ib.min[1];y<=ib.max[1];++y)
|
|
{
|
|
int by = (y+bz)*this->siz[0];
|
|
for(x=ib.min[0];x<=ib.max[0];++x)
|
|
// Inserire calcolo cella corrente
|
|
// if( pt->Intersect( ... )
|
|
links.push_back( Link(&(*i),by+x) );
|
|
}
|
|
}
|
|
}
|
|
}
|
|
// Push della sentinella
|
|
/*links.push_back( Link((typename ContainerType::iterator)NULL,
|
|
(grid.size()-1)));*/
|
|
|
|
links.push_back( Link( NULL, int(grid.size())-1) );
|
|
|
|
// Ordinamento dei links
|
|
sort( links.begin(), links.end() );
|
|
|
|
// Creazione puntatori ai links
|
|
typename std::vector<Link>::iterator pl;
|
|
unsigned int pg;
|
|
pl = links.begin();
|
|
for(pg=0;pg<grid.size();++pg)
|
|
{
|
|
assert(pl!=links.end());
|
|
grid[pg] = &*pl;
|
|
while( (int)pg == pl->Index() ) // Trovato inizio
|
|
{
|
|
++pl; // Ricerca prossimo blocco
|
|
if(pl==links.end())
|
|
break;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
|
|
int MemUsed()
|
|
{
|
|
return sizeof(GridStaticPtr)+ sizeof(Link)*links.size() +
|
|
sizeof(Cell) * grid.size();
|
|
}
|
|
|
|
template <class OBJPOINTDISTFUNCTOR, class OBJMARKER>
|
|
ObjPtr GetClosest(OBJPOINTDISTFUNCTOR & _getPointDistance, OBJMARKER & _marker,
|
|
const CoordType & _p, const ScalarType & _maxDist,ScalarType & _minDist, CoordType & _closestPt)
|
|
{
|
|
return (vcg::GridClosest<GridPtrType,OBJPOINTDISTFUNCTOR,OBJMARKER>(*this,_getPointDistance,_marker, _p,_maxDist,_minDist,_closestPt));
|
|
}
|
|
|
|
|
|
template <class OBJPOINTDISTFUNCTOR, class OBJMARKER, class OBJPTRCONTAINER,class DISTCONTAINER, class POINTCONTAINER>
|
|
unsigned int GetKClosest(OBJPOINTDISTFUNCTOR & _getPointDistance,OBJMARKER & _marker,
|
|
const unsigned int _k, const CoordType & _p, const ScalarType & _maxDist,OBJPTRCONTAINER & _objectPtrs,
|
|
DISTCONTAINER & _distances, POINTCONTAINER & _points)
|
|
{
|
|
return (vcg::GridGetKClosest<GridPtrType,
|
|
OBJPOINTDISTFUNCTOR,OBJMARKER,OBJPTRCONTAINER,DISTCONTAINER,POINTCONTAINER>(*this,_getPointDistance,_marker,_k,_p,_maxDist,_objectPtrs,_distances,_points));
|
|
}
|
|
|
|
template <class OBJPOINTDISTFUNCTOR, class OBJMARKER, class OBJPTRCONTAINER, class DISTCONTAINER, class POINTCONTAINER>
|
|
unsigned int GetInSphere(OBJPOINTDISTFUNCTOR & _getPointDistance,
|
|
OBJMARKER & _marker,
|
|
const CoordType & _p,
|
|
const ScalarType & _r,
|
|
OBJPTRCONTAINER & _objectPtrs,
|
|
DISTCONTAINER & _distances,
|
|
POINTCONTAINER & _points)
|
|
{
|
|
return(vcg::GridGetInSphere<GridPtrType,
|
|
OBJPOINTDISTFUNCTOR,OBJMARKER,OBJPTRCONTAINER,DISTCONTAINER,POINTCONTAINER>
|
|
(*this,_getPointDistance,_marker,_p,_r,_objectPtrs,_distances,_points));
|
|
}
|
|
|
|
template <class OBJMARKER, class OBJPTRCONTAINER>
|
|
unsigned int GetInBox(OBJMARKER & _marker,
|
|
const vcg::Box3<ScalarType> _bbox,
|
|
OBJPTRCONTAINER & _objectPtrs)
|
|
{
|
|
return(vcg::GridGetInBox<GridPtrType,OBJMARKER,OBJPTRCONTAINER>
|
|
(*this,_marker,_bbox,_objectPtrs));
|
|
}
|
|
|
|
template <class OBJRAYISECTFUNCTOR, class OBJMARKER>
|
|
ObjPtr DoRay(OBJRAYISECTFUNCTOR & _rayIntersector, OBJMARKER & _marker, const Ray3<ScalarType> & _ray, const ScalarType & _maxDist, ScalarType & _t)
|
|
{
|
|
return(vcg::GridDoRay<GridPtrType,OBJRAYISECTFUNCTOR,OBJMARKER>(*this,_rayIntersector,_marker,_ray,_maxDist,_t));
|
|
}
|
|
|
|
/* If the grid has a cubic voxel of side <radius> this function
|
|
process all couple of elementes in neighbouring cells.
|
|
GATHERFUNCTOR needs to expose this method:
|
|
bool operator()(OBJTYPE *v1, OBJTYPE *v2);
|
|
which is then called ONCE per unordered pair v1,v2.
|
|
example:
|
|
|
|
struct GFunctor {
|
|
double radius2, iradius2;
|
|
GFunctor(double radius) { radius2 = radius*radius; iradius2 = 1/radius2; }
|
|
|
|
bool operator()(CVertex *v1, CVertex *v2) {
|
|
Point3d &p = v1->P();
|
|
Point3d &q = v2->P();
|
|
double dist2 = (p-q).SquaredNorm();
|
|
if(dist2 < radius2) {
|
|
double w = exp(dist2*iradius2);
|
|
//do something
|
|
}
|
|
}
|
|
}; */
|
|
|
|
template <class GATHERFUNCTOR>
|
|
void Gather(GATHERFUNCTOR gfunctor) {
|
|
static int corner[8*3] = { 0, 0, 0, 1, 0, 0, 0, 1, 0, 0, 0, 1,
|
|
0, 1, 1, 1, 0, 1, 1, 1, 0, 1, 1, 1 };
|
|
|
|
static int diagonals[14*2] = { 0, 0,
|
|
0, 1, 0, 2, 0, 3, 0, 4, 0, 5, 0, 6, 0, 7,
|
|
2, 3, 1, 3, 1, 2,
|
|
1, 4, 2, 5, 3, 6 };
|
|
|
|
Cell ostart, oend, dstart, dend;
|
|
for(int z = 0; z < this->siz[2]; z++) {
|
|
for(int y = 0; y < this->siz[1]; y++) {
|
|
for(int x = 0; x < this->siz[0]; x++) {
|
|
|
|
Grid(x, y, z, ostart, oend);
|
|
|
|
for(Cell c = ostart; c != oend; c++)
|
|
for(Cell s = c+1; s != oend; s++)
|
|
gfunctor(c->Elem(), s->Elem());
|
|
|
|
for(int d = 2; d < 28; d += 2) { //skipping self
|
|
int *cs = corner + 3*diagonals[d];
|
|
int *ce = corner + 3*diagonals[d+1];
|
|
if((x + cs[0] < this->siz[0]) && (y + cs[1] < this->siz[1]) && (z + cs[2] < this->siz[2]) &&
|
|
(x + ce[0] < this->siz[0]) && (y + ce[1] < this->siz[1]) && (z + ce[2] < this->siz[2])) {
|
|
|
|
Grid(x+cs[0], y+cs[1], z+cs[2], ostart, oend);
|
|
Grid(x+ce[0], y+ce[1], z+ce[2], dstart, dend);
|
|
|
|
for(Cell c = ostart; c != oend; c++)
|
|
for(Cell s = dstart; s != dend; s++)
|
|
gfunctor(c->Elem(), s->Elem());
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
}; //end class GridStaticPtr
|
|
|
|
} // end namespace
|
|
|
|
#endif
|