3. 惯导系统原理与矿卡应用要点

在无人矿卡的组合定位链路中，GNSS 提供的是“绝对位置”，惯导提供的是“连续姿态与相对位移”。矿区台阶、破碎站、排土场之间常有高陡边坡和料堆遮挡，GNSS 信号频繁失锁或多路径严重，此时定位能否连续，几乎完全取决于惯导这一段是否可靠。理解惯导，关键要抓住四件事：它由什么组成、怎样推算位置、起步前如何对准、误差为什么随时间累积。

一、惯性测量单元的组成与测量含义

矿卡上使用的惯导通常由惯性测量单元（IMU）和惯性导航解算单元两部分构成，IMU 是核心敏感部件。IMU 内部包含三只陀螺仪和三只加速度计，分别沿载体坐标系的三个正交轴安装。工程上先约定坐标系：以车辆质心为原点，X 轴指向车头前进方向，Y 轴指向车身右侧，Z 轴沿车体垂向向上，构成右手系。陀螺仪测量的是车体绕三轴的角速度（单位 °/s 或 rad/s），加速度计测量的是沿三轴的比力（单位 m/s²），注意它包含重力反作用，并非单纯的车辆加速度。

矿卡工况对 IMU 有明确要求。一是量程与动态范围：重载下坡制动、装卸时的冲击，会让纵向加速度和俯仰角速度出现较大瞬时值，量程偏小会削顶失真。二是零偏稳定性：矿卡单班连续作业时间长，陀螺零偏若漂移大，几十分钟后航向误差就会明显。三是安装基准：IMU 必须与车体坐标系严格对齐，安装角偏差会直接转化为姿态和航向的系统误差，因此安装后要做杆臂与安装角标定，并把 IMU 到 GNSS 天线的杆臂向量写入解算参数。

二、航位推算：从角速度和比力到位置

惯导的定位本质是航位推算（DR）。解算流程可概括为：陀螺角速度经姿态更新得到车体姿态（横滚、俯仰、航向）；加速度计比力经姿态矩阵投影到导航坐标系，扣除重力后积分得速度，再积分得位置。三个积分环节串联，意味着任何一次微小偏差都会被“积分放大”。

举个教学示例（数值为合理假设，非实测）：某矿卡在平直路段以 5 m/s 匀速行驶，若纵向加速度计存在 0.01 m/s² 的残余零偏未被估计，则 60 s 后速度误差约 0.6 m/s，位置误差约 18 m；若同时航向存在 0.1° 的初始偏差，行驶 500 m 后横向位置偏差约 0.87 m。这说明惯导短时精度很高，但误差会随时间和行驶距离增长，必须靠 GNSS 观测持续校正。

三、初始对准：决定整段航向的起点

惯导开始推算前必须完成初始对准，即确定初始姿态矩阵，尤其是航向。对准分两步：粗对准利用加速度计测得的重力方向确定水平姿态（横滚、俯仰），利用陀螺感知地球自转角速度在载体上的分量确定航向；精对准则通过一段时间的观测与滤波，估计并收敛陀螺零偏和失准角。矿卡属于车载应用，通常采用“静止对准 + GNSS 辅助航向”的方式，在装车点或停车位完成。

对准质量直接决定后续表现。实操中应关注三点：一是车辆必须真正静止，发动机怠速振动、人员上下车、相邻设备作业都会引入扰动，导致对准结果抖动；二是对准时长要足够，短时对准虽快但零偏估计不足，起步后航向会缓慢漂移；三是航向基准要可靠，若用双天线 GNSS 提供航向，需确认基线方向和天线安装无误。对准完成后应记录航向角、水平姿态和估计的零偏值，作为后续排障的基线数据。

四、误差累积特性与矿卡应用要点

惯导误差主要来自陀螺零偏、加速度计零偏、标度因数误差、安装误差和随机噪声。其传播规律是：陀螺零偏引起姿态误差随时间线性增长，姿态误差又使重力被错误投影，进而产生加速度误差，最终位置误差近似随时间的平方增长；加速度计零偏则直接导致位置误差随时间的平方增长。因此惯导“短时精、长时漂”，失锁时间越长，位置可信度下降越快。

结合矿卡场景，应用要点可归纳为：在装卸点、破碎站等 GNSS 良好区域确保组合滤波充分收敛，让零偏估计稳定；进入边坡遮挡区前确认组合状态正常，避免带着未收敛的航向进入失锁段；失锁期间以惯导递推为主，但应设定失锁时长阈值，超过阈值后降低定位置信度并触发限速或停车策略；恢复 GNSS 后不要立即完全信任新观测，应通过滤波平滑过渡，防止位置跳变引发横向控制抖动。日常排障时，可对比对准记录的零偏与当前估计值，若零偏显著增大，往往指向 IMU 安装松动、温漂异常或器件老化，应优先检查安装基准与线束，再判断是否需要重新标定或更换 IMU。