Ну что, вы поможете, или придется обращаться на форум по алгебре и геометрии?
По середине дороги есть вейпоинты и машина движется по ним. Если машина вылетела с трассы, нужно вернуть ее на дорогу, а именно на линию между двумя последними вейпоинтами, между которыми произошла авария. Позиция вейпоинтов известна, позиция точки, где машина улетела с трассы- тоже, она будет сбоку от линии между вейпоинтами и дорогой, валяться в кювете. Теперь надо вычислить новую точку, которая была бы ближайшей к месту, где в обочине валяется машина, но была бы строго на прямой линии между вейпоинтами на автодороге.
Нарисовал схемку, Точка 1 и Точка 2- вейпоинты на дороге, сбоку Точка 3 - валяющаяся в кустах машина, надо вычислить позицию точки на линии между вейпоинтами (там где куча знаков вопроса):