CN113485377B - 双层虚拟引导机制的无人帆船自适应路径跟踪控制方法 - Google Patents
双层虚拟引导机制的无人帆船自适应路径跟踪控制方法 Download PDFInfo
- Publication number
- CN113485377B CN113485377B CN202110938430.8A CN202110938430A CN113485377B CN 113485377 B CN113485377 B CN 113485377B CN 202110938430 A CN202110938430 A CN 202110938430A CN 113485377 B CN113485377 B CN 113485377B
- Authority
- CN
- China
- Prior art keywords
- representing
- unmanned sailing
- sailing boat
- heading
- unmanned
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 46
- 230000007246 mechanism Effects 0.000 title claims abstract description 25
- 238000013178 mathematical model Methods 0.000 claims abstract description 13
- 239000011159 matrix material Substances 0.000 claims description 24
- 238000013461 design Methods 0.000 claims description 18
- 238000013016 damping Methods 0.000 claims description 17
- 230000001537 neural effect Effects 0.000 claims description 17
- 230000003044 adaptive effect Effects 0.000 claims description 16
- 238000013528 artificial neural network Methods 0.000 claims description 16
- 230000001960 triggered effect Effects 0.000 claims description 12
- 230000008859 change Effects 0.000 claims description 10
- 238000005516 engineering process Methods 0.000 claims description 8
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 4
- 238000009795 derivation Methods 0.000 claims description 4
- 238000010276 construction Methods 0.000 claims description 3
- 238000011084 recovery Methods 0.000 claims description 3
- 239000000758 substrate Substances 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 230000001141 propulsive effect Effects 0.000 claims description 2
- 239000010410 layer Substances 0.000 description 12
- 230000005540 biological transmission Effects 0.000 description 8
- 238000004088 simulation Methods 0.000 description 7
- 230000008569 process Effects 0.000 description 4
- 238000005299 abrasion Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 3
- 238000012423 maintenance Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000012938 design process Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 238000004891 communication Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 239000002355 dual-layer Substances 0.000 description 1
- 238000004134 energy conservation Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 239000005431 greenhouse gas Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法,包括:建立无人帆船的数学模型;构建双层虚拟引导的制导算法;构建艏向虚拟控制器,以降低艏向误差;构造比例积分滑模面,在所述艏向虚拟控制器中引入事件的触发机制,以获取事件触发虚拟控制律;构建考虑输入饱和限制的触发控制律,以实现考虑执行器饱和限制下无人帆船能够得到稳定的控制输入和控制输出。本发明针对无人帆船在时变风向和输入饱和限制下直线路径跟踪控制任务,提出了一种基于双层虚拟引导的无人帆船事件触发鲁棒自使用滑模控制方法,能够针对横风航行和迎/顺风航行分别实时规划参考信号,实现了无人帆船在时变风向下执行直线路径跟踪控制任务。
Description
技术领域
本发明涉及船舶运动控制技术领域,尤其涉及一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法。
背景技术
在无人帆船运动控制领域,帆结构主要用来提供前行动力,舵结构主要用来产生转船力矩。而且,在顶风和顺风局面下,帆结构无法提供充足的前向推力,因此帆船具有无法顶风和顺风航行的特点。考虑到无人帆船在迎风和顺风局面下推力不足的限制,因此在迎风和顺风局面下通常采用“Z”型航线。
制导与控制是船舶运动控制领域中重要的两个子系统,在现有的无人帆船制导结构中,迎风、顺风和横风航行参考艏向是单独产生的,在控制器设计过程中存在不连续现象。此外,无人帆船由于帆结构的存在,在航行过程中受时变风速和风向的影响,闭环控制系统更容易发生低频抖振,特别是为保证无人帆船实时追踪到参考信号,控制输入需要频繁操舵,加快了执行器的磨损。而且,帆受风力作用下更容易引发无人帆船到达执行器饱和状态。
基于以上分析,常规欠驱动船路径跟踪控制算法在无人帆船直线路径跟踪控制任务中具有以下2点缺陷:
1)传统的ILOS制导算法不能引导无人帆船在时变风向下进行路径跟踪控制任务,而且现有的无人帆船制导结构存在参考艏向信号不连续特点。
2)帆受风力作用下,无人帆船更易到达执行器饱和状态,影响控制系统稳定性。此外,外界时变风速风向下,无人帆船控制输入更容易发生低频抖振,增大控制命令传输负载。
发明内容
本发明提供一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法,以克服现有的无人帆船制导结构存在参考艏向信号不连续和外界时变风速风向下,无人帆船控制输入更容易发生低频抖振,增大控制命令传输负载的技术问题。
具体如下:
一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法,包括如下步骤:
S1:建立无人帆船的数学模型;
S2:构建双层虚拟引导的制导算法,以获取无人帆船在迎风、顺风和横风三种航行局面下参考艏向信号;
S3:构建艏向虚拟控制器,以降低艏向误差;
S4:构造比例积分滑模面,以获取基于滑模面的动态误差导数;
S5:在所述艏向虚拟控制器中引入事件的触发机制,以获取事件触发虚拟控制律;
S6:构建考虑输入饱和限制的触发控制律,以实现考虑执行器饱和限制下无人帆船能够得到稳定的控制输入和控制输出。
进一步的,所述无人帆船的数学模型建立如下:
式中:η=[x,y,φ,ψ]T,其中x表示无人帆船在大地坐标系下的横轴坐标,y表示无人帆船在大地坐标系下的纵轴坐标;φ表示无人帆船的横倾角,ψ表示无人帆船的艏向角;
ν=[u,v,p,r]T,其中u表示附体坐标系下无人帆船的前向速度、v表示附体坐标系下无人帆船的横漂速度、p表示附体坐标系下无人帆船的横摇角速度和r表示附体坐标系下无人帆船的艏摇角速度;
J(η)表示变换矩阵;M-1表示M的逆矩阵,M表示前进、横漂、横摇和艏摇自由度上的系统惯性矩阵;C(ν)表示无人帆船本身及附加质量受到的科里奥利向心力矩阵;F(ν)表示由帆、舵、龙骨以及船体造成的模型未知项;G(η)表示在给定倾侧角度下的横摇回复力矩,dwi,i=u,v,p,r表示海洋环境造成的干扰力/力矩;τ=[τu,0,τr]T表示无人帆船的控制输入力/力矩;其中,τu表示帆提供的推进力;τr表示舵提供的转船力矩;
表示无人帆船在前进自由度上的附加质量,/>表示无人帆船在横漂自由度上的附加质量,/>表示无人帆船在横摇自由度上的附加质量,表示无人帆船在艏摇自由度上的附加质量,m为帆船质量;/>分别表示附加质量mu,mv,mp,mr的负数;g(φ)=mgGMtsin(φ)cos(φ),其中GMt表示初稳性高度,g表示重力加速度;Ixx表示无人帆船质量绕x轴的惯性矩;Izz表示无人帆船质量绕z轴的惯性矩;
简化所述无人帆船的4自由度非线性数学模型如下:
式中,b表示执行器增益;sat(δr)表示控制输入的饱和函数;δr表示舵角;fr(·)表示无人帆船艏向模型的非线性项;c表示饱和辅助系数;表示饱和辅助变量;h(δr)表示考虑饱和限制的控制输入;δrM表示舵角的最大值;ρ(δr)表示有界的饱和误差函数。
进一步的,构建双层虚拟引导的制导算法的公式如下:
ψILOS=ψr-arctan(ye+σyint/△)-β (11)
ζ(t)=sgn(ye(t)+dcsgn(ζ(t-1))) (13)
其中,ψs为参考艏向信号;ψtw为真风向;χmax为迎风、顺风界限角度;β为漂角;yint表示无人帆船横风制导积分项;σ为增益算子;△为前向视距;ye表示无人帆船的横向偏差距离;dc表示迎风、顺风区域无人帆船偏航距离;ψr表示参考路径点的切向;ψILOS表示横风航行时的无人帆船参考艏向;ζ(t)表示无人帆船迎/顺风换舷的判断符号函数。
进一步的,所述降低艏向误差方法如下:
根据公式(8)和公式(10),得到无人帆船的艏向误差ψe,并对其求导,可得:
为了降低艏向误差,引入艏向虚拟控制器α1如下:
式中,k1为正的艏向虚拟控制器设计参数。
进一步的,所述构造比例积分滑模面方法如下:
定义动态误差re=α1-r,可得到re的导数,即,
式中,h(δr)表示考虑饱和限制的控制输入;fr(·)表示无人帆船艏向模型的非线性项;ρ(δr)表示有界的饱和误差函数;
构造所述比例积分滑模面:
式中,k2为正的滑模面设计参数;
对所述比例积分滑模面L1求导为:
因此,可表示如下:
进一步的,所述事件触发虚拟控制律的设计方法如下:
S51:所述艏向虚拟控制器中引入事件的触发机制具体如下:
事件触发控制输入hT(δr)(tk)为:
事件触发规则为:
式中,hT(δr)表示表示事件触发控制输入;tk表示当前事件触发时刻;a表示事件触发阈值;eδ表示事件触发控制输入和考虑饱和限制的控制输入的差值;
于是得到,
式中,λ表示事件触发规则的限制参数;
S52:所述构建事件虚拟触发控制律具体如下:
引入鲁棒神经阻尼技术,则无人帆船艏向模型的非线性项fr(·)表示如下:
fr(·)=S(v)Ar+εr=S(v)Aα1-S(v)Are+εr=S(v)Aα1-prS(v)ωr+εr (23)
定义中间辅助变量Π为:
式中,S(v)表示高斯函数,A表示神经网络权重矩阵,εr表示神经网络逼近误差,α1表示艏向虚拟控制器,pr表示神经网络权重矩阵A的范数,ωr表示神经网络权重矩阵A的单位矩阵,dδ表示有外界干扰和有界饱和误差函数组成的类干扰,dδ表示类干扰误差的最大值,εr表示神经网络逼近误差的最大值,θr表示正的鲁棒上界参数,表示鲁棒神经阻尼项;
于是所述比例积分滑模面L1求导可变换为:
式中,λ表示事件触发规则的限制参数;∏-prS(ν)ωr表示鲁棒神经阻尼技术逼近的模型不确定项;
针对hT(δ)设计虚拟事件触发控制律α2:
式中,krn表示正的鲁棒神经阻尼参数,γ1表示正的自适应律的设计参数,σ1为正的自适应律的防漂移设计参数; 表示鲁棒神经阻尼项;S(ν)表示高斯函数。
进一步的,所述考虑输入饱和限制的触发控制律设计方法如下:
定义控制输入误差le=α2-hT(δr),并对其求导,可得,
式中,le表示虚拟事件触发控制律和控制输入之间的误差;表示饱和控制增益;
因此,饱和辅助变量为,
式中,k3为大于零的事件触发控制器设计参数;c表示饱和辅助系数。
有益效果:本发明针对无人帆船在时变风向和输入饱和限制下直线路径跟踪控制任务,提出了一种基于双层虚拟引导的无人帆船事件触发鲁棒自使用滑模控制方法,能够针对横风航行和迎/顺风航行分别实时规划参考信号,并且设计了无人帆船事件触发鲁棒自适应滑模控制器,在控制器设计过程中,引入饱和辅助变量、比例积分滑模修正面和事件触发技术,实现了无人帆船在时变风向下执行直线路径跟踪控制任务。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明无人帆船系统变量示意图;
图2为本发明双曲正切函数曲线图;
图3为本发明双层虚拟引导框架图;
图4为本发明无人帆船事件触发鲁棒自适应滑模控制算法流程图;
图5a为本发明风速变化示意图;
图5b为本发明风向变化示意图;
图6a为本发明无人帆船航向保持任务下的控制输入变化曲线;
图6b为图6a中的局部放大图;
图7a为本发明无人帆船航向保持任务下的艏向角变化曲线图;
图7b为本发明无人帆船航向保持任务下的艏摇速率变化曲线图;
图8为本发明无人帆船路径跟踪轨迹图;
图9a为本发明无人帆船路径跟踪任务下的舵角变化曲线图;
图9b为本发明无人帆船路径跟踪任务下的帆角变化曲线图;
图10a为本发明无人帆船路径跟踪任务下的艏向角变化曲线图;
图10b为本发明无人帆船路径跟踪任务下的横倾角变化曲线图;
图11a为本发明无人帆船路径跟踪任务下的漂角变化曲线图;
图11b为本发明无人帆船路径跟踪任务下的滑模面变化曲线图;
图12a为本发明无人帆船路径跟踪任务下的自适应律;
图12b为本发明无人帆船路径跟踪任务下的触发时间间隔变化过程图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明公开了一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法,包括如下步骤,如附图4所示:
S1:建立无人帆船的数学模型;数学模型是控制系统的基础部分,并且是后续步骤所设计控制器的被控对象;
优选地,建立无人帆船的4自由度非线性数学模型如下:
式中:η=[x,y,φ,ψ]T,其中x表示无人帆船在大地坐标系下的横轴坐标,y表示无人帆船在大地坐标系下的纵轴坐标;φ表示无人帆船的横倾角,ψ表示无人帆船的艏向角;
ν=[u,v,p,r]T,其中u表示附体坐标系下无人帆船的前向速度、v表示附体坐标系下无人帆船的横漂速度、p表示附体坐标系下无人帆船的横摇角速度和r表示附体坐标系下无人帆船的艏摇角速度,如图1所示,图中R代表舵,K代表龙骨;S代表帆;Ob代表重心位置。
J(η)表示变换矩阵;M-1表示M的逆矩阵,M表示前进、横漂、横摇和艏摇自由度上的系统惯性矩阵;C(ν)表示无人帆船本身及附加质量受到的科里奥利向心力矩阵;F(ν)表示由帆、舵、龙骨以及船体造成的模型未知项;G(η)表示在给定倾侧角度下的横摇回复力矩,dwi,i=u,v,p,r表示海洋环境造成的干扰力/力矩;τ=[τu,0,τr]T表示无人帆船的控制输入力/力矩;其中,τu表示帆提供的推进力,主要通过调节帆角δs来产生;τr表示舵提供的转船力矩,主要通过调节舵角δr来产生。
表示无人帆船在前进自由度上的附加质量,/>表示无人帆船在横漂自由度上的附加质量,/>表示无人帆船在横摇自由度上的附加质量,表示无人帆船在艏摇自由度上的附加质量,m为帆船质量;/>分别表示附加质量mu,mv,mp,mr的负数;g(φ)=mgGMtsin(φ)cos(φ),其中GMt表示初稳性高度,g表示重力加速度;Ixx表示无人帆船质量绕x轴的惯性矩;,Izz表示无人帆船质量绕z轴的惯性矩;
为了简化控制器设计,仅选取航向自由度的数学模型和双曲正切饱和函数,简化所述无人帆船的4自由度非线性数学模型如下:
式中,b表示执行器增益;sat(δr)表示控制输入的饱和函数;δr表示舵角;fr(·)表示无人帆船艏向模型的非线性项;c表示饱和辅助系数;表示饱和辅助变量;h(δr)表示考虑饱和限制的控制输入;δrM表示舵角的最大值;ρ(δr)表示有界的饱和误差函数;tanh(·)表示双曲正切函数;
S2:构建双层虚拟引导的制导算法,以获取无人帆船在迎风、顺风和横风三种航行局面下参考艏向信号;无人帆船在执行路径跟踪任务时,如何使无人帆船在迎风、顺风和横风局面下跟踪到期望航线是我们要解决的一个关键问题。
优选地,构建双层虚拟引导的制导算法如下:
如附图3所示,无人帆船在横风、顺风和迎风三种航行局面下的艏向信号如公式(10),
ψILOS=ψr-arctan(ye+σyint/△)-β (11)
ζ(t)=sgn(ye(t)+dcsgn(ζ(t-1))) (13)
其中,ψs为参考艏向信号;ψtw为真风向;χmax为迎风、顺风界限角度;β为漂角;yint表示无人帆船横风制导积分项;σ为增益算子;△为前向视距;ye表示无人帆船的横向偏差距离;dc表示迎风、顺风区域无人帆船偏航距离;ψr表示参考路径点的切向;ψILOS表示横风航行时的无人帆船参考艏向;ζ(t)表示无人帆船迎/顺风换舷的判断符号函数。
S3:构建艏向虚拟控制器,以降低艏向误差;具体如下:为了使无人帆船的当前艏向跟踪到所述参考艏向,需要降低艏向误差,因此要构建艏向虚拟控制器。
根据无人帆船的航向数学模型公式(8)和无人帆船的参考艏向公式(10),得到无人帆船的艏向误差ψe,并对其求导,可得:
为了降低艏向误差,引入艏向虚拟控制器α1如下:
式中,k1为为正的艏向虚拟控制器设计参数;
S4:构造比例积分滑模面,以获取基于滑模面的动态误差导数;
优选地,定义动态误差re=α1-r,可得到re的导数,即,
式中,h(δr)表示考虑饱和限制的控制输入;fr(·)表示无人帆船艏向模型的非线性项,在船舶运动控制领域,通常采用径向基函数神经网络进行在线逼近;ρ(δr)表示有界的饱和误差函数;
为了提高无人帆船控制系统的路径跟踪的控制效果,引入比例积分滑模技术,构造所述比例积分滑模面L1如下:
式中,k2为正的滑模面设计参数;
对所述比例积分滑模面L1求导为:
因此,可表示如下:
S5:在所述艏向虚拟控制器中引入事件的触发机制,以获取事件触发虚拟控制律;减少控制输入的传输频率,降低无人帆船加速执行器的磨损;具体的,无人帆船在路径跟踪控制过程中,会受到外界时变扰动的作用,从而引起无人帆船的艏向不断变化,为了降低艏向误差,需要不断产生控制命令,会增加控制输入的传输频率。因此引入事件触发机制,能够减少控制输入的传输频率,降低无人帆船执行器的磨损。
优选地,在所述艏向虚拟控制器中引入事件的触发机制具体如下:
对于无人帆船,系统的不确定性和外部干扰会导致闭环系统的频繁抖振,这样会增加控制输入的传输频率,加速执行器的磨损,考虑到这种限制,于是在所述艏向虚拟控制器中引入事件的触发机制具体如下:
事件触发控制输入hT(δr)(tk)为:
事件触发规则为:
式中,hT(δr)表示表示事件触发控制输入;tk表示当前事件触发时刻;a表示事件触发阈值;0<a<1;eδ表示事件触发控制输入和考虑饱和限制的控制输入的差值,eδ=hT(δr)-h(δr);
于是得到,
式中,λ表示事件触发规则的限制参数。
所述构建事件虚拟触发控制律具体如下:
为了处理系统模型不确定以及避免神经网络权重在线更新,引入鲁棒神经阻尼技术,则无人帆船艏向模型的非线性项fr(·)表示如下:
fr(·)=S(v)Ar+εr=S(v)Aα1-S(v)Are+εr=S(v)Aα1-prS(v)ωr+εr (23)
进一步的,为了构建鲁棒神经阻尼项,定义中间辅助变量Π为:
式中,S(v)表示高斯函数,A表示神经网络权重矩阵,εr表示神经网络逼近误差,α1表示艏向虚拟控制器,pr表示神经网络权重矩阵A的范数,ωr表示神经网络权重矩阵A的单位矩阵,dδ表示有外界干扰和有界饱和误差函数组成的类干扰,dδ表示类干扰误差的最大值,εr表示神经网络逼近误差的最大值,θr表示正的鲁棒上界参数,表示鲁棒神经阻尼项;
考虑到鲁棒神经阻尼技术和事件触发技术,对所述比例积分滑模面L1进行求导如下:
式中,λ表示事件触发规则的限制参数;∏-prS(ν)ωr表示鲁棒神经阻尼技术逼近的模型不确定项;
针对hT(δ)设计虚拟事件触发控制律α2:
式中,krn表示正的鲁棒神经阻尼参数,γ1表示正的自适应律的设计参数,σ1为正的自适应律的防漂移设计参数; 表示鲁棒神经阻尼项;S(ν)表示高斯函数。
S6:构建考虑输入饱和限制的触发控制律,以实现考虑执行器饱和限制下无人帆船能够得到稳定的控制输入和控制输出。
所述考虑输入饱和限制的触发控制律设计方法如下:
定义控制输入误差le=α2-hT(δr),并对其求导,可得,
式中,le表示虚拟事件触发控制律和控制输入之间的误差;表示饱和控制增益且ξ∈(0,1);
因此,饱和辅助变量为,
式中,k3为大于零的事件触发控制器设计参数;c表示饱和辅助系数。
为了验证本发明的优势性和有效性,在时变外界风力干扰下分别进行两个数值仿真。仿真1为本发明控制算法与算法A和算法B的对比实验,其中,算法A为不考虑事件触发机制的本发明算法,算法B为成熟的鲁棒自适应控制算法,本发明和算法A、算法B的主要区别如表1所示。
表1本发明算法、算法A和算法B之间的异同点
图6和图7表示仿真1的主要对比结果,图6(a)描述了三种算法下的控制输入,图6(b)是局部放大细节,显示了本发明控制方法的优越性。可以发现,该算法的阶梯控制输入可以降低传输频率。与基于符号函数的输入饱和方法相比,该算法中的输入饱和技术由于设计了辅助补偿系统,可以有效地释放执行器的约束。图7为闭环控制系统的输出性能。综合图5和图6我们可以发现,与算法A相比,本发明算法由于采用事件触发技术能够有效降低控制输入的传输频率;与算法B相比,本发明算法由于采用成熟的双曲正切函数处理执行器饱和问题,如附图2所示,控制输入在饱和界限处更平滑且更容易达到稳定状态。
仿真2为无人帆船在时变风向下进行直线路径跟踪实验,其中,平均风向变化过程如式(29)所示。
时变风向下直线路径的主要仿真结果如图8-图12所示。图8描述了无人帆船在模拟海洋环境下的路径跟踪轨迹。从图8中可以发现,尽管无人帆船遇到逆风、侧风和顺风条件,但它可以以满意的精度跟踪所需的路径。特别是在逆风和顺风场景中,由于采用了双层虚拟制导,实现了“Z”型路径。图9为无人帆船路径跟踪任务下的舵角和帆角变化曲线。在船舶工程中,应将控制指令传递给执行机构,执行机构可通过伺服系统实现控制指令。在图9(a)中,实线表示设计的控制器产生的控制命令,点虚线表示舵机伺服系统的实际输入。此外,当满足事件触发规则时,控制命令将保持不变。这样可以减少通信负担,避免低频外部干扰引起的系统抖振。图10显示了无人帆船的控制输出。值得注意的是,横摇角φ在合理的范围内,这可以提高闭环控制系统的安全性和稳定性。漂移角和滑模面的变化过程如图11所示。从图12(a)中可以看出,自适应参数可以释放执行器非线性增益的约束,且大的自适应参数值可以保证无人帆船在迎风换舷过程中的自动性。图12(b)显示触发间隔最大可达5.5s。
结合现有技术、控制器设计和仿真试验,本发明在无人帆船运动控制领域取得了以下2点有益效果:
1)本发明的双层虚拟引导算法能够在迎风、顺风和横风航行状态下产生连续的参考艏向信号。与现有技术相比,本发明能够实现时变风向下无人帆船有效执行直线路径跟踪控制任务。此外,采用成熟的双曲正切函数解决了输入饱和限制带来的系统不稳定。由于比例积分滑模技术和事件触发技术的优势,本发明的控制方法能够降低受外界扰动引起的控制输入频繁抖振现象,提高了控制算法的路径跟踪控制效果。
2)通过数值仿真验证了本发明的控制方法在时变风向中无人帆船直线路径跟踪控制的有效性和可行性。无人帆船属于新型智能新能源船舶,具有明显的“绿色、节能”的特点,对降低船舶温室气体排放量具有重要作用,在海洋牧场、环境监测等长航时自主工程任务中具有广阔应用前景。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (6)
1.一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法,其特征在于,包括如下步骤:
S1:建立无人帆船的数学模型;
S2:构建双层虚拟引导的制导算法,以获取无人帆船在迎风、顺风和横风三种航行局面下参考艏向信号;
构建双层虚拟引导的制导算法的公式如下:
ψILOS=ψr-arctan(ye+σyint/△)-β (11)
ζ(t)=sgn(ye(t)+dcsgn(ζ(t-1))) (13)
其中,ψs为参考艏向信号;ψtw为真风向;χmax为迎风、顺风界限角度;β为漂角;yint表示无人帆船横风制导积分项;σ为增益算子;△为前向视距;ye表示无人帆船的横向偏差距离;dc表示迎风、顺风区域无人帆船偏航距离;ψr表示参考路径点的切向;ψILOS表示横风航行时的无人帆船参考艏向;ζ(t)表示无人帆船迎/顺风换舷的判断符号函数;
S3:构建艏向虚拟控制器,以降低艏向误差;
S4:构造比例积分滑模面,以获取基于滑模面的动态误差导数;
S5:在所述艏向虚拟控制器中引入事件的触发机制,以获取事件触发虚拟控制律;
S6:构建考虑输入饱和限制的触发控制律,以实现考虑执行器饱和限制下无人帆船能够得到稳定的控制输入和控制输出。
2.根据权利要求1所述的一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法,其特征在于,所述无人帆船的数学模型建立如下:
式中:η=[x,y,φ,ψ]T,其中x表示无人帆船在大地坐标系下的横轴坐标,y表示无人帆船在大地坐标系下的纵轴坐标;φ表示无人帆船的横倾角,ψ表示无人帆船的艏向角;
ν=[u,v,p,r]T,其中u表示附体坐标系下无人帆船的前向速度、v表示附体坐标系下无人帆船的横漂速度、p表示附体坐标系下无人帆船的横摇角速度和r表示附体坐标系下无人帆船的艏摇角速度;
J(η)表示变换矩阵;M-1表示M的逆矩阵,M表示前进、横漂、横摇和艏摇自由度上的系统惯性矩阵;C(ν)表示无人帆船本身及附加质量受到的科里奥利向心力矩阵;F(ν)表示由帆、舵、龙骨以及船体造成的模型未知项;G(η)表示在给定倾侧角度下的横摇回复力矩,dwi,i=u,v,p,r表示海洋环境造成的干扰力/力矩;τ=[τu,0,τr]T表示无人帆船的控制输入力/力矩;其中,τu表示帆提供的推进力;τr表示舵提供的转船力矩;
表示无人帆船在前进自由度上的附加质量,/>表示无人帆船在横漂自由度上的附加质量,/>表示无人帆船在横摇自由度上的附加质量,/>表示无人帆船在艏摇自由度上的附加质量,m为帆船质量;/>分别表示附加质量mu,mv,mp,mr的负数;g(φ)=mgGMtsin(φ)cos(φ),其中GMt表示初稳性高度,g表示重力加速度;Ixx表示无人帆船质量绕x轴的惯性矩;Izz表示无人帆船质量绕z轴的惯性矩;
简化所述无人帆船的4自由度非线性数学模型如下:
式中,b表示执行器增益;sat(δr)表示控制输入的饱和函数;δr表示舵角;fr(·)表示无人帆船艏向模型的非线性项;c表示饱和辅助系数;表示饱和辅助变量;h(δr)表示考虑饱和限制的控制输入;δrM表示舵角的最大值;ρ(δr)表示有界的饱和误差函数。
3.根据权利要求2所述的一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法,其特征在于,所述降低艏向误差方法如下:
根据公式(8)和公式(10),得到无人帆船的艏向误差ψe,并对其求导,可得:
为了降低艏向误差,引入艏向虚拟控制器α1如下:
式中,k1为正的艏向虚拟控制器设计参数。
4.根据权利要求3所述的一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法,其特征在于,所述构造比例积分滑模面方法如下:
定义动态误差re=α1-r,可得到re的导数,即,
式中,h(δr)表示考虑饱和限制的控制输入;fr(·)表示无人帆船艏向模型的非线性项;ρ(δr)表示有界的饱和误差函数;
构造所述比例积分滑模面:
式中,k2为正的滑模面设计参数;
对所述比例积分滑模面L1求导为:
因此,可表示如下:
5.根据权利要求4所述的一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法,其特征在于,所述事件触发虚拟控制律的设计方法如下:
S51:所述艏向虚拟控制器中引入事件的触发机制具体如下:
事件触发控制输入hT(δr)(tk)为:
事件触发规则为:
tk+1=inf{t>tk||eδ|>a|h(δr)|} (21)
式中,hT(δr)表示表示事件触发控制输入;tk表示当前事件触发时刻;a表示事件触发阈值;eδ表示事件触发控制输入和考虑饱和限制的控制输入的差值;
于是得到,
式中,λ表示事件触发规则的限制参数;
S52:构建事件虚拟触发控制律具体如下:
引入鲁棒神经阻尼技术,则无人帆船艏向模型的非线性项fr(·)表示如下:
fr(·)=S(v)Ar+εr=S(v)Aα1-S(v)Are+εr=S(v)Aα1-prS(v)ωr+εr (23)
定义中间辅助变量Π为:
式中,S(v)表示高斯函数,A表示神经网络权重矩阵,εr表示神经网络逼近误差,α1表示艏向虚拟控制器,pr表示神经网络权重矩阵A的范数,ωr表示神经网络权重矩阵A的单位矩阵,dδ表示有外界干扰和有界饱和误差函数组成的类干扰,dδ表示类干扰误差的最大值,εr表示神经网络逼近误差的最大值,θr表示正的鲁棒上界参数,表示鲁棒神经阻尼项;
于是所述比例积分滑模面L1求导可变换为:
式中,λ表示事件触发规则的限制参数;∏-prS(ν)ωr表示鲁棒神经阻尼技术逼近的模型不确定项;
针对hT(δ)设计虚拟事件触发控制律α2:
式中,krn表示正的鲁棒神经阻尼参数,γ1表示正的自适应律的设计参数,σ1为正的自适应律的防漂移设计参数; 表示鲁棒神经阻尼项;S(ν)表示高斯函数。
6.根据权利要求5所述的一种双层虚拟引导机制的无人帆船自适应路径跟踪控制方法,其特征在于,所述考虑输入饱和限制的触发控制律设计方法如下:
定义控制输入误差le=α2-hT(δr),并对其求导,可得,
式中,le表示虚拟事件触发控制律和控制输入之间的误差;表示饱和控制增益;
因此,饱和辅助变量为,
式中,k3为大于零的事件触发控制器设计参数;c表示饱和辅助系数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110938430.8A CN113485377B (zh) | 2021-08-16 | 2021-08-16 | 双层虚拟引导机制的无人帆船自适应路径跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110938430.8A CN113485377B (zh) | 2021-08-16 | 2021-08-16 | 双层虚拟引导机制的无人帆船自适应路径跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113485377A CN113485377A (zh) | 2021-10-08 |
CN113485377B true CN113485377B (zh) | 2023-11-17 |
Family
ID=77946626
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110938430.8A Active CN113485377B (zh) | 2021-08-16 | 2021-08-16 | 双层虚拟引导机制的无人帆船自适应路径跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113485377B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114661053B (zh) * | 2022-04-14 | 2024-07-23 | 大连海事大学 | 一种考虑障碍船危险行为的船舶动态避障制导与控制方法 |
CN115016257B (zh) * | 2022-05-05 | 2024-09-17 | 哈尔滨工程大学 | 纵平面跟踪无人水下航行器的模糊事件触发滑模控制方法 |
CN114578697B (zh) * | 2022-05-09 | 2022-07-12 | 西南石油大学 | 一种电机驱动机械手的多约束自适应控制方法 |
CN115113524B (zh) * | 2022-06-02 | 2023-09-19 | 大连海事大学 | 一种基于干预lvs制导的asv多端口事件触发路径跟踪控制方法 |
CN115454098A (zh) * | 2022-10-11 | 2022-12-09 | 东翼长启科技(重庆)有限公司 | 一种基于翼帆和舵联动的无人帆船航向控制方法及系统 |
CN115963841A (zh) * | 2023-01-16 | 2023-04-14 | 大连海事大学 | 基于改进lvs制导的无人帆船动态事件触发控制方法 |
CN117193344B (zh) * | 2023-09-21 | 2024-03-15 | 大连海事大学 | 基于同步制导的机/船协同多元任务事件触发控制方法 |
CN117193345B (zh) * | 2023-09-21 | 2024-03-26 | 大连海事大学 | 基于动态事件触发的机-船协同平台自主降落控制方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006131622A1 (fr) * | 2005-06-10 | 2006-12-14 | Agence Spatiale Europeenne | Module et systeme de pilotage automatique d’un bateau a voile pour la navigation en presence de vagues. |
JP2014004911A (ja) * | 2012-06-25 | 2014-01-16 | Tokyo Univ Of Marine Science & Technology | 非線形の自己回帰モデルによる船舶の航路保持方法 |
CN107966152A (zh) * | 2017-11-22 | 2018-04-27 | 大连海事大学 | 一种具有碰撞风险预测机制的避碰及路径跟踪制导方法 |
CN109116856A (zh) * | 2018-09-28 | 2019-01-01 | 上海海事大学 | 一种基于扰动观测器的欠驱动船舶路径跟踪控制方法 |
CN109189071A (zh) * | 2018-09-25 | 2019-01-11 | 大连海事大学 | 基于模糊观测器的鲁棒自适应无人船路径跟踪控制方法 |
CN111708280A (zh) * | 2020-06-30 | 2020-09-25 | 大连海事大学 | 一种考虑执行器故障的船舶路径跟踪事件触发控制器方法 |
CN112346465A (zh) * | 2020-11-27 | 2021-02-09 | 哈尔滨工程大学 | 基于ialos导引律的欠驱无人船自适应模糊控制方法 |
CN112650257A (zh) * | 2020-12-30 | 2021-04-13 | 大连海事大学 | 一种无人艇区域保持控制方法及装置 |
CN112987771A (zh) * | 2021-03-08 | 2021-06-18 | 大连海事大学 | 基于多端口输出误差触发机制的机帆船路径跟踪控制方法 |
CN113219978A (zh) * | 2021-05-12 | 2021-08-06 | 大连海事大学 | 一种基于零阶保持器的船舶路径跟踪事件触发控制方法 |
-
2021
- 2021-08-16 CN CN202110938430.8A patent/CN113485377B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006131622A1 (fr) * | 2005-06-10 | 2006-12-14 | Agence Spatiale Europeenne | Module et systeme de pilotage automatique d’un bateau a voile pour la navigation en presence de vagues. |
JP2014004911A (ja) * | 2012-06-25 | 2014-01-16 | Tokyo Univ Of Marine Science & Technology | 非線形の自己回帰モデルによる船舶の航路保持方法 |
CN107966152A (zh) * | 2017-11-22 | 2018-04-27 | 大连海事大学 | 一种具有碰撞风险预测机制的避碰及路径跟踪制导方法 |
CN109189071A (zh) * | 2018-09-25 | 2019-01-11 | 大连海事大学 | 基于模糊观测器的鲁棒自适应无人船路径跟踪控制方法 |
CN109116856A (zh) * | 2018-09-28 | 2019-01-01 | 上海海事大学 | 一种基于扰动观测器的欠驱动船舶路径跟踪控制方法 |
CN111708280A (zh) * | 2020-06-30 | 2020-09-25 | 大连海事大学 | 一种考虑执行器故障的船舶路径跟踪事件触发控制器方法 |
CN112346465A (zh) * | 2020-11-27 | 2021-02-09 | 哈尔滨工程大学 | 基于ialos导引律的欠驱无人船自适应模糊控制方法 |
CN112650257A (zh) * | 2020-12-30 | 2021-04-13 | 大连海事大学 | 一种无人艇区域保持控制方法及装置 |
CN112987771A (zh) * | 2021-03-08 | 2021-06-18 | 大连海事大学 | 基于多端口输出误差触发机制的机帆船路径跟踪控制方法 |
CN113219978A (zh) * | 2021-05-12 | 2021-08-06 | 大连海事大学 | 一种基于零阶保持器的船舶路径跟踪事件触发控制方法 |
Non-Patent Citations (2)
Title |
---|
Event-triggered robust neural control for unmanned sail-assisted vehicles subject to actuator failures;Guoqing Zhang;《Ocean Engineering》;第216卷;第1-11页 * |
基于速度调节的无人帆船机器人自适应航向保持控制;张国庆;《控制理论与应用》;第37卷(第11期);第2383-2390页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113485377A (zh) | 2021-10-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113485377B (zh) | 双层虚拟引导机制的无人帆船自适应路径跟踪控制方法 | |
CN111580523B (zh) | 一种基于侧滑角补偿的无人艇路径跟踪自抗扰控制方法 | |
Zhang et al. | Robust adaptive neural control for wing-sail-assisted vehicle via the multiport event-triggered approach | |
CN111045332A (zh) | 一种无人艇路径跟踪导引策略和扰动补偿方法 | |
Deng et al. | Line-of-sight-based guidance and adaptive neural path-following control for sailboats | |
CN105334735A (zh) | 一种基于角速率的飞翼布局无人机控制律 | |
CN117707162B (zh) | 基于改进lvs制导的无人帆船动态事件触发控制方法 | |
Fan et al. | Course keeping control based on integrated nonlinear feedback for a USV with pod-like propulsion | |
CN106292294A (zh) | 基于模型参考自适应控制的舰载无人机自动着舰控制装置 | |
CN111290278B (zh) | 一种基于预测滑模的高超声速飞行器鲁棒姿态控制方法 | |
CN115113524B (zh) | 一种基于干预lvs制导的asv多端口事件触发路径跟踪控制方法 | |
CN112987771B (zh) | 基于多端口输出误差触发机制的机帆船路径跟踪控制方法 | |
Shen et al. | Online speed optimization with feedforward of unmanned sailboat via extremum seeking without steady-state oscillation | |
Li et al. | Event-triggered robust adaptive control for path following of the URS in presence of the marine practice | |
Wang et al. | Autonomous piloting and berthing based on Long Short Time Memory neural networks and nonlinear model predictive control algorithm | |
Bencatel et al. | Full state feedback foiling control for america’s cup catamarans | |
CN104991446B (zh) | 一种基于大脑情感学习的无人机推力变向智能控制方法 | |
CN116048090A (zh) | 一种具有能耗优化效应的风帆助航船路径跟踪控制方法 | |
Fu et al. | Adaptive finite-time PI sliding mode trajectory tracking control for underactuated hovercraft with drift angle constraint | |
CN114637312A (zh) | 一种基于智能变形决策的无人机节能飞行控制方法及系统 | |
CN113110527B (zh) | 一种自主水下航行器有限时间路径跟踪的级联控制方法 | |
Su et al. | Nonlinear feedback-based path following control for underactuated ships via an improved compound line-of-sight guidance | |
CN116795125B (zh) | 基于非线性模型预测控制的飞行器制导控制一体化方法 | |
CN115685764B (zh) | 变翼展飞行器任务自适应的抗干扰跟踪控制方法及系统 | |
Rodriguez et al. | Adaptive takeoff maneuver optimization of a sailing boat for America’s cup |
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 |