Function replaceStraightSegmentsWithOneLine

source/MRVoxels/MRToolPath.cpp:1594–1647

std::vector<GCommand> replaceStraightSegmentsWithOneLine( const std::span<GCommand>& path, float eps, float maxLength, Axis axis )
{
    if ( path.size() < 3 )
        return {};

    std::vector<GCommand> res;

    const float epsSq = eps * eps;
    const float maxLengthSq = maxLength * maxLength;
    int startIdx = 0, endIdx = 0;
    for ( int i = startIdx + 2; i < path.size(); ++i )
    {
        const auto& d0 = path[startIdx];
        const auto& d2 = path[i];

        const Vector2f p0 = project( d0, axis );
        const Vector2f p2 = project( d2, axis );

        if ( ( p0 - p2 ).lengthSq() < maxLengthSq ) // don't merge too long lines
        {
            bool allInTolerance = true;
            for ( int k = startIdx + 1; k < i; ++k )
            {
                const auto& dk = path[k];

                const Vector2f pk = project( dk, axis );
                const float dist2 = distSqrToLineSegment( pk, p0, p2 );
                if ( dist2 > epsSq )
                {
                    allInTolerance = false;
                    break;
                }
            }
            if ( allInTolerance )
            {
                endIdx = i;
                if ( i < path.size() - 1 ) // don't continue on last point, do interpolation
                    continue;
            }
        }

        res.push_back( path[endIdx] );
        startIdx = ( startIdx <= endIdx ) ? endIdx + 1 : endIdx;
        endIdx = startIdx;
        i = startIdx + 1;
    }

    for ( int i = startIdx; i < path.size(); ++i )
    {
        res.push_back( path[i] );
    }

    return res;
}

Expected<void> interpolateLines( std::vector<GCommand>& commands, const LineInterpolationParams& params, Axis axis )
{