Method PathNearestPoint

ogsr_engine/xrGame/PHMovementControl.cpp:358–441

}

void CPHMovementControl::PathNearestPoint(const xr_vector<DetailPathManager::STravelPathPoint>& path, // in path
                                          const Fvector& new_position, // in position
                                          int& index, // in start from; out nearest
                                          bool& near_line // out type
)
{
    Fvector from_first, from_second, dir;
    bool after_line = true; // to check first point

    Fvector path_point, vtemp;
    float temp;
    int i = 0;

    for (; i < m_path_size - 1; ++i)
    {
        const Fvector &first = path[i].position, &second = path[i + 1].position;
        from_first.sub(new_position, first);
        from_second.sub(new_position, second);
        dir.sub(second, first);
        dir.normalize_safe();

        if (from_first.dotproduct(dir) < 0.f) // befor this line
        {
            if (after_line) // after previous line && befor this line = near first point
            {
                vtemp.sub(new_position, first);
                temp = vtemp.magnitude();
                if (temp < m_path_distance)
                {
                    m_path_distance = temp;
                    index = i;
                    vPathPoint.set(first);
                    SetPathDir(dir);
                    near_line = false;
                }
            }
            after_line = false;
        }
        else // after first
        {
            if (from_second.dotproduct(dir) < 0.f) // befor second && after first = near line
            {
                // temp=dir.dotproduct(new_position); seems to be wrong
                temp = dir.dotproduct(from_first);
                vtemp.set(dir);
                vtemp.mul(temp);
                path_point.add(vtemp, first);
                vtemp.sub(path_point, new_position);
                temp = vtemp.magnitude();
                if (temp < m_path_distance)
                {
                    m_path_distance = temp;
                    index = i;
                    vPathPoint.set(path_point);
                    SetPathDir(dir);
                    near_line = true;
                }
            }