Création d'un compte pour un collaborateur extérieur au laboratoire depuis l'intranet ICube : https://intranet.icube.unistra.fr/fr/labs/member/profile

import2tablesSurface.hpp 29.3 KB
Newer Older
Pierre Kraemer's avatar
Pierre Kraemer committed
1
2
3
/*******************************************************************************
* CGoGN: Combinatorial and Geometric modeling with Generic N-dimensional Maps  *
* version 0.1                                                                  *
4
* Copyright (C) 2009-2011, IGG Team, LSIIT, University of Strasbourg           *
Pierre Kraemer's avatar
Pierre Kraemer committed
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
*                                                                              *
* This library is free software; you can redistribute it and/or modify it      *
* under the terms of the GNU Lesser General Public License as published by the *
* Free Software Foundation; either version 2.1 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 PURVEC3E. See the GNU Lesser General Public License  *
* for more details.                                                            *
*                                                                              *
* You should have received a copy of the GNU Lesser General Public License     *
* along with this library; if not, write to the Free Software Foundation,      *
* Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301 USA.           *
*                                                                              *
20
* Web site: http://cgogn.u-strasbg.fr/                                         *
Pierre Kraemer's avatar
Pierre Kraemer committed
21
22
23
24
25
* Contact information: cgogn@unistra.fr                                        *
*                                                                              *
*******************************************************************************/

#include "Algo/Import/importPlyData.h"
26
27
#include "Algo/Geometry/boundingbox.h"
#include "Topology/generic/autoAttributeHandler.h"
Pierre Kraemer's avatar
Pierre Kraemer committed
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49

#include "openctm.h"

#include "assimp.h"
#include "aiPostProcess.h"
#include "aiScene.h"


namespace CGoGN
{

namespace Algo
{

namespace Import
{

template<typename PFP>
ImportSurfacique::ImportType MeshTablesSurface<PFP>::getFileType(const std::string& filename)
{
	if ((filename.rfind(".trianbgz")!=std::string::npos) || (filename.rfind(".TRIANBGZ")!=std::string::npos))
		return ImportSurfacique::TRIANBGZ;
Pierre Kraemer's avatar
Pierre Kraemer committed
50

Pierre Kraemer's avatar
Pierre Kraemer committed
51
52
53
54
55
56
57
58
	if ((filename.rfind(".trian")!=std::string::npos) || (filename.rfind(".TRIAN")!=std::string::npos))
		return ImportSurfacique::TRIAN;

	if ((filename.rfind(".plyptm")!=std::string::npos) || (filename.rfind(".PLYGEN")!=std::string::npos))
		return ImportSurfacique::PLYPTM;

	if ((filename.rfind(".ply")!=std::string::npos) || (filename.rfind(".PLY")!=std::string::npos))
		return ImportSurfacique::PLY;
Pierre Kraemer's avatar
Pierre Kraemer committed
59

Pierre Kraemer's avatar
Pierre Kraemer committed
60
61
	if ((filename.rfind(".off")!=std::string::npos) || (filename.rfind(".OFF")!=std::string::npos))
		return ImportSurfacique::OFF;
Pierre Kraemer's avatar
Pierre Kraemer committed
62

Pierre Kraemer's avatar
Pierre Kraemer committed
63
64
	if ((filename.rfind(".obj")!=std::string::npos) || (filename.rfind(".OBJ")!=std::string::npos))
		return ImportSurfacique::OBJ;
Pierre Kraemer's avatar
Pierre Kraemer committed
65

Pierre Kraemer's avatar
Pierre Kraemer committed
66
67
68
69
70
71
72
	if ((filename.rfind(".ctm")!=std::string::npos) || (filename.rfind(".OBJ")!=std::string::npos))
		return ImportSurfacique::CTM;

	return ImportSurfacique::UNKNOWNSURFACE;
}

template<typename PFP>
Pierre Kraemer's avatar
Pierre Kraemer committed
73
bool MeshTablesSurface<PFP>::importMesh(const std::string& filename, std::vector<std::string>& attrNames, ImportSurfacique::ImportType kind)
Pierre Kraemer's avatar
Pierre Kraemer committed
74
75
76
77
{
	if (kind == ImportSurfacique::UNKNOWNSURFACE)
		kind = getFileType(filename);

Pierre Kraemer's avatar
Pierre Kraemer committed
78
	attrNames.clear() ;
Pierre Kraemer's avatar
Pierre Kraemer committed
79
80
81
82

	switch (kind)
	{
	case ImportSurfacique::TRIAN:
83
		CGoGNout << "TYPE: TRIAN" << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
84
		return importTrian(filename, attrNames);
Pierre Kraemer's avatar
Pierre Kraemer committed
85
86
		break;
	case ImportSurfacique::TRIANBGZ:
87
		CGoGNout << "TYPE: TRIANBGZ" << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
88
		return importTrianBinGz(filename, attrNames);
Pierre Kraemer's avatar
Pierre Kraemer committed
89
90
		break;
	case ImportSurfacique::CTM:
91
		CGoGNout << "TYPE: CTM" << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
92
		return importCTM(filename, attrNames);
Pierre Kraemer's avatar
Pierre Kraemer committed
93
94
		break;
	case ImportSurfacique::OFF:
95
		CGoGNout << "TYPE: OFF" << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
96
		return importOff(filename, attrNames);
Pierre Kraemer's avatar
Pierre Kraemer committed
97
98
		break;
	case ImportSurfacique::PLY:
99
		CGoGNout << "TYPE: PLY" << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
100
		return importPly(filename, attrNames);
Pierre Kraemer's avatar
Pierre Kraemer committed
101
		break;
Pierre Kraemer's avatar
Pierre Kraemer committed
102
	case ImportSurfacique::PLYPTM:
103
		CGoGNout << "TYPE: PLYPTM" << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
104
105
		return importPlyPTM(filename, attrNames);
		break;
Pierre Kraemer's avatar
Pierre Kraemer committed
106
	case ImportSurfacique::OBJ:
107
		CGoGNout << "TYPE: OBJ" << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
108
		return importObj(filename, attrNames);
Pierre Kraemer's avatar
Pierre Kraemer committed
109
110
		break;
	default:
111
		CGoGNout << "TYPE: ASSIMP" << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
112
		return importASSIMP(filename, attrNames);
Pierre Kraemer's avatar
Pierre Kraemer committed
113
114
115
116
117
118
		break;
	}
	return false;
}

template<typename PFP>
Pierre Kraemer's avatar
Pierre Kraemer committed
119
bool MeshTablesSurface<PFP>::importTrian(const std::string& filename, std::vector<std::string>& attrNames)
Pierre Kraemer's avatar
Pierre Kraemer committed
120
{
121
	AttributeHandler<typename PFP::VEC3> positions =  m_map.template getAttribute<typename PFP::VEC3>(VERTEX, "position") ;
122
123

	if (!positions.isValid())
124
		positions = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "position") ;
125

Pierre Kraemer's avatar
Pierre Kraemer committed
126
127
	attrNames.push_back(positions.name()) ;

128
	AttributeContainer& container = m_map.getAttributeContainer(VERTEX) ;
129

Pierre Kraemer's avatar
Pierre Kraemer committed
130
131
132
133
	// open file
	std::ifstream fp(filename.c_str(), std::ios::in);
	if (!fp.good())
	{
134
		CGoGNerr << "Unable to open file " << filename << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
135
136
137
		return false;
	}

Pierre Kraemer's avatar
Pierre Kraemer committed
138
	// read nb of points
Pierre Kraemer's avatar
Pierre Kraemer committed
139
140
	fp >> m_nbVertices;

Pierre Kraemer's avatar
Pierre Kraemer committed
141
	// read points
Pierre Kraemer's avatar
Pierre Kraemer committed
142
143
144
	std::vector<unsigned int> verticesID;
	verticesID.reserve(m_nbVertices);

Pierre Kraemer's avatar
Pierre Kraemer committed
145
	for (unsigned int i = 0; i < m_nbVertices; ++i)
Pierre Kraemer's avatar
Pierre Kraemer committed
146
147
148
149
150
	{
		VEC3 pos;
		fp >> pos[0];
		fp >> pos[1];
		fp >> pos[2];
Pierre Kraemer's avatar
Pierre Kraemer committed
151
152
		unsigned int id = container.insertLine();
		positions[id] = pos;
Pierre Kraemer's avatar
Pierre Kraemer committed
153
154
155
156
157
158
159
160
		verticesID.push_back(id);
	}

