一种考虑ICR纵向偏差补偿的水下履带采矿车轨迹跟踪算法

作者：陈昱衡; 边有钢; 崔庆佳; 胡满江^*; 秦洪懋

来源：中南大学学报(自然科学版), 2023, 54(04): 1336-1343.

• 深海采矿装备
• 水下履带采矿车
• 轨迹跟踪
• 参数估计
• 无迹卡尔曼滤波

水下履带采矿车在多金属结核矿区的稀软底质上进行采集作业时，受水动力的影响其瞬时转向中心(ICR)纵向偏移后与几何中心不再重合，故难以基于精准的运动学模型设计水下履带采矿车的轨迹跟踪算法。因而，本文提出一种基于履带车运动学模型的分散式轨迹跟踪算法以实现履带采矿车高精度路径跟踪控制。首先，通过引入虚拟转角设计水下履带采矿车的Stanley横向控制律；其次，利用无迹卡尔曼(UKF)滤波法估计的ICR纵向偏移作为纵向误差的补偿，以此设计水下履带采矿车的纵向控制律；最后，基于运动学模型计算水下履带采矿车的期望驱动轮转速。研究结果表明：引入纵向偏差补偿后的分散式轨迹跟踪算法可以精准地跟踪预设轨迹。

• 单位
  湖南大学; 汽车车身先进设计制造国家重点实验室