مسیر یابی در Gooegle Maps

این تابع دوتا ورودی داره. اولی، مختصاتکاربر(همون Latitude و Longitude) و دومی مختصات مقصد. 

 public double CalculationByDistance(LatLng StartP, LatLng EndP) {
 double Radius=6378.1;//radius of earth in Km
    double lat1 = StartP.latitude;
    double lat2 = EndP.latitude;
    double lon1 = StartP.longitude;
    double lon2 = EndP.longitude;
    double dLat = Math.toRadians(lat2-lat1);
    double dLon = Math.toRadians(lon2-lon1);
  double a = Math.sin(dLat/2) * Math.sin(dLat/2) + Math.cos(Math.toRadians(lat1)) * Math.cos(Math.toRadians(lat2)) * Math.sin(dLon/2) * Math.sin(dLon/2);
double c = 2 * Math.asin(Math.sqrt(a));
    DecimalFormat newFormat = new DecimalFormat("####");
    double valueResult= Radius*c;
    double raw=valueResult*1000;
    double km=raw/1000;
    double meter=raw%1000;
    long kmInDec =  (int) km;
    int  meterInDec= Integer.valueOf(newFormat.format(meter));
    if(kmInDec == 0 ) {
        txtDistance.setText(meterInDec + " متر ");
    }else {
        txtDistance.setText(kmInDec + " کیلومتر " +" و "+ meterInDec + " متر ");
    }
    Log.i("Radius Value", "" + valueResult + "   KM  " + kmInDec + " Meter   " + meterInDec);
    return Radius * c;
}