Scanner3D/pointcloud.cpp at master · puma3/Scanner3D · GitHub

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
#include "pointcloud.h"

Point3D::Point3D(float _x, float _y, float _z) :
    x(_x),
    y(_y),
    z(_z)
{}

PointCloud::PointCloud()
{}

void PointCloud::push_back(Point3D pnt)
{
    cloud.push_back(pnt);
}

void PointCloud::push_back(float _x, float _y, float _z)
{
    cloud.push_back(Point3D(_x, _y, _z));
}

void PointCloud::clean()
{
    cloud.clear();
    mesh.clear();
}

void PointCloud::meshify(int step)
{
    for(auto i = 0; i < height*(frames); i+=height) {
        for (int j = i; j < (i + height-step-2); j+=step) {
            if(i != height*(frames)) {
                mesh.push_back(Polygon(&cloud[j], &cloud[j+height], &cloud[j+height+step], &cloud[j+step]));
            }
            else
                mesh.push_back(Polygon(&cloud[j], &cloud[j%height], &cloud[j%height+step], &cloud[j+step]));
        }
    }
}

void PointCloud::saveToFile()
{
    std::ofstream _file;
    _file.open("points.off", std::ofstream::out);

    int _nVertices = height*frames;

    _file << "OFF\n" << _nVertices << "\t" << 0 << "\t" << 0 << endl;

    for (auto it = cloud.begin(); it != cloud.end(); ++it) {
        _file << it->x << "\t" << it->y << "\t" << it->z << endl;
    }

    _file.close();
}

Polygon::Polygon(Point3D *e1, Point3D *e2, Point3D *e3, Point3D *e4) :
    edge_1(e1),
    edge_2(e2),
    edge_3(e3),
    edge_4(e4)
{}