CN110580057A - 一种基于圆周分层规划的uuv集群编队队形形成方法 - Google Patents

一种基于圆周分层规划的uuv集群编队队形形成方法 Download PDF

Info

Publication number
CN110580057A
CN110580057A CN201910917112.6A CN201910917112A CN110580057A CN 110580057 A CN110580057 A CN 110580057A CN 201910917112 A CN201910917112 A CN 201910917112A CN 110580057 A CN110580057 A CN 110580057A
Authority
CN
China
Prior art keywords
uuv
slave
point
formation
master
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
CN201910917112.6A
Other languages
English (en)
Other versions
CN110580057B (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.)
Harbin Engineering University
Original Assignee
Harbin Engineering 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 Harbin Engineering University filed Critical Harbin Engineering University
Priority to CN201910917112.6A priority Critical patent/CN110580057B/zh
Publication of CN110580057A publication Critical patent/CN110580057A/zh
Application granted granted Critical
Publication of CN110580057B publication Critical patent/CN110580057B/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, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10Simultaneous control of position or course in three dimensions

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)
  • Navigation (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于圆周分层规划的UUV集群编队队形形成方法,包括初始化设置UUV主从身份指令,设置队形形成参数,期望队形指令;队形形成后,UUV保持定点、定艏向,并确定主从身份;UUV集群进行位置和艏向信息交互;主UUV对从UUV进行分散机动规划,并发送分散机动目标点;从UUV分散机动,机动完成后告知主UUV;主UUV对从UUV先后进行径向和周向机动规划,并先后发送径向机动和周向机动目标点;从UUV先后进行径向机动和周向机动,机动完成后告知主UUV;主UUV向从UUV发送队形形成成功指令,UUV集群编队队形形成。本发明可使UUV集群从初始随机分布、杂乱无序的形态,快速、安全的形成期望队形。

Description

一种基于圆周分层规划的UUV集群编队队形形成方法
技术领域
本发明涉及一种基于圆周分层规划形成UUV(水下无人航行器,UnmannedUnderwater Vehicle)集群编队期望队形的方法,属于UUV编队控制领域。
背景技术
UUV在民用海洋领域和军事海洋领域方面发挥着越来越重要的作用。但是单UUV的个体能力有限,无法完成复杂的作业任务。而UUV集群由于具有功能冗余、空间分布的特点,可以通过相互之间的协作,增强作业能力、提高作业效率,完成复杂的作业任务。通常UUV集群会采用保持某种期望队形的编队形式进行作业,因此编队控制技术是UUV集群的关键技术之一。而UUV集群编队控制首先要解决的问题就是队形形成问题。UUV集群编队队形形成是指UUV集群从初始随机分布、杂乱无序的几何形态,经信息交互、自主规划、协调机动后,形成某一期望几何队形的过程。
在队形形成的研究中,常用的方法是人工势场法,人工势场法是建造势场函数,然后通过研究反馈控制律来完成队形的形成。此外还有其他的一些方法,比如允许UUV自主切换控制律实现期望的队形,还可以在图形理论框架上进行研究,完成期望队形。但是以上的各种方法在应用的过程中都要求每个UUV之间能进行实时通信,存在大量的信息的传输,并且随着UUV数量的增加,控制策略将会变得更加复杂。对此,找到一种简单易实现的方法使UUV集群能够自主形成期望队形就显得尤为重要。
申请号为201811229466.3的专利文件中公开了“一种用于无人设备集群控制的多体队形重构方法”,主要解决leader-follower模式的控制算法中无人设备集群受到干扰工况的多体队形重构方法。首先该专利采用的是实时计算飞行并调整集群飞行队形的方法,与本发明的利用先规划后机动的队形形成方法不同。其次该专利重点提出了一种建立与所述当前队形关联的概率密度函数,通过调整集群中被控物体的位置,减小交叉熵的队形重构方法,与本发明重点解决通过分阶段规划机动目标位置点进行队形形成的方法不同。
申请号为201810390428.X的专利文件中公开了“无人机对性控制方法”,主要解决编队成员不需已知某些全局信息生成任意队形的无人机编队队形分布式控制方法。首先该专利是利用编队内各无人机生成各自的目标编队位置形成目标基准队形的方法,与本发明利用主UUV获取所有UUV信息,进行机动位置点统一规划的队形形成方法不同。其次该专利重点提出了一种虚拟分配操作下生成编队内各成员的目标编队位置并朝它飞行,使无人机集群形成目标基准队形的方法,与本发明重点解决通过分阶段规划机动目标位置点进行队形形成的方法不同。
发明内容
针对上述现有技术,本发明要解决的技术问题是提供一种基于圆周分层规划的UUV集群编队队形形成方法。
为解决上述技术问题,本发明的一种基于圆周分层规划的UUV集群编队队形形成方法,包括以下步骤:
步骤一:初始化,设置UUV主从身份指令,设置队形形成参数,期望队形指令;
设置的队形形成参数为lUUV、Nnum_UUV_F和Nreal_s,其中,lUUV为UUV的艇长,Nnum_UUV_F为从UUV的个数,Nreal_s为取值(Nnum_UUV_F,Nr)内的任意整数,为最多扇形区域个数,Rmin为所有从UUV所在位置点相对距离的最小值,表示向下取整运算。
设置的期望队形指令为其中rAim(m)表示每个从期望点的相对距离,θAim(m)表示每个从期望点的相对方位,m为各从期望点的代号,m=1,2,···,Nnum_UUV_F
步骤二:队形形成开始,所有UUV保持定点、定艏向,并确定自己的主从身份;
步骤三:UUV集群进行信息交互。所有从UUV向主UUV发送自身当前位置信息i表示各从UUV代号,i=1,2,···,Nnum_UUV_F。主UUV向所有从UUV发送自身当前位置信息和艏向信息θH_L
步骤四:主UUV判断是否接收到所有从UUV位置信息。若主UUV判断在120秒内收到所有从UUV当前位置信息,转步骤五,否则认为队形形成失败,转步骤十八;
步骤五:主UUV对从UUV进行分散机动规划。主UUV根据每个从UUV的当前位置,利用粒子群优化算法进行分散机动规划,将每个从UUV分配到不同的扇形区域内,规划的结果是得到每个从UUV分散机动的目标点坐标
步骤六:主UUV将规划好的每个从UUV的分散机动目标点位置信息发送给所有从UUV;
步骤七:从UUV分散机动。所有从UUV沿着自身当前位置点所在的圆周机动到分散机动目标点,每个从UUV分散机动完成后告知主UUV;
步骤八:主UUV判断是否所有从UUV完成分散机动。若主UUV判断在秒内所有从UUV完成分散机动,转步骤九,否则认为队形形成失败,转步骤十八;
其中,Rmax为所有从UUV所在位置点及所有从期望点的相对距离的最大值,表示向上取整运算。
步骤九:主UUV对从UUV进行径向机动规划。主UUV根据所有从UUV当前位置和所有从期望点的位置,将从UUV分配到所有从期望点所在的圆周上,圆周上有几个从期望点就分配几个从UUV,规划的结果是得到每个从UUV的径向机动目标点
步骤十:主UUV将规划好的每个从UUV的径向机动目标点位置信息发送给所有从UUV;
步骤十一:从UUV径向机动。所有从UUV沿着自身当前位置点的径向方向机动到各自的径向机动目标点位置,每个从UUV径向机动完成后告知主UUV;
步骤十二:主UUV判断是否所有从UUV完成径向机动。若主UUV判断在秒内所有从UUV完成径向机动,转步骤十三,否则认为队形形成失败,转步骤十八;
步骤十三:主UUV对从UUV进行周向机动规划。主UUV根据所有从UUV当前位置和所有从期望点的位置,为每一个从UUV分配一个从期望点,规划结果是得到每个从UUV的周向机动目标点
步骤十四:主UUV将规划好的每个从UUV的周向机动目标点位置信息发送给所有从UUV;
步骤十五:从UUV周向机动。所有从UUV从当前位置向各自的周向机动目标点位置进行机动,每个从UUV周向机动完成后告知主UUV;
步骤十六:主UUV判断是否所有从UUV完成周向机动。若主UUV判断在内所有从UUV完成周向机动,转步骤十七,否则认为队形形成失败,转步骤十八;
步骤十七:主UUV向所有从UUV发送队形形成成功指令,所有UUV保持定点、定艏向,转步骤十九;
步骤十八:主UUV向所有从UUV发送队形形成失败指令,所有UUV停车;
步骤十九:UUV集群编队队形形成结束。
本发明一种基于圆周分层规划的UUV集群编队队形形成方法,还可以包括:
1.所述的步骤五中,主UUV对从UUV进行分散机动规划具体包括:
步骤五(A):求解各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i);
步骤五(B):求解各从UUV分散机动的目标点所在的扇形区域sectorPlan(i),并计算各从UUV分散机动目标点的相对位置
步骤五(C):求解各从UUV分散机动的目标点的位置
2.所述的步骤九中,主UUV对从UUV进行径向机动规划具体包括:
步骤九(A):求解各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i),求解方法与步骤五(A)相同;
步骤九(B):求解各从期望点所在的扇形区域sectorAim(m)和环形区域ringAim(m);
步骤九(C):按照编号规则,分别对每个从UUV的当前位置点进行编号idf(i)和从期望点进行编号idAim(m);
步骤九(D):为各从UUV分配径向机动目标从期望点。
步骤九(E):求解各从UUV径向机动目标点的位置
3.所述的步骤十三中,主UUV对从UUV进行周向机动规划具体包括:
步骤十三(A):求解各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i),求解方法与步骤五(A)相同;
步骤十三(B):为所有从UUV根据编号规则进行编号,编号方法同步骤九(C)中对每个从UUV的当前位置点的编号方法;
步骤十三(C):为各从UUV分配从期望点,分配方法同步骤九(D);
步骤十三(D):求解各从UUV周向机动目标点的位置
4.所述的步骤五(B)中,求解各从UUV分散机动的目标点所在的扇形区域sectorPlan(i),并计算各从UUV分散机动目标点的相对位置
根据粒子群优化算法,求解出机动距离最短的情况下,各从UUV分散机动的目标点所在的扇形区域sectorPlan(i),并计算得到各从UUV分散机动目标点的相对位置rd(i)为分散机动目标点的相对距离,θd(i)为分散机动目标点的相对方位,利用的公式如下:
rd(i)=rf(i)
分散机动规划得到的结果满足以下条件:
(1)若ring(i)=ring(j),i≠j,i=1,2,···,Nnum_UUV_F,j=1,2,···,Nnum_UUV_F则有以下式子成立:(θf(i)-θf(j))(θd(i)-θd(j))>0;
(2)rf(i)=rd(i);
(3)sectorPlan(i)≠sectorPlan(j),i≠j。
5.所述的步骤九(B)中,求解各从期望点所在的扇形区域sectorAim(m)和环形区域ringAim(m):
根据初始化的期望队形指令计算各从期望点所在的扇形区域sectorAim(m)和环形区域ringAim(m),利用的公式如下:
6.所述的步骤九(C)中,对每个从UUV的当前位置点进行编号idf(i)和从期望点进行编号idAim(m),编号规则如下:
(1)各点编号总体按照环形区域从内到外的顺序;
(2)若同一环形区域存在多个点,按照各点的相对方位从小到大进行编号;
(3)对各点的编号从1开始直到将所有需要编号的点都编上序号为止。
7.所述的步骤九(D)中,为各从UUV分配径向机动目标从期望点。分配方法为:若idf(i)=idAim(m),则i号UUV分配了m号从期望点。
8.所述的步骤九(E)中,求解各从UUV径向机动目标点的位置每个从UUV根据分配的径向机动目标从期望点,计算得到各自的径向机动目标点的相对位置再计算得到Cr_pos_E(i)。Cr_pole_L(i)及Cr_pos_E(i)求解利用的公式如下:
rr(i)=rAim(m)
θr(i)=θf(i)
其中,rr(i)为各从UUV径向机动目标点的相对距离,θr(i)为各从UUV径向机动目标点的相对方位。
9.所述的步骤十三(D)中,求解各从UUV周向机动目标点的位置每个从UUV根据分配的从期望点,计算得到各自的周向机动目标点的相对位置再计算得到Cc_pos_E(i)。Cc_pole_L(i)及Cc_pos_E(i)求解利用的公式如下:
rc(i)=rf(i)
θc(i)=θAim(m)
其中rc(i)为各从UUV周向机动目标点的相对距离,θc(i)为各从UUV周向机动目标点的相对方位。
本发明的有益效果:
1、本发明将UUV集群编队队形形成所在空间划分为环形区域和扇形区域,可以有效的避免编队队形形成过程中UUV之间的碰撞。
2、本发明将UUV集群编队队形形成过程依次分为分散机动、径向机动和周向机动三个阶段,可以实现UUV集群编队队形形成过程中的有序机动协调,可有效的避免UUV集群的机动混乱,同时也可有效的避免UUV之间的碰撞。
3、本发明中,UUV集群之间的信息交互量少,计算简单,规划速度快,协调机动逻辑分明,易于工程实现。
附图说明
图1为UUV集群编队队形形成示意图;
图2为UUV集群编队期望队形示意图;
图3为UUV集群编队队形形成所在空间划分示意图;
图4为基于圆周分层规划的UUV集群编队队形形成方法流程图;
图5为UUV集群编队分散机动原理示意图;
图6为UUV集群编队径向机动原理示意图;
图7为UUV集群编队周向机动原理示意图。
具体实施方式
下面结合附图,进一步说明本发明的具体实施方式。
结合图1,介绍UUV集群编队队形形成的过程。
如图1所示,以包含5个成员的UUV集群进行介绍。初始状态,集群UUV的几何形态是随机分布且杂乱无序的,每个UUV处于待机状态,等待编队队形形成开始指令。期望形成的几何队形为图中所示的矩形队形。当队形形成开始后,所有的UUV根据自己事先被赋予的身份信息,确定自己是主UUV还是从UUV,如图中0号UUV为主UUV,其余为从UUV。主UUV保持定位、定艏向,UUV集群之间经过信息交互、自主规划、协调机动后,在保证不发生相互碰撞的前提下形成期望的矩形队形。队形形成过程中,从UUV进行机动,主UUV始终保持定点、定艏向
结合图2,介绍UUV集群编队的期望队形。
如图2所示,以期望的几何队形为矩形、以包含5个成员的UUV集群为例进行介绍。期望点0、1、2、3、4组成期望的矩形队形。在UUV集群形成矩形队形后,每个UUV位于一个期望点上,其中主UUV位于期望点0上,期望点0称为主期望点。其他4个从UUV分布于期望点1、2、3、4上,称这4个期望点为从期望点。为了更清楚的介绍本发明的具体实施方式有如下定义:
(1)定义任意位置点所在的圆周,是以主期望点为圆心,以主期望点到该位置点的距离为半径形成的圆。如图2,矩形期望队形中,从期望点1、从期望点2、从期望点3和从期望点4所在的圆周重合,如图所示的圆周U。图2中,位置点W所在的圆周,如图所示的圆周W。
(2)定义UUV集群所在空间区域任意位置点的相对距离r,为该位置点与主期望点连线的线段的长度,计算方法为:
(3)定义UUV集群所在空间区域任意位置点的相对方位θ,为该点与主期望点的连线逆时针转至主UUV的艏向所转过的角度,计算方法为:
则有
其中,θH_L为主UUV的艏向,AE_B为计算得到的相对方位值,取值范围为(-π,π],所以需要通过公式(3)将AE_B变换为取值范围为[0,2π)的相对方位。
在图2中,根据公式(1)、(2)和(3)可求从期望点3的相对距离rAim(3)以及相对方位θAim(3):
θAim(3)=atan2(-(xAim(3)-xL)sinθH_L+(yAim(3)-yL)cosθH_L,
(xAim(3)-xL)cosθH_L+(yAim(3)-yL)sinθH_L)
其他从期望点可同理计算。
(4)若已知某位置点的相对距离为r,相对方位为θ,则可解算得到该点的坐标为:
在图2中,若已知从期望点1的相对距离为rAim(1)、相对方位为θAim(1),则从期望点1的坐标为:
其他从期望点可同理计算。
结合图3,介绍UUV集群编队队形形成的所在空间划分。
为了更好的利用粒子群优化算法进行UUV集群队形形成规划,将UUV集群所在空间区域划分为多个环形区域和多个扇形区域,具体的划分过程为:
(1)环形区域划分。如图3所示,UUV集群所在空间区域中以主期望点为圆心,存在多个圆周,每个圆周的半径为R(k),相邻两个圆周之间形成的区域为环形区域,由此多个圆周将平面分成多个环形区域,并且环形区域总个数为Nl,并且有:
R(k)=k·Rd,k=1,...Nl
Rd=2lUUV
其中,Rd为划分环形区域的圆周半径分度值,lUUV为UUV的艇长,Rmax为所有从UUV所在位置点及所有从期望点的相对距离的最大值,表示向上取整运算。
将所有环形区域以主期望点为基准,沿径向方向进行编号。如图3中共划分了3个环形区域,每个环形区域的编号如图中所示。
(2)扇形区域划分。如图3所示,划分扇形区域是以主期望点为圆心,将圆周均等分为多个扇形区域,等分角度θreal_s,且有
其中,Nreal_s可取值为(Nnum_UUV_F,Nr)内的任意整数,Nnum_UUV_F为从UUV的个数,Nr最多扇形区域个数,Rmin为所有从UUV所在位置点相对距离的最小值,表示向下取整运算。
将所有扇形区域以主UUV艏向方向为基准,顺时针进行编号。如图3中共划分了12个扇形区域,每个扇形区域的编号如图中所示。
结合图4、图5、图6、图7,介绍基于圆周分层规划的UUV集群编队队形形成方法的流程。
步骤一:初始化,设置UUV主从身份指令,设置队形形成参数lUUV、Nnum_UUV_F和Nreal_s,设置期望队形指令其中,rAim(m)表示每个从期望点的相对距离,θAim(m)表示每个从期望点的相对方位,m为各从期望点的代号,m=1,2,···,Nnum_UUV_F
步骤二:队形形成开始,所有UUV保持定点、定艏向,并确定自己的主从身份。
步骤三:UUV集群进行信息交互。所有从UUV向主UUV发送自身当前位置信息i表示各从UUV代号,i=1,2,···,Nnum_UUV_F。主UUV向所有从UUV发送自身当前位置信息PL和艏向信息θH_L
步骤四:主UUV判断是否接收到所有从UUV位置信息。若主UUV判断在120秒内收到所有从UUV当前位置信息,转步骤五,否则认为队形形成失败,转步骤十八。
步骤五:主UUV对从UUV进行分散机动规划。主UUV根据每个从UUV的当前位置,利用粒子群优化算法进行分散机动规划,将每个从UUV分配到不同的扇形区域内,规划的结果是得到每个从UUV分散机动的目标点坐标具体过程如下:
步骤五(A):求解各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i)。根据所有主从UUV的当前位置,利用公式(1)、(2)和(3)得到各从UUV当前位置点的相对位置rf(i)为各从UUV的相对距离,θf(i)为从UUV的相对方位。再根据公式(5)求解出各从UUV当前位置点分布所在的扇形区域sector(i)和环形区域ring(i):
步骤五(B):求解各从UUV分散机动的目标点所在的扇形区域sectorPlan(i),并计算各从UUV分散机动目标点的相对位置。根据粒子群优化算法,求解出机动距离最短的情况下,各从UUV分散机动的目标点所在的扇形区域sectorPlan(i),并根据公式(6)计算得到各从UUV分散机动目标点的相对位置rd(i)为分散机动目标点的相对距离,θd(i)为分散机动目标点的相对方位:
并且分散机动规划得到的结果满足以下条件:
(1)若ring(i)=ring(j),i≠j,i=1,2,···,Nnum_UUV_F,j=1,2,···,Nnum_UUV_F则有以下式子成立:(θf(i)-θf(j))(θd(i)-θd(j))>0;
(2)rf(i)=rd(i);
(3)sectorPlan(i)≠sectorPlan(j),i≠j。
步骤五(C):根据公式(4)求解各从UUV分散机动的目标点的位置
根据图3中的各UUV的分布以及步骤五对各UUV的分散机动的规划,规划结果如图5所示,图中虚线UUV所在位置点表示的是当前位置点,实线UUV所在的位置点表示的是分散机动目标点。如图5所示,1号从UUV分配到分散机动目标点1,其他从UUV同理。分散机动规划的结果保证每个从UUV所在的扇形区域只有一个从UUV。
步骤六:主UUV将规划好的每个从UUV的分散机动目标点位置信息发送给所有从UUV。
步骤七:从UUV分散机动。所有从UUV沿着自身当前位置点所在的圆周机动到分散机动目标点,分散机动过程如图5所示,1号从UUV从当前位置点1机动到分散机动目标点1,其他从UUV同理。每个从UUV分散机动完成后告知主UUV。
步骤八:主UUV判断是否所有从UUV完成分散机动。若主UUV判断在秒内所有从UUV完成分散机动,转步骤九,否则认为队形形成失败,转步骤十八。
步骤九:主UUV对从UUV进行径向机动规划。主UUV根据所有从UUV当前位置和所有从期望点的位置,将从UUV分配到所有从期望点所在的圆周上,圆周上有几个从期望点就分配几个从UUV,规划的结果是得到每个从UUV的径向机动目标点具体过程如下:
步骤九(A):求解各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i)。根据所有从UUV的当前位置,利用公式(1)、(2)和(3)得到各从UUV当前位置点的相对位置Pf_pole_L(i)。再利用公式(5)计算各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i)。
步骤九(B):求解各从期望点所在的扇形区域sectorAim(m)和环形区域ringAim(m)。根据初始化的期望队形指令利用公式(7)计算各从期望点所在的扇形区域sectorAim(m)和环形区域ringAim(m)。
步骤九(C):按如下编号规则,分别对每个从UUV的当前位置点进行编号idf(i)和从期望点进行编号idAim(m):
(1)各点编号总体按照环形区域从内到外的顺序;
(2)若同一环形区域存在多个点,按照各点的相对方位从小到大进行编号;
(3)对各点的编号从1开始直到将所有需要编号的点都编上序号为止。
结合图6,根据从UUV的当前位置,由步骤九(C)编号规则(1)可知,由于1号和3号UUV在环形2区域,2号和4号UUV在环形3区域,所以先对环形2区域内UUV当前位置点进行编号。由步骤九(C)编号规则(2),由于环形2区域内θf(3)<θf(1),所以idf(3)=1,idf(1)=2;对环形3区域内的从UUV当前位置点继续进行编号,由于θf(2)<θf(4),所以idf(2)=3,idf(4)=4。由步骤九(C)编号规则(3),所有从UUV的当前位置点都已编号,所以从UUV的当前位置点编号完成。同理,对各从期望点进行编号为idAim(1)=1,idAim(2)=4,idAim(3)=2,idAim(4)=3。
步骤九(D):为各从UUV分配径向机动目标从期望点。根据步骤九(C)得到的idf(i)和idAim(m),为每一个从UUV分配一个径向机动的目标从期望点。分配方法为:若idf(i)=idAim(m),则i号UUV径向机动分配了m号从期望点。
步骤九(E):求解各从UUV径向机动目标点的位置每个从UUV根据分配的径向机动目标从期望点,利用公式(8)得到各自的径向机动目标点的相对位置再利用公式(4)计算得到Cr_pos_E(i)。rr(i)为各从UUV径向机动目标点的相对距离,θr(i)为各从UUV径向机动目标点的相对方位,Cr_pole_L(i)求解过程如下:
rr(i)=rAim(m) (8)
θr(i)=θf(i)
如图6所示,图中虚线UUV所在位置点表示的是当前位置点,实线UUV所在的位置点表示的是径向机动目标点,1号从UUV分配到径向机动目标点1,其他从UUV同理。
步骤十:主UUV将规划好的每个从UUV的径向机动目标点位置信息发送给所有从UUV。
步骤十一:从UUV径向机动。所有从UUV沿着自身当前位置点的径向方向机动到各自的径向机动目标点位置,每个从UUV径向机动完成后告知主UUV。径向机动过程如图6所示,1号从UUV从当前位置点1机动到径向机动目标点1,其他从UUV同理。
步骤十二:主UUV判断是否所有从UUV完成径向机动。若主UUV判断在秒内所有从UUV完成径向机动,转步骤十三,否则认为队形形成失败,转步骤十八。
步骤十三:主UUV对从UUV进行周向机动规划。主UUV根据所有从UUV当前位置和所有从期望点的位置,为每一个从UUV分配一个从期望点,规划结果是得到每个从UUV的周向机动目标点具体过程如下:
步骤十三(A):求解各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i)。根据所有从UUV的当前位置,利用公式(1)、(2)和(3)得到各从UUV当前位置点的相对位置Pf_pole_L(i),再利用公式(5)计算各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i)。
步骤十三(B):为所有从UUV根据编号规则进行编号。根据步骤九(B)中的编号规则对每个从UUV的当前位置点重新编号,更新编号idf(i)。如图7所示,根据各从UUV当前位置点,可得到如下编号:idf(1)=3,idf(2)=2,idf(3)=1,idf(4)=4。
步骤十三(C):为各从UUV分配从期望点。结合步骤十三(B)得到的idf(i)和步骤九(B)得到的idAim(m),为每一个从UUV分配一个从期望点。分配方法同样为:若idf(i)=idAim(m),则i号从UUV就分配了m号从期望点。
步骤十三(D):求解各从UUV周向机动目标点的位置每个从UUV根据分配的从期望点,利用公式(9)得到各自的周向机动目标点的相对位置再利用公式(4)计算得到Cc_pos_E(i)。rc(i)为各从UUV周向机动目标点的相对距离,θc(i)为各从UUV周向机动目标点的相对方位,Cc_pole_L(i)求解过程如下:
如图7所示,图中虚线UUV所在位置点表示的是当前位置点,实线UUV所在的位置点表示的是周向机动目标点,各周向机动目标点与相应的从期望点重合。图7中,1号UUV分配到从期望点4上,2号UUV分配到从期望点3上,3号UUV分配到从期望点1上,4号UUV分配到出从期望点2上。
步骤十四:主UUV将规划好的每个从UUV的周向机动目标点位置信息发送给所有从UUV。
步骤十五:从UUV周向机动。所有从UUV从当前位置向各自的周向机动目标点位置进行机动。周向机动过程如图7所示,1号从UUV从当前位置点1机动到从期望点4,其他从UUV同理。每个从UUV周向机动完成后告知主UUV。
步骤十六:主UUV判断是否所有从UUV完成周向机动。若主UUV判断在内所有从UUV完成周向机动,转步骤十七,否则认为队形形成失败,转步骤十八。
步骤十七:主UUV向所有从UUV发送队形形成成功指令,所有UUV保持定点、定艏向,转步骤十九。
步骤十八:主UUV向所有从UUV发送队形形成失败指令,所有UUV停车。
步骤十九:UUV集群编队队形形成结束。

