shoulders/shoulder.cpp at master · phantom-pose/shoulders · 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
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
#include "shoulder.h"

using namespace std;

Shoulder::Shoulder(bool l): m_left{l}
{
    if (m_left)
    {
        m_size = make_shared<Size>(new Size(SIZE_X_LEFT, SIZE_Y_LEFT, SIZE_Z_LEFT));
    }
    else
    {
        m_size = make_shared<Size>(new Size(SIZE_X_RIGHT, SIZE_Y_RIGHT, SIZE_Z_RIGHT));
    }

    m_data = new int**[Z()];
    for (int k = 0; k < Z(); k++)
    {
        m_data[k] = new int*[Y()];
        for (int j = 0; j < Y(); j++)
        {
            m_data[k][j] = new int[X()];
        }
    }
    ifstream dataFile;
    string line;
    dataFile.open(m_left ? LEFT_FILENAME : RIGHT_FILENAME);
    if (dataFile.is_open())
    {
        string delimiter = " ";
        size_t pos = 0;
        string token;
        int iz, iy, ix, t = 0;
        while (getline(dataFile, line))
        {
            while ((pos = line.find(delimiter)) != string::npos)
            {
                iz = t / (X()*Y());
                iy = (t % (X()*Y())) / X();
                ix = (t % (X()*Y())) % X();
                token = line.substr(0, pos);
                line.erase(0, pos + delimiter.length());
                m_data[iz][iy][ix] = atoi(token.c_str());
                t++;
            }
            iz = t / (X()*Y());
            iy = (t % (X()*Y())) / X();
            ix = (t % (X()*Y())) % X();
            m_data[iz][iy][ix] = atoi(line.c_str());
            t++;
        }
    }
    dataFile.close();
}

Shoulder::~Shoulder()
{
    for (int k = 0; k < Z(); k++)
    {
        for (int j = 0; j < Y(); j++)
        {
            delete m_data[k][j];
        }
        delete m_data[k];
    }
    delete m_data;
}

int ** Shoulder::GetSlice(int number) const
{
    int ** slice = new int*[Z()];
    for (int iz = 0; iz < Z(); iz++)
    {
        slice[iz] = new int[X()];
        for (int ix = 0; ix < X(); ix++)
        {
            slice[iz][ix] = m_data[iz][number][ix];
        }
    }
    return slice;
}

vector<DecCoords2D*> Shoulder::GetBezierLine(double alpha) const
{
    vector<DecCoords2D*> line;
    line.reserve(BEZIER_LENGTH);
    for (int it = 0; it < BEZIER_LENGTH; it++)
    {
        line.push_back(FindPoint(alpha, static_cast<float>(it)/BEZIER_LENGTH,
                             X()*SIZE_X_VOXEL, Z()*SIZE_Z_VOXEL));
    }
    return line;
}