расчет растояния по координатам. Опции

[alexdos]

Подскажите где почитать про расчет растояния по координатам, нужно упрощенная формула, для растояний до 500 метров, точность не шибкая, и пару метров устрит. Но чтоб просто и быстро. Нужно знать приблизился ли обьект с жпс на какоето растояния до статической координаты. Координат будет штук 500, а может и больше.

[adnega]

Подскажите где почитать про расчет растояния по координатам, нужно упрощенная формула, для растояний до 500 метров, точность не шибкая, и пару метров устрит. Но чтоб просто и быстро. Нужно знать приблизился ли обьект с жпс на какоето растояния до статической координаты. Координат будет штук 500, а может и больше.

Я вот так считаю:

Код

#include <math.h>

double sdlat, sdlon, dist;
volatile double lat, clat, lon, clon;

clat = 57.60904722 * M_PI / 180.0;
clon = 39.82411944 * M_PI / 180.0;

lat = 57.6083 * M_PI / 180.0;
lon = 39.82488333 * M_PI / 180.0;

sdlat = sin((lat - clat) / 2.0);
sdlon = sin((lon - clon) / 2.0);
dist = 2.0 * asin(sqrt(sdlat * sdlat + cos(clat) * cos(lat) * sdlon * sdlon)) * 6367444.6571225;

На Cortex-M4F довольно быстро.