aswi2021virtual-surreality-gitlab/deltarobot/element/element.cpp @ c137512e

#include "element.hpp"

const int Element::DATA_COUNT_FOR_VERTEX = 7;
const int Element::TRAJECTORY = 0;
const int Element::SPHERE = 1;
const int Element::SPHERE_FIXED = 2;
const int Element::ARROW = 3;
const int Element::ARROW_SPECIAL = 4;
const int Element::WALL = 5;

Element::Element(const int category)
{
    this->category = category;
}

const float *Element::getData() const
{
    return data.data();
}

int Element::dataCount() const
{
    return data.size();
}

int Element::vertexCount() const
{
    return dataCount() / DATA_COUNT_FOR_VERTEX;
}

void Element::addVertex(const QVector3D &v, const QVector3D &n)
{
    data.insert(data.end(), {v.x(), v.y(), v.z(), n.x(), n.y(), n.z(), (float) category});
}

void Element::addTetragon(const QVector3D &a, const QVector3D &b, const QVector3D &c, const QVector3D &d)
{
    QVector3D n = normal(a, d, b);
    addTriangleWithNormal(a, d, b, n);
    addTriangleWithNormal(c, b, d, n);
}

void Element::addTriangle(const QVector3D &a, const QVector3D &b, const QVector3D &c)
{
    addTriangleWithNormal(a, b, c, normal(a, b, c));
}

QVector3D Element::normal(const QVector3D &a, const QVector3D &b, const QVector3D &c)
{
    return QVector3D::normal(b - a, c - a);
}

void Element::clear()
{
    data.clear();
}

void Element::addTriangleWithNormal(const QVector3D &a, const QVector3D &b, const QVector3D &c, const QVector3D &n)
{
    addVertex(a, n);
    addVertex(b, n);
    addVertex(c, n);
}