Research on trajectory tracking control of semi-submersible unmanned vehicle navigation based on MPC
-
摘要: 针对新型半潜式无人艇在导航航行过程中轨迹跟踪误差较大的问题,提出基于模型预测控制（MPC）的轨迹跟踪控制方法．并建立新型半潜式无人艇的运动模型,基于实际参数,构建MPC目标函数和系统约束条件,将半潜式无人艇轨迹跟踪问题转化为最优值问题;利用仿真软件,对控制算法进行了仿真分析. 利用卫星定位设备进行了导航轨迹跟踪试验．仿真与试验结果表明:基于MPC的轨迹跟踪控制方法提高了半潜式无人艇的导航轨迹跟踪精度,跟踪精度比原有PID控制方法提高了50％左右.Abstract: Aiming at the problem of large tracking error in the navigation process of new semi-submersible unmanned aerial vehicle, a tracking control method based on MPC is proposed. In this paper, the motion model of the new semi-submersible is established, and based on the actual parameters, the MPC objective function and system constraints are constructed; The trajectory tracking problem of the semi-submersible is transformed into the optimal value problem; The control algorithm is simulated and analyzed by using the simulation software, and the navigation trajectory tracking test is carried out by using the satellite positioning equipment. The simulation and test results show that the MPC based trajectory tracking control method improves the tracking accuracy of the navigation trajectory of the semi-submersible unmanned vehicle, and the tracking accuracy is about 50％ higher than the original PID control method.
-
Key words:
- semi-submersible unmanned vehicle /
- navigation track tracking /
- MPC
-
[1] 王石,张建强,杨舒卉,等.国内外无人艇发展现状及典型作战应用研究［J］.火力与指挥控制,2019,44(2):11-15. [2] 赵涛,何龙,李卫,等.一种半潜式无人艇的设计［J］.上海海洋大学学报,2019,28(2):313-319. [3] WAN B, FEI Q, HUANG X S, et al. Design of control system for an unmanned semi-submersible vehicle［C］／／2017 13th IEEE International Conference on Control Automation(ICCA),2017.DOI: 10.1109／ICCA.2017.8003163. [4] LEE K,JEONG M J,KIM D H. Software-in-the-loop based modeling and simulation of lunmanned semi-submersible vehicle for performance verification of autonomous navigation［C］／／Materials Science and Engineering Conference Series, 2017. DOI: 10.1088／1757-899X／280／1／012042. [5] 林政,吕霞付.基于改进模糊算法的水面无人艇自主避障［J］.计算机应用,2019,39(9):2523-2528. [6] 吴燕翔,李权任,甘世红,等.基于模糊神经网络的船舶自动驾驶仪的研究［J］.船舶工程,2009,31(4):52-55. [7] 刘恒志.基于广义预测控制的无人艇航迹跟踪研究［D］.郑州:河南大学,2018. [8] 黎为.基于预测控制的水面无人艇航迹跟踪方法研究［D］.黑龙江:哈尔滨工程大学,2016. [9] 吴青,王乐,柳晨光,等.基于MPC的无人船运动控制及可视化仿真系统实现［J］.武汉理工大学学报(交通科学与工程版),2016,40(2):245-250. [10] 刘志林,耿超,黎为，等.基于预测控制的小型无人艇航迹跟踪方法［C］／／第36届中国控制会议论文集(C)，2017. [11] 井辉.无人艇操纵系统模糊建模［J］.舰船科学技术,2018,40(10A):46-48. [12] 岳晋. 喷水推进无人艇六自由度运动建模与仿真研究［D］.大连:大连海事大学,2016. [13] 王阳阳. AUV动力学模型研究及在组合导航中的应用［D］.南京:东南大学,2016. [14] 施生达.潜艇操纵性［M］.北京:国防工业出版社,1995. [15] 王晓飞,张葆华,褚德英,等.基于解析模型预测控制的欠驱动船舶路径跟踪控制器设计［J］.船海工程,2012,41(1):135-137,141. [16] 柳晨光,初秀民,王乐,等.欠驱动水面船舶的轨迹跟踪模型预测控制器［J］.上海交通大学学报,2015,49(12):1842-1848,1854. [17] 张子昌,林莉,徐雪峰,等.基于模型预测控制的潜艇水平面航迹控制算法［J］.中国舰船研究,2019,14(3):172-178. [18] 柳晨光. 基于预测控制的无人船运动控制方法研究［D］.武汉:武汉理工大学,2017. -
点击查看大图
计量
- 文章访问数: 330
- HTML全文浏览量: 44
- PDF下载量: 54
- 被引次数: 0
下载:
