2. 时间同步与对准的数学基础

多传感器时间同步与对准，本质上是在统一的时间轴和统一的空间基准上，把来自不同传感器的量测放到同一个参考框架里比较。若坐标系定义不一致、刚体变换方向写反、时间戳含义混淆，后续的滤波、融合与标定都会出现系统性偏差。本节围绕四个数学支柱展开：坐标系、刚体变换、时间戳模型、误差传播与不确定度。

一、坐标系：先定义，再使用

飞行器上常见的坐标系包括：地心惯性系（ECI）、地心地固系（ECEF）、当地导航系（NED 或 ENU）、机体坐标系（b 系）、传感器坐标系（s 系）。每个坐标系都必须明确原点、轴向和手性。例如 NED 系中 x 指向北、y 指向东、z 指向地；ENU 系中 x 指向东、y 指向北、z 指向天。两者仅通过一个固定旋转矩阵关联，但若混用，姿态角符号会整体翻转。

传感器坐标系通常由安装决定。以 IMU 为例，其 s 系相对 b 系的安装矩阵记为 R_bs，包含三个安装失准角。GNSS 天线相位中心相对机体的杆臂向量记为 l_b，单位米。相机光心相对机体的外参包括旋转 R_bc 和平移 t_bc。这些量在时间同步中并非直接参与，但决定了“同一时刻不同传感器量测是否指向同一物理点”。

二、刚体变换：旋转与平移的组合

两个坐标系之间的刚体变换可写为齐次形式：

T = [ R  t ]
    [ 0  1 ]
p_A = R_AB * p_B + t_AB

其中 R_AB 表示把 B 系向量旋转到 A 系，t_AB 是 B 系原点在 A 系中的位置。旋转矩阵满足正交性 R^T R = I、det(R)=1。工程中常用四元数 q = [qw, qx, qy, qz] 或旋转向量 φ = θ·u 表示，避免万向锁并减少参数冗余。四元数乘法与旋转矩阵的转换关系必须与所选库一致，例如 Hamilton 与 JPL 约定在虚部符号上不同。

复合变换遵循链式法则：T_AC = T_AB · T_BC。注意顺序不可交换。若已知相机到机体的外参 T_bc 和机体到导航系的姿态 T_nb，则相机到导航系为 T_nc = T_nb · T_bc。时间同步要保证 T_nb(t) 与相机曝光时刻 t 对齐，否则运动中的杆臂会引入随速度变化的视差误差。

三、时间戳模型：从物理量测到参与解算

一个传感器数据从物理量测到参与融合，经历四个时刻：物理量测时刻 t_meas、打时间戳时刻 t_stamp、到达融合节点时刻 t_arrive、参与解算时刻 t_use。理想情况下四者相同，实际存在采样延迟 δ_s、传输延迟 δ_t、排队延迟 δ_q。时间戳模型可写为：

t_stamp = t_meas + δ_s + δ_t + δ_q + η
t_local = (1 + ε) · t_true + b + η

其中 ε 为时钟频偏，b 为钟差，η 为随机噪声。若只做一次对齐而不估计 ε 和 b，长时间运行后钟差会线性累积。工程上常用 PPS 秒脉冲配合 UTC 时间报文，把 b 估计到微秒级；或用 IEEE 1588 硬件时间戳，把 δ_t 压缩到纳秒级。对于 IMU 与相机，若相机曝光时刻无法硬件触发，则需通过运动相关性估计 δ_s，典型值在毫秒量级。

四、误差传播与不确定度

设某量测 y = f(x, t)，其中 x 为状态，t 为时间。时间误差 δt 通过雅可比 ∂f/∂t 传播到量测：δy ≈ (∂f/∂t)·δt。对于匀速运动，∂f/∂t = v，因此位置误差为 v·δt。若飞行器速度 30 m/s，时间同步误差 1 ms，则位置误差约 3 cm；若速度 300 m/s，同样 1 ms 误差对应 30 cm。这说明高速场景对时间同步精度要求更严。

不确定度合成遵循协方差传播律：Σ_y = J Σ_x J^T + Σ_η，其中 J 为雅可比矩阵，Σ_η 为量测噪声协方差。若时间误差与状态误差独立，则总协方差为两者之和。工程中常用 1σ 或 95% 置信区间表示。例如某组合导航系统给出位置不确定度 0.5 m (1σ)，其中时间同步贡献 0.1 m，则时间同步不是主要误差源；若时间同步贡献 0.4 m，则应优先优化时间戳链路。

综上，坐标系与刚体变换解决“空间对齐”，时间戳模型解决“时间对齐”，误差传播与不确定度解决“对齐得有多好”。三者共同构成多传感器时间同步与对准的数学基础。实际工程中，建议先固定坐标系与变换约定，再建立时间戳模型并标定延迟，最后用协方差传播评估时间同步对最终精度的影响，从而决定是否需要更高精度的时钟或触发方案。