	// read nb of faces
	fp >> m_nbFaces;
	m_nbEdges.reserve(m_nbFaces);
	m_emb.reserve(3*m_nbFaces);

Pierre Kraemer's avatar
Pierre Kraemer committed
161
162
	// read indices of faces
	for (unsigned int i = 0; i < m_nbFaces; ++i)
Pierre Kraemer's avatar
Pierre Kraemer committed
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
	{
		m_nbEdges.push_back(3);
		// read the three vertices of triangle
		int pt;
		fp >> pt;
		m_emb.push_back(verticesID[pt]);
		fp >> pt;
		m_emb.push_back(verticesID[pt]);
		fp >> pt;
		m_emb.push_back(verticesID[pt]);

		// neighbour not always good in files !!
		int neigh;
		fp >> neigh;
		fp >> neigh;
		fp >> neigh;
	}

	fp.close();
	return true;
}

template<typename PFP>
Pierre Kraemer's avatar
Pierre Kraemer committed
186
bool MeshTablesSurface<PFP>::importTrianBinGz(const std::string& filename, std::vector<std::string>& attrNames)
Pierre Kraemer's avatar
Pierre Kraemer committed
187
{
188
	AttributeHandler<typename PFP::VEC3> positions =  m_map.template getAttribute<typename PFP::VEC3>(VERTEX, "position") ;
189
190

	if (!positions.isValid())
191
		positions = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "position") ;
192

Pierre Kraemer's avatar
Pierre Kraemer committed
193
194
	attrNames.push_back(positions.name()) ;

195
	AttributeContainer& container = m_map.getAttributeContainer(VERTEX) ;
196

Pierre Kraemer's avatar
Pierre Kraemer committed
197
198
199
200
201
	// open file
	igzstream fs(filename.c_str(), std::ios::in|std::ios::binary);

	if (!fs.good())
	{
202
		CGoGNerr << "Unable to open file " << filename << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
203
204
		return false;
	}
Pierre Kraemer's avatar
Pierre Kraemer committed
205

Pierre Kraemer's avatar
Pierre Kraemer committed
206
207
208
209
210
	// read nb of points
	fs.read(reinterpret_cast<char*>(&m_nbVertices), sizeof(int));

	// read points
	std::vector<unsigned int> verticesID;
Pierre Kraemer's avatar
Pierre Kraemer committed
211
	{	// juste pour limiter la portee des variables
Pierre Kraemer's avatar
Pierre Kraemer committed
212
213
		verticesID.reserve(m_nbVertices);
		float* buffer = new float[m_nbVertices*3];
Pierre Kraemer's avatar
Pierre Kraemer committed
214
		fs.read(reinterpret_cast<char*>(buffer), 3*m_nbVertices*sizeof(float));
Pierre Kraemer's avatar
Pierre Kraemer committed
215
		float *ptr = buffer;
Pierre Kraemer's avatar
Pierre Kraemer committed
216
		for (unsigned int i = 0; i < m_nbVertices; ++i)
Pierre Kraemer's avatar
Pierre Kraemer committed
217
218
219
220
221
222
		{
			VEC3 pos;
			pos[0]= *ptr++;
			pos[1]= *ptr++;
			pos[2]= *ptr++;

Pierre Kraemer's avatar
Pierre Kraemer committed
223
224
			unsigned int id = container.insertLine();
			positions[id] = pos;
Pierre Kraemer's avatar
Pierre Kraemer committed
225
226
227
228
229
230
231
232
233
234
235
236

			verticesID.push_back(id);
		}
		delete[] buffer;
	}

