Function FindNearestPointOnLine

src/SB/Core/gc/iCollide.cpp:114–152

}

void FindNearestPointOnLine(xVec3* _result, xVec3* _point, xVec3* _start, xVec3* _end)
{
    RwV3d localResult;
    RwV3d* result = (RwV3d*)_result;
    RwV3d* point = (RwV3d*)_point;
    RwV3d* start = (RwV3d*)_start;
    RwV3d* end = (RwV3d*)_end;

    float mu;
    float lineLength2;

    mu = (point->x * (end->x - start->x) + point->y * (end->y - start->y) +
          point->z * (end->z - start->z)) -
         (start->x * (end->x - start->x) + start->y * (end->y - start->y) +
          start->z * (end->z - start->z));
    if (mu <= 0.0f)
    {
        localResult = *start;
    }
    else
    {
        lineLength2 = SQR(end->x - start->x) + SQR(end->y - start->y) + SQR(end->z - start->z);
        if (mu < lineLength2)
        {
            mu /= lineLength2;
            localResult.x = mu * (end->x - start->x);
            localResult.x += start->x;
            localResult.y = mu * (end->y - start->y);
            localResult.y += start->y;
            localResult.z = mu * (end->z - start->z);
            localResult.z += start->z;
        }
        else
        {
            localResult = *end;
        }
    }
    *result = localResult;
}

static void properSphereIsectTri(const xVec3* center, F32 radius, xVec3* tohit, F32* dist_ptr,
                                 RpCollisionTriangle* tri)