CN108073175A - 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法 - Google Patents

基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法 Download PDF

Info

Publication number
CN108073175A
CN108073175A CN201810063947.5A CN201810063947A CN108073175A CN 108073175 A CN108073175 A CN 108073175A CN 201810063947 A CN201810063947 A CN 201810063947A CN 108073175 A CN108073175 A CN 108073175A
Authority
CN
China
Prior art keywords
mrow
msub
ship
mtd
mover
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
Application number
CN201810063947.5A
Other languages
English (en)
Other versions
CN108073175B (zh
Inventor
陆宇
张卫东
乔磊
程引
孙博
彭晨
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Jiaotong University
Original Assignee
Shanghai Jiaotong University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shanghai Jiaotong University filed Critical Shanghai Jiaotong University
Priority to CN201810063947.5A priority Critical patent/CN108073175B/zh
Publication of CN108073175A publication Critical patent/CN108073175A/zh
Application granted granted Critical
Publication of CN108073175B publication Critical patent/CN108073175B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02Control of position or course in two dimensions
    • G05D1/0206Control of position or course in two dimensions specially adapted to water vehicles
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06NCOMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
    • G06N3/00Computing arrangements based on biological models
    • G06N3/02Neural networks
    • G06N3/08Learning methods
    • G06N3/084Backpropagation, e.g. using gradient descent
    • GPHYSICS
    • G08SIGNALLING
    • G08CTRANSMISSION SYSTEMS FOR MEASURED VALUES, CONTROL OR SIMILAR SIGNALS
    • G08C17/00Arrangements for transmitting signals characterised by the use of a wireless electrical link
    • G08C17/02Arrangements for transmitting signals characterised by the use of a wireless electrical link using a radio link

Abstract

本发明涉及一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,包括以下步骤:1)设定队形并进行参数初始化;2)采集领导艇的位置坐标(xL,yL)和艏向角ψL,进行滤波后传输给跟随艇;3)根据队形以及领导艇的位置坐标和艏向角信息实时获取跟随艇在编队中的参考位置(xr,yr)和参考运动姿态ψr;4)引入虚拟艇并进行实时自适应规划获取跟随艇的参考航迹;5)采用RBF神经网络和最小参数学习算法组合策略对学习参数进行在线训练,生成智能编队控制信号,包括跟随艇的主机转速nF和舵角命令信号δF。与现有技术相比,本发明具有适应曲线路径任务、避免过顶、无需领导艇速度信息、简单便捷、实时性强等优点。

Description

