自动驾驶矿卡横向控制:从路径跟踪到转向迟滞补偿

矿卡的横向控制，表面上看是“让车沿着路线走”。实际落到矿区场景，它要同时处理车身宽、轴距长、载荷变化大、道路附着不稳定、弯道超高和转向机构响应慢等问题。普通乘用车上能工作的路径跟踪算法，直接搬到矿卡上，往往会出现转向来回修正、弯道切内侧、重载下横摆响应迟缓，甚至在坡弯组合路段触发横向稳定风险。

一、横向控制到底控制什么？

自动驾驶系统通常把运动控制拆成纵向和横向两部分。纵向控制负责速度、加速度、驱动和制动；横向控制负责车辆相对道路中心线或规划轨迹的位置与航向。对矿卡来说，横向控制的直接输出一般是前轮转角请求、转向角速度限制，或者面向线控转向执行器的转向电机/液压阀控制量。

横向控制的输入主要来自三类信号。第一类是规划层给出的参考轨迹，包括轨迹点、曲率、期望速度和道路边界；第二类是定位与状态估计，包括车辆位置、航向角、横摆角速度、侧向速度估计、车速和坡度；第三类是执行器反馈，包括实际转角、转向角速度、转向压力、电机电流或液压系统状态。

如果把问题写得更工程化，横向控制不是简单让车辆“朝路径方向转”，而是让车辆在有限转向能力、有限侧向附着和有限稳定裕度内，尽量减小横向偏差和航向偏差。

二、矿区道路为什么让横向控制更难？

矿区道路不像城市道路那样规整。它的典型特点是低速重载、坡道多、弯道半径变化明显、路面附着会随雨水和粉尘变化，局部还有车辙、碎石和不规则边界。对横向控制来说，这些条件会同时放大三个问题。

针对无人矿卡已经有不少研究把路径跟踪和抗侧翻联动起来处理。这个方向的意义很直接：横向控制不能只看“贴不贴线”，还要看车辆是否处在安全稳定的横向动力学区域内。

三、横向误差是怎么计算出来的？

横向控制的第一步是把车辆当前位置投影到参考路径上，找到最近点或预瞄点，然后计算横向误差和航向误差。横向误差表示车辆中心相对路径中心线偏到了哪一侧；航向误差表示车头方向和路径切线方向差了多少。

这里有一个容易忽略的细节：矿卡车身宽，车道或道路安全边界未必充裕，所以控制器不能只约束车辆几何中心。实际工程中还需要计算车身外轮廓、前后角点与道路边界的距离，必要时把“车体占用边界”作为横向安全约束。

四、从 Pure Pursuit 到 Stanley：几何控制的价值和边界

几何控制方法的优点是直观、计算量小、容易部署。Pure Pursuit 会在车辆前方取一个预瞄点，根据车辆到预瞄点的几何关系计算转角；Stanley 方法则更强调横向误差和航向误差的组合修正。这类方法适合低速、路径变化不剧烈、执行器响应比较可控的场景。

矿区自动驾驶早期落地时，几何控制常被用于低速调试、固定路线巡航或作为降级控制器。它的工程价值并不低，因为它能快速形成闭环，也方便排查定位、路径、转向标定是否正确。

但几何控制也有明显边界。它通常不显式考虑未来一段时间内的车辆动力学，不容易同时处理转向角限制、转向角速度限制、侧向加速度限制和道路边界约束。在重载矿卡上，如果速度稍高、弯道曲率变化明显，单纯几何控制容易出现“先滞后、再大幅修正”的现象。

五、LQR 和 MPC 为什么更适合量产级控制？

如果说几何控制主要看当前几何关系，那么 LQR 和 MPC 会更明确地把车辆模型放进控制器。LQR 通常基于线性化车辆模型，把横向误差、航向误差、横摆角速度、侧向速度等状态组合成代价函数，求一个兼顾误差和控制量的转角。它计算量低，调参逻辑清楚，适合很多工程系统。

