2006-09-21 20:10:05 +02:00
|
|
|
/****************************************************************************
|
|
|
|
* 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. *
|
|
|
|
* *
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
* This program is free software; you can redistribute it and/or modify *
|
2006-09-21 20:10:05 +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_SPACE_NORMAL_EXTRAPOLATION_H
|
|
|
|
#define VCG_SPACE_NORMAL_EXTRAPOLATION_H
|
|
|
|
|
|
|
|
#include <vcg/math/matrix33.h>
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
#include <vcg/math/linear.h>
|
2006-09-21 20:10:05 +02:00
|
|
|
#include <vcg/math/lin_algebra.h>
|
2006-10-13 12:38:09 +02:00
|
|
|
#include <vcg/math/disjoint_set.h>
|
2006-09-21 20:10:05 +02:00
|
|
|
#include <vcg/space/box3.h>
|
|
|
|
#include <vcg/space/point3.h>
|
|
|
|
#include <vcg/space/index/octree.h>
|
2006-10-13 12:38:09 +02:00
|
|
|
#include <wrap/callback.h>
|
2006-09-21 20:10:05 +02:00
|
|
|
|
|
|
|
#include <vector>
|
|
|
|
#include <queue>
|
|
|
|
#include <algorithm>
|
|
|
|
#include <limits>
|
|
|
|
#include <stdlib.h>
|
|
|
|
|
|
|
|
namespace vcg
|
|
|
|
{
|
|
|
|
/*!
|
|
|
|
*/
|
|
|
|
template < class VERTEX_CONTAINER >
|
|
|
|
class NormalExtrapolation
|
|
|
|
{
|
|
|
|
public:
|
2006-10-16 18:10:22 +02:00
|
|
|
typedef typename VERTEX_CONTAINER::value_type VertexType;
|
|
|
|
typedef VertexType * VertexPointer;
|
|
|
|
typedef typename VERTEX_CONTAINER::iterator VertexIterator;
|
|
|
|
typedef typename VertexType::CoordType CoordType;
|
|
|
|
typedef typename VertexType::NormalType NormalType;
|
|
|
|
typedef typename VertexType::ScalarType ScalarType;
|
|
|
|
typedef typename vcg::Box3< ScalarType > BoundingBoxType;
|
|
|
|
typedef typename vcg::Matrix33<ScalarType> MatrixType;
|
2006-09-21 20:10:05 +02:00
|
|
|
|
|
|
|
enum NormalOrientation {IsCorrect=0, MustBeFlipped=1};
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
|
2006-10-16 18:10:22 +02:00
|
|
|
private:
|
|
|
|
/*************************************************
|
2006-09-21 20:10:05 +02:00
|
|
|
* Inner class definitions
|
|
|
|
**************************************************/
|
|
|
|
// Dummy class: no object marker is needed
|
|
|
|
class DummyObjectMarker {};
|
|
|
|
|
|
|
|
// Object functor: compute the distance between a vertex and a point
|
|
|
|
struct VertPointDistanceFunctor
|
|
|
|
{
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
inline bool operator()(const VertexType &v, const CoordType &p, ScalarType &d, CoordType &q) const
|
|
|
|
{
|
|
|
|
ScalarType distance = vcg::Distance(p, v.P());
|
|
|
|
if (distance>d)
|
2006-09-21 20:10:05 +02:00
|
|
|
return false;
|
|
|
|
|
|
|
|
d = distance;
|
|
|
|
q = v.P();
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
};
|
|
|
|
// Plane structure: identify a plain as a <center, normal> pair
|
|
|
|
struct Plane
|
|
|
|
{
|
2008-10-27 15:48:14 +01:00
|
|
|
Plane() { center.SetZero(); normal.SetZero();};
|
2006-10-12 13:02:37 +02:00
|
|
|
|
|
|
|
// Object functor: return the bounding-box enclosing a given plane
|
|
|
|
inline void GetBBox(BoundingBoxType &bb) { bb.Set(center); };
|
|
|
|
|
2006-09-21 20:10:05 +02:00
|
|
|
CoordType center;
|
|
|
|
NormalType normal;
|
|
|
|
int index;
|
|
|
|
};
|
|
|
|
|
|
|
|
// Object functor: compute the distance between a point and the plane
|
|
|
|
struct PlanePointDistanceFunctor
|
|
|
|
{
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
inline bool operator()(const Plane &plane, const CoordType &p, ScalarType &d, CoordType &q) const
|
|
|
|
{
|
|
|
|
ScalarType distance = vcg::Distance(p, plane.center);
|
|
|
|
if (distance>d)
|
2006-09-21 20:10:05 +02:00
|
|
|
return false;
|
|
|
|
|
|
|
|
d = distance;
|
|
|
|
q = plane.center;
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
};
|
|
|
|
|
|
|
|
// Represent an edge in the Riemannian graph
|
|
|
|
struct RiemannianEdge
|
|
|
|
{
|
|
|
|
RiemannianEdge(Plane *p=NULL, ScalarType w=std::numeric_limits<ScalarType>::max()) {plane=p; weight=w; }
|
|
|
|
|
|
|
|
Plane *plane;
|
|
|
|
ScalarType weight;
|
|
|
|
};
|
|
|
|
// Represent an edge in the MST tree
|
|
|
|
struct MSTEdge
|
|
|
|
{
|
|
|
|
MSTEdge(Plane *p0=NULL, Plane *p1=NULL, ScalarType w=std::numeric_limits<ScalarType>::max()) {u=p0; v=p1; weight=w;};
|
|
|
|
inline bool operator<(const MSTEdge &e) const {return weight<e.weight;}
|
|
|
|
|
|
|
|
Plane *u;
|
|
|
|
Plane *v;
|
|
|
|
ScalarType weight;
|
|
|
|
};
|
|
|
|
// Represent a node in the MST tree
|
|
|
|
struct MSTNode
|
|
|
|
{
|
|
|
|
MSTNode(MSTNode* p=NULL) {parent=p;}
|
|
|
|
|
|
|
|
MSTNode *parent;
|
|
|
|
VertexPointer vertex;
|
|
|
|
std::vector< MSTNode* > sons;
|
|
|
|
};
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
|
2006-10-16 18:10:22 +02:00
|
|
|
typedef std::vector< Plane > PlaneContainer;
|
|
|
|
typedef typename PlaneContainer::iterator PlaneIterator;
|
|
|
|
|
|
|
|
public:
|
|
|
|
/*!
|
|
|
|
*/
|
|
|
|
static void ExtrapolateNormals(const VertexIterator &begin, const VertexIterator &end, const unsigned int k, const int root_index=-1, NormalOrientation orientation=IsCorrect, CallBackPos *callback=NULL)
|
|
|
|
{
|
2006-09-21 20:10:05 +02:00
|
|
|
BoundingBoxType dataset_bb;
|
|
|
|
for (VertexIterator iter=begin; iter!=end; iter++)
|
|
|
|
dataset_bb.Add(iter->P());
|
2007-06-20 11:26:42 +02:00
|
|
|
ScalarType max_distance = dataset_bb.Diag();
|
2006-09-21 20:10:05 +02:00
|
|
|
|
|
|
|
// Step 1: identify the tangent planes used to locally approximate the surface
|
|
|
|
int vertex_count = int( std::distance(begin, end) );
|
2006-10-13 12:38:09 +02:00
|
|
|
int step = int(vertex_count/100)-1;
|
|
|
|
int progress = 0;
|
|
|
|
int percentage;
|
|
|
|
char message[128];
|
|
|
|
sprintf(message, "Locating tangent planes...");
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
std::vector< Plane > tangent_planes(vertex_count);
|
2006-09-21 20:10:05 +02:00
|
|
|
vcg::Octree< VertexType, ScalarType > octree_for_planes;
|
2006-10-16 18:10:22 +02:00
|
|
|
octree_for_planes.Set( begin, end );
|
2006-09-21 20:10:05 +02:00
|
|
|
|
|
|
|
std::vector< VertexPointer > nearest_vertices;
|
|
|
|
std::vector< CoordType > nearest_points;
|
|
|
|
std::vector< ScalarType > distances;
|
|
|
|
for (VertexIterator iter=begin; iter!=end; iter++)
|
|
|
|
{
|
2006-10-13 12:38:09 +02:00
|
|
|
if (callback!=NULL && (++progress%step)==0 && (percentage=int((progress*100)/vertex_count))<100) (callback)(percentage, message);
|
2006-10-18 10:32:03 +02:00
|
|
|
VertPointDistanceFunctor vpdf;
|
|
|
|
DummyObjectMarker dom;
|
|
|
|
octree_for_planes.GetKClosest(vpdf, dom, k, iter->P(), max_distance, nearest_vertices, distances, nearest_points);
|
2006-09-21 20:10:05 +02:00
|
|
|
|
|
|
|
// for each vertex *iter, compute the centroid as avarege of the k-nearest vertices of *iter
|
|
|
|
Plane *plane = &tangent_planes[ std::distance(begin, iter) ];
|
2006-11-07 18:22:53 +01:00
|
|
|
for (unsigned int n=0; n<k; n++)
|
2006-09-21 20:10:05 +02:00
|
|
|
plane->center += nearest_points[n];
|
2007-06-20 11:26:42 +02:00
|
|
|
plane->center /= ScalarType(k);
|
2006-09-21 20:10:05 +02:00
|
|
|
|
|
|
|
// then, identity the normal associated to the centroid
|
|
|
|
MatrixType covariance_matrix;
|
|
|
|
CoordType diff;
|
|
|
|
covariance_matrix.SetZero();
|
2006-11-07 18:22:53 +01:00
|
|
|
for (unsigned int n=0; n<k; n++)
|
2006-09-21 20:10:05 +02:00
|
|
|
{
|
|
|
|
diff = nearest_points[n] - plane->center;
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
for (int i=0; i<3; i++)
|
|
|
|
for (int j=0; j<3; j++)
|
2006-09-21 20:10:05 +02:00
|
|
|
covariance_matrix[i][j]+=diff[i]*diff[j];
|
|
|
|
}
|
|
|
|
|
|
|
|
CoordType eigenvalues;
|
|
|
|
MatrixType eigenvectors;
|
|
|
|
int required_rotations;
|
|
|
|
vcg::Jacobi< MatrixType, CoordType >(covariance_matrix, eigenvalues, eigenvectors, required_rotations);
|
|
|
|
vcg::SortEigenvaluesAndEigenvectors< MatrixType, CoordType >(eigenvalues, eigenvectors);
|
|
|
|
for (int d=0; d<3; d++)
|
|
|
|
plane->normal[d] = eigenvectors[d][2];
|
|
|
|
plane->normal.Normalize();
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
iter->N() = plane->normal;
|
2006-09-21 20:10:05 +02:00
|
|
|
plane->index = int( std::distance(begin, iter) );
|
|
|
|
}
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
|
2006-09-21 20:10:05 +02:00
|
|
|
// Step 2: build the Riemannian graph, i.e. the graph where each point is connected to the k-nearest neigbours.
|
|
|
|
dataset_bb.SetNull();
|
2006-10-16 18:10:22 +02:00
|
|
|
PlaneIterator ePlane = tangent_planes.end();
|
|
|
|
for (PlaneIterator iPlane=tangent_planes.begin(); iPlane!=ePlane; iPlane++)
|
2006-09-21 20:10:05 +02:00
|
|
|
dataset_bb.Add(iPlane->center);
|
|
|
|
max_distance = dataset_bb.Diag();
|
|
|
|
|
|
|
|
vcg::Octree< Plane, ScalarType > octree_for_plane;
|
2006-10-16 18:10:22 +02:00
|
|
|
octree_for_plane.Set( tangent_planes.begin(), tangent_planes.end());
|
2006-09-21 20:10:05 +02:00
|
|
|
std::vector< Plane* > nearest_planes(distances.size());
|
|
|
|
std::vector< std::vector< RiemannianEdge > > riemannian_graph(vertex_count); //it's probably that we are wasting the last position...
|
2006-10-13 12:38:09 +02:00
|
|
|
progress = 0;
|
|
|
|
sprintf(message, "Building Riemannian graph...");
|
2006-10-16 18:10:22 +02:00
|
|
|
for (PlaneIterator iPlane=tangent_planes.begin(); iPlane!=ePlane; iPlane++)
|
2006-09-21 20:10:05 +02:00
|
|
|
{
|
2006-10-13 12:38:09 +02:00
|
|
|
if (callback!=NULL && (++progress%step)==0 && (percentage=int((progress*100)/vertex_count))<100) (callback)(percentage, message);
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
|
2006-10-16 18:10:22 +02:00
|
|
|
unsigned int kk = k;
|
2006-10-18 10:32:03 +02:00
|
|
|
PlanePointDistanceFunctor ppdf;
|
|
|
|
DummyObjectMarker dom;
|
2006-10-16 18:10:22 +02:00
|
|
|
octree_for_plane.GetKClosest
|
2006-10-18 10:32:03 +02:00
|
|
|
(ppdf, dom, kk, iPlane->center, max_distance, nearest_planes, distances, nearest_points, true, false);
|
2006-09-21 20:10:05 +02:00
|
|
|
|
2008-07-09 12:31:55 +02:00
|
|
|
for (unsigned int n=0; n<k; n++)
|
2006-09-21 20:10:05 +02:00
|
|
|
if (iPlane->index<nearest_planes[n]->index)
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
riemannian_graph[iPlane->index].push_back(RiemannianEdge(nearest_planes[n], 1.0f - fabs(iPlane->normal .dot(nearest_planes[n]->normal))));
|
2006-09-21 20:10:05 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
// Step 3: compute the minimum spanning tree (MST) over the Riemannian graph (we use the Kruskal algorithm)
|
|
|
|
std::vector< MSTEdge > E;
|
2006-10-16 18:10:22 +02:00
|
|
|
typename std::vector< std::vector< RiemannianEdge > >::iterator iRiemannian = riemannian_graph.begin();
|
|
|
|
typename std::vector< RiemannianEdge >::iterator iRiemannianEdge, eRiemannianEdge;
|
2006-09-21 20:10:05 +02:00
|
|
|
for (int i=0; i<vertex_count; i++, iRiemannian++)
|
|
|
|
for (iRiemannianEdge=iRiemannian->begin(), eRiemannianEdge=iRiemannian->end(); iRiemannianEdge!=eRiemannianEdge; iRiemannianEdge++)
|
|
|
|
E.push_back(MSTEdge(&tangent_planes[i], iRiemannianEdge->plane, iRiemannianEdge->weight));
|
|
|
|
|
|
|
|
std::sort( E.begin(), E.end() );
|
2006-11-07 16:13:57 +01:00
|
|
|
vcg::DisjointSet<Plane> planeset;
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
|
2006-10-16 18:10:22 +02:00
|
|
|
for (typename std::vector< Plane >::iterator iPlane=tangent_planes.begin(); iPlane!=ePlane; iPlane++)
|
2006-11-07 16:13:57 +01:00
|
|
|
planeset.MakeSet( &*iPlane );
|
2006-09-21 20:10:05 +02:00
|
|
|
|
2006-10-16 18:10:22 +02:00
|
|
|
typename std::vector< MSTEdge >::iterator iMSTEdge = E.begin();
|
|
|
|
typename std::vector< MSTEdge >::iterator eMSTEdge = E.end();
|
2006-09-21 20:10:05 +02:00
|
|
|
std::vector< MSTEdge > unoriented_tree;
|
|
|
|
Plane *u, *v;
|
|
|
|
for ( ; iMSTEdge!=eMSTEdge; iMSTEdge++)
|
2006-11-07 16:13:57 +01:00
|
|
|
if ((u=planeset.FindSet(iMSTEdge->u))!=(v=planeset.FindSet(iMSTEdge->v)))
|
|
|
|
unoriented_tree.push_back( *iMSTEdge ), planeset.Union(u, v);
|
2006-09-21 20:10:05 +02:00
|
|
|
E.clear();
|
|
|
|
|
|
|
|
// compute for each plane the list of sorting edges
|
|
|
|
std::vector< std::vector< int > > incident_edges(vertex_count);
|
|
|
|
iMSTEdge = unoriented_tree.begin();
|
|
|
|
eMSTEdge = unoriented_tree.end();
|
2006-10-13 12:38:09 +02:00
|
|
|
|
|
|
|
progress = 0;
|
|
|
|
int mst_size = int(unoriented_tree.size());
|
|
|
|
sprintf(message, "Building orieted graph...");
|
2006-09-21 20:10:05 +02:00
|
|
|
for ( ; iMSTEdge!=eMSTEdge; iMSTEdge++)
|
|
|
|
{
|
2006-10-13 12:38:09 +02:00
|
|
|
if (callback!=NULL && (++progress%step)==0 && (percentage=int((progress*100)/mst_size))<100) (callback)(percentage, message);
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
|
2006-09-21 20:10:05 +02:00
|
|
|
int u_index = int(iMSTEdge->u->index);
|
|
|
|
int v_index = int(iMSTEdge->v->index);
|
|
|
|
incident_edges[ u_index ].push_back( v_index ),
|
|
|
|
incident_edges[ v_index ].push_back( u_index );
|
|
|
|
}
|
|
|
|
|
|
|
|
// Traverse the incident_edges vector and build the MST
|
|
|
|
VertexIterator iCurrentVertex, iSonVertex;
|
|
|
|
std::vector< MSTNode > MST(vertex_count);
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
|
2006-10-16 18:10:22 +02:00
|
|
|
typename std::vector< Plane >::iterator iFirstPlane = tangent_planes.begin();
|
|
|
|
typename std::vector< Plane >::iterator iCurrentPlane, iSonPlane;
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
|
2006-09-21 20:10:05 +02:00
|
|
|
MSTNode *mst_root;
|
|
|
|
int r_index = (root_index!=-1)? root_index : rand()*vertex_count/RAND_MAX;
|
|
|
|
mst_root = &MST[ r_index ];
|
|
|
|
mst_root->parent = mst_root; //the parent of the root is the root itself
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
|
2006-09-21 20:10:05 +02:00
|
|
|
if (orientation==MustBeFlipped)
|
|
|
|
{
|
|
|
|
iCurrentVertex = begin;
|
|
|
|
std::advance(iCurrentVertex, r_index);
|
|
|
|
iCurrentVertex->N() = iCurrentVertex->N()*ScalarType(-1.0f);
|
|
|
|
}
|
|
|
|
|
|
|
|
{ // just to limit the scope of the variable border
|
|
|
|
std::queue< int > border;
|
|
|
|
border.push(r_index);
|
2006-10-13 12:38:09 +02:00
|
|
|
int maxSize = 0;
|
|
|
|
int queueSize = 0;
|
|
|
|
progress = 0;
|
|
|
|
sprintf(message, "Extracting the tree...");
|
|
|
|
while ((queueSize=int(border.size()))>0)
|
2006-09-21 20:10:05 +02:00
|
|
|
{
|
2006-10-13 12:38:09 +02:00
|
|
|
if (callback!=NULL && ((++progress%step)==0) && (percentage=int((maxSize-queueSize)*100/maxSize))<100) (callback)(percentage, message);
|
|
|
|
|
2006-09-21 20:10:05 +02:00
|
|
|
int current_node_index = border.front(); border.pop();
|
|
|
|
|
|
|
|
MSTNode *current_node = &MST[current_node_index]; //retrieve the pointer to the current MST node
|
|
|
|
std::advance((iCurrentVertex=begin), current_node_index); //retrieve the pointer to the correspective vertex
|
|
|
|
current_node->vertex = &*iCurrentVertex; //and associate it to the MST node
|
|
|
|
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
std::vector< int >::iterator iSon = incident_edges[ current_node_index ].begin();
|
2006-09-21 20:10:05 +02:00
|
|
|
std::vector< int >::iterator eSon = incident_edges[ current_node_index ].end();
|
|
|
|
for ( ; iSon!=eSon; iSon++)
|
|
|
|
{
|
|
|
|
MSTNode *son = &MST[ *iSon ];
|
|
|
|
if (son->parent==NULL) // the node hasn't been visited
|
|
|
|
{
|
|
|
|
son->parent = current_node; // Update the MST nodes
|
|
|
|
current_node->sons.push_back(son);
|
|
|
|
//std::advance((iSonVertex=begin), *iSon);//retrieve the pointer to the Vertex associated to son
|
|
|
|
border.push( *iSon );
|
|
|
|
}
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
maxSize = vcg::math::Max<int>(maxSize, queueSize);
|
2006-09-21 20:10:05 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// and finally visit the MST tree in order to propagate the normals
|
|
|
|
{
|
|
|
|
std::queue< MSTNode* > border;
|
|
|
|
border.push(mst_root);
|
2006-10-13 12:38:09 +02:00
|
|
|
sprintf(message, "Orienting normals...");
|
|
|
|
progress = 0;
|
|
|
|
int maxSize = 0;
|
|
|
|
int queueSize = 0;
|
|
|
|
while ((queueSize=int(border.size()))>0)
|
2006-09-21 20:10:05 +02:00
|
|
|
{
|
|
|
|
MSTNode *current_node = border.front(); border.pop();
|
|
|
|
//std::vector< MSTNode* >::iterator iMSTSon = current_node->sons.begin();
|
|
|
|
//std::vector< MSTNode* >::iterator eMSTSon = current_node->sons.end();
|
|
|
|
for (int s=0; s<int(current_node->sons.size()); s++)
|
|
|
|
{
|
2006-10-13 12:38:09 +02:00
|
|
|
if (callback!=NULL && ((++progress%step)==0) && (percentage=int((maxSize-queueSize)*100/maxSize))<100) (callback)(percentage, message);
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
|
|
|
|
if (current_node->vertex->N().dot(current_node->sons[s]->vertex->N())<ScalarType(0.0f))
|
2006-09-21 20:10:05 +02:00
|
|
|
current_node->sons[s]->vertex->N() *= ScalarType(-1.0f);
|
|
|
|
border.push( current_node->sons[s] );
|
make point2 derived Eigen's Matrix, and a set of minimal fixes to make meshlab compile
with both old and new version. The fixes include:
- dot product: vec0 * vec1 => vec0.dot(vec1) (I added .dot() to the old Point classes too)
- Transpose: Transpose is an Eigen type, so we cannot keep it if Eigen is used. Therefore
I added a .tranpose() to old matrix classes, and modified most of the Transpose() to transpose()
both in vcg and meshlab. In fact, transpose() are free with Eigen, it simply returns a transpose
expression without copies. On the other be carefull: m = m.transpose() won't work as expected,
here me must evaluate to a temporary: m = m.transpose().eval(); However, this operation in very
rarely needed: you transpose at the same sime you set m, or you use m.transpose() directly.
- the last issue is Normalize which both modifies *this and return a ref to it. This behavior
don't make sense anymore when using expression template, e.g., in (a+b).Normalize(), the type
of a+b if not a Point (or whatever Vector types), it an expression of the addition of 2 points,
so we cannot modify the value of *this, since there is no value. Therefore I've already changed
all those .Normalize() of expressions to the Eigen's version .normalized().
- Finally I've changed the Zero to SetZero in the old Point classes too.
2008-10-28 01:59:46 +01:00
|
|
|
maxSize = vcg::math::Max<int>(maxSize, queueSize);
|
2006-09-21 20:10:05 +02:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2006-10-13 12:38:09 +02:00
|
|
|
if (callback!=NULL) (callback)(100, message);
|
2006-09-21 20:10:05 +02:00
|
|
|
};
|
|
|
|
};
|
|
|
|
|
|
|
|
};//end of namespace vcg
|
|
|
|
|
2006-10-18 10:32:03 +02:00
|
|
|
#endif //end of VCG_SPACE_NORMAL_EXTRAPOLATION_H
|