基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法
技术领域
本发明涉及海洋工程无人艇控制技术领域,尤其是涉及一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法。
背景技术
在开发利用海洋方面,无人艇作为海上最为典型的无人智能平台系统,引起了国家的高度重视。无人艇具有吃水浅、速度快、机动性强等优点,可大量应用于海洋科研、海洋开发、海洋环境监测、海洋权益维护等军事和民用任务中。
随着环境的复杂化和任务的多样化,单无人艇不仅需要在自身的能力范围内独自执行任务,还需要与其它无人艇联合完成任务,无人艇编队技术逐渐受到广泛关注。无人艇编队是指具有保持固定或临时队形能力的无人艇集群。相比于单无人艇作业,通过保持预设队形,无人艇群具有更大的作业范围、更强的容错能力以及更高的资源利用率,对于完成水上任务具有重要意义。
虽然无人艇编队的思想很直观,但在实际工程中实现无人艇编队面临诸多挑战,涉及到无人艇群环境感知、自主导航、避碰避障、任务实时规划、队形控制等一系列问题。目前国内在欠驱动无人艇编队队形控制方面研究的局限性主要体现在如下两个方面:
其一,体现在曲线路径场景应用方面。目前关于欠驱动无人艇编队队形控制的绝大部分研究在大地坐标系下展开,所获得的队形为绝对队形,无法满足曲线路径任务下的编队巡航需求;使用绝对队形进行编队的另一弊端是队形设置时存在过顶问题,即无法实现跟随艇与领导艇在同一竖直直线下的队形保持。如何实现在曲线路径场景下进行有效编队同时避免队形设置时的过顶问题亟需解决。
其二,体现在算法工程化实现方面。随着控制方法的智能化发展,出现了很多欠驱动无人艇编队的智能控制方法,特别是基于神经网络的编队控制方法,可有效解决无人艇模型不确定以及外界环境扰动问题。但这些基于神经网路的编队智能控制方法在工程化实现过程中都存在维数灾问题,即随着神经网络隐含层节点数目的增多,在线学习参数也越来越多,从而导致在线学习时间过长,难以满足工程实时性需求。
发明内容
本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法。
本发明的目的可以通过以下技术方案来实现:
一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,包括以下步骤:
1)设定队形并进行参数初始化;
2)采集领导艇的位置坐标(xL,yL)和艏向角ψL,进行滤波后传输给跟随艇;
3)根据队形以及领导艇的位置坐标和艏向角信息实时获取跟随艇在编队中的参考位置(xr,yr)和参考运动姿态ψr
4)引入虚拟艇并进行实时自适应规划获取跟随艇的参考航迹;
5)采用RBF神经网络和最小参数学习算法组合策略对学习参数进行在线训练,生成智能编队控制信号,包括跟随艇的主机转速nF和舵角命令信号δF
所述的步骤1)具体包括以下步骤:
设定跟随艇与领导艇间的队形,包括相对距离ρ和跟随艇相对于领导艇前进方向的夹角λ,并设置跟随艇的自适应参数初值学习参数初值可调控制参数Γν、kν、kze、kψe、Γu、Γr、δu、δr、ku、kr、控制矩阵Ke、控制向量μj和参数hj
所述的步骤3)中,获取跟随艇在编队中的参考位置(xr,yr)和参考运动姿态ψr的计算式为:
ηr(k)=ηL(k)+R(ψL(k))l
ηr=[xr,yrr]T
l=[ρcosλ,ρsinλ,0]T
其中,ηr(k)为当前时刻跟随艇的参考位置向量,ηL(k)为当前时刻领导艇的参考位置向量,R(ψL(k))为旋转矩阵,l为与队形参数有关的中间向量,ψL(k)为当前时刻领导艇的艏向角。
所述的步骤4)具体包括以下步骤:
41)计算当前时刻k的虚拟艇自适应参数值
42)生成当前时刻的虚拟艇前进速度命令uv(k)、侧向速度命令vv(k)和转首角速度命令rv(k)。
所述的步骤41)中,自适应参数值的迭代公式为:
e(k)=ηr(k)-ηv(k)
ηr=[xr,yrr]T
ηv=[xv,yvv]T
其中,为上一时刻k-1的虚拟艇自适应参数值,T为控制周期,Γν和kν均为可调控制参数,(xv,yv)和ψv分别为虚拟艇的位置坐标和艏向角,e(k)为虚拟艇跟踪误差向量。
所述的步骤42)中,虚拟艇前进速度命令uv(k)、侧向速度命令vv(k)和转首角速度命令rv(k)的计算公式为:
νv(k)=[uv(k),vv(k),rv(k)]T
其中,Ke为可调控制参数矩阵,RTv(k))为旋转矩阵。
所述的步骤5)具体包括以下步骤:
51)计算当前时刻k的虚拟控制量αu(k)和αr(k);
52)在线训练并存储学习参数
所述的步骤51)中,虚拟控制量αu(k)和αr(k)的计算式为:
ψd=[1-sign(xe)]sign(ye)π/2+arctan(ye/xe)
x=x-x
ye=yv-y
ψe=ψd
其中,kze和kψe均为可调控制参数,(x,y)为跟随艇位置坐标,(xe,ye)为跟随艇跟踪位置误差坐标,ψd为跟随艇相对于虚拟艇的方向角,ze为跟随艇跟踪距离误差。
所述的步骤52)中,学习参数的迭代公式为:
ie=i-αi
其中,ie表示跟随艇的速度跟踪误差,Si(·)=[s1(·),…,sl(·)]T为高斯基函数向量,且满足μj和hj分别为接受域的中心向量和高斯函数的宽度,l为隐含层节点个数,Γi和δi均为可调控制参数,αi为虚拟控制量,Φibi均为中间参数。
所述的智能编队控制信号的计算公式为:
其中,ku和kr均为可调控制参数。
与现有技术相比,本发明具有以下优点:
一、本发明不同于在大地坐标系下直接驱动跟随艇跟踪领导艇实现编队,在领导艇船体坐标系下引入虚拟艇自适应规划,可在曲线路径任务下实现欠驱动无人艇编队,同时可避免队形设置时的过顶问题。
二、跟随艇只需获得领导艇的位置坐标和艏向角信息便可实现队形保持;
三、跟随艇只需在线训练2个学习参数便可保证无人艇编队系统的鲁棒性能,简单便捷,实时性强。
附图说明
图1为本发明中虚拟艇自适应规划策略基本原理图。
图2为本发明中欠驱动无人艇编队智能控制逻辑结构示意图。
图3为本发明中欠驱动无人艇编队智能控制方法流程图。
具体实施方式
下面结合附图和具体实施例对本发明进行详细说明。
实施例
如图1-3所示,本发明提供一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,该方法中的计算在无人艇的控制单元中通过软件实现,控制单元可以是工控机或小型的嵌入式系统。以电驱无人艇群为例,该方法的执行过程包括以下5个具体实施步骤。
步骤1:设定队形并初始化参数。根据无人艇群的任务需求设定跟随艇与领导艇间的队形,包括相对距离ρ和跟随艇相对于领导艇前进方向的夹角λ;同时设置虚拟艇自适应参数的初始值学习参数的初始值控制参数Γν、kν、kze、kψe、Γu、Γr、δu、δr、ku、kr、控制矩阵Ke、控制向量μj和参数hj
步骤2:领导艇位置、艏向角信息的采集、滤波和传输。对领导艇的GPS信息(质心位置)和电子罗盘信息(艏向)进行采样,经模拟量输入通道传输信号后滤波,经A/D转换后获得数字量输入信号。对无人艇群采用wifi组网通信技术,将滤波后的数据传输给跟随艇。滤波过程对具体的方法并无限制,可采用最常用的卡尔曼滤波方法或者最小二乘法。
步骤3:跟随艇编队参考位置姿态的实时计算。根据步骤1中的预设队形ρ、λ和步骤2中经滤波、传输得到的领导艇位置、艏向角信息ηL=[xL,yLL]T,跟随艇实时计算其在编队中的参考位置(xr,yr)和参考运动姿态ψr,计算公式为:
ηr(k)=ηL(k)+R(ψL(k))l。
其中,ηr为跟随艇参考位置向量,ηr=[xr,yrr]T,l为与编队队形有关的中间向量,l=[ρcosλ,ρsinλ,0]T,R(ψL(k))为如下旋转矩阵:
步骤4:虚拟艇实时自适应规划。根据虚拟艇的数学模型采用自适应算法实时规划虚拟艇的位置和运动姿态,控制虚拟艇跟踪跟随艇在编队中的参考位置和参考运动姿态。其中,虚拟艇自适应规划算法具体为:
(1)计算并存储当前时刻的虚拟艇自适应参数值其迭代公式为:
其中:为上一时刻的虚拟艇自适应参数值,T为控制周期,Γν和kν均为可调控制参数,e(k)为当前时刻的虚拟艇跟踪误差,e(k)=ηr(k)-ηv(k),ηr(k)为当前时刻跟随艇参考位置向量,ηv(k)为当前时刻虚拟艇位置向量,ηr=[xr,yrr]T,ηv=[xv,yvv]T,(xv,yv)和ψv分别为虚拟艇的位置坐标和艏向角。
(2)生成当前时刻的虚拟艇前进速度命令uv(k)、侧向速度命令vv(k)和转首角速度命令rv(k),其计算公式为:
其中:νv=[uv,vv,rv]T,Ke为可调控制参数矩阵,R(ψv(k))为如下旋转矩阵:
步骤5:跟随艇智能编队控制命令生成。通过RBF神经网络和最小参数学习算法组合策略在线训练学习参数利用学习参数生成智能编队控制信号即跟随艇的主机转速nF和舵角命令信号δF。由监控模块执行编制好的控制算法程序,通过不同占空比的PWM波用以驱动推进器和舵机,给出对应的推力和舵偏角,调节跟随艇航行速度和方向,驱动跟随艇跟踪虚拟艇,最终实现无人艇群的编队控制任务。其中,利用RBF神经网络和最小参数学习算法组合策略生成智能编队控制信号过程具体为:
(1)计算并存储当前时刻的虚拟控制量αu(k)和αr(k),其计算公式为:
其中:ψd=[1-sign(xe)]sign(ye)π/2+arctan(ye/xe),ψd(k)为当前时刻跟随艇相对于虚拟艇的方向角,xe=xv-x,ye=yv-y,(xe,ye)为跟随艇跟踪位置误差坐标,(x,y)为跟随艇的位置坐标,ze为跟随艇跟踪距离误差,ψe=ψd-ψ,ψe为跟随艇艏向角跟踪误差,ψ为跟随艇的艏向角信息,kze和kψe均为可调控制参数。
(2)在线训练并存储学习参数其迭代公式为:
其中:ie(k)表示当前时刻跟随艇的速度跟踪误差,ie=i-αi,αi为虚拟控制量,Φibi均为中间参数。Si(·)=[s1(·),…,sl(·)]T为高斯基函数向量,满足μj和hj分别为接受域的中心向量和高斯函数的宽度,l为隐含层节点个数,Γi和δi均为可调控制参数。
(3)生成智能编队控制信号nF(k)和δF(k),其计算公式为:
其中:ku和kr均为可调控制参数。

