计算工具类：public class HaversineDistanceCalculator { // 地球半径，单位为千米 private static final double EARTH_RADIUS = 6371; // 计算两点之间的距离，使用Haversine公式 private static double calculateDistance(double lat1, double lon1, double lat2, double lon2) { double phi1 = Math.toRadians(lat1); double phi2 = Math.toRadians(lat2); double dphi = Math.toRadians(lat2 - lat1); double dlambda = Math.toRadians(lon2 - lon1); double a = Math.sin(dphi / 2) * Math.sin(dphi / 2) + Math.cos(phi1) * Math.cos(phi2) * Math.sin(dlambda / 2) * Math.sin(dlambda / 2); double c = 2 * Math.atan2(Math.sqrt(a), Math.sqrt(1 - a)); return EARTH_RADIUS * c; } // 计算路径的总距离 public static double calculateTotalDistance(double[][] path) { double totalDistance = 0.0; for (int i = 0; i path.length - 1; i++) { double[] point1 = path[i];