Claims (10)

1.一种基于圆周分层规划的UUV集群编队队形形成方法,其特征在于,包括以下步骤:
步骤一:初始化,设置UUV主从身份指令,设置队形形成参数,期望队形指令;
设置的队形形成参数为lUUV、Nnum_UUV_F和Nreal_s,其中,lUUV为UUV的艇长,Nnum_UUV_F为从UUV的个数,Nreal_s为取值(Nnum_UUV_F,Nr)内的任意整数,为最多扇形区域个数,Rmin为所有从UUV所在位置点相对距离的最小值,表示向下取整运算;
设置的期望队形指令为其中rAim(m)表示每个从期望点的相对距离,θAim(m)表示每个从期望点的相对方位,m为各从期望点的代号,m=1,2,…,Nnum_UUV_F
步骤二:队形形成开始,所有UUV保持定点、定艏向,并确定自己的主从身份;
步骤三:UUV集群进行信息交互,所有从UUV向主UUV发送自身当前位置信息i表示各从UUV代号,i=1,2,…,Nnum_UUV_F,主UUV向所有从UUV发送自身当前位置信息和艏向信息θH_L
步骤四:主UUV判断是否接收到所有从UUV位置信息,若主UUV判断在120秒内收到所有从UUV当前位置信息,转步骤五,否则认为队形形成失败,转步骤十八;
步骤五:主UUV对从UUV进行分散机动规划,主UUV根据每个从UUV的当前位置,利用粒子群优化算法进行分散机动规划,将每个从UUV分配到不同的扇形区域内,规划的结果是得到每个从UUV分散机动的目标点坐标
步骤六:主UUV将规划好的每个从UUV的分散机动目标点位置信息发送给所有从UUV;
步骤七:从UUV分散机动,所有从UUV沿着自身当前位置点所在的圆周机动到分散机动目标点,每个从UUV分散机动完成后告知主UUV;
步骤八:主UUV判断是否所有从UUV完成分散机动,若主UUV判断在秒内所有从UUV完成分散机动,转步骤九,否则认为队形形成失败,转步骤十八;
其中,Rmax为所有从UUV所在位置点及所有从期望点的相对距离的最大值,表示向上取整运算;
步骤九:主UUV对从UUV进行径向机动规划,主UUV根据所有从UUV当前位置和所有从期望点的位置,将从UUV分配到所有从期望点所在的圆周上,圆周上有几个从期望点就分配几个从UUV,规划的结果是得到每个从UUV的径向机动目标点
步骤十:主UUV将规划好的每个从UUV的径向机动目标点位置信息发送给所有从UUV;
步骤十一:从UUV径向机动,所有从UUV沿着自身当前位置点的径向方向机动到各自的径向机动目标点位置,每个从UUV径向机动完成后告知主UUV;
步骤十二:主UUV判断是否所有从UUV完成径向机动,若主UUV判断在秒内所有从UUV完成径向机动,转步骤十三,否则认为队形形成失败,转步骤十八;
步骤十三:主UUV对从UUV进行周向机动规划,主UUV根据所有从UUV当前位置和所有从期望点的位置,为每一个从UUV分配一个从期望点,规划结果是得到每个从UUV的周向机动目标点
步骤十四:主UUV将规划好的每个从UUV的周向机动目标点位置信息发送给所有从UUV;
步骤十五:从UUV周向机动,所有从UUV从当前位置向各自的周向机动目标点位置进行机动,每个从UUV周向机动完成后告知主UUV;
步骤十六:主UUV判断是否所有从UUV完成周向机动,若主UUV判断在内所有从UUV完成周向机动,转步骤十七,否则认为队形形成失败,转步骤十八;
步骤十七:主UUV向所有从UUV发送队形形成成功指令,所有UUV保持定点、定艏向,转步骤十九;
步骤十八:主UUV向所有从UUV发送队形形成失败指令,所有UUV停车;
步骤十九:UUV集群编队队形形成结束。
2.根据权利要求1所述的一种基于圆周分层规划的UUV集群编队队形形成方法,其特征在于,所述的步骤五具体包括:
步骤五(A):求解各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i):
其中,θf(i)为从UUV的相对方位,rf(i)为各从UUV的相对距离,Rd=2lUUV为划分环形区域的圆周半径分度值;
步骤五(B):求解各从UUV分散机动的目标点所在的扇形区域sectorPlan(i),并计算各从UUV分散机动目标点的相对位置
步骤五(C):求解各从UUV分散机动的目标点的位置
3.根据权利要求1所述的一种基于圆周分层规划的UUV集群编队队形形成方法,其特征在于,所述的步骤九具体包括:
步骤九(A):求解各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i),求解方法与步骤五(A)相同;
步骤九(B):求解各从期望点所在的扇形区域sectorAim(m)和环形区域ringAim(m);
步骤九(C):按照编号规则,分别对每个从UUV的当前位置点进行编号idf(i)和从期望点进行编号idAim(m);
步骤九(D):为各从UUV分配径向机动目标从期望点;
步骤九(E):求解各从UUV径向机动目标点的位置
4.根据权利要求1所述的一种基于圆周分层规划的UUV集群编队队形形成方法,其特征在于,所述的步骤十三具体包括:
步骤十三(A):求解各从UUV当前位置点所在的扇形区域sector(i)和环形区域ring(i),求解方法与步骤五(A)相同;
步骤十三(B):为所有从UUV根据编号规则进行编号,编号方法同步骤九(C)中对每个从UUV的当前位置点的编号方法;
步骤十三(C):为各从UUV分配从期望点,分配方法同步骤九(D);
步骤十三(D):求解各从UUV周向机动目标点的位置
5.根据权利要求2所述的一种基于圆周分层规划的UUV集群编队队形形成方法,所述的步骤五(B),其特征在于:
求解各从UUV分散机动的目标点所在的扇形区域sectorPlan(i),并计算各从UUV分散机动目标点的相对位置
根据粒子群优化算法,求解出机动距离最短的情况下,各从UUV分散机动的目标点所在的扇形区域sectorPlan(i),并计算得到各从UUV分散机动目标点的相对位置rd(i)为分散机动目标点的相对距离,θd(i)为分散机动目标点的相对方位,利用的公式如下:
rd(i)=rf(i)
分散机动规划得到的结果满足以下条件:
(1)若ring(i)=ring(j),i≠j,i=1,2,…,Nnum_UUV_F,j=1,2,…,Nnum_UUV_F则有以下式子成立:(θf(i)-θf(j))(θd(i)-θd(j))>0;
(2)rf(i)=rd(i);
(3)sectorPlan(i)≠sectorPlan(j),i≠j。
6.根据权利要求3所述的一种基于圆周分层规划的UUV集群编队队形形成方法,所述的步骤九(B),其特征在于:
求解各从期望点所在的扇形区域sectorAim(m)和环形区域ringAim(m):
根据初始化的期望队形指令计算各从期望点所在的扇形区域sectorAim(m)和环形区域ringAim(m),利用的公式如下:
7.根据权利要求3所述的一种基于圆周分层规划的UUV集群编队队形形成方法,所述的步骤九(C),其特征在于:
对每个从UUV的当前位置点进行编号idf(i)和从期望点进行编号idAim(m),编号规则如下:
(1)各点编号总体按照环形区域从内到外的顺序;
(2)若同一环形区域存在多个点,按照各点的相对方位从小到大进行编号;
(3)对各点的编号从1开始直到将所有需要编号的点都编上序号为止。
8.根据权利要求3所述的一种基于圆周分层规划的UUV集群编队队形形成方法,所述的步骤九(D),其特征在于:
为各从UUV分配径向机动目标从期望点,分配方法为:若idf(i)=idAim(m),则i号UUV分配了m号从期望点。
9.根据权利要求3所述的一种基于圆周分层规划的UUV集群编队队形形成方法,所述的步骤九(E),其特征在于:
求解各从UUV径向机动目标点的位置每个从UUV根据分配的径向机动目标从期望点,计算得到各自的径向机动目标点的相对位置再计算得到Cr_pos_E(i),Cr_pole_L(i)及Cr_pos_E(i)求解利用的公式如下:
rr(i)=rAim(m)
θr(i)=θf(i)
其中,rr(i)为各从UUV径向机动目标点的相对距离,θr(i)为各从UUV径向机动目标点的相对方位。
10.根据权利要求4所述的一种基于圆周分层规划的UUV集群编队队形形成方法,所述的步骤十三(D),其特征在于:
求解各从UUV周向机动目标点的位置每个从UUV根据分配的从期望点,计算得到各自的周向机动目标点的相对位置再计算得到Cc_pos_E(i),Cc_pole_L(i)及Cc_pos_E(i)求解利用的公式如下:
rc(i)=rf(i)
θc(i)=θAim(m)
其中rc(i)为各从UUV周向机动目标点的相对距离,θc(i)为各从UUV周向机动目标点的相对方位。
CN201910917112.6A 2019-09-26 2019-09-26 一种基于圆周分层规划的uuv集群编队队形形成方法 Active CN110580057B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910917112.6A CN110580057B (zh) 2019-09-26 2019-09-26 一种基于圆周分层规划的uuv集群编队队形形成方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910917112.6A CN110580057B (zh) 2019-09-26 2019-09-26 一种基于圆周分层规划的uuv集群编队队形形成方法

