-
Notifications
You must be signed in to change notification settings - Fork 70
/
Copy pathPointCloudPoint.cpp
70 lines (54 loc) · 1.53 KB
/
PointCloudPoint.cpp
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
68
69
70
/*
* Copyright 2009-2010, Andrew Barry
*
* This file is part of MakerScanner.
*
* MakerScanner is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License (Version 2, June 1991) as published by
* the Free Software Foundation.
*
* MakerScanner 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 this program. If not, see <http://www.gnu.org/licenses/>.
*/
#include "PointCloudPoint.h"
// copy constructor
PointCloudPoint::PointCloudPoint(PointCloudPoint *point)
{
dist = point->dist;
theta = point->theta;
phi = point->phi;
r = point->r;
g = point->g;
b = point->b;
w = point->w;
h = point->h;
laserPosition = point->laserPosition;
}
// Generates the point cloud string for this point (one line)
wxString PointCloudPoint::GetPlyString()
{
double pxDist = dist;
double x, y, z;
x = pxDist * tan(theta);
y = pxDist;
z = pxDist * tan(phi);
wxString xString = wxT("");
xString << x;
wxString yString = wxT("");
yString << y;
wxString zString = wxT("");
zString << z;
wxString rString = wxT("");
rString << r;
wxString gString = wxT("");
gString << g;
wxString bString = wxT("");
bString << b;
return xString + wxT(" ") + yString + wxT(" ") + zString + wxT(" ") + rString + wxT(" ")
+ gString + wxT(" ") + bString;
}