如何使用OSMDroid检查当前位置与KML点之间的距离？

implementation 'org.osmdroid:osmdroid-android:6.1.10'

LocationManager locationManager = (LocationManager) getSystemService(Context.LOCATION_SERVICE);
Criteria criteria = new Criteria();
String provider = locationManager.getBestProvider(criteria, false);
Location location = locationManager.getLastKnownLocation(provider);
double latitude = location.getLatitude();
double longitude = location.getLongitude();

// 使用SimpleXML解析KML文件
Serializer serializer = new Persister();
File kmlFile = new File("path/to/kml/file.kml");
Kml kml = serializer.read(Kml.class, kmlFile);
Placemark placemark = kml.getFeature().getPlacemarks().get(0);
double kmlLatitude = placemark.getGeometry().getLocation().getLatitude();
double kmlLongitude = placemark.getGeometry().getLocation().getLongitude();

private static final int EARTH_RADIUS = 6371; // 地球平均半径，单位为千米

private double calculateDistance(double lat1, double lon1, double lat2, double lon2) {
    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.atan2(Math.sqrt(a), Math.sqrt(1 - a));
    double distance = EARTH_RADIUS * c;
    return distance;
}

double distance = calculateDistance(latitude, longitude, kmlLatitude, kmlLongitude);