	// read nb of faces
	fs.read(reinterpret_cast<char*>(&m_nbFaces), sizeof(int));
	m_nbEdges.reserve(m_nbFaces);
	m_emb.reserve(3*m_nbFaces);

	// read indices of faces
Pierre Kraemer's avatar
Pierre Kraemer committed
237
	{	// juste pour limiter la portee des variables
Pierre Kraemer's avatar
Pierre Kraemer committed
238
239
240
241
		int* buffer = new int[m_nbFaces*6];
		fs.read(reinterpret_cast<char*>(buffer),6*m_nbFaces*sizeof(float));
		int *ptr = buffer;

Pierre Kraemer's avatar
Pierre Kraemer committed
242
		for (unsigned int i = 0; i < m_nbFaces; i++)
Pierre Kraemer's avatar
Pierre Kraemer committed
243
244
245
246
247
248
249
250
251
252
253
254
255
		{
			m_nbEdges.push_back(3);
			m_emb.push_back(verticesID[*ptr++]);
			m_emb.push_back(verticesID[*ptr++]);
			m_emb.push_back(verticesID[*ptr++]);
		}
	}
	
	fs.close();
	return true;
}

template<typename PFP>
Pierre Kraemer's avatar
Pierre Kraemer committed
256
bool MeshTablesSurface<PFP>::importOff(const std::string& filename, std::vector<std::string>& attrNames)
Pierre Kraemer's avatar
Pierre Kraemer committed
257
{
258
	AttributeHandler<typename PFP::VEC3> positions =  m_map.template getAttribute<typename PFP::VEC3>(VERTEX, "position") ;
259
260

	if (!positions.isValid())
261
		positions = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "position") ;
262

Pierre Kraemer's avatar
Pierre Kraemer committed
263
264
	attrNames.push_back(positions.name()) ;

265
	AttributeContainer& container = m_map.getAttributeContainer(VERTEX) ;
266

Pierre Kraemer's avatar
Pierre Kraemer committed
267
268
269
270
	// open file
	std::ifstream fp(filename.c_str(), std::ios::in);
	if (!fp.good())
	{
271
		CGoGNerr << "Unable to open file " << filename << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
272
273
274
275
276
277
278
279
280
		return false;
	}

    std::string ligne;

    // lecture de OFF
    std::getline (fp, ligne);
    if (ligne.rfind("OFF") == std::string::npos)
    {
281
282
		CGoGNerr << "Problem reading off file: not an off file" << CGoGNendl;
		CGoGNerr << ligne << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
283
		return false;
Pierre Kraemer's avatar
Pierre Kraemer committed
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
    }

    // lecture des nombres de sommets/faces/aretes
	int nbe;
    {
    	do
    	{
    		std::getline (fp, ligne);
    	} while (ligne.size()==0);

	    std::stringstream oss(ligne);
		oss >> m_nbVertices;
		oss >> m_nbFaces;
		oss >> nbe;
    }

	//lecture sommets
	std::vector<unsigned int> verticesID;
	verticesID.reserve(m_nbVertices);
Pierre Kraemer's avatar
Pierre Kraemer committed
303
	for (unsigned int i = 0; i < m_nbVertices;++i)
Pierre Kraemer's avatar
Pierre Kraemer committed
304
305
306
307
	{
    	do
    	{
    		std::getline (fp, ligne);
Pierre Kraemer's avatar
Pierre Kraemer committed
308
    	} while (ligne.size() == 0);
Pierre Kraemer's avatar
Pierre Kraemer committed
309
310
311
312
313
314
315
316
317
318

		std::stringstream oss(ligne);

		float x,y,z;
		oss >> x;
		oss >> y;
		oss >> z;
		// on peut ajouter ici la lecture de couleur si elle existe
		VEC3 pos(x,y,z);

Pierre Kraemer's avatar
Pierre Kraemer committed
319
320
		unsigned int id = container.insertLine();
		positions[id] = pos;
Pierre Kraemer's avatar
Pierre Kraemer committed
321
322
323
324
325
326
327
328
329

		verticesID.push_back(id);
	}

	// lecture faces
	// normalement nbVertices*8 devrait suffire largement
	m_nbEdges.reserve(m_nbFaces);
	m_emb.reserve(m_nbVertices*8);

Pierre Kraemer's avatar
Pierre Kraemer committed
330
	for (unsigned int i = 0; i < m_nbFaces; ++i)
Pierre Kraemer's avatar
Pierre Kraemer committed
331
332
333
334
	{
    	do
    	{
    		std::getline (fp, ligne);
Pierre Kraemer's avatar
Pierre Kraemer committed
335
    	} while (ligne.size() == 0);
Pierre Kraemer's avatar
Pierre Kraemer committed
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354

		std::stringstream oss(ligne);
		int n;
		oss >> n;
		m_nbEdges.push_back(n);
		for (int j=0;j<n; ++j)
		{
			int index; // index du plongement
			oss >> index;
			m_emb.push_back(verticesID[index]);
		}
		// on peut ajouter ici la lecture de couleur si elle existe
	}

	fp.close();
	return true;
}

template <typename PFP>
Pierre Kraemer's avatar
Pierre Kraemer committed
355
bool MeshTablesSurface<PFP>::importObj(const std::string& filename, std::vector<std::string>& attrNames)
Pierre Kraemer's avatar
Pierre Kraemer committed
356
{
357
	AttributeHandler<typename PFP::VEC3> positions =  m_map.template getAttribute<typename PFP::VEC3>(VERTEX, "position") ;
358
359

	if (!positions.isValid())
360
		positions = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "position") ;
361

Pierre Kraemer's avatar
Pierre Kraemer committed
362
363
	attrNames.push_back(positions.name()) ;

364
	AttributeContainer& container = m_map.getAttributeContainer(VERTEX) ;
365

Pierre Kraemer's avatar
Pierre Kraemer committed
366
367
368
369
	// open file
	std::ifstream fp(filename.c_str(), std::ios::binary);
	if (!fp.good())
	{
370
		CGoGNerr << "Unable to open file " << filename << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
371
372
373
		return false;
	}

