Method push

ogsr_engine/xrCore/_sphere.cpp:228–283

void Basis::pop() { --m; }

bool Basis::push(const Fvector& p)
{
    if (m == 0)
    {
        q0 = p;
        c[0] = q0;
        sqr_r[0] = 0;
    }
    else
    {
        int i;
        const float eps = 1e-16f;

        // set v_m to Q_m
        v[m].sub(p, q0);

        // compute the a_{m,i}, i< m
        for (i = 1; i < m; ++i)
        {
            a[m][i] = v[i].dotproduct(v[m]);
            a[m][i] *= (2.f / z[i]);
        }

        // update v_m to Q_m-\bar{Q}_m
        for (i = 1; i < m; ++i)
        {
            v[m].mad(v[m], v[i], -a[m][i]);
        }

        // compute z_m
        z[m] = 0;
        z[m] += v[m].square_magnitude();
        z[m] *= 2;

        // reject push if z_m too small
        if (z[m] < eps * current_sqr_r)
        {
            return false;
        }

        // update c, sqr_r
        float e = -sqr_r[m - 1];
        e += p.distance_to_sqr(c[m - 1]);

        f[m] = e / z[m];

        c[m].mad(c[m - 1], v[m], f[m]);

        sqr_r[m] = sqr_r[m - 1] + e * f[m] / 2;
    }

    current_c = c + m;
    current_sqr_r = sqr_r[m];
    s = ++m;
    return true;
}

void Fsphere_compute(Fsphere& dest, const Fvector* verts, int count)