File content as of revision 0:d463d5c04541:

int gpscnt = 0;



void gpscal()
{      
        
        if(gpscnt<10){
            lats = gps.lat; //latt=37.541230;    //37.540553;
            lons = gps.lon; // lont=127.079819;   // 127.078038; 
            gpscnt++;
        }
        
        latt = lats; //37.5409023;//
        lont = lons; //127.0800591;//
         
        latp = gps.lat;
        lonp = gps.lon;
        
        dlat = latp - latt;
        dlon = lonp - lont;
        
        //GPSASCII();
        
        /*
        //jarak ke tujuan.....
        latp=latp*3.14/180;  //ftoa(latp, 1, dst);  putstr3(dst); putchar3('\n');
        latt=latt*3.14/180;  //ftoa(latt, 1, dst);  putstr3(dst); putchar3('\n');
        lonp=lonp*3.14/180;  //ftoa(lonp, 1, dst);  putstr3(dst); putchar3('\n');
        lont=lont*3.14/180;  //ftoa(lont, 1, dst);  putstr3(dst); putchar3('\n');
        d_lat=latp-latt;
        d_lon=lonp-lont;
        a=(sin(d_lat/2))*(sin(d_lat/2))+cos(latt)*cos(latp)*(sin(d_lon/2))*(sin(d_lon/2));
        //c=2*atan2(sqrt(a),sqrt(1-a));
        //d=r*c;          
        c=2*asin(sqrt(a));              
        d=c*180*60*1000/3.14*1.852;     // d = distance to target  
       // if(d > 5000 || d < -5000) d = ld;      
        gps.dist = d;
        
        //sudut hadap ke tujuan....
        //b=atan2(sin(d_lon)*cos(latp), cos(latt)*sin(latp)-sin(latt)*cos(latp)*cos(d_lon));
        b=(acos((sin(latt)-sin(latp)*cos(c))/(sin(c)*cos(latp))))*180/3.14;
        if (b==360)b=0;
        gps.bear = b;             
    
        ld = d;        
        GPSASCII();
        */
        
}