Pierre Kraemer's avatar
Pierre Kraemer committed
374
//	fp.seekg(0, std::ios::end);
Pierre Kraemer's avatar
Pierre Kraemer committed
375
//	int ab = fp.tellg();
Pierre Kraemer's avatar
Pierre Kraemer committed
376
//	fp.seekg(0, std::ios::beg);
Pierre Kraemer's avatar
Pierre Kraemer committed
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
//	int ac = fp.tellg();

    std::string ligne;
    std::string tag;

    do
    {
    	fp >> tag;
    	std::getline (fp, ligne);
    }while (tag != std::string("v"));

    // lecture des sommets
	std::vector<unsigned int> verticesID;
	verticesID.reserve(102400); // on tape large (400Ko wahouuuuu !!)

Pierre Kraemer's avatar
Pierre Kraemer committed
392
	unsigned int i = 0;
Pierre Kraemer's avatar
Pierre Kraemer committed
393
394
395
396
397
398
399
400
401
402
403
404
405
    do
    {
		if (tag == std::string("v"))
		{
			std::stringstream oss(ligne);
		
			float x,y,z;
			oss >> x;
			oss >> y;
			oss >> z;

			VEC3 pos(x,y,z);

Pierre Kraemer's avatar
Pierre Kraemer committed
406
407
			unsigned int id = container.insertLine();
			positions[id] = pos;
Pierre Kraemer's avatar
Pierre Kraemer committed
408
409
410
411
412
413

			verticesID.push_back(id);
			i++;
		}

		fp >> tag;
Pierre Kraemer's avatar
Pierre Kraemer committed
414
    	std::getline(fp, ligne);
Pierre Kraemer's avatar
Pierre Kraemer committed
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
    } while (!fp.eof());

	m_nbVertices = verticesID.size();

	// close/clear/open only way to go back to beginning of file
	fp.close();
	fp.clear();
	fp.open(filename.c_str());

	do
    {
    	fp >> tag;
    	std::getline (fp, ligne);
    } while (tag != std::string("f"));

	m_nbEdges.reserve(verticesID.size()*2);
	m_emb.reserve(verticesID.size()*8);

	std::vector<int> table;
434
	table.reserve(64); // NBV cotes pour une face devrait suffire
Pierre Kraemer's avatar
Pierre Kraemer committed
435
436
437
	m_nbFaces = 0;
    do
    {
Pierre Kraemer's avatar
Pierre Kraemer committed
438
    	if (tag == std::string("f")) // lecture d'une face
Pierre Kraemer's avatar
Pierre Kraemer committed
439
440
441
442
443
444
445
446
    	{
    		std::stringstream oss(ligne);
     		table.clear();
    		while (!oss.eof())  // lecture de tous les indices
    		{
    			std::string str;
    			oss >> str;

Pierre Kraemer's avatar
Pierre Kraemer committed
447
    			unsigned int ind = 0;
CGoGN GIT Supervisor's avatar
CGoGN GIT Supervisor committed
448
    			while ( (ind<str.length()) &&  (str[ind]!='/'))
Pierre Kraemer's avatar
Pierre Kraemer committed
449
450
    				ind++;

Pierre Kraemer's avatar
Pierre Kraemer committed
451
				if (ind > 0)
Pierre Kraemer's avatar
Pierre Kraemer committed
452
453
				{
    				long index;
Pierre Kraemer's avatar
Pierre Kraemer committed
454
					std::stringstream iss(str.substr(0, ind));
Pierre Kraemer's avatar
Pierre Kraemer committed
455
456
457
458
459
					iss >> index;
		   			table.push_back(index);
				}
    		}

Pierre Kraemer's avatar
Pierre Kraemer committed
460
    		unsigned int n = table.size();
Pierre Kraemer's avatar
Pierre Kraemer committed
461
			m_nbEdges.push_back(short(n));
Pierre Kraemer's avatar
Pierre Kraemer committed
462
    		for (unsigned int j = 0; j < n; ++j)
Pierre Kraemer's avatar
Pierre Kraemer committed
463
    		{
Pierre Kraemer's avatar
Pierre Kraemer committed
464
    			int index = table[j] - 1; // les index commencent a 1 (boufonnerie d'obj ;)
Pierre Kraemer's avatar
Pierre Kraemer committed
465
466
467
468
469
				m_emb.push_back(verticesID[index]);
    		}
			m_nbFaces++;
    	}
		fp >> tag;
Pierre Kraemer's avatar
Pierre Kraemer committed
470
    	std::getline(fp, ligne);
Pierre Kraemer's avatar
Pierre Kraemer committed
471
472
473
474
475
476
477
     } while (!fp.eof());

	fp.close ();
	return true;
}

template<typename PFP>
Pierre Kraemer's avatar
Pierre Kraemer committed
478
bool MeshTablesSurface<PFP>::importPly(const std::string& filename, std::vector<std::string>& attrNames)
Pierre Kraemer's avatar
Pierre Kraemer committed
479
{
480
	AttributeHandler<typename PFP::VEC3> positions =  m_map.template getAttribute<typename PFP::VEC3>(VERTEX, "position") ;
481
482

	if (!positions.isValid())
483
		positions = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "position") ;
484

Pierre Kraemer's avatar
Pierre Kraemer committed
485
486
	attrNames.push_back(positions.name()) ;

487
	AttributeContainer& container = m_map.getAttributeContainer(VERTEX) ;
488

Pierre Kraemer's avatar
Pierre Kraemer committed
489
490
491
492
	PlyImportData pid;

	if (! pid.read_file(filename) )
	{
493
		CGoGNerr << "Unable to open file " << filename << CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
494
495
496
497
498
499
500
501
502
503
		return false;
	}
	
    // lecture des nombres de sommets/aretes/faces
	m_nbVertices = pid.nbVertices();
	m_nbFaces = pid.nbFaces();
 
	//lecture sommets
	std::vector<unsigned int> verticesID;
	verticesID.reserve(m_nbVertices);