Claims (10)

1.一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,其特征在于,包括以下步骤:
1)设定队形并进行参数初始化;
2)采集领导艇的位置坐标(xL,yL)和艏向角ψL,进行滤波后传输给跟随艇;
3)根据队形以及领导艇的位置坐标和艏向角信息实时获取跟随艇在编队中的参考位置(xr,yr)和参考运动姿态ψr
4)引入虚拟艇并进行实时自适应规划获取跟随艇的参考航迹;
5)采用RBF神经网络和最小参数学习算法组合策略对学习参数进行在线训练,生成智能编队控制信号,包括跟随艇的主机转速nF和舵角命令信号δF
2.根据权利要求1所述的一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,其特征在于,所述的步骤1)具体包括以下步骤:
设定跟随艇与领导艇间的队形,包括相对距离ρ和跟随艇相对于领导艇前进方向的夹角λ,并设置跟随艇的自适应参数初值学习参数初值可调控制参数Γν、kν、kze、kψe、Γu、Γr、δu、δr、ku、kr、控制矩阵Ke、控制向量μj和参数hj
3.根据权利要求1所述的一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,其特征在于,所述的步骤3)中,获取跟随艇在编队中的参考位置(xr,yr)和参考运动姿态ψr的计算式为:
ηr(k)=ηL(k)+R(ψL(k))l
ηr=[xr,yrr]T
l=[ρcosλ,ρsinλ,0]T
<mrow> <mi>R</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>L</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>L</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>L</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>L</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>L</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,ηr(k)为当前时刻跟随艇的参考位置向量,ηL(k)为当前时刻领导艇的参考位置向量,R(ψL(k))为旋转矩阵,l为与队形参数有关的中间向量,ψL(k)为当前时刻领导艇的艏向角。
4.根据权利要求1所述的一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,其特征在于,所述的步骤4)具体包括以下步骤:
41)计算当前时刻k的虚拟艇自适应参数值
42)生成当前时刻的虚拟艇前进速度命令uv(k)、侧向速度命令vv(k)和转首角速度命令rv(k)。
5.根据权利要求4所述的一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,其特征在于,所述的步骤41)中,自适应参数值的迭代公式为:
<mrow> <msub> <mover> <mi>v</mi> <mo>^</mo> </mover> <mi>M</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mover> <mi>v</mi> <mo>^</mo> </mover> <mi>M</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>T&amp;Gamma;</mi> <mi>v</mi> </msub> <mo>{</mo> <msup> <mi>e</mi> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mi>tanh</mi> <mrow> <mo>(</mo> <mi>e</mi> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>k</mi> <mi>v</mi> </msub> <mo>&amp;lsqb;</mo> <msub> <mover> <mi>v</mi> <mo>^</mo> </mover> <mi>M</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>v</mi> <mo>^</mo> </mover> <mi>M</mi> </msub> <mrow> <mo>(</mo> <mn>0</mn> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> <mo>}</mo> </mrow>
e(k)=ηr(k)-ηv(k)
ηr=[xr,yrr]T
ηv=[xv,yvv]T
其中,为上一时刻k-1的虚拟艇自适应参数值,T为控制周期,Γν和kν均为可调控制参数,(xv,yv)和ψv分别为虚拟艇的位置坐标和艏向角,e(k)为虚拟艇跟踪误差向量。
6.根据权利要求5所述的一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,其特征在于,所述的步骤42)中,虚拟艇前进速度命令uv(k)、侧向速度命令vv(k)和转首角速度命令rv(k)的计算公式为:
<mrow> <msub> <mi>v</mi> <mi>k</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mi>R</mi> <mi>T</mi> </msup> <mrow> <mo>(</mo> <mi>&amp;psi;</mi> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>K</mi> <mi>e</mi> </msub> <mi>e</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mover> <mi>v</mi> <mo>^</mo> </mover> <mi>M</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mi>tanh</mi> <mrow> <mo>(</mo> <mi>e</mi> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> </mrow>
νv(k)=[uv(k),vv(k),rv(k)]T
<mrow> <mi>R</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>v</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>v</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>v</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>v</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mrow> <mi>cos</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>v</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> </mrow>
其中,Ke为可调控制参数矩阵,RTv(k))为旋转矩阵。
7.根据权利要求6所述的一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,其特征在于,所述的步骤5)具体包括以下步骤:
51)计算当前时刻k的虚拟控制量αu(k)和αr(k);
52)在线训练并存储学习参数
8.根据权利要求7所述的一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,其特征在于,所述的步骤51)中,虚拟控制量αu(k)和αr(k)的计算式为:
<mrow> <msub> <mi>&amp;alpha;</mi> <mi>u</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>cos&amp;psi;</mi> <mi>e</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>d</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mfrac> <mrow> <msub> <mi>x</mi> <mi>v</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>x</mi> <mi>v</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> <mi>T</mi> </mfrac> <mo>+</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>d</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mfrac> <mrow> <msub> <mi>y</mi> <mi>v</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>y</mi> <mi>v</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> <mi>T</mi> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mi>v</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mi>sin</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;psi;</mi> <mi>e</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>k</mi> <mrow> <mi>z</mi> <mi>e</mi> </mrow> </msub> <msub> <mi>z</mi> <mi>e</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>
<mrow> <msub> <mi>&amp;alpha;</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>k</mi> <mrow> <mi>&amp;psi;</mi> <mi>e</mi> </mrow> </msub> <msub> <mi>&amp;psi;</mi> <mi>e</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mrow> <msub> <mi>&amp;psi;</mi> <mi>d</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>&amp;psi;</mi> <mi>d</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> <mi>T</mi> </mfrac> </mrow>
ψd=[1-sign(xe)]sign(ye)π/2+arctan(ye/xe)
xe=xv-x
ye=yv-y
ψe=ψd
<mrow> <msub> <mi>z</mi> <mi>e</mi> </msub> <mo>=</mo> <msqrt> <mrow> <msubsup> <mi>x</mi> <mi>e</mi> <mn>2</mn> </msubsup> <mo>+</mo> <msubsup> <mi>y</mi> <mi>e</mi> <mn>2</mn> </msubsup> </mrow> </msqrt> </mrow>
其中,kze和kψe均为可调控制参数,(x,y)为跟随艇位置坐标,(xe,ye)为跟随艇跟踪位置误差坐标,ψd为跟随艇相对于虚拟艇的方向角,ze为跟随艇跟踪距离误差。
9.根据权利要求8所述的一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,其特征在于,所述的步骤52)中,学习参数的迭代公式为:
<mrow> <msub> <mover> <mi>&amp;lambda;</mi> <mo>^</mo> </mover> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mover> <mi>&amp;lambda;</mi> <mo>^</mo> </mover> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>T&amp;Gamma;</mi> <mi>i</mi> </msub> <mo>{</mo> <msub> <mi>&amp;Phi;</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <msubsup> <mi>i</mi> <mi>e</mi> <mn>2</mn> </msubsup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>&amp;delta;</mi> <mi>i</mi> </msub> <mo>&amp;lsqb;</mo> <msub> <mover> <mi>&amp;lambda;</mi> <mo>^</mo> </mover> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&amp;lambda;</mi> <mo>^</mo> </mover> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mn>0</mn> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> <mo>}</mo> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mi>u</mi> <mo>,</mo> <mi>r</mi> </mrow>
ie=i-αi
其中,ie表示跟随艇的速度跟踪误差,Si(·)=[s1(·),…,sl(·)]T为高斯基函数向量,且满足j=1,…,l,μj和hj分别为接受域的中心向量和高斯函数的宽度,l为隐含层节点个数,Γi和δi均为可调控制参数,αi为虚拟控制量,Φibi均为中间参数。
10.根据权利要求9所述的一种基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法,其特征在于,所述的智能编队控制信号的计算公式为:
<mrow> <msub> <mi>n</mi> <mi>F</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>N</mi> <mi>F</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> <msqrt> <mrow> <mo>|</mo> <msub> <mi>N</mi> <mi>F</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>|</mo> </mrow> </msqrt> </mrow>
<mrow> <msub> <mi>N</mi> <mi>F</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <msub> <mi>k</mi> <mi>u</mi> </msub> <msub> <mi>u</mi> <mi>e</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mrow> <msub> <mi>&amp;alpha;</mi> <mi>u</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>&amp;alpha;</mi> <mi>u</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> <mi>T</mi> </mfrac> <mo>-</mo> <msub> <mover> <mi>&amp;lambda;</mi> <mo>^</mo> </mover> <mi>u</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <msub> <mi>&amp;Phi;</mi> <mi>u</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <msub> <mi>u</mi> <mi>e</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>&amp;delta;</mi> <mi>F</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <msub> <mi>k</mi> <mi>r</mi> </msub> <msub> <mi>r</mi> <mi>e</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mrow> <msub> <mi>&amp;alpha;</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>&amp;alpha;</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow> <mi>T</mi> </mfrac> <mo>-</mo> <msub> <mover> <mi>&amp;lambda;</mi> <mo>^</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <msub> <mi>&amp;Phi;</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <msub> <mi>r</mi> <mi>e</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow>
其中,ku和kr均为可调控制参数。
CN201810063947.5A 2018-01-23 2018-01-23 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法 Active CN108073175B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810063947.5A CN108073175B (zh) 2018-01-23 2018-01-23 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810063947.5A CN108073175B (zh) 2018-01-23 2018-01-23 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法

