📚 课程目录第4章空间基准与坐标系

4. 空间基准与坐标系

在无人机多传感器载荷同步与标定中，所有测量数据最终都要落到同一个空间基准上，才能谈“同一时刻、同一位置、同一姿态”。如果激光雷达点云、相机像素、IMU角速度、GNSS位置各自停留在自己的坐标系里，融合就无从谈起。本章围绕五个核心坐标系——WGS84、ECEF、ENU、机体坐标系和传感器坐标系——梳理它们之间的层级关系与变换基础，为后续外参标定和时间同步建立统一的数学语言。

一、核心原理：从大地基准到局部坐标

WGS84（World Geodetic System 1984）是GNSS定位所采用的大地基准，它用经度λ、纬度φ、椭球高h描述地球表面附近的位置。WGS84本身是一个椭球模型，长半轴约6378137 m，扁率约1/298.257223563。GNSS接收机输出的经纬高就是WGS84坐标，但它不是笛卡尔坐标，直接做向量运算会引入非线性误差。

ECEF（Earth-Centered, Earth-Fixed）是地心地固坐标系，原点在地球质心，X轴指向本初子午线与赤道交点，Z轴指向北极，Y轴按右手系确定。ECEF是笛卡尔坐标，适合做卫星轨道、地球自转补偿和跨区域坐标统一。WGS84到ECEF的转换是标定链路中的第一步：

N = a / sqrt(1 - e²·sin²φ)
X = (N + h)·cosφ·cosλ
Y = (N + h)·cosφ·sinλ
Z = (N·(1 - e²) + h)·sinφ
其中 a = 6378137.0 m，e² = 0.00669437999014

ENU（East-North-Up）是局部切平面坐标系，原点通常选在无人机起飞点或某个参考点，东、北、天三个轴构成右手系。ENU适合描述无人机在局部范围内的运动，因为它的坐标变化与人的直觉一致，且在小范围内可近似为平面。ECEF到ENU的变换需要参考点经纬高，通过旋转矩阵完成：

R = [[-sinλ, cosλ, 0],
     [-sinφ·cosλ, -sinφ·sinλ, cosφ],
     [cosφ·cosλ, cosφ·sinλ, sinφ]]
P_enu = R · (P_ecef - P_ref_ecef)

机体坐标系（Body Frame）固连在无人机机体上，通常定义X轴指向机头，Y轴指向右翼，Z轴指向机腹，符合右手系。机体坐标系描述的是无人机自身的姿态和运动，IMU测量的角速度和加速度就是在机体坐标系下表达的。传感器坐标系（Sensor Frame）则固连在具体载荷上，例如相机坐标系、激光雷达坐标系、GNSS天线坐标系。每个传感器都有自己的安装位置和朝向，传感器坐标系到机体坐标系的变换就是外参标定要解决的核心问题。

二、方法流程：坐标变换的标准化步骤

在实际标定与融合中，坐标变换应遵循固定流程，避免随意跳步导致量纲或基准混乱。推荐步骤如下：

确定参考点：选择无人机起飞点或标定场中心作为ENU原点，记录其WGS84经纬高。
WGS84转ECEF：用椭球参数将参考点和所有GNSS观测值转为ECEF笛卡尔坐标。
ECEF转ENU：以参考点为原点，构造旋转矩阵，得到局部东-北-天坐标。
传感器到机体：通过标定获得每个传感器的旋转矩阵R和平移向量t，将传感器测量值转到机体坐标系。
机体到ENU：利用无人机姿态（滚转、俯仰、偏航）构造旋转矩阵，将机体坐标转到ENU。
时间对齐：每个变换必须绑定时间戳，确保同一时刻的传感器数据使用同一组外参和姿态。

关键公式：P_enu = R_body→enu · (R_sensor→body · P_sensor + t_sensor→body) + t_body→enu

三、案例/场景：激光雷达与相机联合标定

假设无人机搭载一台激光雷达和一台相机，需要将激光点云投影到图像上验证标定效果。激光雷达坐标系下的点P_lidar先通过外参R_lidar→body、t_lidar→body转到机体坐标系，再通过相机外参R_cam→body、t_cam→body转到相机坐标系，最后经相机内参投影到像素平面。如果外参有误，点云边缘会在图像上出现明显错位。实际作业中，常用棋盘格或标定板同时被相机和激光雷达观测，通过最小化重投影误差求解外参。

另一个典型场景是GNSS/IMU组合导航。GNSS天线相位中心与IMU中心不重合，存在杆臂效应。当无人机做角运动时，天线相位中心的速度与IMU中心的速度不同，必须通过杆臂向量和角速度补偿。这个杆臂向量就是GNSS天线坐标系到机体坐标系平移向量的一部分。

四、误区与复盘

常见误区一：把WGS84经纬高直接当平面坐标做加减。经纬度一度对应的距离随纬度变化，直接相减会引入几十米甚至上百米误差。

常见误区二：忽略ENU原点的选择。不同参考点得到的ENU坐标不同，跨设备对比时必须统一参考点。

常见误区三：外参标定后不验证。标定结果应通过独立数据交叉验证，例如用点云到图像的重投影误差、IMU与GNSS的速度一致性等指标。

常见误区四：坐标系旋转方向混淆。主动旋转与被动旋转、内旋与外旋的矩阵顺序不同，必须明确约定。

五、坐标系对照清单

坐标系	原点	轴向定义	典型用途	关键参数
WGS84	地球质心（椭球模型）	经度、纬度、椭球高	GNSS定位输出	a=6378137 m，f=1/298.257
ECEF	地球质心	X本初子午线，Z北极，Y右手系	跨区域统一、卫星轨道	笛卡尔坐标，单位米
ENU	局部参考点	东、北、天	局部轨迹、运动描述	参考点经纬高
机体坐标系	无人机重心或IMU中心	X前、Y右、Z下	姿态控制、IMU测量	滚转、俯仰、偏航
传感器坐标系	各传感器安装中心	依传感器定义	原始数据表达	外参R、t

掌握这五个坐标系的定义与变换关系，是后续外参标定、时间同步和传感器融合的基础。实际工程中，建议把每个变换写成独立的函数或类，输入输出都带时间戳和坐标系标签，避免“隐式假设”带来的系统性误差。