CN113821028A - 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 - Google Patents
基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 Download PDFInfo
- Publication number
- CN113821028A CN113821028A CN202111002098.0A CN202111002098A CN113821028A CN 113821028 A CN113821028 A CN 113821028A CN 202111002098 A CN202111002098 A CN 202111002098A CN 113821028 A CN113821028 A CN 113821028A
- Authority
- CN
- China
- Prior art keywords
- pilot
- follower
- formation
- neighbor
- model predictive
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Abstract
本发明公开了一种基于分布式模型预测控制的欠驱动AUV编队轨迹跟踪控制方法。在输入约束的情况下,针对编队中领航者和跟随者之间通信受阻的问题,本发明首次设计了分布式模型预测控制器,采用图论的方法对领航者和邻居跟随者的信息进行整合。与传统的领航者‑追随者方法相比,减轻了对领航者的依赖性。除此之外,邻居的信息被用于设计状态约束,从而实现编队个体之间避免碰撞的功能。为了解决欠驱动问题,本发明采用带有参考监督优化器的视线制导律,计算期望的最佳航向角。本发明首次利用参考监督器来约束期望的最优航向角增量,以防止出现较大的期望转向导致执行器输出过大。为了解决系统模型的不确定性和环境的扰动,本发明利用径向基函数神经网络逼近不确定的部分系统方程,结合最小学习参数法,减小计算复杂度。
Description
技术领域
本发明涉及无人水下机器人的编队控制领域,特别涉及一种基于分布式模型预测控制的欠驱动AUV编队轨迹跟踪控制方法。
背景技术
多自主水下航行器(AUV)通过其个体间的相互协调,能高效可靠地执行水下任务。因此,多AUV的编队运动控制逐渐成为AUV技术的重要发展方向,其中,欠驱动AUV编队轨迹跟踪控制具有很大的应用前景和价值。
相比于全驱动系统,欠驱动系统降低制造成本和能源消耗,提高推进效率,减少推进设备的维护,AUV的欠驱动结构简化了航行器的机械结构设计,降低机械故障的可能性,节省了不必要的系统开发和运行费用。然而欠驱动问题给控制器的设计带来了一定的复杂性。此外,对于目前广泛应用的领航者-跟随者编队方法,存在跟随者完全依赖领航者的问题,一旦失去领航者的信息跟随者将无法完成任务。任何一个编队在运动时,都需要保障个体之间的避碰,这就要求个体之间交互状态信息和有效地利用信息。在实际应用中,存在驱动器饱和的问题,即动力器无法提供理论上需要的动力去完成某个动作。大幅度的输入信号容易导致暂态响应的崩溃。面对以上问题,本发明提出基于分布式模型预测控制的欠驱动AUV编队轨迹跟踪控制方法,在分布式模型预测控制中整合领航者和邻居跟随者的信息,约束输入,求解最优的控制量。同时为了获得期望的最佳航向角,设计了带有参考监督优化器的视线制导律,以解决欠驱动问题。
发明内容
本发明的技术内容旨在提供一种基于分布式模型预测控制的欠驱动AUV编队轨迹跟踪控制方法,解决现有控制方法中的输入约束、系统欠驱动、编队中个体之间避碰问题、领航者-跟随者编队法中依赖领航者等问题。
为了解决上述技术问题,本发明通过以下技术方案实现:
基于分布式模型预测控制的欠驱动AUV编队轨迹跟踪控制方法,主要包括带有参考监督优化器的视线制导律,结合最小学习参数法的径向基函数神经网络,分布式模型预测控制器。具体包括以下实施步骤:
第一步:根据视线法计算视线角,采用视线制导律可以有效解决系统的欠驱动问题。在此基础上,本发明设计期望的最佳航向角增量作为决策变量,同时考虑期望值和真实值,即将视线角和此刻的航向角作为参考监督优化器的代价函数项,并对期望的最佳航向角增量进行约束,最终获得期望的最佳航向角。参考监督优化器可以防止出现较大的转向导致执行器输出过大。
第二步:AUV动力学的复杂性包括非线性动力学,未建模的动力学效应,系统的不确定性和环境干扰。将以上的不确定性用径向基函数神经网络逼近,将速度作为输入神经元,设计三层神经网络,隐藏层含有8个神经元,输出层含有3个神经元,分别拟合三个方向的不确定方程。由于神经网络会引入较大的计算量,结合最小学习参数法,加速梯度下降的过程,减小计算的复杂度,提高系统的实时性。
第三步:将前两步获得的期望最佳航向角和其他参考状态输入到分布式模型预测控制器中,采用图论的方法对领航者和邻居跟随者的信息进行整合,在代价函数中增加邻居信息的一项,除了与领航者保持一定的位置关系,还与邻居的跟随者保持相对的位置关系,考虑了分布式的编队效果。此外,邻居信息作为状态约束以达到避碰的目的。模型预测控制可以对输入进行约束,从而解决了实际应用中驱动器饱和的问题,达到最优的控制效果。分布式模型预测控制器解决了传统领航者-追随者编队方法中对领航者的依赖问题,只要跟随者有一个邻居与领航者的通信的有效,该跟随者就能完成编队轨迹跟踪。
本发明的有益效果是:
(1)有效地解决了输入饱和的问题,利用模型预测控制的优势,在动力约束的条件下寻找最佳的控制输入解;
(2)在传统的领航者-跟随者编队方法中,存在对领航者完全依赖的问题,本发明设计的分布式模型预测控制同时考虑了领航者和邻居的信息,在保证跟踪精度的同时,也降低了与领航者通信的要求,使得跟随者不会轻易失去参考输入;同时实现了编队中个体之间的避免碰撞;
(3)采用视线制导律,补偿了横荡方向欠驱动器的问题;
(4)在视线制导律的基础上增加一个参考监督优化器,防止出现较大的转向导致执行器输出过大;
(5)利用径向基函数神经网络拟合系统的非线性,提高系统的鲁棒性。并用最小学习参数法,加速梯度下降的过程,减小计算的复杂度,提高系统的实时性。
附图说明
图1为本发明中的基于视线角的导航系统;
图2为本发明中的领航者-跟随者编队轨迹跟踪示意图;
图3为本发明中的用于编队轨迹跟踪的视线制导律示意图;
图4为本发明中的基于图论的通信正常时的拓扑图;
图5为本发明中的基于图论的某一跟随者与领航者之间通信被阻断时的拓扑图;
图6为本发明中的径向基函数神经网络结构图。
具体实施方式
下面结合附图对本发明的具体实施方式作进一步说明。在此需要特别说明的是,对于以下实施方式的说明旨在帮助理解本发明,但不构成对本发明的限定。此外,下面描述的本发明各个实施方式中所涉及的技术特征只要彼此之间未构成冲突就可以相互结合。
如图1所示是领航者-跟随者编队轨迹跟踪示意图,为了方便阐述,本发明采用的
是一个领航者和三个跟随者的模式。假设领航者AUV可以完全追踪上预设的轨迹,三个跟随
者完成对领航者的跟踪。在此过程中,跟随者不仅保持与领航者之间的距离和位置关系,同时保持与其他邻居跟随者之间的空间关系。
视距制导律的角度由下式计算可得:
其中,是航迹误差,是一个常值参数,和分别表示领航者和邻居跟随者的航
向角。为了避免传统方法中跟随者对领航者的绝对依赖,本发明改进了视距制导律的计算,
在图论的基础上,考虑与领航者的视距关系和邻居跟随者的航向角。同时为了降低计算复
杂度,在能获得领航者信息时,降低邻居跟随者的参考权重,不妨将该权重降低为0。下一步
设计参考监督优化器,以期望的最佳航向角增量为决策变量,将和此刻的航向角作为代
价函数项,获得受约束的期望最佳航向角。该期望最佳航向角作为分布式模型预测控制器
的一个参考输入。
如图5所示是径向基函数神经网络结构图,采用径向基神经网络逼近不确定方程,将速度作为输入神经元,设计三层神经网络,隐藏层含有8个神经元,输出层含有3个神经元,分别拟合三个方向的不确定方程,通过调整参数获得最佳的拟合效果,如下式:
χ(0)=χ0,
Claims (11)
1.一种基于分布式模型预测控制的欠驱动AUV编队轨迹跟踪控制方法,其特征在于:带有参考监督优化器的视线制导律,结合最小学习参数法的径向基函数神经网络,整合了邻居节点信息的分布式模型预测控制器。
2.具体内容如下:
根据权利要求1所述的带有参考监督优化器的视线制导律,其特征在于:根据视线法计算视线角,采用视线制导律可以有效解决系统的欠驱动问题。
3.在此基础上,本发明设计期望的最佳航向角增量作为决策变量,同时考虑期望值和真实值,即将视线角和此刻的航向角作为参考监督优化器的代价函数项,并对期望的最佳航向角增量进行约束,最终获得期望的最佳航向角。
4.参考监督优化器可以防止出现较大的转向导致执行器输出过大。
5.根据权利要求1所述的结合最小学习参数法的径向基函数神经网络,其特征在于:AUV动力学的复杂性包括非线性动力学,未建模的动力学效应,系统的不确定性和环境干扰。
6.将以上的不确定性用径向基函数神经网络逼近,将速度作为输入神经元,设计三层神经网络,隐藏层含有8个神经元,输出层含有3个神经元,分别拟合三个方向的不确定方程。
7.由于神经网络会引入较大的计算量,结合最小学习参数法,加速梯度下降的过程,减小计算的复杂度,提高系统的实时性。
8.根据权利要求1所述的整合了邻居节点信息的分布式模型预测控制器,其特征在于:采用图论的方法对领航者和邻居跟随者的信息进行整合,在代价函数中增加邻居信息的一项,除了与领航者保持一定的位置关系,还与邻居的跟随者保持相对的位置关系。
9.此外,邻居信息作为状态约束可以实现编队个体之间的避碰,保障了编队的安全性。
10.模型预测控制可以对输入进行约束,从而解决了实际应用中驱动器饱和的问题,达到最优的控制效果。
11.分布式模型预测控制器解决了传统领航者-追随者编队方法中对领航者的依赖问题,只要跟随者有一个邻居与领航者的通信有效,该跟随者就能完成编队轨迹跟踪。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111002098.0A CN113821028B (zh) | 2021-08-30 | 2021-08-30 | 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111002098.0A CN113821028B (zh) | 2021-08-30 | 2021-08-30 | 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113821028A true CN113821028A (zh) | 2021-12-21 |
CN113821028B CN113821028B (zh) | 2023-08-08 |
Family
ID=78923330
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111002098.0A Active CN113821028B (zh) | 2021-08-30 | 2021-08-30 | 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113821028B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117331317A (zh) * | 2023-12-01 | 2024-01-02 | 东海实验室 | 一种基于宽度学习的欠驱动水下直升机合围控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109375643A (zh) * | 2018-10-24 | 2019-02-22 | 中北大学 | 基于领航-跟随式三角形编队的多四旋翼对峙跟踪目标制导律 |
CN109445447A (zh) * | 2019-01-14 | 2019-03-08 | 北京航空航天大学 | 一种多智能体编队跟踪控制方法及系统 |
CN110032197A (zh) * | 2019-05-07 | 2019-07-19 | 大连海事大学 | 一种基于有限时间制导和控制的无人船路径跟踪控制方法 |
CN111240345A (zh) * | 2020-02-11 | 2020-06-05 | 哈尔滨工程大学 | 一种基于双bp网络增强学习框架的水下机器人轨迹跟踪方法 |
CN111562742A (zh) * | 2020-05-28 | 2020-08-21 | 中国船舶工业集团公司第七0八研究所 | 一种欠驱动船舶的在线建模与自适应控制方法 |
CN113189979A (zh) * | 2021-04-02 | 2021-07-30 | 大连海事大学 | 一种无人船的分布式队列有限时间控制方法 |
-
2021
- 2021-08-30 CN CN202111002098.0A patent/CN113821028B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109375643A (zh) * | 2018-10-24 | 2019-02-22 | 中北大学 | 基于领航-跟随式三角形编队的多四旋翼对峙跟踪目标制导律 |
CN109445447A (zh) * | 2019-01-14 | 2019-03-08 | 北京航空航天大学 | 一种多智能体编队跟踪控制方法及系统 |
CN110032197A (zh) * | 2019-05-07 | 2019-07-19 | 大连海事大学 | 一种基于有限时间制导和控制的无人船路径跟踪控制方法 |
CN111240345A (zh) * | 2020-02-11 | 2020-06-05 | 哈尔滨工程大学 | 一种基于双bp网络增强学习框架的水下机器人轨迹跟踪方法 |
CN111562742A (zh) * | 2020-05-28 | 2020-08-21 | 中国船舶工业集团公司第七0八研究所 | 一种欠驱动船舶的在线建模与自适应控制方法 |
CN113189979A (zh) * | 2021-04-02 | 2021-07-30 | 大连海事大学 | 一种无人船的分布式队列有限时间控制方法 |
Non-Patent Citations (14)
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117331317A (zh) * | 2023-12-01 | 2024-01-02 | 东海实验室 | 一种基于宽度学习的欠驱动水下直升机合围控制方法 |
CN117331317B (zh) * | 2023-12-01 | 2024-02-20 | 东海实验室 | 一种基于宽度学习的欠驱动水下直升机合围控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113821028B (zh) | 2023-08-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zhou et al. | Adaptive fuzzy backstepping-based formation control of unmanned surface vehicles with unknown model nonlinearity and actuator saturation | |
Zhang et al. | Collision avoidance in fixed-wing UAV formation flight based on a consensus control algorithm | |
Yu et al. | Composite adaptive disturbance observer-based decentralized fractional-order fault-tolerant control of networked UAVs | |
Xiang et al. | Synchronized path following control of multiple homogenous underactuated AUVs | |
Arrichiello et al. | Formation control of marine surface vessels using the null-space-based behavioral control | |
Wei et al. | MPC-based motion planning and control enables smarter and safer autonomous marine vehicles: Perspectives and a tutorial survey | |
Sun et al. | A formation collision avoidance system for unmanned surface vehicles with leader-follower structure | |
Zhang et al. | Approach-angle-based three-dimensional indirect adaptive fuzzy path following of under-actuated AUV with input saturation | |
Rajappa et al. | Adaptive super twisting controller for a quadrotor uav | |
Zheng et al. | Multilayer neural dynamics-based adaptive control of multirotor UAVs for tracking time-varying tasks | |
Santoso et al. | State-of-the-art integrated guidance and control systems in unmanned vehicles: A review | |
Chen et al. | Cooperative tracking of vessel trajectories based on curved dynamic coordinates | |
Yin et al. | A virtual linkage-based dual event-triggered formation control strategy for multiple amphibious spherical robots in constrained space with limited communication | |
Mu et al. | Formation control strategy for underactuated unmanned surface vehicles subject to unknown dynamics and external disturbances with input saturation | |
CN114138022B (zh) | 一种基于精英鸽群智能的无人机集群分布式编队控制方法 | |
Wang et al. | A novel obstacle avoidance consensus control for multi-AUV formation system | |
Wu et al. | Augmented safety guarantee-based area keeping control for an underactuated USV with environmental disturbances | |
Abro et al. | Single-Input fuzzy-sliding mode control for an underactuated quadrotor craft | |
CN113821028A (zh) | 基于分布式模型预测控制的欠驱动auv编队轨迹跟踪控制方法 | |
Li et al. | Finite-Time Fuzzy Adaptive Dynamic Event-Triggered Formation Tracking Control for USVs With Actuator Faults and Multiple Constraints | |
Haraldsen et al. | Reactive collision avoidance for underactuated surface vehicles using the collision cone concept | |
Islam et al. | Consensus based distributed cooperative control for multiple miniature aerial vehicles with uncertainty | |
Jianzhang et al. | Swarm control of USVs based on adaptive back-stepping combined with sliding mode | |
Zhang et al. | A distributed adaptive mixed self-/event-triggered formation control approach for multiple stratospheric airships with relative state constraints and input delay | |
Seghour et al. | Consensus-based approach and reactive fuzzy navigation for multiple no-holonomic mobile robots |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |