CN113589840A - 一种基于有限时间收敛滑模导引的无人机自动避撞方法 - Google Patents
一种基于有限时间收敛滑模导引的无人机自动避撞方法 Download PDFInfo
- Publication number
- CN113589840A CN113589840A CN202110780440.3A CN202110780440A CN113589840A CN 113589840 A CN113589840 A CN 113589840A CN 202110780440 A CN202110780440 A CN 202110780440A CN 113589840 A CN113589840 A CN 113589840A
- Authority
- CN
- China
- Prior art keywords
- collision avoidance
- unmanned aerial
- aerial vehicle
- machine
- sliding mode
- 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.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 45
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims abstract description 5
- 238000005096 rolling process Methods 0.000 claims description 6
- 238000001514 detection method Methods 0.000 claims description 4
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 3
- 239000000126 substance Substances 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 4
- 238000004088 simulation Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- PCTMTFRHKVHKIS-BMFZQQSSSA-N (1s,3r,4e,6e,8e,10e,12e,14e,16e,18s,19r,20r,21s,25r,27r,30r,31r,33s,35r,37s,38r)-3-[(2r,3s,4s,5s,6r)-4-amino-3,5-dihydroxy-6-methyloxan-2-yl]oxy-19,25,27,30,31,33,35,37-octahydroxy-18,20,21-trimethyl-23-oxo-22,39-dioxabicyclo[33.3.1]nonatriaconta-4,6,8,10 Chemical compound C1C=C2C[C@@H](OS(O)(=O)=O)CC[C@]2(C)[C@@H]2[C@@H]1[C@@H]1CC[C@H]([C@H](C)CCCC(C)C)[C@@]1(C)CC2.O[C@H]1[C@@H](N)[C@H](O)[C@@H](C)O[C@H]1O[C@H]1/C=C/C=C/C=C/C=C/C=C/C=C/C=C/[C@H](C)[C@@H](O)[C@@H](C)[C@H](C)OC(=O)C[C@H](O)C[C@H](O)CC[C@@H](O)[C@H](O)C[C@H](O)C[C@](O)(C[C@H](O)[C@H]2C(O)=O)O[C@H]2C1 PCTMTFRHKVHKIS-BMFZQQSSSA-N 0.000 description 1
- 238000006757 chemical reactions by type Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
- 230000003068 static 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
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
本申请公开了一种基于有限时间收敛滑模导引的无人机自动避撞方法,所述自动避撞方法中当无人机正常飞行过程中,根据侵入机和避撞机的碰撞锥检测两无人机是否会发生碰撞,如果不发生碰撞,无人机继续正常飞行;如果检测到两无人机会发生碰撞,生成快速有限时间收敛滑模导引指令进行自动避撞飞行控制,同时计算出避撞完成时间,当达到估计的避撞完成时间后避撞完成,避撞机进入正常飞行模式飞往目标点具有以下优点:解决了现有滑模控制在无人机避撞领域应用较少,以及现有的自动避撞方法难以保证系统的稳定性并且难以准确估计自动避撞完成时间的问题。
Description
技术领域
本发明属于无人机飞行控制技术领域,具体涉及一种基于有限时间收敛滑模导引的无人机自动避撞方法。
背景技术
基于导引的无人机自动避撞方法是一种快速的反应式避撞方法,计算量较小,易于综合无人机与障碍的飞行状态信息,避撞决策实时性较强。但是现有的基于导引律的无人机自动避撞方法主要针对静态的或者匀低速运动的障碍物,对于环境的复杂性和扰动考虑较少,因此基于导引的无人机自动避撞方法有待进一步改进。自动避撞技术已成为当前无人机研究的热点。
在无人机避撞方面的研究,核心思路如下:首先通过避撞检测方法检测可能发生的碰撞,然后采取合适的避撞方法,在一定的性能指标和约束下进行避撞飞行。目前滑模导引主要应用在导弹拦截领域,在无人机避撞领域应用较少。具有有限时间收敛的特性。
发明内容
针对现有滑模控制在无人机避撞领域应用较少,以及现有的自动避撞方法难以保证系统的稳定性并且难以准确估计自动避撞完成时间的问题,本发明提供了一种基于有限时间收敛导引的无人机自动避撞方法。
为解决以上技术问题,本发明采用以下技术方案:
一种基于有限时间收敛滑模导引的无人机自动避撞方法,所述自动避撞方法中当无人机正常飞行过程中,根据侵入机和避撞机的碰撞锥检测两无人机是否会发生碰撞,如果不发生碰撞,无人机继续正常飞行;如果检测到两无人机会发生碰撞,生成快速有限时间收敛滑模导引指令进行自动避撞飞行控制,同时计算出避撞完成时间,当达到估计的避撞完成时间后避撞完成,避撞机进入正常飞行模式飞往目标点。
进一步的,步骤一:基于避撞机与侵入机的碰撞锥检测。
步骤二:基于有限时间收敛滑模导引的无人机避撞指令生成与飞行控制。
步骤三:无人机自动避撞完成时间计算,在执行步骤二时,同时对无人机完成避撞的时间进行估计;
步骤四:检测避撞是否完成;
检测飞行时间是否达到估计的无人机避撞完成时间,如果达到了就执行步骤五。如果未达到继续执行步骤二;
步骤五:避撞机进入正常飞行模式,避撞机继续飞往目标点。
进一步的,所述步骤一中初始状态下避撞机沿预定的正常飞行轨迹飞往目标点。利用机载传感器获得避撞机和侵入机的飞行状态信息,飞行状态信息包括避撞机初始位置(x0,y0)、飞行速度V和航向角ψ(t),侵入机的位置(xOB,yOB)、速度VOB和航向角ψOB,根据避撞机和侵入机的相对几何关系,得出两无人机的相对距离为RT(t)如公式1所示:
两无人机相对速度Vrel(t)如公式2所示:
Vrel(t)=Vcos(ψrel-ψ(t))+VOBcos(π+ψOB-ψrel(t)) 公式2;
其中,ψrel(t)为两无人机相对速度方位角如公式3所示:
进一步的,所述步骤一中视线角λ(t)如公式4所示:
相对速度方位角和视线角的差值ε(t)如公式5所示:
ε(t)=|λ(t)-ψrel(t)| 公式5。
进一步的,所述步骤一中给定安全距离RS后可求取碰撞锥的半顶角θ(t)如公
式6所示:
碰撞锥下边界角μ(t)如公式7所示:
μ(t)=λ(t)-θ(t) 公式7。
进一步的,所述步骤一中无人机的运动模型如公式8所示:
当相对速度Vrel(t)在碰撞锥内,即相对速度方位角与视线角的偏差绝对值小于碰撞锥的半顶角,即公式为|λ(t)-ψrel(t)|=|ε(t)|<θ(t),则两个无人机会发生碰撞,并执行步骤二;如果速度方位角与视线角的偏差绝对值大于或等于碰撞锥的半顶角,则执行步骤五。
进一步的,所述步骤二中检测到避撞机与侵入机发生碰撞,首先计算机生成有限时间收敛滑模导引指令a(t)如公式9所示:
进一步的,所述步骤三中无人机自动避撞完成时间的估计过程包括以下步骤:
进一步的,所述步骤三中无人机自动避撞完成时间的估计过程包括以下步骤:
进一步的,根据两无人机航迹的交点坐标(xT,yT),避撞机进行直线飞行的时间如公式14所示:
无人机自动避撞完成时间T:
本发明采用以上技术方案,与现有技术相比,具有如下技术效果:
附图说明
为了更清楚地说明本发明具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍。在所有附图中,类似的元件或部分一般由类似的附图标记标识。附图中,各元件或部分并不一定按照实际的比例绘制。
图1为本发明基于有限时间收敛滑模导引的无人机自动避撞方法的流程图;
图2为本发明中避撞机与侵入机的几何关系图;
图3为本发明中无人机自动避撞轨迹仿真图;
图4为本发明中无人机自动避撞距离仿真图。
具体实施方式
实施例1,如图1至图4所示,一种基于有限时间收敛滑模导引的无人机自动避撞方法,当无人机正常飞行过程中,侵入机和避撞机符合图2的相对几何关系,图2中ABCD为碰撞锥,其中A点和C点分别为避撞机和侵入机的位置。B、D点是根据设置的安全距离Rs计算的碰撞锥边界点。根据侵入机和避撞机的碰撞锥检测两无人机是否会发生碰撞,如果不发生碰撞,无人机继续正常飞行,如果检测到两无人机会发生碰撞,避撞机自动驾驶系统计算生成有限时间收敛滑模导引指令进行自动避撞飞行控制,同时计算出避撞完成时间,当达到估计的避撞完成时间后避撞完成,避撞机进入正常飞行模式飞往目标点。
一种基于有限时间收敛滑模导引的无人机自动避撞方法,流程图如图1所示,包括以下步骤:
步骤一:基于避撞机与侵入机的碰撞锥检测。
根据图2,初始状态下避撞机沿预定的正常飞行轨迹飞往目标点。利用机载传感器获得避撞机和侵入机的飞行状态信息,飞行状态信息包括避撞机初始位置(x0,y0)、飞行速度V和航向角ψ(t),侵入机的位置(xOB,yOB)、速度VOB和航向角ψOB。根据图2的避撞机和侵入机的相对几何关系,得出两无人机的相对距离为RT(t)如公式1所示:
两无人机相对速度Vrel(t)如公式2所示:
Vrel(t)=Vcos(ψrel-ψ(t))+VOBcos(π+ψOB-ψrel(t)) 公式2。
其中,ψrel(t)为两无人机相对速度方位角如公式3所示:
视线角λ(t)如公式4所示:
相对速度方位角和视线角的差值ε(t)如公式5所示:
ε(t)=|λ(t)-ψrel(t)| 公式5。
给定安全距离RS后可求取碰撞锥的半顶角θ(t)如公式6所示:
碰撞锥下边界角μ(t)如公式7所示:
μ(t)=λ(t)-θ(t) 公式7。
无人机的运动模型如公式8所示:
当相对速度Vrel(t)在碰撞锥内,即相对速度方位角与视线角的偏差绝对值小于碰撞锥的半顶角,即公式为|λ(t)-ψrel(t)|=|ε(t)|<θ(t),则两个无人机会发生碰撞,并执行步骤二;如果速度方位角与视线角的偏差绝对值大于或等于碰撞锥的半顶角,则执行步骤五。
步骤二:基于有限时间收敛滑模导引的无人机避撞指令生成与飞行控制。
检测到避撞机与侵入机发生碰撞,首先计算机生成有限时间收敛滑模导引指令a(t)如公式9所示:
步骤三:无人机自动避撞完成时间计算。
在执行步骤二时,同时对无人机完成避撞的时间进行估计;无人机自动避撞完成时间的估计过程为:
无人机自动避撞完成时间T:
步骤四:检测避撞是否完成。
检测飞行时间是否达到估计的无人机避撞完成时间T,如果达到了就执行步骤五。如果未达到继续执行步骤二;
步骤五:避撞机进入正常飞行模式。
避撞机继续飞往目标点。图3和图4为基于有限时间收敛滑模导引的无人机自动避撞仿真图。
本发明的描述是为了示例和描述起见而给出的,而并不是无遗漏的或者将本发明限于所公开的形式。很多修改和变化对于本领域的普通技术人员而言是显然的。选择和描述实施例是为了更好的说明本发明的原理和实际应用,并且使本领域的普通技术人员能够理解本发明从而设计适于特定用途的带有各种修改的各种实施例。
Claims (10)
1.一种基于有限时间收敛滑模导引的无人机自动避撞方法,其特征在于:所述自动避撞方法中当无人机正常飞行过程中,根据侵入机和避撞机的碰撞锥检测两无人机是否会发生碰撞,如果不发生碰撞,无人机继续正常飞行;如果检测到两无人机会发生碰撞,生成快速有限时间收敛滑模导引指令进行自动避撞飞行控制,同时计算出避撞完成时间,当达到估计的避撞完成时间后避撞完成,避撞机进入正常飞行模式飞往目标点。
2.如权利要求1所述的一种基于有限时间收敛滑模导引的无人机自动避撞方法,其特征在于:包括以下步骤:
步骤一:基于避撞机与侵入机的碰撞锥检测。
步骤二:基于有限时间收敛滑模导引的无人机避撞指令生成与飞行控制。
步骤三:无人机自动避撞完成时间计算,在执行步骤二时,同时对无人机完成避撞的时间进行估计;
步骤四:检测避撞是否完成;
检测飞行时间是否达到估计的无人机避撞完成时间,如果达到了就执行步骤五。如果未达到继续执行步骤二;
步骤五:避撞机进入正常飞行模式,避撞机继续飞往目标点。
3.如权利要求2所述的一种基于有限时间收敛滑模导引的无人机自动避撞方法,其特征在于:所述步骤一中初始状态下避撞机沿预定的正常飞行轨迹飞往目标点。利用机载传感器获得避撞机和侵入机的飞行状态信息,飞行状态信息包括避撞机初始位置(x0,y0)、飞行速度V和航向角ψ(t),侵入机的位置(xOB,yOB)、速度VOB和航向角ψOB,根据避撞机和侵入机的相对几何关系,得出两无人机的相对距离为RT(t)如公式1所示:
两无人机相对速度Vrel(t)如公式2所示:
Vrel(t)=V cos(ψrel-ψ(t))+VOBcos(π+ψOB-Ψrel(t)) 公式2;
其中,ψrel(t)为两无人机相对速度方位角如公式3所示:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110780440.3A CN113589840A (zh) | 2021-07-09 | 2021-07-09 | 一种基于有限时间收敛滑模导引的无人机自动避撞方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110780440.3A CN113589840A (zh) | 2021-07-09 | 2021-07-09 | 一种基于有限时间收敛滑模导引的无人机自动避撞方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113589840A true CN113589840A (zh) | 2021-11-02 |
Family
ID=78246873
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110780440.3A Withdrawn CN113589840A (zh) | 2021-07-09 | 2021-07-09 | 一种基于有限时间收敛滑模导引的无人机自动避撞方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113589840A (zh) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106647810A (zh) * | 2017-01-10 | 2017-05-10 | 山东科技大学 | 一种基于负比例导引的无人机自动避撞方法 |
CN112099348A (zh) * | 2020-08-19 | 2020-12-18 | 南京理工大学 | 一种基于观测器和全局滑模的碰撞角控制制导方法 |
-
2021
- 2021-07-09 CN CN202110780440.3A patent/CN113589840A/zh not_active Withdrawn
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106647810A (zh) * | 2017-01-10 | 2017-05-10 | 山东科技大学 | 一种基于负比例导引的无人机自动避撞方法 |
CN112099348A (zh) * | 2020-08-19 | 2020-12-18 | 南京理工大学 | 一种基于观测器和全局滑模的碰撞角控制制导方法 |
Non-Patent Citations (1)
Title |
---|
NING ZHANG: "A fast finite-time convergent guidance law with nonlinear disturbance observer for unmanned aerial vehicles collision avoidance", AEROSPACE SCIENCE AND TECHNOLOGY, vol. 86, pages 204 - 214, XP085623331, DOI: 10.1016/j.ast.2019.01.021 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109947123B (zh) | 一种基于视线导引律的无人机路径跟踪与自主避障方法 | |
CN106681348B (zh) | 考虑全捷联导引头视场约束的制导控制一体化设计方法 | |
CN107608367B (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
CN105955268B (zh) | 一种考虑局部避碰的uuv动目标滑模跟踪控制方法 | |
CN106020236B (zh) | 一种自适应引导长度的无人机航迹跟踪方法 | |
CN106774400B (zh) | 一种基于逆动力学的无人机三维轨迹制导方法 | |
CN103884237B (zh) | 基于目标概率分布信息的多对一协同制导方法 | |
CN105045284B (zh) | 一种抗干扰无人飞行器路径跟踪控制方法 | |
CN105759829A (zh) | 基于激光雷达的微型无人机操控方法及系统 | |
CN110008502A (zh) | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 | |
CN110687931B (zh) | 一种方位角姿态与前置导引切换的一体化机动导引方法 | |
CN110262555B (zh) | 连续障碍环境下无人机实时避障控制方法 | |
CN110764523B (zh) | 基于抗饱和平滑变换的比例积分前置导引攻击目标的方法 | |
CN105116914B (zh) | 一种平流层飞艇解析模型预测路径跟踪控制方法 | |
CN113126644B (zh) | 基于自适应视线法的无人机三维航迹跟踪方法 | |
CN106647810A (zh) | 一种基于负比例导引的无人机自动避撞方法 | |
CN110716566A (zh) | 一种欠驱动无人艇的有限时间轨迹跟踪控制方法 | |
CN106970646B (zh) | 基于自适应积分反步的四旋翼飞行器控制方法 | |
Gonçalves et al. | Precise landing of autonomous aerial vehicles using vector fields | |
Mills et al. | Vision based control for fixed wing UAVs inspecting locally linear infrastructure using skid-to-turn maneuvers | |
CN104019701A (zh) | 一种直接力气动力复合控制方法与前向拦截制导方法 | |
Acuna et al. | Vision-based UAV landing on a moving platform in GPS denied environments using motion prediction | |
CN114740859A (zh) | 一种船只自动悬停方法及系统 | |
CN117270402B (zh) | 一种适用于极端风场的无人机复合抗扰航迹跟踪控制方法 | |
CN114265425A (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 | ||
WW01 | Invention patent application withdrawn after publication | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20211102 |