Pierre Kraemer's avatar
Pierre Kraemer committed
504
	for (unsigned int i = 0; i < m_nbVertices; ++i)
Pierre Kraemer's avatar
Pierre Kraemer committed
505
506
	{
		VEC3 pos;
Pierre Kraemer's avatar
Pierre Kraemer committed
507
		pid.vertexPosition(i, pos);
Pierre Kraemer's avatar
Pierre Kraemer committed
508

Pierre Kraemer's avatar
Pierre Kraemer committed
509
510
		unsigned int id = container.insertLine();
		positions[id] = pos;
Pierre Kraemer's avatar
Pierre Kraemer committed
511
512
513
514
515
516
517

		verticesID.push_back(id);
	}

	m_nbEdges.reserve(m_nbFaces);
	m_emb.reserve(m_nbVertices*8);

Pierre Kraemer's avatar
Pierre Kraemer committed
518
	for (unsigned int i = 0; i < m_nbFaces; ++i)
Pierre Kraemer's avatar
Pierre Kraemer committed
519
	{
Pierre Kraemer's avatar
Pierre Kraemer committed
520
		unsigned int n = pid.getFaceValence(i);
Pierre Kraemer's avatar
Pierre Kraemer committed
521
522
		m_nbEdges.push_back(n);
		int* indices = pid.getFaceIndices(i);
Pierre Kraemer's avatar
Pierre Kraemer committed
523
		for (unsigned int j = 0; j < n; ++j)
Pierre Kraemer's avatar
Pierre Kraemer committed
524
		{
Pierre Kraemer's avatar
Pierre Kraemer committed
525
			m_emb.push_back(verticesID[indices[j]]);
Pierre Kraemer's avatar
Pierre Kraemer committed
526
527
528
529
530
531
		}
	}

	return true;
}

Pierre Kraemer's avatar
Pierre Kraemer committed
532
533
template <typename PFP>
bool MeshTablesSurface<PFP>::importPlyPTM(const std::string& filename, std::vector<std::string>& attrNames)
534
{
535
	AttributeHandler<typename PFP::VEC3> positions = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "position") ;
536
537
538
	attrNames.push_back(positions.name()) ;

	AttributeHandler<typename PFP::VEC3> frame[3] ;
539
540
541
	frame[0] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "frame_T") ; // Tangent
	frame[1] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "frame_B") ; // Bitangent
	frame[2] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "frame_N") ; // Normal
542
543
544
545
	for (unsigned int i = 0 ; i < 3 ; ++i)
		attrNames.push_back(frame[i].name()) ;

	AttributeHandler<typename PFP::VEC3> colorPTM[15] ;
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
	colorPTM[0] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a0") ;
	colorPTM[1] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a1") ;
	colorPTM[2] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a2") ;
	colorPTM[3] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a3") ;
	colorPTM[4] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a4") ;
	colorPTM[5] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a5") ;
	colorPTM[6] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a6") ;
	colorPTM[7] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a7") ;
	colorPTM[8] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a8") ;
	colorPTM[9] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a9") ;
	colorPTM[10] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a10") ;
	colorPTM[11] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a11") ;
	colorPTM[12] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a12") ;
	colorPTM[13] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a13") ;
	colorPTM[14] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a14") ;
561
562
563
564

	for (unsigned int i = 0 ; i < 15 ; ++i)
		attrNames.push_back(colorPTM[i].name()) ;

565
	AttributeContainer& container = m_map.getAttributeContainer(VERTEX) ;
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583

	std::ifstream fp(filename.c_str(), std::ios::binary);
	if (!fp.good())
	{
		std::cerr << "Unable to open file " << filename<< std::endl;
		return false;
	}

    std::string ligne;
    std::string tag;

	fp >> tag;
	if (tag != std::string("ply"))
	{
		std::cerr <<filename<< " is not a ply file !" <<  std::endl;
		return false;
	}

584

585
586
587
588
589
590
591
592
593
594
595
596
	// va au nombre de sommets
	do
	{
		fp >> tag;
	} while (tag != std::string("vertex"));

	unsigned int nbp;
	fp >> nbp;
	// read points
	std::vector<unsigned int> verticesID;
	verticesID.reserve(nbp);

597
	AttributeHandler<typename PFP::REAL> errors[3] ;
598
599
600
601
602
603
604
	// va au nombre de faces en comptant le nombre de "property"
	unsigned int nb_props = 0;
	do
	{
		fp >> tag;
		if (tag == std::string("property"))
			nb_props++;
605
		if (tag == std::string("errL2")) {
Kenneth Vanhoey's avatar
merge    
Kenneth Vanhoey committed
606
607
608
			errors[0] = m_map.template addAttribute<typename PFP::REAL>(VERTEX, "errL2") ;
			errors[1] = m_map.template addAttribute<typename PFP::REAL>(VERTEX, "errLmax") ;
			errors[2] = m_map.template addAttribute<typename PFP::REAL>(VERTEX, "stdDev") ;
609
610
611
612
613
			for (unsigned int i = 0 ; i < 3 ; ++i)
					attrNames.push_back(errors[i].name()) ;
		}


614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
	} while (tag != std::string("face"));

	fp >> m_nbFaces;
 	m_nbEdges.reserve(m_nbFaces);
	m_emb.reserve(3*m_nbFaces);

	// lecture des sommets

	// saute à la fin du header
	do
	{
		fp >> tag;
	} while (tag != std::string("end_header"));

	float* properties = new float[nb_props];

	for (unsigned int i = 0; i < nbp; ++i)
	{
		unsigned int id = container.insertLine();
		verticesID.push_back(id);

		for (unsigned int j = 0; j < nb_props; ++j)
		{
			fp >> properties[j];
		}

		positions[id] = VEC3(properties[0],properties[1],properties[2]);

		for (unsigned int k = 0 ; k < 3 ; ++k)
			for (unsigned int l = 0 ; l < 3 ; ++l)
				frame[k][id][l] = properties[3+(3*k+l)] ;

		for (unsigned int k = 0 ; k < 3 ; ++k)
			for (unsigned int l = 0 ; l < 15 ; ++l)
				colorPTM[l][id][k] = properties[12+(15*k+l)];
649
650
651
652

		if (errors[0].isValid())
			for (unsigned int k = 0 ; k < 3 ; ++k)
				errors[k][id] = properties[57 + k] ;
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
	}

	m_nbVertices = verticesID.size();
	delete[] properties;

