recon/CameraMesh.cpp at master · bunbun205/recon · 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
94
95
96
97
98
#include "CameraMesh.h"

void plane2Buffer(Vertex * & vertexBuffer, GLuint * & elementBuffer, unsigned int & elementStartIndex,
                      const Vertex & a, const Vertex & b, const Vertex & c, const Vertex & d)
{

    vertexBuffer[0] = a;
    vertexBuffer[1] = b;
    vertexBuffer[2] = c;
    vertexBuffer[3] = d;

    if (a.y < c.y) {
        vertexBuffer[0].r *= 0.5;
        vertexBuffer[1].r *= 0.5;
        vertexBuffer[0].g *= 0.5;
        vertexBuffer[1].g *= 0.5;
        vertexBuffer[0].b *= 0.5;
        vertexBuffer[1].b *= 0.5;
    }

    vertexBuffer += 4;

    elementBuffer[0] = elementStartIndex;
    elementBuffer[1] = elementStartIndex+1;
    elementBuffer[2] = elementStartIndex+3;
    elementBuffer[3] = elementStartIndex+1;
    elementBuffer[4] = elementStartIndex+2;
    elementBuffer[5] = elementStartIndex+3;

    elementBuffer += 6;
    elementStartIndex += 4;
}

CameraMesh::CameraMesh(const QVector3D position){

    mVertices.push_back(position);
    mVertices.push_back(position + QVector3D( 0.2,  0.15, -0.5));
    mVertices.push_back(position + QVector3D(-0.2,  0.15, -0.5));
    mVertices.push_back(position + QVector3D(-0.2, -0.15, -0.5));
    mVertices.push_back(position + QVector3D( 0.2, -0.15, -0.5));

    setColor(Qt::yellow);
}

void CameraMesh::transform(const QMatrix4x4 &transform){

    for(QVector3D &v : mVertices)
        v = transform * v;
}

void CameraMesh::copy2Buffer(Vertex *&vertexBuffer, GLuint *&elementBuffer, unsigned int &elementStartIndex) const{

    std::vector<QColor> cols;
    Q_ASSERT(!mColors.empty());
    // three ways to store vertex colors
    if (mColors.size() == 1) {
        cols = std::vector<QColor>(5, mColors[0]);
    }
    else {
        Q_ASSERT(mColors.size() == 5);
        cols = mColors;
    }

    plane2Buffer(vertexBuffer, elementBuffer, elementStartIndex,
            Vertex(mVertices[0], cols[0]),
            Vertex(mVertices[1], cols[0]),
            Vertex(mVertices[2], cols[0]),
            Vertex(mVertices[0], cols[0])
        );

    plane2Buffer(vertexBuffer, elementBuffer, elementStartIndex,
            Vertex(mVertices[0], cols[1]),
            Vertex(mVertices[2], cols[1]),
            Vertex(mVertices[3], cols[1]),
            Vertex(mVertices[0], cols[1])
        );

    plane2Buffer(vertexBuffer, elementBuffer, elementStartIndex,
            Vertex(mVertices[0], cols[2]),
            Vertex(mVertices[3], cols[2]),
            Vertex(mVertices[4], cols[2]),
            Vertex(mVertices[0], cols[2])
        );

    plane2Buffer(vertexBuffer, elementBuffer, elementStartIndex,
            Vertex(mVertices[0], cols[3]),
            Vertex(mVertices[4], cols[3]),
            Vertex(mVertices[2], cols[3]),
            Vertex(mVertices[0], cols[3])
        );

    plane2Buffer(vertexBuffer, elementBuffer, elementStartIndex,
            Vertex(mVertices[1], cols[4]),
            Vertex(mVertices[2], cols[4]),
            Vertex(mVertices[3], cols[4]),
            Vertex(mVertices[7], cols[4])
        );
}