///////////// 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);