// read indices of faces
	for (unsigned int i = 0; i < m_nbFaces; i++)
	{
		// read the indices vertices of face
		int nbe;
		fp >> nbe;
		m_nbEdges.push_back(nbe);

		int pt;
		for (int j=0; j<nbe; ++j)
		{
			fp >> pt;
			m_emb.push_back(verticesID[pt]);
		}
	}

	fp.close();
	return true;
}

/*template <typename PFP>
bool MeshTablesSurface<PFP>::importPlyPTM(const std::string& filename, std::vector<std::string>& attrNames)
Pierre Kraemer's avatar
Pierre Kraemer committed
680
{
681
	AttributeHandler<typename PFP::VEC3> positions =  m_map.template getAttribute<typename PFP::VEC3>(VERTEX, "position") ;
682
683

	if (!positions.isValid())
684
		positions = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "position") ;
685

Pierre Kraemer's avatar
Pierre Kraemer committed
686
	attrNames.push_back(positions.name()) ;
687
688

	AttributeHandler<typename PFP::VEC3> frame[3] ;
689
690
691
	frame[0] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "frame_T") ; // Tangent
	frame[1] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "frame_B") ; // Bitangent
	frame[2] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "frame_N") ; // Normal
692
693
694
695
	for (unsigned int i = 0 ; i < 3 ; ++i)
		attrNames.push_back(frame[i].name()) ;

	AttributeHandler<typename PFP::VEC3> colorPTM[6] ;
696
697
698
699
700
701
	colorPTM[0] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_a") ;
	colorPTM[1] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_b") ;
	colorPTM[2] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_c") ;
	colorPTM[3] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_d") ;
	colorPTM[4] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_e") ;
	colorPTM[5] = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "colorPTM_f") ;
702
703
704

	for (unsigned int i = 0 ; i < 6 ; ++i)
		attrNames.push_back(colorPTM[i].name()) ;
Pierre Kraemer's avatar
Pierre Kraemer committed
705

706
	AttributeContainer& container = m_map.getAttributeContainer(VERTEX) ;
707

Pierre Kraemer's avatar
Pierre Kraemer committed
708
709
710
	std::ifstream fp(filename.c_str(), std::ios::binary);
	if (!fp.good())
	{
711
		CGoGNerr << "Unable to open file " << filename<< CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
712
713
714
715
716
717
718
719
720
		return false;
	}

    std::string ligne;
    std::string tag;

	fp >> tag;
	if (tag != std::string("ply"))
	{
721
		CGoGNerr <<filename<< " is not a ply file !" <<  CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
		return false;
	}

	// va au nombre de sommets
	do
	{
		fp >> tag;
	} while (tag != std::string("vertex"));

	unsigned int nbp;
	fp >> nbp;
	// read points
	std::vector<unsigned int> verticesID;
	verticesID.reserve(nbp);

	// va au nombre de faces en comptant le nombre de "property"
	unsigned int nb_props = 0;
	do
	{
		fp >> tag;
		if (tag == std::string("property"))
			nb_props++;
	} while (tag != std::string("face"));

	fp >> m_nbFaces;
 	m_nbEdges.reserve(m_nbFaces);
	m_emb.reserve(3*m_nbFaces);

	// lecture des sommets

	// saute à la fin du header
	do
	{
		fp >> tag;
	} while (tag != std::string("end_header"));

	float* properties = new float[nb_props];

	for (unsigned int i = 0; i < nbp; ++i)
	{
		unsigned int id = container.insertLine();
		verticesID.push_back(id);

		for (unsigned int j = 0; j < nb_props; ++j)
		{
			fp >> properties[j];
		}

		positions[id] = VEC3(properties[0],properties[1],properties[2]);

		for (unsigned int k = 0 ; k < 3 ; ++k)
			for (unsigned int l = 0 ; l < 3 ; ++l)
774
				frame[k][id][l] = properties[3+(3*k+l)] ;
Pierre Kraemer's avatar
Pierre Kraemer committed
775
776
777

		for (unsigned int k = 0 ; k < 3 ; ++k)
			for (unsigned int l = 0 ; l < 6 ; ++l)
778
				colorPTM[l][id][k] = properties[12+(6*k+l)];
Pierre Kraemer's avatar
Pierre Kraemer committed
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
	}

	m_nbVertices = verticesID.size();
	delete[] properties;

// read indices of faces
	for (unsigned int i = 0; i < m_nbFaces; i++)
	{
		// read the indices vertices of face
		int nbe;
		fp >> nbe;
		m_nbEdges.push_back(nbe);

		int pt;
		for (int j=0; j<nbe; ++j)
		{
			fp >> pt;
			m_emb.push_back(verticesID[pt]);
		}
	}

	fp.close();
	return true;
802
}*/
Pierre Kraemer's avatar
Pierre Kraemer committed
803
804

template <typename PFP>
Pierre Kraemer's avatar
Pierre Kraemer committed
805
bool MeshTablesSurface<PFP>::importCTM(const std::string& filename, std::vector<std::string>& attrNames)
Pierre Kraemer's avatar
Pierre Kraemer committed
806
{
807
	AttributeHandler<typename PFP::VEC3> positions =  m_map.template getAttribute<typename PFP::VEC3>(VERTEX, "position") ;
808
809

	if (!positions.isValid())
810
		positions = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "position") ;
811

Pierre Kraemer's avatar
Pierre Kraemer committed
812
813
	attrNames.push_back(positions.name()) ;

814
	AttributeContainer& container = m_map.getAttributeContainer(VERTEX) ;
815

