Как выбрать правильную параллельную дорогу с учетом местоположения и направления GPS
У меня есть два вектора (с цифровой карты), точка и пеленг. Эти векторы проходят почти параллельно друг другу, и я знаю расстояние до векторов от точки и направление этих двух векторов. Я уже написал код, который оценивает расстояния с помощью настраиваемого порога (например, 5 метров), а затем оценивает пеленги, чтобы найти ближайший, но этот порог слишком "резкий" и пропускает некоторые варианты использования. Это почти похоже на то, что эффекты расстояния или пеленга должны уменьшаться по мере удаления, но я понятия не имею, как разработать такой алгоритм. По сути, вектор под углом 90 градусов на расстоянии 0 метров должен оцениваться как находящийся дальше, чем вектор под углом 1 градус, но на расстоянии семи метров. Спутниковая навигация должна делать это постоянно, но я не могу найти справки о том, как это сделать. Я'Я не специалист по математике, и мое приложение написано на C/C#, поэтому любые примеры исходного кода будут для меня более понятными, чем математические уравнения. Спасибо. Тим