rendered paste body ///////////// START GPS AND WAYPOINT CODE
long double along;
along = 174.681821;
// print_double("Score = %lf\n",along);
long double alat;
alat = deg2rad(-36.788889);
long double blong;
blong = 174.668494;
long double blat;
blat = deg2rad(-36.785127);
long double adiff;
adiff = blong - along;
if (adiff > 180) {
adiff -= 360;
}
if (adiff < -180) {
adiff += 360;
}
long double bdiff;
bdiff = deg2rad(adiff);
long double cosdist;
cosdist = (sin(alat) * sin(blat) + cos(alat) * cos(blat) * cos(bdiff));
long double rdist;
rdist = acos(cosdist);
long double nautical_miles;
nautical_miles = abs(rad2deg(rdist) * 60);