Publications (2)

Publication Number Publication Date
CN110580057A true CN110580057A (zh) 2019-12-17
CN110580057B CN110580057B (zh) 2023-03-31

Family

ID=68813744

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910917112.6A Active CN110580057B (zh) 2019-09-26 2019-09-26 一种基于圆周分层规划的uuv集群编队队形形成方法

Country Status (1)

Country Link
CN (1) CN110580057B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111930116A (zh) * 2020-07-24 2020-11-13 哈尔滨工程大学 一种基于栅格法的大规模uuv集群编队队形形成方法
CN112068577A (zh) * 2020-09-24 2020-12-11 哈尔滨工程大学 一种uuv集群中uuv个体的绿色动态控位方法
CN112904719A (zh) * 2021-01-15 2021-06-04 哈尔滨工程大学 一种适用于水下机器人位置环形区域跟踪控制方法
CN113467488A (zh) * 2021-08-10 2021-10-01 华中农业大学 X舵水下航行器的多层级容错控制系统

Citations (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE2355682B1 (de) * 1973-11-07 1975-05-15 Siemens Ag Verfahren zur rechnerischen Radarzielverfolgung von mehreren dichtfliegenden Flugobjekten
US6072433A (en) * 1996-07-31 2000-06-06 California Institute Of Technology Autonomous formation flying sensor
CN105974939A (zh) * 2016-07-25 2016-09-28 零度智控(北京)智能科技有限公司 无人机编队阵型自动生成方法及装置
CN106444423A (zh) * 2016-09-30 2017-02-22 天津大学 室内多无人机编队飞行仿真验证平台及其实现方法
CN106843269A (zh) * 2017-01-22 2017-06-13 北京航空航天大学 一种基于小型鸟类集群飞行机制的无人机编队方法
US20170269612A1 (en) * 2016-03-18 2017-09-21 Sunlight Photonics Inc. Flight control methods for operating close formation flight
CN107544541A (zh) * 2017-09-18 2018-01-05 南方科技大学 一种无人机控制方法及系统
GB201721523D0 (en) * 2017-12-21 2018-02-07 Av8Or Ip Ltd Autonomous unmanned aerial vehicle and method of control thereof
CN107703966A (zh) * 2017-07-06 2018-02-16 北京航空航天大学 一种基于雁群自组织飞行的无人机自主编队控制方法
CN108490961A (zh) * 2018-03-23 2018-09-04 哈尔滨工程大学 一种多auv动态圆弧编队控制方法
CN108594846A (zh) * 2018-03-23 2018-09-28 哈尔滨工程大学 一种障碍环境下多auv编队队形优化控制方法
CN108594853A (zh) * 2018-04-27 2018-09-28 中国人民解放军陆军工程大学 无人机队形控制方法
CN108663938A (zh) * 2018-05-25 2018-10-16 哈尔滨工程大学 一种考虑通讯拓扑变换的uuv集群协调控制方法
CN108829132A (zh) * 2018-06-12 2018-11-16 哈尔滨工程大学 一种考虑大时滞的多uuv空间机动控制方法
CN109032186A (zh) * 2018-09-30 2018-12-18 西安科技大学 一种无人机群协同退出圆形轨迹的控制方法
CN109445459A (zh) * 2018-10-25 2019-03-08 中国人民解放军战略支援部队航天工程大学 无人机集群编队控制方法及其装置
CN109581891A (zh) * 2018-12-29 2019-04-05 深圳华侨城文化旅游科技股份有限公司 一种无人机的编队仿真方法、系统及存储介质
CN110162096A (zh) * 2019-06-21 2019-08-23 南京邮电大学 基于人工势场法的无人机编队队形形成与保持方法
CN110262553A (zh) * 2019-06-27 2019-09-20 西北工业大学 基于位置信息的固定翼无人机编队飞行装置与方法

Patent Citations (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE2355682B1 (de) * 1973-11-07 1975-05-15 Siemens Ag Verfahren zur rechnerischen Radarzielverfolgung von mehreren dichtfliegenden Flugobjekten
US6072433A (en) * 1996-07-31 2000-06-06 California Institute Of Technology Autonomous formation flying sensor
US20170269612A1 (en) * 2016-03-18 2017-09-21 Sunlight Photonics Inc. Flight control methods for operating close formation flight
CN105974939A (zh) * 2016-07-25 2016-09-28 零度智控(北京)智能科技有限公司 无人机编队阵型自动生成方法及装置
CN106444423A (zh) * 2016-09-30 2017-02-22 天津大学 室内多无人机编队飞行仿真验证平台及其实现方法
CN106843269A (zh) * 2017-01-22 2017-06-13 北京航空航天大学 一种基于小型鸟类集群飞行机制的无人机编队方法
CN107703966A (zh) * 2017-07-06 2018-02-16 北京航空航天大学 一种基于雁群自组织飞行的无人机自主编队控制方法
CN107544541A (zh) * 2017-09-18 2018-01-05 南方科技大学 一种无人机控制方法及系统
GB201721523D0 (en) * 2017-12-21 2018-02-07 Av8Or Ip Ltd Autonomous unmanned aerial vehicle and method of control thereof
CN108490961A (zh) * 2018-03-23 2018-09-04 哈尔滨工程大学 一种多auv动态圆弧编队控制方法
CN108594846A (zh) * 2018-03-23 2018-09-28 哈尔滨工程大学 一种障碍环境下多auv编队队形优化控制方法
CN108594853A (zh) * 2018-04-27 2018-09-28 中国人民解放军陆军工程大学 无人机队形控制方法
CN108663938A (zh) * 2018-05-25 2018-10-16 哈尔滨工程大学 一种考虑通讯拓扑变换的uuv集群协调控制方法
CN108829132A (zh) * 2018-06-12 2018-11-16 哈尔滨工程大学 一种考虑大时滞的多uuv空间机动控制方法
CN109032186A (zh) * 2018-09-30 2018-12-18 西安科技大学 一种无人机群协同退出圆形轨迹的控制方法
CN109445459A (zh) * 2018-10-25 2019-03-08 中国人民解放军战略支援部队航天工程大学 无人机集群编队控制方法及其装置
CN109581891A (zh) * 2018-12-29 2019-04-05 深圳华侨城文化旅游科技股份有限公司 一种无人机的编队仿真方法、系统及存储介质
CN110162096A (zh) * 2019-06-21 2019-08-23 南京邮电大学 基于人工势场法的无人机编队队形形成与保持方法
CN110262553A (zh) * 2019-06-27 2019-09-20 西北工业大学 基于位置信息的固定翼无人机编队飞行装置与方法

Non-Patent Citations (9)

* Cited by examiner, † Cited by third party
Title
BIAN X: "Path tracking-based underactuated UUV formation coordinated control", 《JOURNAL OF HUAZHONG UNIVERSITY OF SCIENCE AND TECHNOLOGY(NATURAL SCIENCE EDITION)》 *
HONGTAO LIANG: "Research on Agent Modeling and Simulation for Unmanned Underwater Vehicle in Formation Collaborative System", 《ICIC EXPRESS LETTERS, PART B: APPLICATIONS》 *
MOON, JH: "Decentralized Observer-Based Output-Feedback Formation Control of Multiple Unmanned Underwater Vehicles", 《JOURNAL OF ELECTRICAL ENGINEERING & TECHNOLOGY》 *
刘海林: "自主式水下航行器的最优编队控制研究", 《中国优秀博士学位论文全文数据库 工程科技Ⅱ辑》 *
唐悦: "多无人机编队队形选择和优化", 《计算机仿真》 *
李朝旭等: "多无人机协同运动的虚拟队形制导控制", 《系统工程与电子技术》 *
程旗等: "无人机自主编队的人工力场控制方法", 《兵器装备工程学报》 *
程潇: "无人机编队组网技术研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *
韩翃: "多UUV编队队形控制仿真智能决策技术研究", 《2011中国西部声学学术交流会论文集》 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111930116A (zh) * 2020-07-24 2020-11-13 哈尔滨工程大学 一种基于栅格法的大规模uuv集群编队队形形成方法
CN111930116B (zh) * 2020-07-24 2022-10-14 哈尔滨工程大学 一种基于栅格法的大规模uuv集群编队队形形成方法
CN112068577A (zh) * 2020-09-24 2020-12-11 哈尔滨工程大学 一种uuv集群中uuv个体的绿色动态控位方法
CN112904719A (zh) * 2021-01-15 2021-06-04 哈尔滨工程大学 一种适用于水下机器人位置环形区域跟踪控制方法
CN113467488A (zh) * 2021-08-10 2021-10-01 华中农业大学 X舵水下航行器的多层级容错控制系统
CN113467488B (zh) * 2021-08-10 2022-03-22 华中农业大学 X舵水下航行器的多层级容错控制系统

Also Published As

Publication number Publication date
CN110580057B (zh) 2023-03-31

Similar Documents

Publication Publication Date Title
CN110580057B (zh) 一种基于圆周分层规划的uuv集群编队队形形成方法
CN113268076B (zh) 一种多无人机集群编队协同控制算法
Deng et al. Cooperative task assignment of multiple heterogeneous unmanned aerial vehicles using a modified genetic algorithm with multi-type genes
CN107491086B (zh) 时变网络拓扑下的无人机编队避障方法及系统
WO2017202141A1 (zh) 基于邻域约束的空地异构机器人系统路径规划方法
Huo et al. Pigeon-inspired circular formation control for multi-UAV system with limited target information
CN110308740A (zh) 一种面向移动目标追踪的无人机群动态任务分配方法
CN111273685B (zh) 一种异构多无人机自主聚集、分离及合并集群方法
CN111766784B (zh) 障碍物环境下多机器人图案构成的迭代优化方法
CN107703970B (zh) 无人机集群环绕追踪方法
Kalyaev et al. A novel method for distribution of goals among UAVs for oil field monitoring
CN107807671A (zh) 无人机集群危险规避方法
Ermekbayuly Kyzyrkanov et al. Formation control and coordination of swarm robotic systems
CN114428516B (zh) 无人机集群避障方法
Liao et al. UAV swarm formation reconfiguration control based on variable-stepsize MPC-APCMPIO algorithm
Sun et al. Cooperative strategy for pursuit-evasion problem with collision avoidance
CN110231827A (zh) 一种uuv地理围栏的离线初始构建与在线滚动更新方法
Khachumov et al. The model of UAV formation based on the uniform allocation of points on the sphere
Guo et al. Research on multi-UAV formation and semi-physical simulation with virtual structure
CN111930116B (zh) 一种基于栅格法的大规模uuv集群编队队形形成方法
Shao et al. A New Method for Multi-UAV Cooperative Mission Planning Under Fault
CN113359848A (zh) 一种基于航路点的无人机编队生成-切换航迹规划方法
CN114879664A (zh) Auv编队方法、装置、计算机系统及可读存储介质
Shafiq et al. Formation control of multiple UAVs using PID control approach
Liang et al. Research on capability characteristics modeling and cooperative fire strike planning for unmanned ground vehicles

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