一种考虑ICR纵向偏差补偿的水下履带采矿车轨迹跟踪算法 |
| |
引用本文: | 陈昱衡,边有钢,崔庆佳,胡满江,秦洪懋.一种考虑ICR纵向偏差补偿的水下履带采矿车轨迹跟踪算法[J].中南大学学报(自然科学版),2023(4):1336-1343. |
| |
作者姓名: | 陈昱衡 边有钢 崔庆佳 胡满江 秦洪懋 |
| |
作者单位: | 1. 湖南大学汽车车身先进设计制造国家重点实验室;2. 湖南大学无锡智能控制研究院 |
| |
基金项目: | 国家重点研发计划(2021YFC2801700);;湖南省自然科学基金资助项目(2021JC0010,2021JJ40086);;湖南省科技重大专项(2020GK1025); |
| |
摘 要: | 水下履带采矿车在多金属结核矿区的稀软底质上进行采集作业时,受水动力的影响其瞬时转向中心(ICR)纵向偏移后与几何中心不再重合,故难以基于精准的运动学模型设计水下履带采矿车的轨迹跟踪算法。因而,本文提出一种基于履带车运动学模型的分散式轨迹跟踪算法以实现履带采矿车高精度路径跟踪控制。首先,通过引入虚拟转角设计水下履带采矿车的Stanley横向控制律;其次,利用无迹卡尔曼(UKF)滤波法估计的ICR纵向偏移作为纵向误差的补偿,以此设计水下履带采矿车的纵向控制律;最后,基于运动学模型计算水下履带采矿车的期望驱动轮转速。研究结果表明:引入纵向偏差补偿后的分散式轨迹跟踪算法可以精准地跟踪预设轨迹。
|
关 键 词: | 深海采矿装备 水下履带采矿车 轨迹跟踪 参数估计 无迹卡尔曼滤波 |
|