CN111026137B - 一种攻击角约束下同时攻击目标的三维分布式协同导引方法 - Google Patents

一种攻击角约束下同时攻击目标的三维分布式协同导引方法 Download PDF

Info

Publication number
CN111026137B
CN111026137B CN201911364058.3A CN201911364058A CN111026137B CN 111026137 B CN111026137 B CN 111026137B CN 201911364058 A CN201911364058 A CN 201911364058A CN 111026137 B CN111026137 B CN 111026137B
Authority
CN
China
Prior art keywords
attack
target
ith
auv
angle
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
Application number
CN201911364058.3A
Other languages
English (en)
Other versions
CN111026137A (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.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical 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 Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201911364058.3A priority Critical patent/CN111026137B/zh
Publication of CN111026137A publication Critical patent/CN111026137A/zh
Application granted granted Critical
Publication of CN111026137B publication Critical patent/CN111026137B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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/04Control of altitude or depth
    • G05D1/06Rate of change of altitude or depth
    • G05D1/0692Rate of change of altitude or depth specially adapted for under-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

在导引任务中,面对高复杂度的防御系统会导致更大的脱靶量、不精确的目标估计和更低的命中概率。为了提高命中率,本发明提出了多对一的攻击角约束下三维(3‑D)分布式协同导引律,在具有攻击角约束的情况下可同时攻击静止目标。为了实现同时攻击,通过沿着视线角的方向调节速度来同步剩余时间的估计值,这对于增强攻击过程中的鲁棒性是很有效的方法。所提出的导引律在攻击过程中可以最大化目标的信息量,比传统目标估计的方法更精确、更简单,还可以减少计算负荷,这是本发明的亮点。最后,通过仿真和实验结果验证了所提出制导方案的有效性。

Description

一种攻击角约束下同时攻击目标的三维分布式协同导引方法
技术领域
本发明属于水下航行器控制领域,具体涉及水下自主航行器协同导引的控制方法,具体为一种攻击角约束下同时攻击目标的三维分布式协同导引方法。
背景技术
地球表面近71%的地区被海洋覆盖。对人类而言,海洋与人类生活息息相关,紧密相连。随着世界经济和科技的发展,人类对资源的需求与日俱增,陆地资源日趋匮乏,海洋资源和能源开发利用愈来愈受到人们的重视。由此可见,进一步探索、开发海洋对于我国的长期可持续发展,具有越来越重要的战略意义。
伴随着AUV等水下航行器的发展,舰艇的防御系统也在不断地发展和升级。现今的大多数军舰都装备有各自防御系统,使AUV的突防能力和打击效果大打折扣。所以,AUV要想突破防御系统的层层防御变得越来越困难,这使得饱和攻击战术收到重视。
具有攻击角度约束的协同齐射攻击(多对一)是提高攻击概率的有效策略。从不同位置,利用不同平台,发射多个AUV,从不同角度同时突防,形成“多对一”的打击态势,使敌方舰艇的防御系统在短时间内处于无法应付的饱和状态,从而提高突防成功的概率。当多个AUV对目标实施饱和攻击时,从不同角度接近目标,也是避免水下航行器之间相互碰撞的一种有效手段。
另外,在实际工程中,协同导引方法还存在以下两个问题:1、由于目标估计不够准确,会存在一定误差;2、多个AUV没有同时攻击目标,对其命中概率产生影响。
发明内容
本发明针对目标估计不准确且没有同时攻击目标等问题,提出了一种攻击角约束下同时攻击目标的三维分布式协同导引方法,并通过仿真,验证了本发明所提导引律的有效性。
本发明的技术方案为:
所述一种攻击角约束下同时攻击目标的三维分布式协同导引方法,其特征在于:包括以下步骤:
步骤1:建立目标和第i个AUV的模型:
Figure BDA0002337949350000021
Figure BDA0002337949350000022
其中,ri是目标和第i个AUV之间的相对距离,qe,i和qa,i分别是第i个AUV的俯仰角和方位角,[aAri,aAei,aAai]T是在第i个视线角坐标系中的第i个AUV的加速度向量;
步骤2:对步骤1所述的模型设计法向、切向和垂向导引律,并按导引律引导共计N个AUV:
Figure BDA0002337949350000023
Figure BDA0002337949350000024
Figure BDA0002337949350000025
其中,kri和kti是正常数,kriξi用于收敛剩余时间的估计误差,kti用于调节攻击时间,
Figure BDA0002337949350000026
为第i个AUV的剩余时间估计,
Figure BDA0002337949350000027
用于确保在终端时刻所有的剩余时间估计值收敛到零,sign(·)为符号函数;λi>0且为常数,kei是正常数,用于影响到达滑模面的速率,si为滑模面,取
Figure BDA0002337949350000028
Figure BDA0002337949350000029
为期望的俯仰角,ρei是常数;
Figure BDA00023379493500000210
为一致性误差向量,μ=[μ12],μ1和μ2是正常数,影响
Figure BDA00023379493500000211
的收敛速度,ρai为常数。
有益效果
相对现有技术,本发明具有如下优点及效果:
本发明所述的导引方法利用带有攻击角度约束的多个AUV去同时攻击静止目标。在攻击目标的过程中,基于协同导引的角度约束可最大化目标的信息量能够提供更精确的目标估计,从不同方向攻击可以减少计算负荷;同步了所有AUV的攻击时间,在终端时刻确保剩余时间估计值收敛到零,提高了系统的鲁棒性。
本发明适用于多对一攻击静止目标的导引过程,具有控制精度高,结构简单,易于调节,鲁棒性强,易于工程实现等优点。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1是带有角度约束的协同导引控制系统。
图2是3D平面协同导引轨迹。
图3是2D水平面协同导引轨迹。
图4是剩余时间估计值变化曲线。
图5是垂直方向攻击角度误差变化曲线。
图6是水平方向攻击角度误差变化曲线。
图7是法向加速度变化曲线。
图8是切向加速度变化曲线。
图9是垂向加速度变化曲线。
具体实施方式
下面详细描述本发明的实施例,所述实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
本实例通过用四个AUV从四个预定的方向同时攻击静止目标来验证所提出的三维分布式导引律的有效性。AUV的加速度在惯性坐标系视为未知外界扰动部分。下面表1给出导引参数和初始条件:
表1初始条件
Figure BDA0002337949350000031
Figure BDA0002337949350000041
给出导引律中涉及的参数:r1=300,r2=400,r3=500,r4=600,
Figure BDA00023379493500000413
kr1=kr2=kr3=kr4=0.3,kt1=kt2=kt3=kt4=1.2,λ1=λ2=λ3=λ4=1,ke1=ke2=ke3=ke4=0.1,μ=0.08,qa1=-150*pi/180,qa2=-10*pi/180,qa3=80*pi/180,qa4=150*pi/180,
Figure BDA0002337949350000042
qe1=-40*pi/180,qe2=-30*pi/180,qe3=-15*pi/180,qe4=-10*pi/180,
Figure BDA0002337949350000043
ρei(0)=ρai(0)=0,i=1,…,4。
首先,建立目标和第i个AUV的模型:
Figure BDA0002337949350000044
Figure BDA0002337949350000045
其中,ri是目标和第i个AUV之间的相对距离,qe,i和qa,i分别是第i个AUV的俯仰角和方位角,[aAri,aAei,aAai]T是在第i个视线角坐标系中的第i个AUV的加速度向量;
其次,针对所述的模型设计法向、切向和垂向导引律:
Figure BDA0002337949350000046
Figure BDA0002337949350000047
Figure BDA0002337949350000048
其中,kri和kti是正常数,kriξi用来收敛剩余时间的估计误差,kt1=kti=…ktN可以调节攻击时间,
Figure BDA0002337949350000049
为第i个AUV的剩余时间估计,
Figure BDA00023379493500000410
可以保证在终端时刻所有的剩余时间估计值收敛到零,sign(·)为符号函数;λi>0是常数,kei是正常数,可以影响到达滑模面的速率,si为滑模面,取
Figure BDA00023379493500000411
是一致最终有界的,
Figure BDA00023379493500000412
为期望的俯仰角,ρei是常数;
Figure BDA0002337949350000051
为一致性误差向量,可以取
Figure BDA0002337949350000052
Figure BDA0002337949350000053
μ=[μ12],μ1和μ2是正常数,影响
Figure BDA00023379493500000517
的收敛速度,ρai为常数。对于上述导引律,下面采用李雅普诺夫稳定性原理证明所设计导引律的有效性。
证明aAri导引律的有效性如下。选取李雅普诺夫候选函数:
Figure BDA0002337949350000054
其中,
Figure BDA0002337949350000055
对候选函数V1求关于时间的导数,则有:
Figure BDA0002337949350000056
其中,拉普拉斯矩阵l=lT
Figure BDA0002337949350000057
kr=diag(kr1,…,krN),
Figure BDA0002337949350000058
kt=diag(kt1,…,ktN)。
由于
Figure BDA0002337949350000059
得出
Figure BDA00023379493500000510
V1的导数还可写为:
Figure BDA00023379493500000511
由于ξTξ=λξV11,λξ是正常数,kti>ktsi>0,得出:
Figure BDA00023379493500000512
其中,
Figure BDA00023379493500000513
λkr=diag(λkr1,…,λkrN)。可得出:
Figure BDA00023379493500000514
由于λmin(kr)>0,λmin(kts)>0,可得出:
Figure BDA00023379493500000515
因为
Figure BDA00023379493500000516
V12对时间的导数为:
Figure BDA0002337949350000061
由于λmin(kts)>0,可得
Figure BDA0002337949350000062
在有限时间内能够收敛到零。则有:
Figure BDA0002337949350000063
Figure BDA0002337949350000064
证明结束。
证明aAei导引律的有效性如下。将导引律代入滑模面对时间的导数中:
Figure BDA0002337949350000065
选取李雅普诺夫候选函数:
Figure BDA0002337949350000066
V2关于时间的导数为:
Figure BDA0002337949350000067
由于事实:-ρei|si|≤0,kei>0,得出:
滑模面si最终统一有界,证明结束。
证明aAai导引律的有效性如下。由模型和导引律得:
Figure BDA0002337949350000068
其中,
Figure BDA0002337949350000069
B=[0 1]T
定义
Figure BDA00023379493500000610
得出:
Figure BDA00023379493500000611
其中,
Figure BDA00023379493500000612
由ε=0得出x1=x2=…=xN,化简得:
Figure BDA0002337949350000071
其中,ρa=diag(ρa1,…,ρaN),h=[sign(με1),…,sign(μεN)]T
选取李雅普诺夫候选函数:
Figure BDA0002337949350000072
其中,λ5是正常数。a为正常数,
Figure BDA0002337949350000073
是一个正定矩阵。
V3对时间得导数为:
Figure BDA0002337949350000074
Figure BDA0002337949350000075
通过选择合适的a值,
W为一个负定的矩阵。
进一步,可得:
Figure BDA0002337949350000076
λmin(·)和λmax(·)分别是矩阵(·)最小和最大的特征值。使用Barbalat's引理,得出:
Figure BDA0002337949350000077
从而,当t→∞时,(qe,i-qe,j)-2π(i-j)/N→0。证明结束。
最后,通过算法仿真,验证了基于角度约束下的三维分布式协同导引方法的有效性。
仿真图2和图3分别是在3-D和平面内的导引轨迹。仿真图4给出了剩余时间估计值的误差变化曲线,可以看出四个AUV是同时攻击静止目标的,在终端时刻收敛为零。这也说明了沿着视线角的方向通过调节速度去同步剩余时间估计值的方法是可行的。从仿真图5可以看出,四个AUV的垂直方向攻击角度能够收敛到期望的角度。四个AUV的水平方向的攻击角度误差在图6中给出,可以看出其误差收敛到零。图7、图8和图9给出四个AUV加速度aAr,aAe,aAa的变化曲线,可以看出攻击时间Tf=76.67s。
以上所述为本发明的实施例,四个AUV的脱靶概率是很小的并且满足攻击角度约束。本发明提出的协同导引律在三维空间中能够实现在攻击角度约束下的多AUV同时攻击。法向加速度使系统状态在给定时间内为零并且此后保持零,AUV将沿着期望视线角前进直到目标被击中。切向加速度使得误差收敛到零。随着视线角速率和误差两者都等于零,剩余时间也收敛为零,实现了时间的一致。因此,本发明所提出的角度约束下三维分布式协同导引是可以实现的。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。

Claims (1)

1.一种攻击角约束下同时攻击目标的三维分布式协同导引方法,其特征在于:包括以下步骤:
步骤1:建立目标和第i个AUV的模型:
Figure FDA0003793578540000011
Figure FDA0003793578540000012
Figure FDA0003793578540000013
其中,ri是目标和第i个AUV之间的相对距离,qe,i和qa,i分别是第i个AUV的俯仰角和方位角,[aAri,aAei,aAai]T是在第i个视线角坐标系中的第i个AUV的加速度向量;
步骤2:对步骤1所述的模型设计法向、切向和垂向导引律,并按导引律引导共计N个AUV:
Figure FDA0003793578540000014
Figure FDA0003793578540000015
Figure FDA0003793578540000016
其中,kri和kti是正常数,kriξi用于收敛剩余时间的估计误差,kti用于调节攻击时间,
Figure FDA0003793578540000017
为第i个AUV的剩余时间估计,
Figure FDA0003793578540000018
用于确保在终端时刻所有的剩余时间估计值收敛到零,sign(·)为符号函数;λi>0且为常数,kei是正常数,用于影响到达滑模面的速率,si为滑模面,取
Figure FDA0003793578540000019
Figure FDA00037935785400000110
为期望的俯仰角,ρei是常数;
Figure FDA00037935785400000111
为一致性误差向量,μ=[μ12],μ1和μ2是正常数,影响
Figure FDA00037935785400000112
的收敛速度,ρai为常数。
CN201911364058.3A 2019-12-26 2019-12-26 一种攻击角约束下同时攻击目标的三维分布式协同导引方法 Active CN111026137B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911364058.3A CN111026137B (zh) 2019-12-26 2019-12-26 一种攻击角约束下同时攻击目标的三维分布式协同导引方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911364058.3A CN111026137B (zh) 2019-12-26 2019-12-26 一种攻击角约束下同时攻击目标的三维分布式协同导引方法

Publications (2)

Publication Number Publication Date
CN111026137A CN111026137A (zh) 2020-04-17
CN111026137B true CN111026137B (zh) 2022-10-28

Family

ID=70214490

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911364058.3A Active CN111026137B (zh) 2019-12-26 2019-12-26 一种攻击角约束下同时攻击目标的三维分布式协同导引方法

Country Status (1)

Country Link
CN (1) CN111026137B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112379599B (zh) * 2020-11-20 2022-06-14 西北工业大学 一种针对空中机动目标的三维协同中制导方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104793625A (zh) * 2015-04-17 2015-07-22 西北工业大学 一种自主水下航行器动态抗饱和俯仰角控制方法
DE102016202784A1 (de) * 2016-02-23 2017-08-24 Thyssenkrupp Ag Routenoptimierung
CN107728639A (zh) * 2017-09-08 2018-02-23 哈尔滨工程大学 一种时间窗约束下的异构多auv系统任务协调方法
CN107861382A (zh) * 2017-09-28 2018-03-30 西北工业大学深圳研究院 一种多执行水下机器人鲁棒自适应运动控制装置及其方法
CN108594834A (zh) * 2018-03-23 2018-09-28 哈尔滨工程大学 一种面向未知环境下多auv自适应目标搜索和避障方法
CN109543135A (zh) * 2018-11-09 2019-03-29 西北工业大学 一种基于信息最大化的多auv协同同时导引方法
CN110377059A (zh) * 2019-08-29 2019-10-25 哈尔滨工程大学 一种基于狮群算法的多auv围捕者协同控制方法
CN110488849A (zh) * 2019-08-29 2019-11-22 哈尔滨工程大学 一种基于改进拍卖算法的围捕者决策方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017095539A1 (en) * 2015-11-30 2017-06-08 Raytheon Company Navigation system for autonomous underwater vehicle based on coherence map

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104793625A (zh) * 2015-04-17 2015-07-22 西北工业大学 一种自主水下航行器动态抗饱和俯仰角控制方法
DE102016202784A1 (de) * 2016-02-23 2017-08-24 Thyssenkrupp Ag Routenoptimierung
CN107728639A (zh) * 2017-09-08 2018-02-23 哈尔滨工程大学 一种时间窗约束下的异构多auv系统任务协调方法
CN107861382A (zh) * 2017-09-28 2018-03-30 西北工业大学深圳研究院 一种多执行水下机器人鲁棒自适应运动控制装置及其方法
CN108594834A (zh) * 2018-03-23 2018-09-28 哈尔滨工程大学 一种面向未知环境下多auv自适应目标搜索和避障方法
CN109543135A (zh) * 2018-11-09 2019-03-29 西北工业大学 一种基于信息最大化的多auv协同同时导引方法
CN110377059A (zh) * 2019-08-29 2019-10-25 哈尔滨工程大学 一种基于狮群算法的多auv围捕者协同控制方法
CN110488849A (zh) * 2019-08-29 2019-11-22 哈尔滨工程大学 一种基于改进拍卖算法的围捕者决策方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Guidance law of multiple missiles for cooperative simultaneous attack against maneuvering target;Tingting Zhang,等;《Proceedings of the 37th Chinese Control Conference》;20180727;第4536-4541页 *
多AUV分布式协同制导律;崔海英,等;《2019中国西部声学学术交流会》;20190831;第410-412页 *
无人艇群自主协同技术研究;张丰;《第六届中国指挥控制大会论文集(上册) 》;20180702;第447-450页 *

Also Published As

Publication number Publication date
CN111026137A (zh) 2020-04-17

Similar Documents

Publication Publication Date Title
CN109597423B (zh) 一种基于参考视线角信号的多约束末制导律的设计方法
CN108362171B (zh) 一种具有攻击时间和攻击角度约束的制导策略
CN103090728B (zh) 一种基于滑模控制的带末角约束制导方法
CN106123921B (zh) 动态干扰条件下捷联惯导系统的纬度未知自对准方法
CN110686564B (zh) 一种红外半捷联导引头制导方法及系统
CN109358499A (zh) 基于速度与航向双重制导的无人船精确路径跟踪控制方法
CN103822636B (zh) 一种空对地制导武器捷联寻的视线重构方法
CN111707148B (zh) 一种时变时延条件下多导弹协同制导方法及系统
CN110412874A (zh) 针对机动目标和时延通信的多导弹协同制导律设计方法
CN110764523B (zh) 基于抗饱和平滑变换的比例积分前置导引攻击目标的方法
Oshman et al. Differential-game-based guidance law using target orientation observations
CN108279005A (zh) 一种导引头数据失效模式下的制导信息重构方法
CN114489109B (zh) 一种三维主从式多飞行器攻击时间控制协同制导方法
CN111026137B (zh) 一种攻击角约束下同时攻击目标的三维分布式协同导引方法
CN109543135B (zh) 一种基于信息最大化的多auv协同同时导引方法
CN105676170B (zh) 一种用于多目标无源定位与跟踪的虚假点去除方法
CN110929216B (zh) 一种具有抗拖曳的自适应反步制导律设计方法
CN114415722B (zh) 导弹群协同制导方法、电子设备和存储介质
CN115857538A (zh) 三维空间下满足落角约束的多飞行器协同制导方法
CN116680509A (zh) 一种用于多航天器追逃博弈任务的动态匹配方法
CN103744058A (zh) 基于指数加权衰减记忆滤波的弹道轨迹形成方法
CN104197941A (zh) 一种基于和声搜索算法的水下潜器路突防径规划方法
Zhou et al. Sliding mode guidance law considering missile dynamic characteristics and impact angle constraints
CN116401752A (zh) 基于超扭曲观测器的自适应滑模多飞行器协同末制导律设计方法
CN112379599B (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