/** * Implementation of a spheroid **/ #include "spheroid.hpp" Spheroid::Spheroid(Point& _center, size_t _p, size_t _q) : ImplicitSurface(_center), normal_vector(Point(0,0,1)), init_p(_p), p(_p), q(_q), stiffness(0) { _compute_volume(); } void Spheroid::_compute_volume() { V = (4/3) * PI * p * q * q; } void Spheroid::set_stiffness(size_t _stiffness) { stiffness = _stiffness; } void Spheroid::update_radius() { q = sqrt((3/4) * V / PI / p); } void Spheroid::update_height() { q = (3/4) * V / PI / (p*p); } void Spheroid::update_center_pos(Point& _center) { center = _center; } void Spheroid::check_horizontal_plan_collision(double& height) { if ((center.z - p) <= height) { p = fmin(init_p, center.z-height); update_radius(); } } void Spheroid::check_vertical_plan_collision(double& abscissa) { if (center.x <= abscissa) { if ((center.x + q) >= abscissa) { q = abscissa - center.x; update_height(); } } else { if ((center.x - q) <= abscissa) { q = center.x - abscissa; update_height(); } } } void Spheroid::check_perlin_collision(PerlinNoise perlin) { double height = perlin.noise(center.x, center.y); if ((center.z - p) <= height) { p = fmin(init_p, center.z- height ); normal_vector = perlin.normal_vector(center.x, center.y); update_radius(); } } double Spheroid::operator() (double _x, double _y, double _z) const { return (pow(_x - center.x, 2) / pow(q, 2) + pow(_y - center.y, 2) / pow(q, 2) + pow(_z - center.z, 2) / pow(p, 2) -1); }