针对多自主式水下航行器轨迹跟踪控制中的不确定性问题,研究多自主式水下航行器轨迹精准跟踪控制方法。构建基于灰色预测的轨迹精准跟踪控制模型,利用灰色预测模型预测航行器航向角,构建一元多项式回归模型,拟合航行器初始航向角同预测航向角间的残差,优化灰色预测模型,提升航行器航向角预测精度。将航向角预测结果代入PID控制器内,通过计算航向角控制率确定位置误差、速度误差与加速度误差,通过控制上述误差实现航行器轨迹准确跟踪控制。实验结果显示该方法可在航行器不同运动特性下准确跟踪轨迹,并具有较好的控制效果。
To address the uncertainty issue in trajectory tracking control of multi-autonomous underwater vehicles, a precise trajectory tracking control method for multi-autonomous underwater vehicles is studied. Build a trajectory accurate tracking control model based on gray prediction, use the gray prediction model to predict the aircraft's heading angle, build a unitary polynomial regression model, fit the residual between the initial heading angle of the aircraft and the predicted heading angle, optimize the gray prediction model, and improve the prediction accuracy of the aircraft's heading angle. Bring the predicted heading angle results into the PID controller, determine the position error, velocity error, and acceleration error by calculating the heading angle control rate, and achieve accurate tracking control of the aircraft trajectory by controlling the above errors. The experimental results show that this method can accurately track trajectories under different motion characteristics of the aircraft and has good control effects.
2023,45(11): 102-105 收稿日期:2023-01-22
DOI:10.3404/j.issn.1672-7619.2023.11.020
分类号:U661.33
基金项目:湖北省教育厅资助项目(B2022487)
作者简介:呙力平(1984-),女,硕士,讲师,研究方向为机械设计与制造
参考文献:
[1] 黄哲敏, 程舟济, 夏英凯, 等. X舵自主式水下航行器抗横滚控制研究与操纵性试验[J]. 中国舰船研究, 2021, 16(S1): 19–30
HUANG Zhemin, CHENG Zhouji, XIA Yingkai, et al. Anti-roll control and maneuverability test of X-rudder autonomous underwater vehicle[J]. Chinese Journal of Ship Research, 2021, 16(S1): 19–30
[2] 孙雪洁, 李纪伟. 基于MOOS-IvP的自主式水下航行器的机载软件系统容错设计[J]. 船舶工程, 2021, 43(6): 90–95
SUN Xuejie, LI Jiwei. Fault tolerant design of airborne software system for autonomous underwater vehicles based on MOOS-IvP[J]. Ship Engineering, 2021, 43(6): 90–95
[3] 李韶华, 杨泽坤, 王雪玮. 基于T-S模糊变权重MPC的智能车轨迹跟踪控制[J]. 机械工程学报, 2023, 59(4): 199–212
LI Chaohua, YANG Zekun, WANG Xuewei. Intelligent vehicle trajectory tracking control based on T-S fuzzy variable weight MPC[J]. Chinese Journal of Mechanical Engineering, 2023, 59(4): 199–212
[4] 滕建平, 梁霄, 陶浩, 等. 无人水下航行器全局路径规划及有限时间跟踪控制[J]. 上海海事大学学报, 2022, 43(1): 1–7
TENG Jianping, LIANG Xiao, TAO Hao, et al. Global path planning and finite-time tracking control of unmanned underwater vehicles[J]. Journal of Shanghai Maritime University, 2022, 43(1): 1–7
[5] 赵婧旭, 赵晨, 周锋. 基于主从式水下自主航行器移动组网的合作目标定位方法[J]. 电子与信息学报, 2022, 44(6): 1919–1926
ZHAO Jingxu, ZHAO Chen, ZHOU Feng. cooperative target location method based on master-slave autonomous underwater vehicles mobile network[J]. Journal of Electronics & Information Technology, 2022, 44(6): 1919–1926
[6] 李文魁, 周铸, 宦爱奇, 等. 自主水下航行器自适应S面三维轨迹跟踪的仿真验证[J]. 中国舰船研究, 2022, 17(4): 38–46+91
LI Wenkui, ZHOU Zhu, HUAN Aiqi, et al. Simulation and verification of an adaptive S-plane three-dimensional trajectory tracking control for autonomous underwater vehicles[J]. Chinese Journal of Ship Research, 2022, 17(4): 38–46+91
[7] 曹晓明, 魏勇, 衡辉, 等. 海流扰动下无人水下航行器的动态面反演轨迹跟踪控制[J]. 系统工程与电子技术, 2021, 43(6): 1664–1672
CAO Xiaoming, WEI Yong, HENG Hui, et al. Dynamic surface backstepping trajectory tracking control of unmanned underwater vehicles with ocean current disturbances[J]. Systems Engineering and Electronics, 2021, 43(6): 1664–1672