CN114995518B - 从飞行器gps目标定位失效时的主-从式协同制导方法 - Google Patents
从飞行器gps目标定位失效时的主-从式协同制导方法 Download PDFInfo
- Publication number
- CN114995518B CN114995518B CN202210888429.3A CN202210888429A CN114995518B CN 114995518 B CN114995518 B CN 114995518B CN 202210888429 A CN202210888429 A CN 202210888429A CN 114995518 B CN114995518 B CN 114995518B
- Authority
- CN
- China
- Prior art keywords
- aircraft
- slave
- master
- coordinate system
- formula
- 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 18
- 238000004891 communication Methods 0.000 claims description 28
- 230000001133 acceleration Effects 0.000 claims description 26
- 239000013598 vector Substances 0.000 claims description 15
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 239000003550 marker Substances 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000013178 mathematical model Methods 0.000 abstract 1
- 230000005540 biological transmission Effects 0.000 description 4
- 230000002457 bidirectional effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000035515 penetration Effects 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
Images
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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
- G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying
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)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明提供一种从飞行器GPS目标定位失效时的主‑从式协同制导方法,包括:步骤1:建立主飞行器相对目标、从飞行器相对主飞行器的相对运动关系;步骤2:建立主飞行器的到达时间误差变量:步骤3:主飞行器的制导律独立设计:步骤4:定义从飞行器相对主飞行器的一致性协同变量:步骤5:设计GPS定位功能失效时,从飞行器协同制导律。通过本发明的方法,可使主飞行器和从飞行器在期望的时间到达目标位置。该方法建立飞行器的相对运动关系数学模型,在构建到达时间误差变量的基础上给出主飞行器的制导律,进一步定义一致性位置协同变量,设计出从飞行器的协同制导律,实现所有从飞行器与主飞行器的到达时间一致。
Description
技术领域
本发明涉及主-从式多飞行器协同制导方法,属于飞行器制导、控制领域。具体为发明了一种当从飞行器GPS目标定位功能失效时,依然能保证主-从多飞行器同时到达目标点的协同制导方法。
背景技术
在飞行器突防、空中协同作业、围捕等特殊应用背景下,有时要求多个飞行器在同一时间到达目标点。协同制导由于高效融合、协同互补和信息互助的优势成为了解决多飞行器同时到达的重要手段。根据飞行器在群体中承担“角色”的不同,协同制导方法分为无主式协同制导和“主-从”式协同制导。现有的协同制导技术大多要求所有的飞行器都能探测和定位目标点,然而在强干扰环境下,飞行器的GPS定位功能有时会受到压制和干扰,导致无法正常工作,此时有必要研究当部分飞行器GPS定位功能失效时的协同制导技术。
发明内容
本发明针对“主-从”式多飞行器同时到达目标点的问题,设计了一种当从飞行器GPS定位功能失效时,或为了降低成本从飞行器未配置GPS定位装置时,依然能保证同时到达目标的“主-从”式协同制导方法。整个飞行器群由1个主飞行器和多个从飞行器组成;其中,从飞行器无法探测定位目标的位置信息,本发明将构建主-从飞行器局部运动关系,借助网络化信息交互,设计协同制导律,使得所有飞行器在指定时间同时到达目标。
本发明的技术构思为:在独立设计主飞行器制导律的基础上,为从飞行器设计协同制导律,保证主飞行器和从飞行器在指定时间同时到达目标点。首先,建立主飞行器相对目标、从飞行器相对主飞行器的相对运动关系;其次,给出主飞行器的导引律,使得主飞行器在期望的时间到达目标;最后,构建一致性协同变量,给出可使得从飞行器与主飞行器到达时间同步的协同制导律。
本发明设计的一种从飞行器GPS目标定位失效时的主-从式协同制导方法,包括以下步骤:步骤1:建立主飞行器相对目标、从飞行器相对主飞行器的相对运动关系;
设飞行器群各包含1枚主飞行器和n枚从飞行器。可采用代数图论来表示飞行器之
间的通信关系。从飞行器之间的通信关系可以用邻接矩阵A=[a ij ]来表示,如果第i(i=1,
2,…,n)枚从飞行器能够和第j(j=1, 2,…,n, j≠i)枚从飞行器建立通信关系则a ij =1,否
则,a ij =0。主飞行器只可以发送信息给满足通信条件的部分从飞行器,但不能接收从飞行器
的信息,采用表示第i枚从飞行器与主飞行器之间的通信关系,若接收主飞行器信息,则,否则。如果网络化通信拓扑中的任意两个飞行器节点总存在至少一条通信路径,
则称此通信拓扑图为连通图。如果通信拓扑图中的信息传输都是双向的,则称该图为无向
图,若存在单向的信息传输链路则称该通信拓扑图为有向图。
针对三维平面下飞行器运动关系可以表示为:
式中,[x i , y i , z i ]T表示第i个飞行器在惯性坐标系下的坐标;[v x,i , v y,i , v z,i ]T表示第i个飞行器在惯性坐标系下的速度向量,V i ,θ i 和ψ i 分别表示飞行器速度,航迹倾角和航迹偏角,其动态方程满足:
定义惯性坐标系下的加速度分量a x,i, a y,i 和a z,i 为:
式中,a i 为惯性坐标系下的加速度向量。
视线坐标系下第i个飞行器与目标的相对运动关系可以表示为:
加速度向量从惯性坐标系到视线坐标系的转换关系为:
利用飞行器和目标的位置信息通过下式计算可获得R i ,ε i 和η i 信息:
式中,[x t , y t , z t ]T表示目标在惯性坐标系下的坐标。
步骤2:建立主飞行器的到达时间误差变量:
式中,T d为期望的到达时间指令,t go为剩余飞行时间,t表示当前时间,用下式进行近似估计:
式中,R 0为主飞行器与目标位置点的距离。
步骤3:主飞行器的制导律独立设计:
步骤4:定义从飞行器相对主飞行器的一致性协同变量:
式中,p i,1, p i,2和p i,3为正实数比例系数。
步骤5:设计GPS定位功能失效时,从飞行器协同制导律为:
本发明的有益效果为:本发明设计了一种从飞行器GPS定位功能失效的主-从式到达时间可控协同制导方法。鉴于从飞行器无法获取目标的位置信息,本发明在独立给出主飞行器制导律的基础上,从飞行器利用主飞行器状态信息定义一致性协同变量,并设计了到达时间可控的从飞行器协同制导律,使得主飞行器和所有的从飞行器能够在期望的时间到达目标位置。
附图说明
图1是飞行器通信关系示意图。
图2是三维空间飞行轨迹曲线。
图3是飞行器与目标距离曲线。
图4是主飞行器到达时间误差、视线倾角和视线偏角响应。
图5是一致性协同变量ξ 1,i 响应。
图6是一致性协同变量ξ 2,i 响应。
图7是从飞行器法向加速度曲线。
具体实施方式
请参照图1—7所示,对本发明做进一步说明。
本发明一种从飞行器GPS目标定位失效时的主-从式协同制导方法,包含以下步骤:
步骤1:建立主飞行器相对目标、从飞行器相对主飞行器的相对运动关系;
假设飞行器群各包含1枚主飞行器和n枚从飞行器。可采用代数图论来表示飞行器
之间的通信关系。从飞行器之间的通信关系可以用邻接矩阵A=[a ij ]来表示,如果第i(i=1,
2,…,n)枚从飞行器能够和第j(j=1, 2,…,n, j≠i)枚从飞行器建立通信关系则a ij =1,否
则,a ij =0。主飞行器只可以发送信息给满足通信条件的部分从飞行器,但不能接收从飞行器
的信息,采用 表示第i枚从飞行器与主飞行器之间的通信关系,若接收主飞行器信息,则,否则。如果网络化通信拓扑中的任意两个飞行器节点总存在至少一条通信路径,
则称此通信拓扑图为连通图。如果通信拓扑图中的信息传输都是双向的,则称该图为无向
图,若存在单向的信息传输链路则称该通信拓扑图为有向图。
针对三维平面下飞行器运动关系可以表示为:
式中,[x i , y i , z i ]T表示第i个飞行器在惯性坐标系下的坐标;[v x,i , v y,i , v z,i ]T表示第i个飞行器在惯性坐标系下的速度向量,V i ,θ i 和ψ i 分别表示飞行器速度,航迹倾角和航迹偏角,其动态方程满足:
定义惯性坐标系下的加速度分量a x,i, a y,i 和a z,i 为:
式中,a i 为惯性坐标系下的加速度向量。
视线坐标系下第i个飞行器与目标的相对运动关系可以表示为:
加速度向量从惯性坐标系到视线坐标系的转换关系为:
利用飞行器和目标的位置信息通过下式计算可获得R i ,ε i 和η i 信息:
式中,[x t , y t , z t ]T表示目标在惯性坐标系下的位置坐标。
步骤2:建立主飞行器的到达时间误差变量:
式中,T d为期望的到达时间指令,t go为剩余飞行时间,t表示当前时间,用下式进行近似估计:
式中,R 0为主飞行器与目标位置点的距离。
步骤3:主飞行器的制导律独立设计:
步骤4:定义从飞行器相对主飞行器的一致性协同变量:
式中,p i,1, p i,2和p i,3为正实数比例系数。
步骤5:设计GPS定位功能失效时,从飞行器协同制导律为:
利用Matlab/Simulink仿真平台来验证所设计从飞行器GPS定位功能失效的主-从式到达时间可控的协同制导方法。对于实施例,选择1枚主飞行器,3枚从飞行器,弹间通信拓扑关系如图1所示,其中,0表示主飞行器,1、2、3分别表示第1、2、3个从飞行器。目标位置(0m, 0m, 0m),主飞行器的速度V 0为330m/s,从飞行器的初始速度依次为V 1=350m/s,V 2=310m/s,V 3=310m/s。主飞行器的初始位置为(4048m, 8500m, 7565m),从飞行器的初始位置依次为:(5960m, 6191m, 9596m),(6561m, 5000m, 4680m)和(8116m, 7382m, 5910m)。飞行器过载限制为20g。参数设置为:T d=35s, k 1,0=k 2,0=k 3,0=10, k 1,i =5, k 2,i =8 for i=1,2,3, μ 1=μ 2=μ 3=0.5, ρ i =0.05, σ i =0.03, p 1,1=p 1,2=p 1,3=0.2,
p 2,1=p 2,2=p 2,3=0.4, p 3,1=p 3,2= p 3,3=0.6。
仿真结果见图2-图7,由三维空间运动轨迹和飞行器与目标距离曲线可知,在所发明从飞行器GPS定位功能失效的主-从式到达时间可控协同制导方式下,所有的飞行器能在期望的时刻35s到达目标位置,各从飞行器的到达时间与主飞行器的到达时间保持一致。主飞行器的到达时间误差变量、视线倾角、视线偏角、从飞行器的一致性协同变量等能够稳定收敛,加速度输出在经过暂态调整后逐渐趋于稳态。
Claims (4)
1.一种从飞行器GPS目标定位失效时的主-从式协同制导方法,其特征在于,包括以下步骤:
步骤1:建立主飞行器相对目标、从飞行器相对主飞行器的相对运动关系;
针对三维平面下飞行器运动关系表示为:
式中,[x i , y i , z i ]T表示第i个飞行器在惯性坐标系下的坐标;[v x,i , v y,i , v z,i ]T表示第i个飞行器在惯性坐标系下的速度向量,V i ,θ i 和ψ i 分别表示飞行器速度,航迹倾角和航迹偏角,动态方程满足:
定义惯性坐标系下的加速度分量a x,i, a y,i 和a z,i 为:
式中,a i 为惯性坐标系下的加速度向量;
视线坐标系下第i个飞行器与目标的相对运动关系表示为:
加速度向量从惯性坐标系到视线坐标系的转换关系为:
步骤2:建立主飞行器的到达时间误差变量:
式中,T d为期望的到达时间指令,t go为剩余飞行时间,t表示当前时间,用下式进行近似估计:
式中,R 0为主飞行器与目标位置点的距离;
步骤3:主飞行器的制导律独立设计:
步骤4:定义从飞行器相对主飞行器的一致性协同变量:
式中,p i,1, p i,2和p i,3为正实数比例系数;
步骤5:设计GPS定位功能失效时,从飞行器协同制导律为:
2.根据权利要求1所述的从飞行器GPS目标定位失效时的主-从式协同制导方法,其特征在于:设飞行器群各包含1枚主飞行器和n枚从飞行器;采用代数图论来表示飞行器之间的通信关系;从飞行器之间的通信关系用邻接矩阵A=[a i,j ]来表示,若第i枚从飞行器能够和第j枚从飞行器建立通信关系,则a i,j =1,否则,a i,j =0;i=1, 2,…,n;j=1, 2,…,n, j≠i。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210888429.3A CN114995518B (zh) | 2022-07-27 | 2022-07-27 | 从飞行器gps目标定位失效时的主-从式协同制导方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210888429.3A CN114995518B (zh) | 2022-07-27 | 2022-07-27 | 从飞行器gps目标定位失效时的主-从式协同制导方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114995518A CN114995518A (zh) | 2022-09-02 |
CN114995518B true CN114995518B (zh) | 2022-11-18 |
Family
ID=83021371
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210888429.3A Active CN114995518B (zh) | 2022-07-27 | 2022-07-27 | 从飞行器gps目标定位失效时的主-从式协同制导方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114995518B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS52148164A (en) * | 1976-06-04 | 1977-12-09 | Tech Res & Dev Inst Of Japan Def Agency | Identifier unit for missile target aerocarft |
CN111238467A (zh) * | 2020-02-07 | 2020-06-05 | 西北工业大学 | 一种仿生偏振光辅助的无人作战飞行器自主导航方法 |
CN112861253A (zh) * | 2020-12-25 | 2021-05-28 | 航天科工微电子系统研究院有限公司 | 一种异质多飞行器复杂构型协同弹道规划方法 |
CN113359813A (zh) * | 2021-05-11 | 2021-09-07 | 西北工业大学 | 一种多领弹多从弹群组协同制导方法 |
CN114489109A (zh) * | 2021-09-13 | 2022-05-13 | 西北工业大学 | 一种三维主从式多飞行器攻击时间控制协同制导方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CA3016014A1 (en) * | 2016-02-29 | 2017-09-08 | Intelligent Material Solutions, Inc. | Cooperative guidance system and method |
-
2022
- 2022-07-27 CN CN202210888429.3A patent/CN114995518B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS52148164A (en) * | 1976-06-04 | 1977-12-09 | Tech Res & Dev Inst Of Japan Def Agency | Identifier unit for missile target aerocarft |
CN111238467A (zh) * | 2020-02-07 | 2020-06-05 | 西北工业大学 | 一种仿生偏振光辅助的无人作战飞行器自主导航方法 |
CN112861253A (zh) * | 2020-12-25 | 2021-05-28 | 航天科工微电子系统研究院有限公司 | 一种异质多飞行器复杂构型协同弹道规划方法 |
CN113359813A (zh) * | 2021-05-11 | 2021-09-07 | 西北工业大学 | 一种多领弹多从弹群组协同制导方法 |
CN114489109A (zh) * | 2021-09-13 | 2022-05-13 | 西北工业大学 | 一种三维主从式多飞行器攻击时间控制协同制导方法 |
Non-Patent Citations (4)
Title |
---|
Distributed adaptive cooperative time-varying formation tracking guidance for multiple aerial vehicles system;Jianglong Yu et al.;《Aerospace Science and Technology》;20210702;第1-17页 * |
Vision-aided Multi-UAV Autonomous Flocking in GPS-denied Environment;Yazhe Tang et al.;《IEEE》;20181231;第1-11页 * |
反舰导弹编队飞行控制方法研究;彭明星等;《系统仿真学报》;20170131;第29卷(第1期);第212-217页 * |
基于时空协同的飞行器集群制导技术现状与应用;王燕燕等;《飞控与探测》;20210731;第4卷(第4期);第32-39页 * |
Also Published As
Publication number | Publication date |
---|---|
CN114995518A (zh) | 2022-09-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10037028B2 (en) | Systems, devices, and methods for on-board sensing and control of micro aerial vehicles | |
CN111948944B (zh) | 一种基于自适应神经网络的四旋翼编队容错控制方法 | |
CN106873621B (zh) | 一种基于拉格朗日方程的无人机编队队形控制算法 | |
CN104407619B (zh) | 不确定环境下的多无人机同时到达多个目标方法 | |
CN115639841B (zh) | 一种基于鲁棒牵制的无人机集群编队控制系统及控制方法 | |
CN111857181B (zh) | 分布式航天器编队自适应有限时间姿态协同跟踪控制方法 | |
CN112327926B (zh) | 一种无人机编队的自适应滑模控制方法 | |
CN106707749A (zh) | 一种针对仿生扑翼飞行机器人的控制方法 | |
CN104597911A (zh) | 空中加油受油机自适应最优对接轨迹跟踪飞行控制方法 | |
Dou et al. | Distributed finite‐time formation control for multiple quadrotors via local communications | |
CN110687915B (zh) | 一种基于无向通信拓扑的航天器编队姿态协同控制方法 | |
CN114489109B (zh) | 一种三维主从式多飞行器攻击时间控制协同制导方法 | |
CN109857117A (zh) | 一种基于分布式模式匹配的无人艇集群编队方法 | |
CN117170410B (zh) | 用于无人机编队飞行的控制方法及相关产品 | |
Chen et al. | Spherical formation tracking control of nonlinear second-order agents with adaptive neural flow estimate | |
CN115366109A (zh) | 一种旋翼飞行机械臂复合分层抗干扰方法 | |
Wang et al. | UAV swarm autonomous control based on Internet of Things and artificial intelligence algorithms | |
CN114995518B (zh) | 从飞行器gps目标定位失效时的主-从式协同制导方法 | |
Ghommam et al. | Distance‐Based Formation Control for Quadrotors with Collision Avoidance via Lyapunov Barrier Functions | |
CN114510039A (zh) | 一种前向轮式机器人群组分时抵达的协调控制方法 | |
Jiao et al. | Fault tolerant control algorithm of hexarotor UAV | |
Zhang et al. | Fault tolerant formation flight control of UAVs | |
CN107065877B (zh) | 基于相对位置的分布式编队球形包围追踪未知目标的方法 | |
CN114727217B (zh) | 一种基于数据链通信的低成本双领队异构无人机编队协同定位方法 | |
Liu et al. | Integrated guidance and control of interceptor missile based on asymmetric barrier Lyapunov function |
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 | ||
EE01 | Entry into force of recordation of patent licensing contract | ||
EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20220902 Assignee: BEIJING ZHUOYI INTELLIGENT TECHNOLOGY CO.,LTD. Assignor: Northwestern Polytechnical University Contract record no.: X2024980009826 Denomination of invention: Master slave cooperative guidance method for GPS target positioning failure of aircraft Granted publication date: 20221118 License type: Common License Record date: 20240716 |