Method measure

source/MRMesh/MRFeatures.cpp:468–523

}

MeasureResult Binary<Primitives::Sphere, Primitives::Sphere>::measure( const Primitives::Sphere& a, const Primitives::Sphere& b ) const
{
    MeasureResult ret;

    // Distance.

    Vector3f dir = b.center - a.center;
    float dirLen = dir.length();
    ret.distance.status = MeasureResult::Status::ok;
    ret.distance.distance = dirLen - a.radius - b.radius;
    if ( dirLen > 0 )
        dir /= dirLen;
    else
        dir = Vector3f( 1, 0, 0 ); // An arbitrary default direction.
    ret.distance.closestPointA = a.center + a.radius * dir;
    ret.distance.closestPointB = b.center - b.radius * dir;

    // Angle.

    if ( a.radius == 0 || b.radius == 0 )
    {
        ret.angle.status = MeasureResult::Status::badFeaturePair;
    }
    else
    {
        float s = ( dirLen + a.radius + b.radius ) / 2; // https://en.wikipedia.org/wiki/Altitude_(triangle)
        float intersectionSideOffset = std::sqrt( s * ( s - dirLen ) * ( s - a.radius ) * ( s - b.radius ) ) * 2 / dirLen;
        if ( !std::isfinite( intersectionSideOffset ) )
        {
            ret.angle.status = MeasureResult::Status::badRelativeLocation;
        }
        else
        {
            ret.angle.status = MeasureResult::Status::ok;

            float intersectionFwdOffset = std::sqrt( a.radius * a.radius - intersectionSideOffset * intersectionSideOffset );
            Vector3f sideDir = cross( dir, dir.furthestBasisVector() ).normalized();

            ret.angle.pointA = ret.angle.pointB = a.center + dir * intersectionFwdOffset + sideDir * intersectionSideOffset;
            ret.angle.dirA = ( ret.angle.pointA - a.center ).normalized();
            ret.angle.dirB = ( ret.angle.pointB - b.center ).normalized();
            ret.angle.isSurfaceNormalA = ret.angle.isSurfaceNormalB = true;

            // The circle at the intersection.
            ret.intersections.push_back( primitiveCircle( a.center + dir * intersectionFwdOffset, dir, intersectionSideOffset ) );
        }
    }

    // Center distance.
    ret.centerDistance.status = MeasureResult::Status::ok;
    ret.centerDistance.distance = dirLen;
    ret.centerDistance.closestPointA = a.center;
    ret.centerDistance.closestPointB = b.center;

    return ret;
}

MeasureResult Binary<Primitives::ConeSegment, Primitives::Sphere>::measure( const Primitives::ConeSegment& a, const Primitives::Sphere& b ) const