【技术实现步骤摘要】
无人设备集群协同航行控制方法、装置及无人设备
[0001]本申请属于无人设备控制
,尤其涉及无人设备集群协同航行控制方法
、
装置
、
无人设备及计算机可读存储介质
。
技术介绍
[0002]近年来,随着对网络化无人系统广泛应用,针对网络化无人系统的协同控制研究与日俱增,其中,协同环航
(Cooperative circumnavigation,CCN)
作为实现无人系统任务的关键技术,它是在保持期望编队构型的情况下,能够引导多辆无人车绕一个静态或动态目标进行圆周运动
。
网络化无人系统主要包括:航天器
(Spacecraft),
飞艇
(airship),
无人机
(unmanned aerial vehicle(UAV)),
无人车
(unmanned ground vehicle(UGV)),
无人船
(unmanned surface vehicle(USV),
无人潜水器
(unmanned underwater vehicle(UUV))
等对应的无人系统,网络化无人系统可应用于资源定位
、
环境勘测以及机器人的安全与监控等
。
[0003]目前,与集群环绕控制问题相比,由于协同环航问题可以将被环绕的中心作为实际的网络无人系统任务的主设备或感兴趣的目标,因此,如何设计控制算法解决实际的协同环航问题成为学 ...
【技术保护点】
【技术特征摘要】
1.
一种无人设备集群协同航行控制方法,其特征在于,包括:获取所述无人设备集群中的其他至少一个无人设备当前的位置信息和速度信息;根据所述无人设备集群中的其他至少一个无人设备当前的位置信息和速度信息,生成当前无人设备的操控参数;执行所述操控参数,以协同所述其他至少一个无人设备的航行控制
。2.
如权利要求1所述的无人设备集群协同航行控制方法,其特征在于,所述当前无人设备为领航者,所述方法还包括:获取监测物体当前的位置信息和速度信息;相对应地,所述根据所述无人设备集群中的其他至少一个无人设备当前的位置信息和速度信息,生成当前无人设备的操控参数,包括:根据所述监测物体和所述无人设备集群中的其他至少一个无人设备当前的位置信息和速度信息,生成当前无人设备的操控参数
。3.
如权利要求2所述的无人设备集群协同航行控制方法,其特征在于,所述根据所述监测物体和所述无人设备集群中的其他至少一个无人设备当前的位置信息和速度信息,生成当前无人设备的操控参数,包括:根据所述速度信息和所述当前无人设备的速度,结合势函数进行分析,获得领航者的追踪速度误差以及期望的环航加速度;根据所述追踪速度误差
、
所述期望的环航加速度
、
所述当前无人设备的位置和所述位置信息,通过控制律进行分析,生成当前无人设备的操控参数
。4.
如权利要求3所述的无人设备集群协同航行控制方法,其特征在于,所述控制律为:其中,为第
i
个领航者的追踪速度误差;
S
为预设的缩放矩阵;为第
i
个领航者期望的环航加速度;
k4为第一控制增益,为正常数;
λ
i
为所述位置信息处理的辅助变量;
T
表示转置;表示的广义逆矩阵;
u
i
为第
i
个领航者的操控参数,
u
i
=
[u
x
,
i
,
u
y
,
i
,
u
z
,
i
]
T
,
u
x
,
i
为作用在第
i
个领航者
x
轴上的控制力,
u
y
,
i
是作用在第
i
个领航者
y
轴上的控制力,
u
z
,
i
是作用在第
i
个领航者
z
轴上的控制力;所述位置信息处理的辅助变量
λ
i
为:其中,
μ
i
为第
i
个领航者对应于预设速度
χ
的期望环行速度;为第
i
个领航者接收位置信息和速度信息的权重和,
ω
ij
表示第
i
个领航者接收第
j
个无人设备位置信息和速度信息的权重,为无人设备集群中所有向第
i
个领航者发送位置信息和速度信息的无人设备集合;
k1为第二控制增益,为正常数;
k2为第三控制增益,为正常数;
z
i
为第一辅助变量,一辅助变量,
qi
为仿射变换后第
i
个领航者的坐标,
qj
为仿射变换后第
j
个无人设备的坐标;
P
i
,
α
为第一势函数;
q
ih
为仿射变换后第
i
个领航者的目标位置;
为第二势函数;为仿射变换后无人设备
j
的速度,表示仿射变换后监测物体的速度
。5.
如权利要求4所述的无人设备集群协同航行控制方法,其特征在于,所述预设的缩放矩阵为:其中,
S
为预设的缩放矩阵,
r
h
表示与预设椭圆相对应的圆形半径;所述预设椭圆的半短轴为
l
m
,所述预设椭圆的半长轴为
l
M
,
γ
为第一单位向量,
β
为第二单位向量,
α
为单位法向量
。6.
如权利要求1所述的无人设备集群协同航行控制方法,其特征在于,所述当前无人设备为跟随者,所述根据所述无人设备集群中的其他至少一个无人设备当前的位置信息和速度信息,生成当前无人设备的操控参数,包括:根据所述位置信息
、
所述速度信息
、
所述当前无人设备的位置和当前无人设备的加速度,通过控制律进行分析,生成当前无人设备的操控参数
。7.
如权利要求6所述的无人设备集群协同航行控制方法,其特征在于,所述控制律为:其中,表示第二辅助变量
v
zm
的导数,
v
zm
为第二辅助变量,为第二辅助变量,为第
m
个跟随者接收位置信息和速度信息的权重和,
ω
mn
表示第
m
个跟随者接收第
n
个无人设备位置信息和速度信息的权重,
z
m
为第一辅助变量,
q
m
为仿射变换后第
m
个跟随者的坐标,
q
n
为仿射...
【专利技术属性】
技术研发人员:李东禹,季锐航,喻豪勇,
申请(专利权)人:苏州工业园区新国大研究院,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。