60 lines
1.3 KiB
C++
60 lines
1.3 KiB
C++
/**
|
|
* Implementation of a spheroid
|
|
**/
|
|
|
|
#include "spheroid.hpp"
|
|
|
|
Spheroid::Spheroid(Point& _center, size_t _p, size_t _q) :
|
|
ImplicitSurface(_center), 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();
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
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);
|
|
}
|