Pierre Kraemer's avatar
Pierre Kraemer committed
816
817
818
819
820
821
822
	// Load the file using the OpenCTM API
	CTMimporter ctm;
	// Load the file
	ctm.Load(filename.c_str());

 	m_nbVertices = ctm.GetInteger(CTM_VERTEX_COUNT);

Pierre Kraemer's avatar
Pierre Kraemer committed
823
 	// read points
Pierre Kraemer's avatar
Pierre Kraemer committed
824
825
826
827
	std::vector<unsigned int> verticesID;
	verticesID.reserve(m_nbVertices);

	const CTMfloat* vertices = ctm.GetFloatArray(CTM_VERTICES);
Pierre Kraemer's avatar
Pierre Kraemer committed
828
	for (unsigned int i = 0; i < m_nbVertices; ++i)
Pierre Kraemer's avatar
Pierre Kraemer committed
829
	{
Pierre Kraemer's avatar
Pierre Kraemer committed
830
831
832
833
		VEC3 pos(vertices[0], vertices[1], vertices[2]);
		vertices += 3; // next vertex in float*
		unsigned int id = container.insertLine();
		positions[id] = pos;
Pierre Kraemer's avatar
Pierre Kraemer committed
834
835
836
837
838
839
840
841
842
		verticesID.push_back(id);
	}

	// read nb of faces
	m_nbFaces = ctm.GetInteger(CTM_TRIANGLE_COUNT);
	m_nbEdges.reserve(m_nbFaces);
	m_emb.reserve(3*m_nbFaces);

	const CTMuint * indices = ctm.GetIntegerArray(CTM_INDICES);
Pierre Kraemer's avatar
Pierre Kraemer committed
843
844

	// read indices of faces
Pierre Kraemer's avatar
Pierre Kraemer committed
845
846
847
848
849
850
851
852
853
854
855
856
857
	for (unsigned i=0; i<m_nbFaces; i++)
	{
		m_nbEdges.push_back(3);
		// read the three vertices of triangle
		m_emb.push_back(verticesID[*indices++]);
		m_emb.push_back(verticesID[*indices++]);
		m_emb.push_back(verticesID[*indices++]);
	}

	return true;
}

template<typename PFP>
858
void MeshTablesSurface<PFP>::extractMeshRec(AttributeContainer& container, AttributeHandler<typename PFP::VEC3>& positions, const struct aiScene* scene, const struct aiNode* nd, struct aiMatrix4x4* trafo)
Pierre Kraemer's avatar
Pierre Kraemer committed
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
{
	struct aiMatrix4x4 prev;

	prev = *trafo;
	aiMultiplyMatrix4(trafo,&nd->mTransformation);

	std::vector<unsigned int> verticesID;

	// foreach mesh of node
	for (unsigned int n = 0; n < nd->mNumMeshes; ++n)
	{
		const struct aiMesh* mesh = scene->mMeshes[nd->mMeshes[n]];

		verticesID.clear();
		verticesID.reserve(mesh->mNumVertices);
		//read positions
		for (unsigned int t = 0; t < mesh->mNumVertices; ++t)
		{
			// transform position
			struct aiVector3D tmp = mesh->mVertices[t];
Pierre Kraemer's avatar
Pierre Kraemer committed
879
			aiTransformVecByMatrix4(&tmp, trafo);
Pierre Kraemer's avatar
Pierre Kraemer committed
880
			// now store it
Pierre Kraemer's avatar
Pierre Kraemer committed
881
882
			unsigned int id = container.insertLine();
			positions[id] = VEC3(tmp[0], tmp[1], tmp[2]);
Pierre Kraemer's avatar
Pierre Kraemer committed
883
884
885
886
887
888
889
890
891
892
893
894
895
896
897
898
899
900
901
902
903
			verticesID.push_back(id);
		}
		m_nbVertices += mesh->mNumVertices;

		// read faces indices
		for (unsigned int t = 0; t < mesh->mNumFaces; ++t)
		{
			const struct aiFace* face = &mesh->mFaces[t];
			m_nbEdges.push_back(face->mNumIndices);
			for(unsigned int i = 0; i < face->mNumIndices; i++)
			{
				unsigned int pt = face->mIndices[i];
				m_emb.push_back(verticesID[pt]);
			}
		}
		m_nbFaces += mesh->mNumFaces;
	}

	// recurse on all children of node
	for (unsigned int n = 0; n < nd->mNumChildren; ++n)
	{
904
//		CGoGNout << "Children "<<n<< CGoGNendl;
Pierre Kraemer's avatar
Pierre Kraemer committed
905
		extractMeshRec(container, positions, scene, nd->mChildren[n], trafo);
Pierre Kraemer's avatar
Pierre Kraemer committed
906
907
908
909
910
	}
	*trafo = prev;
}

template <typename PFP>
Pierre Kraemer's avatar
Pierre Kraemer committed
911
bool MeshTablesSurface<PFP>::importASSIMP(const std::string& filename, std::vector<std::string>& attrNames)
Pierre Kraemer's avatar
Pierre Kraemer committed
912
{
913
914
	AttributeContainer& container = m_map.getAttributeContainer(VERTEX) ;
	AttributeHandler<typename PFP::VEC3> positions = m_map.template addAttribute<typename PFP::VEC3>(VERTEX, "position") ;
Pierre Kraemer's avatar
Pierre Kraemer committed
915
916
	attrNames.push_back(positions.name()) ;

Pierre Kraemer's avatar
Pierre Kraemer committed
917
918
919
920
921
922
923
924
925
926
	m_nbVertices = 0;
	m_nbFaces = 0;

 	m_nbEdges.reserve(5000);
	m_emb.reserve(15000);

	struct aiMatrix4x4 trafo;
	aiIdentityMatrix4(&trafo);

	m_lab = 0;
Pierre Kraemer's avatar
Pierre Kraemer committed
927
928
	const struct aiScene* scene = aiImportFile(filename.c_str(), aiProcess_FindDegenerates | aiProcess_JoinIdenticalVertices);
	extractMeshRec(container, positions, scene, scene->mRootNode, &trafo);
Pierre Kraemer's avatar
Pierre Kraemer committed
929
930
931
932

	return true;
}

