Function nearestFloorCB

src/SB/Core/x/xScene.cpp:838–992

}

static RpCollisionTriangle* nearestFloorCB(RpIntersection*, RpCollisionTriangle* collTriangle,
                                           RwReal, void* data)
{
    xNearFloorPoly* nfpoly = (xNearFloorPoly*)data;
    F32 currnear = nfpoly->neardist;
    xVec3 currpt;
    S32 currvert, curredge;
    xVec3 xformVert[4], xformNorm;
    U32 potentialOID;
    S32 i;
    F32 pdx[3], pdz[3];
    F32 numer, denom, t, testdist2, neardx, neardz, nearmag;
    xVec3 edgevec, centvec, testpt;

    if (sUseJSP)
    {
        if (((xClumpCollBSPTriangle*)collTriangle->index)->flags & 0x10)
        {
            return collTriangle;
        }
        potentialOID = ((xClumpCollBSPTriangle*)collTriangle->index)->matIndex;
    }
    else
    {
        potentialOID = collTriangle->index;
    }

    if (sBoxTestMat)
    {
        xMat4x3Toworld(&xformVert[0], sBoxTestMat, (xVec3*)collTriangle->vertices[0]);
        xMat4x3Toworld(&xformVert[1], sBoxTestMat, (xVec3*)collTriangle->vertices[1]);
        xMat4x3Toworld(&xformVert[2], sBoxTestMat, (xVec3*)collTriangle->vertices[2]);
        xMat3x3RMulVec(&xformNorm, sBoxTestMat, (xVec3*)&collTriangle->normal);
        xVec3Normalize(&xformNorm, &xformNorm);
    }
    else
    {
        xformVert[0] = *(xVec3*)collTriangle->vertices[0];
        xformVert[1] = *(xVec3*)collTriangle->vertices[1];
        xformVert[2] = *(xVec3*)collTriangle->vertices[2];
        xformNorm = *(xVec3*)&collTriangle->normal;
    }

    if (xformNorm.y < nfpoly->floorDot)
    {
        return collTriangle;
    }

    pdx[0] = nfpoly->center.x - xformVert[0].x;
    pdx[1] = nfpoly->center.x - xformVert[1].x;
    pdx[2] = nfpoly->center.x - xformVert[2].x;
    pdz[0] = nfpoly->center.z - xformVert[0].z;
    pdz[1] = nfpoly->center.z - xformVert[1].z;
    pdz[2] = nfpoly->center.z - xformVert[2].z;

    F32 f3 = pdx[0] * pdz[1] - pdz[0] * pdx[1];
    F32 f2 = pdx[1] * pdz[2] - pdz[1] * pdx[2];
    F32 f1 = pdx[2] * pdz[0] - pdz[2] * pdx[0];