2. 坐标系与时空基准：WGS84、UTM、ENU、车体坐标系、时间同步基础
做自动驾驶定位，第一件事不是调算法，而是搞清楚——你站在哪个坐标系里说话。
我见过不少新手，上来就对着GPS数据做融合，结果车的位置飘到马路对面去了。查了半天，原来是坐标系搞混了。嗯，这坑我踩过，所以今天咱们先把坐标系和时空基准这摊事理清楚。
2.1 全球坐标系：WGS84
WGS84，全称World Geodetic System 1984。说白了，就是地球的一个数学模型。
它把地球近似成一个椭球体，用经度、纬度、高度三个值来描述地球上任何一个点。你手机里的GPS，输出的原始数据就是WGS84坐标。
核心参数：
- 长半轴 a = 6378137.0 m
- 扁率 f = 1/298.257223563
- 地心引力常数 GM = 3986004.418×10⁸ m³/s²
我个人习惯把WGS84叫做“地球级坐标系”。它适合描述全球范围的位置，但直接拿来做局部路径规划？不行。因为经纬度不是平面单位，算距离还得用球面几何，太麻烦。
避坑指南：我曾经在项目里直接用WGS84的经纬度差值当距离用，结果在赤道附近误差不大，到了高纬度地区，误差直接翻倍。记住：经纬度不是米。
2.2 投影坐标系：UTM
既然WGS84不好算距离，那就把它投影到平面上。UTM（Universal Transverse Mercator）就是最常用的投影方式。
UTM把地球分成60个带，每个带6度经度宽。每个带内，坐标用东向（Easting）和北向（Northing）表示，单位是米。
你想想看，有了UTM，你就可以直接用勾股定理算两点距离了。多方便。
| UTM带号 | 经度范围 | 中央经线 |
|---|---|---|
| 50 | 114°E - 120°E | 117°E |
| 51 | 120°E - 126°E | 123°E |
注意：UTM在不同带之间是不连续的。如果你的车跨带行驶，需要做带间转换。我当年做高精地图时，就因为这个吃了亏——地图拼接处出现了1米多的跳变。
2.3 局部坐标系：ENU
ENU，就是东-北-天（East-North-Up）坐标系。它是个局部直角坐标系，原点通常设在某个参考点。
为什么需要ENU？因为UTM虽然好用，但它覆盖范围太大，在局部区域（比如一个十字路口）用起来不够直观。ENU就简单了：东是x，北是y，天是z。
我建议在感知融合中，把ENU作为全局参考系。所有传感器的数据，最终都转到ENU下做融合。这样逻辑清晰，调试也方便。
转换关系：
// WGS84 (lat, lon, alt) -> ENU (x, y, z)
// 需要先转成地心地固坐标系(ECEF)，再转到ENU
// 伪代码示例
ecef = wgs84_to_ecef(lat, lon, alt)
enu = ecef_to_enu(ecef, ref_lat, ref_lon, ref_alt)2.4 车体坐标系
车体坐标系，也叫Vehicle Frame。它跟着车走，原点通常在车辆后轴中心或质心。
标准定义：
- x轴：车头方向（前进方向）
- y轴：车身左侧（或右侧，看具体定义）
- z轴：车顶方向（向上）
为什么要有车体坐标系？因为传感器都装在车上。激光雷达、摄像头、IMU，它们的数据都是相对于车体坐标系的。你要做融合，就得先把这些数据统一到一个坐标系下。
我的经验：车体坐标系的原点位置，不同车厂定义不一样。有的放在后轴中心，有的放在质心。我曾经因为没确认这个细节，导致IMU和GPS的融合结果差了20厘米。所以，拿到车的第一件事，确认原点位置。
2.5 时间同步基础
坐标系搞定了，还有个更头疼的问题——时间。
你想想看，激光雷达每秒10帧，摄像头每秒30帧，GPS每秒10Hz，IMU每秒100Hz。这些数据到达的时间不一样，你怎么融合？
时间同步，说白了就是给每个数据打上统一的时间戳。
常用的方法：
- GPS时间作为主时钟：GPS模块输出PPS（脉冲每秒）信号，精度可达纳秒级。所有传感器都同步到这个信号上。
- 网络时间协议（NTP）：通过以太网同步，精度在毫秒级。适合要求不高的场景。
- 硬件触发：用FPGA或MCU直接给传感器发触发信号，保证严格同步。
我曾经踩过的坑：在某个项目中，我们用NTP同步，结果发现激光雷达和摄像头的时间戳差了50毫秒。车在高速行驶时，50毫秒意味着1米多的位置误差。后来换成硬件触发，问题才解决。
2.6 知识体系总览
下面这张图，是我自己总结的坐标系与时空基准的知识结构。你可以把它当作本章的思维导图。
嗯，这一章的内容就这些。坐标系和时空基准，听起来基础，但真的是定位融合的基石。你想想看，如果坐标系没对齐，时间没同步，后面再牛的算法也是白搭。
可可精品资料库