Publications (2)

Publication Number Publication Date
CN108073175A true CN108073175A (zh) 2018-05-25
CN108073175B CN108073175B (zh) 2020-11-06

Family

ID=62156794

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810063947.5A Active CN108073175B (zh) 2018-01-23 2018-01-23 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法

Country Status (1)

Country Link
CN (1) CN108073175B (zh)

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108333925A (zh) * 2018-01-18 2018-07-27 上海交通大学 考虑输入和终端约束的船舶推力分配自适应优化方法
CN108829113A (zh) * 2018-09-01 2018-11-16 哈尔滨工程大学 一种多机器人编队自适应零空间行为融合方法
CN108983612A (zh) * 2018-08-08 2018-12-11 华南理工大学 一种具有预设性能和连接保持的水下机器人编队控制方法
CN109032128A (zh) * 2018-06-13 2018-12-18 江南大学 离散多agv非质点系统的三角编队控制方法
CN109407671A (zh) * 2018-12-11 2019-03-01 大连海事大学 一种欠驱动无人船目标包围控制器结构及设计方法
CN109765892A (zh) * 2019-01-16 2019-05-17 大连海事大学 一种无人船集群的碰撞自规避编队控制器结构及设计方法
CN110333723A (zh) * 2019-07-17 2019-10-15 广东华中科技大学工业技术研究院 一种基于双通信设备的无人艇协同编队方法
CN110879599A (zh) * 2019-12-12 2020-03-13 大连海事大学 一种基于有限时间扰动观测器的固定时间编队控制方法
CN111694365A (zh) * 2020-07-01 2020-09-22 武汉理工大学 一种基于深度强化学习的无人船艇编队路径跟踪方法
CN112650231A (zh) * 2020-12-15 2021-04-13 哈尔滨工程大学 一种实现避碰和避障的欠驱船编队控制系统
CN113093804A (zh) * 2021-04-06 2021-07-09 上海海事大学 基于反演滑模控制的无人艇编队控制方法和控制系统
CN113220021A (zh) * 2021-05-06 2021-08-06 西北工业大学 基于虚拟领导者的飞行编队协同自适应跟踪控制方法
CN113359737A (zh) * 2021-06-17 2021-09-07 大连海事大学 一种考虑队形伸缩的船舶编队自适应事件触发控制方法
CN115616907A (zh) * 2022-09-22 2023-01-17 上海海事大学 一种无人艇航向智能规划方法及控制器

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103674029A (zh) * 2013-12-19 2014-03-26 哈尔滨工程大学 一种基于水声通信的多艇协同导航编队构型的方法
CN103955218A (zh) * 2014-04-28 2014-07-30 上海大学 一种基于非线性控制理论的无人艇轨迹跟踪控制装置及方法
CN105182734A (zh) * 2015-09-17 2015-12-23 哈尔滨工程大学 基于虚拟领航者与导引策略的气垫船编队控制装置及方法
CN105676844A (zh) * 2016-01-19 2016-06-15 武汉理工大学 基于模型船的欠驱动无人船编队结构
US20160209849A1 (en) * 2015-01-15 2016-07-21 William Dale Arbogast System and method for decentralized, multi-agent unmanned vehicle navigation and formation control
CN107168312A (zh) * 2017-05-17 2017-09-15 哈尔滨工程大学 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法
CN107255923A (zh) * 2017-06-14 2017-10-17 哈尔滨工程大学 基于rbf辨识的ica‑cmac神经网络的欠驱动无人艇航迹跟踪控制方法
EP3287862A1 (en) * 2016-08-25 2018-02-28 Imotec Holding B.V. Method for steering an underactuated ship

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103674029A (zh) * 2013-12-19 2014-03-26 哈尔滨工程大学 一种基于水声通信的多艇协同导航编队构型的方法
CN103955218A (zh) * 2014-04-28 2014-07-30 上海大学 一种基于非线性控制理论的无人艇轨迹跟踪控制装置及方法
US20160209849A1 (en) * 2015-01-15 2016-07-21 William Dale Arbogast System and method for decentralized, multi-agent unmanned vehicle navigation and formation control
CN105182734A (zh) * 2015-09-17 2015-12-23 哈尔滨工程大学 基于虚拟领航者与导引策略的气垫船编队控制装置及方法
CN105676844A (zh) * 2016-01-19 2016-06-15 武汉理工大学 基于模型船的欠驱动无人船编队结构
EP3287862A1 (en) * 2016-08-25 2018-02-28 Imotec Holding B.V. Method for steering an underactuated ship
CN107168312A (zh) * 2017-05-17 2017-09-15 哈尔滨工程大学 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法
CN107255923A (zh) * 2017-06-14 2017-10-17 哈尔滨工程大学 基于rbf辨识的ica‑cmac神经网络的欠驱动无人艇航迹跟踪控制方法

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
BONG SEOK PARK 等: "《Neural network-based output feedback control for reference tracking of underactuated surface vessels》", 《AUTOMATICA》 *
刘杨 等: "《基于神经网络稳定自适应的欠驱动水面船舶编队控制方法》", 《交通运输工程学报》 *
杨震 等: "《一种欠驱动船舶编队滑模鲁棒控制方法》", 《电机与控制学报》 *
邓华 等: "《船舶航向非线性系统自适应神经网络控制》", 《广州航海学院学报》 *

