基于空间模型预测控制的矿井车辆避障控制器的研究

作者

贾运红马浩楠
单位

煤炭科学研究总院中国矿业大学（北京）机电与信息工程学院中国煤炭科工集团太原研究院有限公司
摘要

针对矿井车辆在巷道实时避障过程中参考轨迹的平滑性问题以及在轨迹跟踪过程中转向角突然变化对矿井车辆结构和转向部件造成损伤问题，设计了1种改进的基于空间模型预测控制(SMPC)算法的矿井车辆避障控制器。该设计结合模型预测控制原理和曲线坐标系，将笛卡尔坐标系下的基于时间t的车辆运动学模型转换成曲线坐标系下基于空间s的偏差模型，采用泰勒线性化处理和欧拉法离散，推导出矿井车辆偏差模型的预测方程;在轨迹跟踪部分建立目标函数优化车辆转向曲率的一阶、二阶导数和横向位移偏差值，在轨迹重规划部分建立目标函数优化横向偏差值及其一阶、二阶导数，并结合障碍物信息和巷道边界信息设置边界函数;将目标函数转换为二次规划问题求解最优控制序列。模拟井下巷道环境搭建仿真平台，对本文提出的矿井车辆避障控制器进行实时仿真验证。结果表明，改进后的控制器在轨迹跟踪方面能够保证车辆与参考轨迹之间的横向位移偏差控制在0.2 m以内，航向角偏差控制在0.09 rad以内;与传统的MPC控制算法相比，改进后的控制器具有更加优秀的精确性和平稳性;在实时避障方面，控制器控制性能会受到道路曲率的影响，但无论是在单个障碍物还是连续多个障碍物情况下，车辆都能够避开障碍物，获得平滑的转向输入和平滑、精确的行驶轨迹。
关键词

井下无人运输车辆模型预测控制轨迹规划轨迹跟踪
基金项目(Foundation)

山西省重点研发计划资助项目(201603D121030，201803D121128);山西省应用基础研究资助项目(201801D121189)