已知3个网格参考点x,y及经纬度，如何计算平面图内目标点经纬度

核心原理 #

小范围楼层场景下可忽略地球曲率影响，平面网格坐标与经纬度的映射符合线性变换规则，使用仿射变换即可实现高精度转换。3个非共线参考点刚好可以求解仿射变换的6个未知参数，变换公式如下：

lon = a * x + b * y + c
lat = d * x + e * y + f

其中a/b/c/d/e/f为待求解的变换参数，求解完成后代入任意平面x/y坐标即可得到对应经纬度。

Java实现代码 #

public class FloorCoordinateConverter {
    // 仿射变换参数
    private double a, b, c;
    private double d, e, f;

    /**
     * 构造方法，传入3个参考点求解变换参数
     * @param p1 参考点1，格式为[平面x, 平面y, 经度, 纬度]
     * @param p2 参考点2，格式为[平面x, 平面y, 经度, 纬度]
     * @param p3 参考点3，格式为[平面x, 平面y, 经度, 纬度]
     */
    public FloorCoordinateConverter(double[] p1, double[] p2, double[] p3) {
        double x1 = p1[0], y1 = p1[1], lon1 = p1[2], lat1 = p1[3];
        double x2 = p2[0], y2 = p2[1], lon2 = p2[2], lat2 = p2[3];
        double x3 = p3[0], y3 = p3[1], lon3 = p3[2], lat3 = p3[3];

        // 计算分母，若接近0说明三个参考点共线，无有效解
        double D = x1 * (y2 - y3) + x2 * (y3 - y1) + x3 * (y1 - y2);
        if (Math.abs(D) < 1e-6) {
            throw new IllegalArgumentException("三个参考点共线，无法求解变换参数");
        }

        // 求解经度相关参数a、b、c
        a = (lon1 * (y2 - y3) + lon2 * (y3 - y1) + lon3 * (y1 - y2)) / D;
        b = (x1 * (lon2 - lon3) + x2 * (lon3 - lon1) + x3 * (lon1 - lon2)) / D;
        c = (lon1 * (x2*y3 - x3*y2) + lon2 * (x3*y1 - x1*y3) + lon3 * (x1*y2 - x2*y1)) / D;

        // 求解纬度相关参数d、e、f
        d = (lat1 * (y2 - y3) + lat2 * (y3 - y1) + lat3 * (y1 - y2)) / D;
        e = (x1 * (lat2 - lat3) + x2 * (lat3 - lat1) + x3 * (lat1 - lat2)) / D;
        f = (lat1 * (x2*y3 - x3*y2) + lat2 * (x3*y1 - x1*y3) + lat3 * (x1*y2 - x2*y1)) / D;
    }

    /**
     * 平面坐标转经纬度
     * @param x 平面x坐标
     * @param y 平面y坐标
     * @return 转换后的经纬度，格式为[经度, 纬度]
     */
    public double[] convert(double x, double y) {
        double lon = a * x + b * y + c;
        double lat = d * x + e * y + f;
        return new double[]{lon, lat};
    }

    // 测试用例
    public static void main(String[] args) {
        // 三个参考点示例
        double[] p1 = new double[]{0, 0, 116.397428, 39.90923};
        double[] p2 = new double[]{100, 0, 116.398528, 39.90923};
        double[] p3 = new double[]{0, 50, 116.397428, 39.90973};

        FloorCoordinateConverter converter = new FloorCoordinateConverter(p1, p2, p3);
        // 转换平面坐标(50,25)
        double[] result = converter.convert(50, 25);
        System.out.printf("经度：%.6f，纬度：%.6f%n", result[0], result[1]);
    }
}

注意事项 #

• 三个参考点需避免共线，尽量分散在楼层平面的不同角落，可有效降低转换误差
• 若有超过3个参考点，可改用最小二乘法拟合变换参数，进一步提升转换精度
• 该方案仅适用于百米级以内的小范围场景（如单层楼宇），更大范围场景需额外引入UTM等地图投影校正逻辑

内容的提问来源于stack exchange，提问作者user16925633