Определение расстояние по координатам GPS, Необходим алгоритм Опции

[Newegor]

Есть задача определения пробега авто по координатам получаемым с GPS модуля по протоколу NMEA. Все работает, вот только осталось сделать подсчет расстояния. Какие есть алгоритмы. Сейчас считаю очень просто по теореме Пифагора, но это для маленьких расстояний подходит, плюс еще не определился как исключить погрешность определения координат, когда авто стоит. Они прыгают иногда и на десятки метров, а авто в это время стоит. В общем поиском по инету ничего путного не нашел (может и плохо искал). Если есть какие-нибудь стандартные методики, то буду благодарен за них.

[AndrewGT]

//v - скорость из VTG, узел = 1852 м/час
S += v*dt
if(v<V0) v = 0; // V0 поставьте, скажем 0.2 м/с