void addForce(const Vec3 &f)
double nearestPointHeight
std::vector< int > correspondingLidarPointList
std::size_t nearestPointIndex
Particle(Vec3 posVec, double time_step)
void satisfyConstraintSelf(int constraintTimes)
void offsetPos(const Vec3 v)
std::vector< Particle * > neighborsList