forked from KeckCAVES/LidarViewer
-
Notifications
You must be signed in to change notification settings - Fork 0
/
LidarSelectionSaver.h
67 lines (56 loc) · 2.5 KB
/
LidarSelectionSaver.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
/***********************************************************************
LidarSelectionSaver - Point processor functor class to save the set of
selected points to a file
Copyright (c) 2005-2012 Oliver Kreylos
This file is part of the LiDAR processing and analysis package.
The LiDAR processing and analysis package 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.
The LiDAR processing and analysis package 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 for more details.
You should have received a copy of the GNU General Public License along
with the LiDAR processing and analysis package; if not, write to the
Free Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
02111-1307 USA
***********************************************************************/
#ifndef LIDARSELECTIONSAVER_INCLUDED
#define LIDARSELECTIONSAVER_INCLUDED
#include <stdio.h>
#include <Misc/File.h>
#include "LidarTypes.h"
#include "LidarOctree.h"
class LidarSelectionSaver
{
/* Elements: */
private:
Misc::File selectionFile; // The file to save the selected points to
const double* pointOffset; // Offset vector from octree coordinates to real coordinates
/* Constructors and destructors: */
public:
LidarSelectionSaver(const char* selectionFileName,const double* sPointOffset)
:selectionFile(selectionFileName,"wt"),
pointOffset(sPointOffset)
{
};
/* Methods: */
void operator()(const LidarPoint& lp) // Process the given LiDAR point
{
/* Write the point to the selection file: */
double op[3];
for(int i=0;i<3;++i)
op[i]=double(lp[i])+pointOffset[i];
fprintf(selectionFile.getFilePtr(),"%.12g %.12g %.12g %u %u %u\n",op[0],op[1],op[2],(unsigned int)lp.value[0],(unsigned int)lp.value[1],(unsigned int)lp.value[2]);
};
void operator()(const LidarPoint& lp,const Vector& normal) // Process the given LiDAR point plus normal vector
{
/* Write the point to the selection file: */
double op[3];
for(int i=0;i<3;++i)
op[i]=double(lp[i])+pointOffset[i];
fprintf(selectionFile.getFilePtr(),"%.12g %.12g %.12g %.4f %.4f %.4f %u %u %u\n",op[0],op[1],op[2],normal[0],normal[1],normal[2],(unsigned int)lp.value[0],(unsigned int)lp.value[1],(unsigned int)lp.value[2]);
};
};
#endif