54 lines
1.6 KiB
C++
54 lines
1.6 KiB
C++
//
|
|
// Created by Иван Ильин on 13.01.2021.
|
|
//
|
|
|
|
#include "Triangle.h"
|
|
|
|
Triangle::Triangle () {
|
|
_points.emplace_back(Point4D(0, 0, 0, 1));
|
|
_points.emplace_back(Point4D(0, 0, 0, 1));
|
|
_points.emplace_back(Point4D(0, 0, 0, 1));
|
|
}
|
|
|
|
Triangle::Triangle(const Point4D& p1, const Point4D& p2, const Point4D& p3, sf::Color color) : _color(color) {
|
|
_points.emplace_back(Point4D(p1));
|
|
_points.emplace_back(Point4D(p2));
|
|
_points.emplace_back(Point4D(p3));
|
|
}
|
|
|
|
Triangle::Triangle(const Triangle &triangle) : _points(triangle._points), _color(triangle._color) {
|
|
|
|
}
|
|
|
|
Triangle Triangle::operator*(const Matrix4x4 &matrix4X4) const {
|
|
return Triangle(matrix4X4 * _points[0], matrix4X4 * _points[1], matrix4X4 * _points[2], _color);
|
|
}
|
|
|
|
Vec3D Triangle::norm() const {
|
|
|
|
Vec3D v1 = Vec3D(_points[1] - _points[0]);
|
|
Vec3D v2 = Vec3D(_points[2] - _points[0]);
|
|
Vec3D crossProduct = v1.cross(v2);
|
|
|
|
if(crossProduct.sqrAbs() > Consts::EPS)
|
|
return crossProduct.normalized();
|
|
else
|
|
return Vec3D(0);
|
|
}
|
|
|
|
Point4D Triangle::operator[](int i) const {
|
|
return _points[i];
|
|
}
|
|
|
|
bool Triangle::isPointInside(const Vec3D &point) const {
|
|
Vec3D triangleNorm = norm();
|
|
|
|
double dot1 = (point - Vec3D(_points[0])).cross(Vec3D(_points[1] - _points[0])).dot(triangleNorm);
|
|
double dot2 = (point - Vec3D(_points[1])).cross(Vec3D(_points[2] - _points[1])).dot(triangleNorm);
|
|
double dot3 = (point - Vec3D(_points[2])).cross(Vec3D(_points[0] - _points[2])).dot(triangleNorm);
|
|
|
|
if((dot1 >= 0 && dot2 >= 0 && dot3 >= 0) || (dot1 <= 0 && dot2 <= 0 && dot3 <= 0))
|
|
return true;
|
|
return false;
|
|
}
|