//==========================================================================* // Utility to get curvature (Inverser Radius) //--------------------------------------------------------------------------* double TUtils::CalcCurvatureXY( const TVec3d& p1, const TVec3d& p2, const TVec3d& p3 ) { return CalcCurvature(p1.x, p1.y, p2.x, p2.y, p3.x, p3.y); }
double Utils::CalcCurvatureZ( const Vec3d& p1, const Vec3d& p2, const Vec3d& p3 ) { double x1 = 0; double x2 = (p1 - p2).len(); double x3 = x2 + (p2 - p3).len(); return CalcCurvature(x1, p1.z, x2, p2.z, x3, p3.z); }
double Utils::CalcCurvature( const Vec2d& p1, const Vec2d& p2, const Vec2d& p3 ) { return CalcCurvature(p1.x, p1.y, p2.x, p2.y, p3.x, p3.y); }