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

#include <utility>
#include "Mesh.h"
#include "ResourceManager.h"

using namespace std;

Mesh &Mesh::operator*=(const Matrix4x4 &matrix4X4) {
    std::vector<Triangle> newTriangles;
    for(auto &t : _tris) {
        newTriangles.emplace_back(t * matrix4X4);
    }
    setTriangles(newTriangles);

    return *this;
}

Mesh &Mesh::loadObj(const std::string& filename, const Vec3D& scale) {

    auto objects = ResourceManager::loadObjects(filename);
    for(auto& obj : objects) {
        for (auto &tri : obj->triangles()) {
            _tris.push_back(tri);
        }
    }
    this->scale(scale);

    return *this;
}

Mesh::Mesh(const std::string& filename, const Vec3D& scale){
    loadObj(filename, scale);
}

Mesh::Mesh(const vector<Triangle> &tries) : _tris(tries) {
}

Mesh Mesh::Obj(const std::string& filename) {
    return Mesh(filename);
}

void Mesh::rotate(const Vec3D &r) {
    Object::rotate(r);
    *this *= Matrix4x4::Rotation(r);
}

void Mesh::rotate(const Vec3D &v, double r) {
    Object::rotate(v, r);
    *this *= Matrix4x4::Rotation(v, r);
}

void Mesh::scale(const Vec3D &s) {
    Object::scale(s);
    *this *= Matrix4x4::Scale(s);
}

void Mesh::rotateRelativePoint(const Vec3D &s, const Vec3D &r) {
    Object::rotateRelativePoint(s, r);
    *this *= Matrix4x4::Rotation(r);
}

void Mesh::rotateRelativePoint(const Vec3D &s, const Vec3D &v, double r) {
    Object::rotateRelativePoint(s, v, r);
    *this *= Matrix4x4::Rotation(v, r);
}

void Mesh::setColor(const sf::Color& c) {
    _color = c;

    // change color of all mesh triangles:
    std::vector<Triangle> newTriangles;
    for(auto &t : _tris) {
        newTriangles.emplace_back(Triangle(t[0], t[1], t[2], c));
    }
    setTriangles(newTriangles);
}

Mesh Mesh::LineTo(const Vec3D& from, const Vec3D& to, double line_width, const sf::Color& color) {

    Mesh line;

    Vec3D v1 = (to - from).normalized();
    Vec3D v2 = from.cross(from + Vec3D{1, 0, 0}).normalized();
    Vec3D v3 = v1.cross(v2).normalized();

    // from plane
    Point4D p1 = (from - v2 * line_width/2.0 - v3 * line_width/2.0).makePoint4D();
    Point4D p2 = (from - v2 * line_width/2.0 + v3 * line_width/2.0).makePoint4D();
    Point4D p3 = (from + v2 * line_width/2.0 + v3 * line_width/2.0).makePoint4D();
    Point4D p4 = (from + v2 * line_width/2.0 - v3 * line_width/2.0).makePoint4D();
    // to plane
    Point4D p5 = (to - v2 * line_width/2.0 - v3 * line_width/2.0).makePoint4D();
    Point4D p6 = (to - v2 * line_width/2.0 + v3 * line_width/2.0).makePoint4D();
    Point4D p7 = (to + v2 * line_width/2.0 + v3 * line_width/2.0).makePoint4D();
    Point4D p8 = (to + v2 * line_width/2.0 - v3 * line_width/2.0).makePoint4D();


    line._tris = std::move(std::vector<Triangle>{
            { p2, p4, p1 },
            { p2, p3, p4 },
            { p1, p6, p2 },
            { p1, p5, p6 },
            { p2, p6, p7 },
            { p2, p7, p3 },
            { p6, p5, p8 },
            { p6, p8, p7 },
            { p4, p3, p7 },
            { p4, p7, p8 },
            { p1, p8, p5 },
            { p1, p4, p8 }
    });
    line.setColor(color);

    return line;
}

Mesh::Mesh(const Mesh &mesh) : _tris(mesh._tris), _color(mesh._color), _visible(mesh._visible) {

}

void Mesh::setTriangles(const vector<Triangle> &t) {
    _tris.clear();
    for (auto & tri : t) {
        _tris.push_back(tri);
    }
}

Mesh::~Mesh() {
    _tris.clear();
}