Cited By (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108333925A (zh) * 2018-01-18 2018-07-27 上海交通大学 考虑输入和终端约束的船舶推力分配自适应优化方法
CN109032128A (zh) * 2018-06-13 2018-12-18 江南大学 离散多agv非质点系统的三角编队控制方法
CN109032128B (zh) * 2018-06-13 2020-04-10 江南大学 离散多agv非质点系统的三角编队控制方法
CN108983612A (zh) * 2018-08-08 2018-12-11 华南理工大学 一种具有预设性能和连接保持的水下机器人编队控制方法
CN108829113B (zh) * 2018-09-01 2021-05-28 哈尔滨工程大学 一种多机器人编队自适应零空间行为融合方法
CN108829113A (zh) * 2018-09-01 2018-11-16 哈尔滨工程大学 一种多机器人编队自适应零空间行为融合方法
CN109407671A (zh) * 2018-12-11 2019-03-01 大连海事大学 一种欠驱动无人船目标包围控制器结构及设计方法
CN109407671B (zh) * 2018-12-11 2021-06-29 大连海事大学 一种欠驱动无人船目标包围控制器结构及设计方法
CN109765892A (zh) * 2019-01-16 2019-05-17 大连海事大学 一种无人船集群的碰撞自规避编队控制器结构及设计方法
CN109765892B (zh) * 2019-01-16 2021-08-10 大连海事大学 一种无人船集群的碰撞自规避编队控制器结构及设计方法
CN110333723A (zh) * 2019-07-17 2019-10-15 广东华中科技大学工业技术研究院 一种基于双通信设备的无人艇协同编队方法
CN110333723B (zh) * 2019-07-17 2022-03-22 广东华中科技大学工业技术研究院 一种基于双通信设备的无人艇协同编队方法
CN110879599A (zh) * 2019-12-12 2020-03-13 大连海事大学 一种基于有限时间扰动观测器的固定时间编队控制方法
CN111694365A (zh) * 2020-07-01 2020-09-22 武汉理工大学 一种基于深度强化学习的无人船艇编队路径跟踪方法
CN111694365B (zh) * 2020-07-01 2021-04-20 武汉理工大学 一种基于深度强化学习的无人船艇编队路径跟踪方法
US11914376B2 (en) 2020-07-01 2024-02-27 Wuhan University Of Technology USV formation path-following method based on deep reinforcement learning
CN112650231A (zh) * 2020-12-15 2021-04-13 哈尔滨工程大学 一种实现避碰和避障的欠驱船编队控制系统
CN112650231B (zh) * 2020-12-15 2022-07-15 哈尔滨工程大学 一种实现避碰和避障的欠驱船编队控制系统
CN113093804A (zh) * 2021-04-06 2021-07-09 上海海事大学 基于反演滑模控制的无人艇编队控制方法和控制系统
CN113093804B (zh) * 2021-04-06 2022-07-12 上海海事大学 基于反演滑模控制的无人艇编队控制方法和控制系统
CN113220021B (zh) * 2021-05-06 2022-08-09 西北工业大学 基于虚拟领导者的飞行编队协同自适应跟踪控制方法
CN113220021A (zh) * 2021-05-06 2021-08-06 西北工业大学 基于虚拟领导者的飞行编队协同自适应跟踪控制方法
CN113359737A (zh) * 2021-06-17 2021-09-07 大连海事大学 一种考虑队形伸缩的船舶编队自适应事件触发控制方法
CN115616907A (zh) * 2022-09-22 2023-01-17 上海海事大学 一种无人艇航向智能规划方法及控制器

Also Published As

Publication number Publication date
CN108073175B (zh) 2020-11-06

Similar Documents

Publication Publication Date Title
CN108073175A (zh) 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法
Moreira et al. Path following control system for a tanker ship model
CN104850122B (zh) 基于可变船长比的抵抗侧风无人水面艇直线路径跟踪方法
CN108445892A (zh) 一种欠驱动无人船编队控制器结构及设计方法
CN108319138A (zh) 一种欠驱动无人艇的滑模-反步双回路轨迹跟踪控制方法
CN107168335A (zh) 一种考虑混合多目标避障的水面无人艇路径跟踪制导方法
CN103345259B (zh) 动力定位船舶实现定位旋转的几何坐标变换导引控制方法
CN111679585B (zh) 一种具有输入饱和受限的无人船强化学习自适应跟踪控制方法
CN111506079B (zh) 一种考虑障碍物避让的无人船虚拟结构编队控制方法
Chen et al. Distributed model predictive control for cooperative floating object transport with multi-vessel systems
Shi et al. Study on intelligent collision avoidance and recovery path planning system for the waterjet-propelled unmanned surface vehicle
Fang et al. Application of neuro-fuzzy algorithm to portable dynamic positioning control system for ships
Du et al. Cooperative multi-agent control for autonomous ship towing under environmental disturbances
CN104950882A (zh) 全局一致渐进路径跟踪引导控制方法
Xue et al. Proximal policy optimization with reciprocal velocity obstacle based collision avoidance path planning for multi-unmanned surface vehicles
Wang et al. Path following control of the wave glider in waves and currents
Yan et al. Reinforcement learning-based autonomous navigation and obstacle avoidance for USVs under partially observable conditions
CN110244556A (zh) 基于期望航向修正的欠驱动船舶航向控制方法
CN110333723B (zh) 一种基于双通信设备的无人艇协同编队方法
CN113093804B (zh) 基于反演滑模控制的无人艇编队控制方法和控制系统
CN109916400B (zh) 一种基于梯度下降算法与vo法相结合的无人艇避障方法
Wang et al. Autonomous piloting and berthing based on Long Short Time Memory neural networks and nonlinear model predictive control algorithm
Li et al. Sim-real joint experimental verification for an unmanned surface vehicle formation strategy based on multi-agent deterministic policy gradient and line of sight guidance
Kim et al. Any-angle path planning with limit-cycle circle set for marine surface vehicle
CN116820101A (zh) 一种距离信息缺失下的欠驱动无人艇编队控制方法

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