📚 课程目录第2章日志时间戳对齐与时钟漂移校正

2. 日志时间戳对齐与时钟漂移校正

问题定位：多源时间戳为什么会对不齐

AUV 任务日志通常由多个子系统各自打时间戳：导航计算机（INS/DVL 组合）以 50 Hz 输出姿态与速度，深度计以 10 Hz 输出压力换算深度，推进器控制器以 5 Hz 上报转速与电流，任务管理计算机则按事件触发记录模式切换。这些子系统各自维护本地时钟，上电时刻不同、晶振频率存在 ppm 级偏差，长时间任务中还会因温度变化产生频率漂移。结果是：同一物理事件在不同日志流中的时间戳相差可达数百毫秒甚至数秒，直接按时间戳排序会把“先转向后下潜”误判为“先下潜后转向”。

本案例采用“主时钟 + 从时钟”的对齐模型：以任务管理计算机时钟为参考基准（它同时接收 GPS 秒脉冲，在出水/近水面阶段可被绝对时间校准），其余子系统为从时钟。校正分两步——先用固定延迟模型消除上电时刻差带来的常量偏移，再用线性漂移模型消除晶振频差带来的斜率偏差。

锚点选取与漂移斜率估计

校正质量取决于锚点。锚点必须是主从两路日志中都能明确识别的同一物理事件。AUV 任务中可靠的锚点有三类：模式切换指令（任务管理机下发、导航机收到并回执）、GPS 定位有效窗口的起止（导航机记录 UTC 秒）、以及推进器使能/失能沿（控制器与任务机均有记录）。深度计没有直接事件接口，通常借用“到达目标深度”这一由任务机判定、深度计同时刻读数突变的事件作为锚点。

设第 i 个锚点在主时钟上的时间为 T_i，在从时钟上的时间为 t_i，则偏移 d_i = T_i − t_i。若只有两个锚点，斜率 k = (d_2 − d_1)/(t_2 − t_1)，截距 b = d_1 − k·t_1。锚点多于两个时用最小二乘拟合 d = k·t + b，再对每个从时钟时间戳做 t_corrected = t + k·t + b。注意 k 是无量纲的 ppm 级小数，符号取决于从时钟快于还是慢于主时钟。

可运行的校正实现

下面是一段完整的 Python 实现，输入为已解析出的锚点对和待校正的从时钟时间戳序列，输出校正后的时间戳与残差报告。示例数据为教学构造值，用于演示计算过程，不代表任何实际航行记录。

import numpy as np

def fit_clock_model(anchors):
    """anchors: [(t_slave, T_master), ...] 单位秒
    返回 (k, b)，模型 d = k*t + b，d = T_master - t_slave"""
    t = np.array([a[0] for a in anchors], dtype=float)
    d = np.array([a[1] - a[0] for a in anchors], dtype=float)
    if len(anchors) == 1:
        return 0.0, d[0]
    k, b = np.polyfit(t, d, 1)
    return float(k), float(b)

def correct_timestamps(ts_slave, k, b):
    ts = np.asarray(ts_slave, dtype=float)
    return ts + k * ts + b

def residual_report(anchors, k, b):
    rows = []
    for t_s, T_m in anchors:
        t_c = t_s + k * t_s + b
        rows.append((t_s, T_m, t_c, (t_c - T_m) * 1000.0))
    return rows

# 教学示例：4 个锚点，从时钟略慢于主时钟
anchors = [
    (100.0, 100.35),
    (1300.0, 1300.62),
    (2500.0, 2500.89),
    (3700.0, 3701.16),
]
k, b = fit_clock_model(anchors)
print(f"k = {k:.3e}  ({k*1e6:.1f} ppm), b = {b:.4f} s")

# 待校正的深度计时间戳（从时钟）
depth_ts = [105.0, 605.0, 1105.0, 1605.0, 2105.0]
corrected = correct_timestamps(depth_ts, k, b)
for raw, cor in zip(depth_ts, corrected):
    print(f"{raw:8.2f} -> {cor:10.4f}")

print("\n锚点残差 (ms):")
for t_s, T_m, t_c, r in residual_report(anchors, k, b):
    print(f"t_s={t_s:7.1f}  T_m={T_m:9.3f}  t_c={t_c:9.4f}  res={r:+7.2f}")

运行后 k 约为 2.4e-4（约 240 ppm），b 约为 0.33 s。四个锚点残差应在 ±30 ms 量级；若某个锚点残差明显偏大（例如超过 100 ms），优先怀疑该锚点事件识别错误，而不是模型失效。校正后的深度计时间戳与主时钟事件序列合并排序，即可得到统一时间基准下的事件链。

漂移斜率 k 的符号约定：本实现中 d = T_master − t_slave，k 为正表示从时钟越走越慢。若你的日志中从时钟时间戳是单调递增的整数毫秒，先统一换算为秒再做拟合，避免量纲混乱导致 k 被放大 1000 倍。

不要用“日志文件写入时间”或“文件修改时间”作为锚点，它们受操作系统缓冲和存储延迟影响，抖动可达秒级。锚点必须来自日志内容本身记录的同一物理事件。

对齐结果的自检清单

检查项	通过条件	不通过时的处理
锚点数量	≥ 2，建议 3~5 个且时间跨度覆盖任务主要阶段	补充 GPS 有效窗口或推进器使能沿作为锚点
锚点残差	全部 \|res\| < 50 ms	剔除离群锚点后重新拟合
漂移斜率	\|k\| < 500 ppm	检查时间单位是否统一、锚点是否错配
事件序列单调性	校正后相邻事件时间差 ≥ 0	核对 k 的符号与锚点主从对应关系
跨子系统一致性	同一事件在各流中校正后时间差 < 100 ms	检查该子系统是否还有未建模的阶跃偏移

若某子系统在任务中途发生时钟重置（例如控制器重启），单一线性模型无法覆盖全程，应按重置时刻分段拟合，每段独立求 k 与 b，并在段边界处记录跳变。这是后续事件序列分析前必须处理的边界条件。