933
934
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
955
956
957
958
959
960
961
962
963
964
965
966
967
968
969
970
971
972
973
974
975
976
977
978
979
980
981
982
983
984
985
986
987
988
989
990
991
992
993
994
995
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009
1010
1011
1012
1013
1014
1015
1016
1017
1018
1019
1020
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030
1031
1032
1033
1034
1035
1036
1037
1038
1039
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082
1083
1084
template<typename PFP>
bool MeshTablesSurface<PFP>::mergeCloseVertices()
{
	const unsigned int NBV=64; // seems to be good

	const int NEIGH[27]={
	-NBV*NBV - NBV - 1, 	-NBV*NBV - NBV, 	-NBV*NBV - NBV + 1,
	-NBV*NBV - 1, 	-NBV*NBV, 	-NBV*NBV + 1,
	-NBV*NBV + NBV - 1,	-NBV*NBV + NBV,	- NBV*NBV + NBV + 1,
	-NBV - 1,	- NBV,	-NBV + 1,
	-1,	0,	1,
	NBV - 1,	NBV,	NBV + 1,
	NBV*NBV - NBV - 1,	NBV*NBV - NBV,	NBV*NBV - NBV + 1,
	NBV*NBV - 1,	NBV*NBV,	NBV*NBV + 1,
	NBV*NBV + NBV - 1,	NBV*NBV + NBV,	NBV*NBV + NBV + 1};

	std::vector<unsigned int>** grid;
	grid = new std::vector<unsigned int>*[NBV*NBV*NBV];

	// init grid with null ptrs	
	for (unsigned int i=0; i<NBV*NBV*NBV; ++i)
		grid[i]=NULL;
	
	AttributeHandler<typename PFP::VEC3> positions = m_map.template getAttribute<typename PFP::VEC3>(VERTEX, "position");
	
	// compute BB
	Geom::BoundingBox<typename PFP::VEC3> bb(positions[ positions.begin() ]) ;
	for (unsigned int i = positions.begin(); i != positions.end(); positions.next(i))
	{
		bb.addPoint(positions[i]) ;
	}

	// add one voxel around to avoid testing		
	typename PFP::VEC3 bbsize = (bb.max() - bb.min());
	typename PFP::VEC3 one = bbsize/(NBV-2);
	one*= 1.001f;
	bb.addPoint( bb.min() - one);
	bb.addPoint( bb.max() + one);
	bbsize = (bb.max() - bb.min());
	

	AutoAttributeHandler<unsigned int> gridIndex(m_map,VERTEX, "gridIndex");
	AutoAttributeHandler<unsigned int> newIndices(m_map,VERTEX, "newIndices");
	
	
	// Store each vertex in the grid and store voxel index in vertex attribute
	for (unsigned int i = positions.begin(); i != positions.end(); positions.next(i))
	{
		typename PFP::VEC3 P = positions[i];
		P -= bb.min();
		float pz = floor((P[2]/bbsize[2])*NBV);
		float py = floor((P[1]/bbsize[1])*NBV);
		float px = floor((P[0]/bbsize[0])*NBV);

		unsigned int index = NBV*NBV*pz + NBV*py + px;
		
		if (pz==63) 
			std::cout << "z 63 bb:"<<bb<<"  P="<<positions[i]<< std::endl;
		
		std::vector<unsigned int>* vox = grid[index];
		if (vox==NULL)
		{
			grid[index] = new std::vector<unsigned int>();
			grid[index]->reserve(8);
			vox = grid[index];
		}
		vox->push_back(i);
		gridIndex[i] = index;
		newIndices[i] = 0xffffffff;
	}
	
	// compute EPSILON: average length of 50 of 100 first edges of first faces divide by 10000
	int nb = 100;
	if (m_nbEdges.size()< 100) 
		nb = m_nbEdges.size();
		
	int k=0;
	typename PFP::REAL d=0;
	for (int i=0; i< nb; i+=2)
	{
		typename PFP::VEC3 e1 = positions[m_emb[k+1]] - positions[m_emb[k]];
		d += e1.norm();
		k += m_nbEdges[i];
	}
	d /= float(nb/2);
	
	typename PFP::REAL EPSILON = d/10000.0f;
	
	
	// traverse vertices
	for (unsigned int i = positions.begin(); i != positions.end(); positions.next(i))
	{
		if (newIndices[i] == 0xffffffff) 
		{
			const typename PFP::VEC3& P = positions[i];
			
			for (unsigned int n=0; n<27; ++n)
			{
				std::vector<unsigned int>* voxel = grid[gridIndex[i]+NEIGH[n]];
				if (voxel != NULL)
				{
					for (std::vector<unsigned int>::iterator v = voxel->begin(); v != voxel->end(); ++v)
					{
						if ((*v != i) && (*v != 0xffffffff))
						{
							typename PFP::VEC3 Q = positions[*v];
							Q -= P;
							typename PFP::REAL d2 = Q*Q;
							if (d2 < EPSILON*EPSILON)
							{
								newIndices[*v] = i;
								*v = 0xffffffff;
							}
						}
					}
				}
			}
		}
	}

	// update faces indices
	for	(std::vector<unsigned int>::iterator it = m_emb.begin(); it != m_emb.end(); ++it)
	{
		if (newIndices[*it] != 0xffffffff)
		{
			*it = newIndices[*it];
		}
	}

	// delete embeddings
	AttributeContainer& container = m_map.getAttributeContainer(VERTEX) ;

	for (unsigned int i = positions.begin(); i != positions.end(); positions.next(i))
	{
		if (newIndices[i] != 0xffffffff)
		{
			container.removeLine(i);
		}
	}

	// release grid memory	
	for (unsigned int i=0; i<NBV*NBV*NBV; ++i)
		if (grid[i]!=NULL)
			delete grid[i];

	delete[] grid;

	return true;
}



Pierre Kraemer's avatar
Pierre Kraemer committed
1085
1086
1087
1088
1089
} // namespace Import

} // namespace Algo

} // namespace CGoGN