坐标系与坐标转换错误：你的航点为什么总跑偏？
做航点任务规划，坐标系是绕不开的第一道坎。我见过太多项目，前期一切顺利，一飞出去航点偏了上百米——最后查下来，就是坐标系没统一。说白了，坐标系就像语言，你说中文我说英文，沟通肯定出问题。
这一章，我就带你把这些坐标系彻底理清楚。
常见坐标系一览
先看看我们日常打交道的几种坐标系。嗯，其实没你想的那么复杂。
| 坐标系 | 全称 | 典型用途 | 特点 |
|---|---|---|---|
| WGS84 | World Geodetic System 1984 | GPS 原始输出、国际标准 | 全球统一，经纬度表示 |
| GCJ02 | 国测局坐标（火星坐标系） | 高德地图、腾讯地图 | WGS84 加偏，国内使用 |
| BD09 | 百度坐标系 | 百度地图 | GCJ02 二次加偏 |
| 地心坐标系 | ECEF (Earth-Centered Earth-Fixed) | 卫星定位、惯性导航解算 | 三维直角坐标，原点在地心 |
| 机体坐标系 | Body Frame | 飞控姿态控制、相对位置 | 以无人机自身为原点 |
你想想看，如果从百度地图上取一个航点，直接喂给飞控——飞控默认是 WGS84，那偏个几十米都算正常。我在项目中遇到过，用户拿着手机百度地图点的航点，导入大疆 Pilot 后直接偏到了隔壁楼顶。
坐标系不统一导致的航点偏移
偏移不是随机的，它有规律。我画了一张图，帮你理解这几种坐标系之间的偏差量级。
核心结论：WGS84 → GCJ02 偏移约 100-700 米（随机方向），GCJ02 → BD09 再偏移约 50-200 米。国内使用地图数据时，必须做坐标转换。
坐标转换的常见陷阱
坐标转换看着简单，但坑特别多。我踩过的，都列在这里了。
陷阱一：转换方向搞反
WGS84 转 GCJ02 和 GCJ02 转 WGS84 不是同一个函数。我见过有人把转换写反了，结果航点从北京偏到了天津。你想想看，这要是真飞出去，后果不堪设想。
避坑指南：每次调用转换函数前，先确认输入坐标的坐标系和输出目标坐标系。我习惯在代码里加注释，比如 // 输入：WGS84，输出：GCJ02，防止自己搞混。
陷阱二：多次重复转换
有些开发者拿到坐标后，不管三七二十一先转一次 GCJ02，后面又转一次——结果坐标越转越偏。我曾经调试一个项目，发现航点每次更新都偏一点，查了两天才发现是转换函数被重复调用了。
我的习惯：在数据流里只做一次坐标转换，转换后的坐标打上标签，后续直接使用。可以用一个结构体来标记坐标系类型。
陷阱三：忽略高程系统
坐标转换通常只处理经纬度，高程（海拔）往往被忽略。但 WGS84 的高程是椭球高，而国内地图用的是正常高（基于似大地水准面）。两者差十几米到几十米。做低空航点任务时，这个误差可能让飞机撞到障碍物。
经验数据：中国境内，WGS84 椭球高比正常高平均高约 20-40 米。东部沿海差值小，西部高原差值大。做航点规划时，建议使用 EGM96 或 EGM2008 模型进行高程转换。
坐标转换的验证方法
怎么确认你转换对了？我总结了三个方法。
- 交叉验证法：用两个不同的转换库（比如 proj4 和 coordTransform）对同一组坐标进行转换，对比结果。偏差应在 0.5 米以内。
- 地图回显法：把转换后的坐标放到对应地图上显示。比如 GCJ02 坐标放到高德地图上，看是否落在预期位置。我每次做转换都会打开高德地图手动验证几个点。
- 往返测试法：WGS84 → GCJ02 → WGS84，看最终结果和原始坐标的偏差。如果偏差超过 1 米，说明转换函数有问题。
小技巧：写一个自动化测试脚本，每次修改转换逻辑后跑一遍。我自己的项目里，这个脚本帮我抓到了至少 5 次转换错误。
代码示例：Python 坐标转换
下面是一个常用的坐标转换代码片段。注意，这里用的是开源库 coordTransform，实际项目中建议使用经过验证的库。
import math
# WGS84 转 GCJ02
def wgs84_to_gcj02(lat, lng):
# 这里省略具体转换公式
# 实际项目中请使用成熟库
pass
# GCJ02 转 BD09
def gcj02_to_bd09(lat, lng):
x = lng
y = lat
z = math.sqrt(x * x + y * y) + 0.00002 * math.sin(y * math.pi)
theta = math.atan2(y, x) + 0.000003 * math.cos(x * math.pi)
bd_lng = z * math.cos(theta) + 0.0065
bd_lat = z * math.sin(theta) + 0.006
return bd_lat, bd_lng
# 使用示例
wgs_lat, wgs_lng = 39.9042, 116.4074 # 北京天安门
gcj_lat, gcj_lng = wgs84_to_gcj02(wgs_lat, wgs_lng)
bd_lat, bd_lng = gcj02_to_bd09(gcj_lat, gcj_lng)
print(f"WGS84: {wgs_lat}, {wgs_lng}")
print(f"GCJ02: {gcj_lat}, {gcj_lng}")
print(f"BD09: {bd_lat}, {bd_lng}")重要提醒：上述代码仅为示例，实际转换公式涉及非线性加偏算法。建议使用 pyproj、coordTransform 等成熟库，不要自己实现转换逻辑——我试过，精度根本达不到要求。
坐标系选择建议
最后，给你一个坐标系选择的参考表。这是我多年项目经验的总结。
| 使用场景 | 推荐坐标系 | 说明 |
|---|---|---|
| GPS 原始数据采集 | WGS84 | 保持原始精度，后续按需转换 |
| 国内地图显示 | GCJ02 或 BD09 | 根据使用的地图 SDK 选择 |
| 飞控内部解算 | 地心坐标系 | 便于惯性导航和位置融合 |
| 相对位置控制 | 机体坐标系 | 用于编队飞行、避障等 |
| 航点任务规划 | WGS84 + 高程转换 | 统一使用 WGS84，高程用 EGM96 修正 |