CN110609567A - 一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法 - Google Patents
一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法 Download PDFInfo
- Publication number
- CN110609567A CN110609567A CN201910870966.3A CN201910870966A CN110609567A CN 110609567 A CN110609567 A CN 110609567A CN 201910870966 A CN201910870966 A CN 201910870966A CN 110609567 A CN110609567 A CN 110609567A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- quad
- attitude
- rotor unmanned
- 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.)
- Pending
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,步骤为:步骤S1:获取无人机飞行控制律;根据四旋翼无人机的非线性欠驱动动力学特性,利用基于积分反步法的PID控制法得到无人机飞行控制律;步骤S2:构建的四旋翼无人机内环控制器;利用水平方向上的间接控制输入量与期望姿态角之间的代数关系,搭建位置控制器与姿态控制器之间的桥梁,进而实现四旋翼无人机的闭环反馈控制;步骤S3:对四旋翼无人机在接入虚假卫星信号后进行姿态控制;根据构建的四旋翼无人机内环控制器,对接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响机理进行分析处理,最终对四旋翼无人机进行姿态控制。本发明具有容易实现、能够提高无人机控制效果等优点。
Description
技术领域
本发明主要涉及到无人机控制技术领域,特指一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法。
背景技术
无人飞行器一般可分为固定翼无人机和旋翼无人机。与固定翼无人机相比,旋翼无人机具有其独特的优势。由于能够垂直起降、自由悬停等飞行动作,所以旋翼无人机可适应各种速度及各种飞行剖面航路的飞行状况,使得其在各个领域都具有广泛的应用。
全球定位***(Global Positioning System,GPS)/惯性导航***(InertialNavigation System,INS)的组合导航是旋翼无人机***导航、制导与控制的核心技术之一。但是由于导航卫星信号十分微弱,故应用卫星导航终端的旋翼无人机GPS/INS组合导航***容易受到转发式或欺骗式等恶意干扰。从干扰的隐蔽性来说,欺骗式干扰的效果要明显优于其他类型干扰,它可使得目标无人机无意识地被攻击。
发明内容
本发明要解决的技术问题就在于:针对现有技术存在的技术问题,本发明提供一种容易实现、能够提高无人机控制效果的面向四旋翼无人机的卫星惯性组合导航终端欺骗方法。
为解决上述技术问题,本发明采用以下技术方案:
一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,其步骤为:
步骤S1:获取无人机飞行控制律;
根据四旋翼无人机的非线性欠驱动动力学特性,利用基于积分反步法的PID控制法得到无人机飞行控制律,包括位置控制律和姿态控制律;
步骤S2:构建的四旋翼无人机内环控制器;
利用水平方向上的间接控制输入量与期望姿态角之间的代数关系,搭建位置控制器与姿态控制器之间的桥梁,进而实现四旋翼无人机的闭环反馈控制;
步骤S3:对四旋翼无人机在接入虚假卫星信号后进行姿态控制;
根据构建的四旋翼无人机内环控制器,对接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响机理进行分析处理,最终对四旋翼无人机进行姿态控制。
作为本发明的进一步改进:在步骤S3中,接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响包括无人机接入虚假卫星信号后,卫星/惯性组合导航输出的位置信息会发生偏移。
作为本发明的进一步改进:在步骤S3中,接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响包括无人机位置的欺骗偏移效果会直接导致水平方向上间接控制输入量ux、uy,以及垂直方向上直接控制输入量uz的变化。
作为本发明的进一步改进:在步骤S3中,接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响包括间接控制输入量ux、uy会导致期望横滚角φ和俯仰角θ发生变化,进而改变姿态的控制输入量ui(i=2,3,4)。
作为本发明的进一步改进:在步骤S3中,接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响包括将发生变化的直接控制输入量ui(i=1,2,3,4)、以及间接控制输入量ux、uy代入到非线性四旋翼无人机动力学模型中,最终不仅会使得无人机的位置发生真实的欺骗偏移,而且会使得其姿态的变化。
作为本发明的进一步改进:还包括:
步骤S4:攻击方利用第三方测量设备设备观测估算无人机的飞行状态信息,包括其位置速度和加速度信息;
步骤S5:根据估算的飞行状态信息攻击方采用PID控制算法,计算出迫使无人机跟踪欺骗轨迹的控制输入量as,进而结合步骤S4获取的无人机估计飞行状态信息攻击方设计虚假卫星信号。
作为本发明的进一步改进:还包括步骤S6:设定欺骗器规划的欺骗轨迹始终依据无人机原定的参考轨迹而缓慢常值拉偏。
与现有技术相比,本发明的优点在于:本发明面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,不仅可根据利用欺骗式干扰技术构造的虚假卫星信号实现四旋翼无人机隐蔽性定点捕获或定向驱离等操作,而且能在整个欺骗过程中保证四旋翼无人机的稳定性飞行,即位置的欺骗偏移不会产生较大的姿态变化,这些在众多应用中都是十分有重要的。
附图说明
图1是本发明方法的流程示意图。
图2在本发明在具体应用实例中的原理示意图。
具体实施方式
以下将结合说明书附图和具体实施例对本发明做进一步详细说明。
如图1和图2所示,本发明的一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,其步骤为:
步骤S1:获取无人机飞行控制律;
根据四旋翼无人机的非线性欠驱动动力学特性,利用基于积分反步法的PID控制法得到无人机飞行控制律,包括位置控制律和姿态控制律。
步骤S2:构建的四旋翼无人机内环控制器;
利用水平方向上的间接控制输入量与期望姿态角之间的代数关系,搭建位置控制器与姿态控制器之间的桥梁,进而实现四旋翼无人机的闭环反馈控制。
步骤S3:对四旋翼无人机在接入虚假卫星信号后进行姿态控制;
根据构建的四旋翼无人机内环控制器,对接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响机理进行分析处理,最终对四旋翼无人机进行姿态控制。
在具体应用实例中,在步骤S1中,四旋翼无人机的非线性动力学模型如下式描述:
其中,x、y和z分别为机体的位置坐标,φ、θ和ψ分别为机体的横滚角、俯仰角以及偏航角,m为机体的质量,l为两机翼的长度,Jx、Jy和Jz分别为机体围绕x、y、z轴旋转的转动惯量,Ti(i=1,2,3,4)分别为机体的升力,Qi(i=1,2,3,4)分别为机体的阻力。
式(1)的四旋翼无人机动力学模型可简化为:
其中,ui(i=1,2,3,4)分别为模型控制输入,可由四旋翼无人机四个旋翼螺旋桨的转速Ω1、Ω2、Ω3、Ω4求得,即
根据四旋翼无人机的非线性欠驱动特性,本发明采用基于积分反步法的PID控制算法设计无人机飞行控制率。首先定义:
将式(2)写成两个而满足反步法所要求的严反馈形子***,即
其中,
b1=l/Jx,b2=l/Jy,b3=l/Jz,
ux=cosx1sinx3cosx5+sinx1sinx5,uy=cosx1sinx3sinx5-sinx1cosx5
姿态控制器:
首先分析姿态控制中的横滚角控制律设计方法,定义横滚角跟踪误差eφ为:
eφ=φ-φd=x1-x1d (4)
其中,φd=x1d为期望的横滚角。
加入积分项Γφ=∫eφdt,选择李雅普诺夫函数V1为:
其中,kφ为正常数。
式(5)的导数为:
将当作虚拟控制量,当期望的虚拟控制为:
可使得其中c1为正常数。
通过上一步中虚拟控制与期望的虚拟控制的误差可以得到:
对上式进行求导运算,即
选择关于eφ、Γφ和eφ2的李雅普诺夫函数V2为:
它的导数形式为:
假定期望的有如下形式:
可使得其中c2为正常数。
对比式(9)和式(12),可得横滚角控制输入量u2为:
通过式(13)可以看出,横滚角控制输入量u2具有PID控制器的形式,即比例参数:
积分参数:Iφ=-c1kφ
微分参数:Dφ=c1+c2
俯仰角θ和航向角ψ的控制机理与横滚角φ的控制机理相似。首先定义俯仰角跟踪误差eθ为:
eθ=θ-θd=x3-x3d (14)
eψ=ψ-ψd=x5-x5d (15)
其中,θd=x3d为期望的俯仰角,ψd=x5d为期望的航向角。
根据式(13),可得俯仰角控制输入量u3和航向角控制输入量u4为:
其中,Γθ=∫eθdt,Γψ=∫eψdt,c3、c4、kθ、c5、c6和kψ为非负的控制器参数,
同时,通过式(16)和(17)可以看出u3和u4具有PID控制器的形式,即比例参数:
积分参数:Iθ=-c3kθ,Iψ=-c5kψ
微分参数:Dθ=c3+c4,Dψ=c5+c6
位置控制器:
无人机位置的控制机理与姿态的控制机理相似。首先定义位置跟踪误差ex1、ey1和ez1为:
ez1=z-zd=x7-x7d (18)
ex1=x-xd=x9-x9d (19)
ey1=y-yd=x11-x11d (20)
其中,zd=x7d、xd=x9d和yd=x11d为期望的位置。
根据式(13),可得垂直方向直接控制输入量u1、水平方向间接控制输入量ux、uy分别为:
其中,cx1、cx2、kx1、cy1、cy2、ky1、cz1、cz2和kz1为非负的控制器参数,Γx=∫exdt,Γy=∫eydt,Γz=∫ezdt,且
在具体应用实例中,在步骤S2中,具体地,本发明将欠驱动的位置状态x和y中含有姿态角的三角函数部分ux和uy分别当作各自间接的控制输入量来设计。经过设计的间接控制输入量ux和uy满足某种关系式的姿态量可以当作姿态控制过程中横滚角φ和俯仰角θ的目标函数,即:
φd=x1d=sin-1(uxsinx5-uycosx5) (23)
同时,式(23)和式(24)构建了位置控制器和姿态控制器之间的桥梁,进而实现四旋翼无人机的内环控制。
在具体应用实例中,在步骤S3中,具体包括:
a、无人机接入虚假卫星信号后,卫星/惯性组合导航输出的位置信息会发生偏移;
b、无人机位置的欺骗偏移效果会根据式(22)至(24),直接导致水平方向上间接控制输入量ux、uy,以及垂直方向上直接控制输入量uz的变化;
c、间接控制输入量ux、uy会根据式(23)和式(24),导致期望横滚角φ和俯仰角θ发生变化,进而改变姿态的控制输入量ui(i=2,3,4);
d、将发生变化的直接控制输入量ui(i=1,2,3,4)、以及间接控制输入量ux、uy代入到式(2)的非线性四旋翼无人机动力学模型中,最终不仅会使得无人机的位置发生真实的欺骗偏移,而且会使得其姿态的变化。
姿态的巨大变化一方面很容易被检测设备所捕获而影响欺骗的隐蔽性,另一方面当其超过飞行的物理极限时,会导致无人机发生坠落危险。
针对此,在具体应用实例中,本发明进一步提出利用轨迹诱导的欺骗方法,具体包括:
步骤S4:攻击方利用第三方测量设备设备(如地面雷达等)观测估算无人机的飞行状态信息,包括其位置速度和加速度信息。
步骤S5:攻击方的目标是使得无人机跟踪欺骗轨迹本专利采用PID控制算法,计算出控制输入量as为:
其中,为欺骗控制参数矩阵。
无人机的目标则是使得无人机跟踪参考轨迹(rd,vd,ad),因此在构造虚假卫星信号时,需要将无人机自身控制的影响考虑在内。结合步骤S4获取的无人机估计飞行状态信息和步骤(5)获取的欺骗控制输入量as,攻击方设计如下所示的虚假卫星信号的加速度分量a*,即:
通过积分运算,求解得到各个时刻虚假卫星信号的位置x*和速度v*信息,即
在具体应用实例中,本发明进一步包括步骤S6:设定欺骗器规划的欺骗轨迹始终依据无人机原定的参考轨迹而缓慢常值拉偏,即
其中,λ为一个不随时间变化且阈值较小的参数。
设定如式(29)的目标避免了单一时刻位置的突然较大变化而引起的无人机姿态突变,这一优化设计既增强欺骗算法的隐蔽性又确保了欺骗过程中无人机飞行的稳定性。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (7)
1.一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,其特征在于,步骤为:
步骤S1:获取无人机飞行控制律;
根据四旋翼无人机的非线性欠驱动动力学特性,利用基于积分反步法的PID控制法得到无人机飞行控制律,包括位置控制律和姿态控制律;
步骤S2:构建的四旋翼无人机内环控制器;
利用水平方向上的间接控制输入量与期望姿态角之间的代数关系,搭建位置控制器与姿态控制器之间的桥梁,进而实现四旋翼无人机的闭环反馈控制;
步骤S3:对四旋翼无人机在接入虚假卫星信号后进行姿态控制;
根据构建的四旋翼无人机内环控制器,对接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响机理进行分析处理,最终对四旋翼无人机进行姿态控制。
2.根据权利要求1所述的面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,其特征在于,在步骤S3中,接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响包括无人机接入虚假卫星信号后,卫星/惯性组合导航输出的位置信息会发生偏移。
3.根据权利要求1所述的面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,其特征在于,在步骤S3中,接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响包括无人机位置的欺骗偏移效果会直接导致水平方向上间接控制输入量ux、uy,以及垂直方向上直接控制输入量uz的变化。
4.根据权利要求1所述的面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,其特征在于,在步骤S3中,接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响包括间接控制输入量ux、uy会导致期望横滚角φ和俯仰角θ发生变化,进而改变姿态的控制输入量ui(i=2,3,4)。
5.根据权利要求1所述的面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,其特征在于,在步骤S3中,接入虚假卫星信号后的无人机位置欺骗偏移对姿态的影响包括将发生变化的直接控制输入量ui(i=1,2,3,4)、以及间接控制输入量ux、uy代入到非线性四旋翼无人机动力学模型中,最终不仅会使得无人机的位置发生真实的欺骗偏移,而且会使得其姿态的变化。
6.根据权利要求1-5中任意一项所述的面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,其特征在于,还包括:
步骤S4:攻击方利用第三方测量设备设备观测估算无人机的飞行状态信息,包括其位置速度和加速度信息;
步骤S5:根据估算的飞行状态信息攻击方采用PID控制算法,计算出迫使无人机跟踪欺骗轨迹的控制输入量as,进而结合步骤S4获取的无人机估计飞行状态信息攻击方设计虚假卫星信号。
7.根据权利要求6所述的面向四旋翼无人机的卫星惯性组合导航终端欺骗方法,其特征在于,还包括步骤S6:设定欺骗器规划的欺骗轨迹始终依据无人机原定的参考轨迹而缓慢常值拉偏。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910870966.3A CN110609567A (zh) | 2019-09-16 | 2019-09-16 | 一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910870966.3A CN110609567A (zh) | 2019-09-16 | 2019-09-16 | 一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110609567A true CN110609567A (zh) | 2019-12-24 |
Family
ID=68891326
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910870966.3A Pending CN110609567A (zh) | 2019-09-16 | 2019-09-16 | 一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110609567A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111580537A (zh) * | 2020-05-28 | 2020-08-25 | 西北工业大学 | 一种无人机特技飞行控制***及方法 |
CN112034733A (zh) * | 2020-08-17 | 2020-12-04 | 广东工业大学 | 一种基于Unity3D的四旋翼无人机城市仿真方法 |
CN112596079A (zh) * | 2020-12-22 | 2021-04-02 | 四川九洲电器集团有限责任公司 | 一种目标飞行器的导航闭环欺骗方法及*** |
CN113110553A (zh) * | 2021-04-29 | 2021-07-13 | 惠州中国科学院遥感与数字地球研究所空间信息技术研究院 | 无人机及其航行安全检测方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105242285A (zh) * | 2015-10-15 | 2016-01-13 | 北京航空航天大学 | 一种基于卫星通信的无人机导航数据被欺骗识别方法 |
CN107607965A (zh) * | 2017-08-30 | 2018-01-19 | 桂林电子科技大学 | 一种黑飞无人机导航诱骗***及方法 |
CN108803639A (zh) * | 2018-05-29 | 2018-11-13 | 南京理工大学 | 一种基于反步法的四旋翼飞行器飞行控制方法 |
-
2019
- 2019-09-16 CN CN201910870966.3A patent/CN110609567A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105242285A (zh) * | 2015-10-15 | 2016-01-13 | 北京航空航天大学 | 一种基于卫星通信的无人机导航数据被欺骗识别方法 |
CN107607965A (zh) * | 2017-08-30 | 2018-01-19 | 桂林电子科技大学 | 一种黑飞无人机导航诱骗***及方法 |
CN108803639A (zh) * | 2018-05-29 | 2018-11-13 | 南京理工大学 | 一种基于反步法的四旋翼飞行器飞行控制方法 |
Non-Patent Citations (2)
Title |
---|
YAN GUO 等: "Covert Spoofing Algorithm of UAV Based on GPS/INS-Integrated Navigation", 《IEEE TRANSACTIONS ON VEHICULAR TECHNOLOGY》 * |
郭妍等: "基于 PID 的积分反步法四旋翼飞行器控制设计", 《2018中国自动化大会(CAC2018)论文集》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111580537A (zh) * | 2020-05-28 | 2020-08-25 | 西北工业大学 | 一种无人机特技飞行控制***及方法 |
CN112034733A (zh) * | 2020-08-17 | 2020-12-04 | 广东工业大学 | 一种基于Unity3D的四旋翼无人机城市仿真方法 |
CN112596079A (zh) * | 2020-12-22 | 2021-04-02 | 四川九洲电器集团有限责任公司 | 一种目标飞行器的导航闭环欺骗方法及*** |
CN112596079B (zh) * | 2020-12-22 | 2022-02-01 | 四川九洲电器集团有限责任公司 | 一种目标飞行器的导航闭环欺骗方法及*** |
CN113110553A (zh) * | 2021-04-29 | 2021-07-13 | 惠州中国科学院遥感与数字地球研究所空间信息技术研究院 | 无人机及其航行安全检测方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110609567A (zh) | 一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法 | |
Wang et al. | Robust H∞ attitude tracking control of a quadrotor UAV on SO (3) via variation-based linearization and interval matrix approach | |
CN108153330B (zh) | 基于可行域约束的无人飞行器三维航迹自适应跟踪方法 | |
CN113031642B (zh) | 动态禁飞区约束的高超声速飞行器轨迹规划方法和*** | |
CN111881518A (zh) | 一种智能的高超声速飞行器再入机动制导方法及*** | |
CN108196570A (zh) | 一种无人机航向修正方法、装置和无人机 | |
Hui et al. | Dynamic attack zone of air-to-air missile after being launched in random wind field | |
CN110908288A (zh) | 一种基于障碍Lyapunov函数的无人机地速约束抗扰控制方法 | |
CN114489094A (zh) | 一种基于加速度反馈增强的旋翼无人机抗风扰控制方法 | |
CN109308074B (zh) | 一种无人机重心偏移的补偿方法及*** | |
Oktay et al. | Dynamic Modeling and Simulation of Quadcopter for Several Flight Conditions | |
CN115016514A (zh) | 仿生扑翼飞行器的起飞、巡航及降落全自主飞行控制方法 | |
CN108205321A (zh) | 滑跑纠偏控制方法及相关装置 | |
Mao et al. | An improved nonlinear guidance law for unmanned aerial vehicles path following | |
CN110895418A (zh) | 补偿舵机动力学滞后的低速旋转飞行器控制方法及*** | |
CN116974208B (zh) | 基于捷联导引头的旋翼无人机目标打击控制方法及*** | |
CN117270402B (zh) | 一种适用于极端风场的无人机复合抗扰航迹跟踪控制方法 | |
CN107272736B (zh) | 一种基于鸽子被动式避障飞行的无人机避障导引方法 | |
CN113625730A (zh) | 一种基于超扭滑模的四旋翼自适应容错控制方法 | |
CN107942672A (zh) | 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 | |
CN107796401A (zh) | 跳跃式再入飞行器线性伪谱参数修正横向制导方法 | |
Chen et al. | Model of UAV and downwash for multi-UAV path planning | |
CN108107726B (zh) | 一种基于对称时变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 | |
CN115344056A (zh) | 一种复杂操纵面飞机的智能飞行控制方法及应用 | |
CN112433473B (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 |