vectozavr-shooter/engine/physics/Simplex.h

//
// Created by Иван Ильин on 08.03.2021.
//

#ifndef ENGINE_SIMPLEX_H
#define ENGINE_SIMPLEX_H

#include "../Vec3D.h"
#include <list>

enum class SimplexType {
    Zero,
    Point,
    Line,
    Triangle,
    Tetrahedron
};

struct Simplex final {
private:
    std::list<Vec3D> _points{};

public:
    Simplex() = default;

    Simplex(std::initializer_list<Vec3D> list) {
        for (const auto & v : list) {
            _points.push_back(v);
            if(_points.size() > 4)
                _points.pop_front();
        }
    }

    void push_front(const Vec3D& point) {
        _points.push_front(point);
        if(_points.size() > 4)
            _points.pop_back();
    }

    Vec3D operator[](unsigned i) const {
        auto it = _points.begin();
        for(unsigned k=0; k<i; k++)
            ++it;
        return *it;

    }
    [[nodiscard]] unsigned size() const { return _points.size(); }

    [[nodiscard]] auto begin() const { return _points.begin(); }
    [[nodiscard]] auto end()   const { return _points.end(); }

    [[nodiscard]] SimplexType type() const { return static_cast<SimplexType>(_points.size()); }
};

#endif //INC_3DZAVR_SIMPLEX_H