MPC 的优势在于可以把未来一段预测时域纳入计算。控制器不只看当前偏差，而是预测未来若干步车辆会怎么走，然后在约束条件下选择一组更合适的转向输入。对矿卡来说，MPC 特别适合处理以下问题：

大型矿卡的转向系统存在明显执行器动态。控制器给出转角请求后，实际转角不会立刻到位，常见表现是一阶滞后、纯延迟、角速度限幅，甚至在低温、液压压力波动时响应进一步变慢。很多研究也专门讨论过无人矿卡横向控制中的转向迟滞和车路状态影响。

如果控制器没有考虑转向迟滞，就会把“车辆还没转过去”误判成“转角不够”，继续加大转向请求。等执行器响应上来，车辆又可能转过头，于是控制器反向修正，形成低频摆动。这种摆动在普通小车上可能只是乘坐不舒服，在矿卡上会带来道路边界、轮胎磨损和横向稳定风险。

七、横向控制必须和速度控制联动

横向控制不能脱离车速。相同曲率下，速度越高，需要的侧向加速度越大。矿卡在下坡弯道、重载弯道和低附着弯道里，如果纵向控制没有提前降速，横向控制再怎么调转角，也无法突破轮胎和稳定性的物理边界。

这个公式很简单，但工程含义很重。路径曲率 κ 已经由道路和规划决定，横向控制器能直接影响的是车辆如何贴近路径，但不能凭空增加可用侧向力。因此在矿卡控制系统中，横向控制通常会向纵向控制提出限速建议：当前曲率、坡度、载荷、附着估计和侧倾裕度不满足时，先降速，再跟踪。

八、抗侧翻约束如何进入横向控制？

矿卡重载时质心高、质量大，横向加速度和侧倾角不能只作为后处理报警。更稳妥的做法是把稳定性指标放进控制器或监督层。常见的处理方式包括侧向加速度限制、横摆角速度限制、横向载荷转移率约束，以及路径跟踪与抗侧翻的协调控制。

实际工程中可以分成三层。第一层是控制器内部约束，限制转角、转向角速度和预测侧向加速度；第二层是运动监督器，根据载荷、坡度和路面状态动态收紧速度和横向控制边界；第三层是故障降级，当定位跳变、转向响应异常或稳定裕度不足时，车辆进入减速、停车或远程接管状态。

九、横向控制的工程实现

工程实现时，可以把横向控制拆成七个步骤。

这套流程里，最容易被低估的是第 3、5、6 步。很多横向控制问题表面看是“算法不够好”，实际原因可能是载荷参数没有切换、转向迟滞没有建模，或者稳定约束只做了报警，没有进入控制决策。

十、调试时应该重点看哪些曲线？

横向控制调试不能只看轨迹回放。至少要同时看以下曲线：横向误差、航向误差、转角请求、实际转角、转向角速度、横摆角速度、侧向加速度、车速、曲率和道路边界距离。如果车辆出现左右摆动，需要先判断是定位噪声、路径曲率不连续、控制增益过大，还是执行器迟滞造成的相位滞后。

在矿区路试中，还要按空载、半载、满载分开看结果。满载时可接受的控制策略，空载不一定舒适；空载下看似很灵敏的参数，满载下可能会转向不足。最终参数不应只追求最小横向误差，而要在误差、转向平顺性、轮胎磨损、边界裕度和稳定性之间取平衡。

结语

自动驾驶矿卡的横向控制，本质上是一个带约束的重载车辆运动控制问题。它需要路径跟踪算法，但不能停留在路径跟踪算法；它需要转向控制，但不能只看转角是否跟随；它需要控制精度，但不能牺牲稳定性和道路边界安全。

真正可用的矿卡横向控制系统，应该把参考路径、车辆模型、转向执行器、载荷状态、附着条件和安全监督放在同一个闭环里。这样车辆在直道上能稳定贴线，在弯道里能提前收敛，在重载下不会过度修正，在异常状态下也能知道什么时候该降速、降级和停车。