Vector3d getReflected(const Vector3d &p, const Hyperplane<double,3> &plane) { Vector3d r = p- 2*plane.signedDistance(p)*plane.normal(); return r; }