double DIST(double StartLat, double StartLong, double EndLat, double EndLong)
{
double fPhimean,            // Средняя широта
fdLambda,                  // Разница между двумя значениями долготы
fdPhi,                     // Разница между двумя значениями широты
fAlpha,                    // Смещение
fRho,                      // Меридианский радиус кривизны
fNu,                       // Поперечный радиус кривизны
fR,                        // Радиус сферы Земли
fz,                        // Угловое расстояние от центра сфероида
fTemp,                     // Временная переменная, использующаяся в вычислениях
Distance;                  // Вычисленное расстояния в метрах

unsigned char S[20];

// Вычисляем разницу между двумя долготами и широтами и получаем среднюю широту
fdLambda=(StartLong - EndLong)*D2R;
fdPhi=(StartLat - EndLat)*D2R;
fPhimean=((StartLat + EndLat)/2.0)*D2R;

// Вычисляем меридианные и поперечные радиусы кривизны средней широты
fTemp=1-e2*(pow(sin(fPhimean),2));
fRho=(a*(1-e2))/pow(fTemp, 1.5);
fNu=a/(sqrt(1-e2*(sin(fPhimean)*sin(fPhimean))));
// Вычисляем угловое расстояние                                        
fz=sqrt(pow(sin(fdPhi/2.0),2)+cos(EndLat*D2R)*cos(StartLat*D2R)*pow(sin(fdLambda/2.0),2));
fz=2*asin(fz);
// Вычисляем смещение
fAlpha=cos(EndLat*D2R)*sin(fdLambda)*1/sin(fz);
fAlpha=asin(fAlpha);
// Вычисляем радиус Земли
fR=(fRho*fNu)/((fRho*pow(sin(fAlpha),2))+(fNu*pow(cos(fAlpha),2)));
// Получаем расстояние
Distance=(fz*fR);
return Distance;                                                    
};

double Azimut(double StartLat, double StartLong, double EndLat, double EndLong)
{
double AZ;
double OX,OY;
unsigned char S[20];
OX=DIST(StartLat, StartLong, StartLat, EndLong);
OY=DIST(StartLat, StartLong, EndLat, StartLong);
if (StartLat<=EndLat)
        {
        if (StartLong<=EndLong)
                        {
                        AZ=atan(OX/OY)*R2D;
                        }
                        else
                        {
                        AZ=360-atan(OX/OY)*R2D;
                        };
        }
        else
        {
        if (StartLong<=EndLong)
                        {
                        AZ=180-atan(OX/OY)*R2D;
                        }
                        else
                        {
                        AZ=180+atan(OX/OY)*R2D;
                        };
        };  

return AZ;                
};