摘要

为了提高履带式无人平台的轨迹跟踪性能,提出了一种考虑纵向速度规划的分层轨迹跟踪算法并进行了联合仿真验证和实车验证。在建立了包含履带的滑移滑转率和质心侧偏角的车辆运动微分方程的基础上,完成分层轨迹跟踪算法框架的构建。上层基于伪谱法的速度规划算法根据路面信息进行纵向速度规划,并将规划的速度作为目标车速下发给下层基于线性时变模型预测控制(LTV-MPC)的轨迹跟踪算法。基于LTV-MPC的算法通过建立预测模型和约束条件,二次规划求解出两侧电机的目标转速。通过Matlab/Simulink和RecurDyn的联合仿真以及实车验证了所提出的算法在不同地面条件下具有良好的轨迹效果。

全文