CN105242285B - 一种基于卫星通信的无人机导航数据被欺骗识别方法 - Google Patents
一种基于卫星通信的无人机导航数据被欺骗识别方法 Download PDFInfo
- Publication number
- CN105242285B CN105242285B CN201510666815.8A CN201510666815A CN105242285B CN 105242285 B CN105242285 B CN 105242285B CN 201510666815 A CN201510666815 A CN 201510666815A CN 105242285 B CN105242285 B CN 105242285B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- msup
- aircraft
- 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
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/21—Interference related issues ; Issues related to cross-correlation, spoofing or other methods of denial of service
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
Abstract
本发明公开了一种基于卫星通信的无人机导航数据被欺骗识别方法,包括步骤一:建立与无人机相关的地心坐标系、机体坐标系统、大地坐标系;步骤二:获得坐标系之间的变换关系;步骤三:根据无人机天线跟踪误差电压跟踪卫星得到卫星在机体坐标下的方位角和俯仰角;步骤四:根据惯性导航测量的机体的方位角、俯仰角、横滚角,计算卫星在飞机所在点大地坐标系统下的大地方位角和俯仰角;步骤五:根据卫星在飞机所在点大地坐标系统下的大地方位角和俯仰角,反推出飞机所在的经度和纬度θLat;本方法利用已有的卫星通信系统就可以进行导航数据被欺骗进行识别,无需要增加其它辅助设备。
Description
技术领域
本发明涉及一种基于卫星通信的无人机导航数据被欺骗识别方法,属于无人机导航抗欺骗技术领域。
背景技术
无人机属于智能设备,由于没有人在无人机上,地面完全靠接收机载的导航数据来判定无人机的具体位置,常用的无人机采用惯性导航+卫星导航相结合的方式进行导航。可以利用惯性导航的不易受干扰和卫星导航的高精度的特点,提供高精度、稳定的位置导航数据。如果机载的导航数据受到欺骗式干扰,如干扰机载的卫星导航数据,当干扰采用渐进式干扰时,即使是采用了组合导航的惯导也无法区分是由于无人机的飞行导致的位置变化,还是由于受到了欺骗干扰导致的位置偏差。导航系统受到干扰后,地面将无法知道飞机的准确位置,可能地面人员看到飞机是往本场着陆飞行,实际上飞机已经远离本场降落到其它机场,在地面上如何识别导航是否被欺骗是必须要解决的问题。
发明内容
本发明的目的是为了解决上述问题,判断在地面识别导航数据是否受到欺骗,从而采取相应的措施,是一种基于卫星通信的无人机导航数据被欺骗识别方法。
一种基于卫星通信的无人机导航数据被欺骗识别方法,包括以下几个步骤:
步骤一:建立与无人机相关的地心坐标系、机体坐标系统、大地坐标系;
步骤二:获得坐标系之间的变换关系;
步骤三:根据无人机天线跟踪误差电压跟踪卫星得到卫星在机体坐标下的方位角和俯仰角;
步骤四:根据惯性导航测量的机体的方位角、俯仰角、横滚角,计算卫星在飞机所在点大地坐标系统下的大地方位角和俯仰角;
步骤五:根据卫星在飞机所在点大地坐标系统下的大地方位角和俯仰角,反推出飞机所在的经度和纬度θLat;
本发明的优点在于:
(1)本方法可以利用已有的卫星通信系统就可以进行导航数据被欺骗进行识别,无需要增加其它辅助设备;
(2)本方法对位置误差进行了分析,并通过实际飞行数据验证:通过卫星通信推算的导航数据平均误差为27.76km,精度满足导航数据欺骗识别要求。
附图说明
图1是本发明的方法流程图;
图2是本发明的地心坐标系示意图;
图3是本发明的大地坐标系示意图;
图4是本发明的机体坐标示意图;
图5是本发明的地心坐标系到大地坐标系之间的变换关系示意图;
图6是本发明的某无人机飞行试验中实际经度和推算经度示意图;
图7是本发明的某无人机飞行试验中实际纬度和推算纬度示意图;
图8是本发明的某无人机飞行试验中总误差比较示意图;
具体实施方式
下面将结合附图和实施例对本发明作进一步的详细说明。
本发明是一种基于卫星通信的无人机导航数据被欺骗识别方法,如图1所示,包括以下几个步骤:
步骤一:建立与无人机相关的地心坐标系、机体坐标系统、大地坐标系;
设飞机的经度和纬度分别为θLatJ,卫星的经度地球半径Re,飞机到地面的高度为h,卫星到地面的高度为H,卫星到飞机的距离为D。
设地心坐标系为O(xe,ye,ze),如图2所示,其中,Oe原点为地球的中心,xe轴过地球中心指向真北方向,ye轴过地球中心指向正东方向,在赤道平面内,ze轴与xeye轴成右手关系。
设大地坐标系为O(xg,yg,zg),如图3所示,其中,O原点为地球质心,xg轴过地球质心水平指向真北方向,yg轴过地球质心,指向正东方向,zg轴过地球质心,指向地心方向,与xgyg轴成右手关系,其中xgoyg为水平面,xgozg为垂直面。
设机体坐标系为O(xj,yj,zj),如图4所示,其中,O原点为机体重心,xj轴过质心的机体滚动轴线,飞行方向为正(横滚轴);yj轴在机体机翼水平面内,指向右边,zj轴在飞机水平对称平面内,与xjyj轴成右手关系。
步骤二:获得坐标系之间的变换关系;
机体相对大地坐标系下的角度定义为:
偏航角为机体oxj轴在大地坐标系xgoyg水平面的投影与oxg的夹角,自真北起顺时针方向为正,与oxj构成右手旋,范围[0,360°];
俯仰角θ为机体oxj轴与大地坐标系xgoyg水平面内的投影之间的夹角,以机头抬高为正,与oyj构成右手旋,范围[-90°,90°];
横滚角φ为机体ozj轴与大地坐标系xgozg垂直面之间的夹角,右侧下降为正,与oxj构成右手旋,范围[-90°,90°]。
图5为本发明涉及的地心坐标系到大地坐标系之间的变换关系示意图。
大地坐标与机体坐标之间的转换关系为:
其中,表示机体坐标下的一个向量,表示大地坐标坐标下的一个向量,为从大地坐标系到机体坐标系的旋转矩阵,具体为:
机体坐标与大地坐标之间的转换关系为:
其中:为从机体坐标系到大地坐标系的旋转矩阵,具体为:
飞机所在点大地坐标与地心坐标之间的转换关系为:
其中:表示地心坐标下的一个向量,飞机所在的点在大地坐标系位置的经度和纬度分别为θLat,地球半径为R,飞机的高度为h,为从地心坐标系到飞机所在点的大地坐标系的旋转矩阵。
步骤三:根据无人机天线跟踪误差电压跟踪卫星得到卫星在机体坐标下的方位角和俯仰角;
设卫星在大地坐标系中的方位、俯仰角为AgS和EgS,卫星在机体坐标系中方位、俯仰角为AjS和EjS,飞机姿态角为偏航角俯仰角θ、横滚角φ,D为卫星到飞机之间的距离,卫星在机体坐标下的方位角、俯仰角为AjS和EjS:
其中,XgS为卫星在飞机所在点大地坐标系下的坐标,XjS为卫星在机体坐标系下的坐标,将(7)(8)式代入(1)式,得:
通过上式可以计算出卫星在机体坐标系下方位角AjS和俯仰角EjS。
步骤四:根据惯性导航测量的机体的方位角、俯仰角、横滚角,计算卫星在飞机所在点大地坐标系统下的大地方位角和俯仰角;
已知卫星在机体坐标系中方位、俯仰角为AjS和EjS及飞机的偏航角俯仰角θ、横滚角φ,将(7)(8)式代入(3)式,得:
通过上式可以计算出卫星在飞机所在点大地坐标系统下的大地方位角AgS和俯仰角EgS。
步骤五:根据卫星在飞机所在点大地坐标系统下的大地方位角和俯仰角,反推出飞机所在的经度和纬度θLat;
卫星在飞机所在点大地坐标系统下的大地方位角AgS和俯仰角EgS与飞机的坐标位置之间的关系:
假设卫星的经度为卫星到地面的高度为H,则卫星在地心坐标系下的坐标XeS为:
卫星在飞机所在点的大地坐标系下的坐标XgS为:
飞机位置点在地心坐标系下的坐标A为:
由飞机所在点大地坐标与地心坐标之间的转换关系得:
由上式得:因为:
得到:
由已得知的AgS、EgS、反推出飞机经度、纬度和θLat:
设由式(20)化简得:
由公式(21)简化得到:
设
则公式(23)简化为:cosθ2 Latcos2λ=1-T2
同理由公式(22)简化得到:(tan2EgS+1)T2+2H'tanEgST+(H'2-1)=0 (24)
则公式(24)简化为:
由公式(23)(24)结合计算得到飞机经度和纬度θLat:
图6为本发明系统在某无人机飞行试验中实际经度和推算经度示意图;
其中,横轴代表时间,单位为秒;纵轴代表经度,单位为度;平滑轨迹为飞机实际经度轨迹;点画线曲线为本方法推算出经度轨迹。
图7为本发明系统在某无人机飞行试验中实际纬度和推算纬度示意图;
其中,横轴代表时间,单位为秒;纵轴代表纬度,单位为度;平滑轨迹为飞机实际纬度轨迹;点画线曲线为本方法推算出纬度轨迹。
步骤六:通过实际飞行数据,根据计算出的飞机的经纬度和导航下传的经纬度进行比较,验证本方法导航数据欺骗识别技术的有效性。
由于机载天线跟踪误差以及天线波束有一定宽度,即使天线主波束没有正对准卫星时,也可以进行信息传输,这种情况将会影响AjS和EjS的精度;另外一方面由于无人机平台的惯性测量部件测量的飞机机体方位角俯仰角θ、横滚角φ存在误差,也可能导致推算出的无人机位置存在误差。以某无人机实际飞行数据为例,将无人机导航系统给出的位置数据和根据卫星的大地角数据推算出的飞机的位置数据进行了比对实验。推算出的位置误差平均值27.76km,标准差:10.74,最大值:80km。实验表明:当导航未受到干扰时,推算出的经纬度在实际经纬度上下变化,如果受到欺骗后,得到的误差将会是单向变化。
图8为本发明系统在某无人机飞行试验中总误差比较示意图,其中,横轴代表时间,单位为秒;纵轴代表总误差,单位为千米;如图8所示曲线为本方法计算出的飞机的经纬度和导航下传的经纬度进行比较得到的总误差曲线。
Claims (1)
1.一种基于卫星通信的无人机导航数据被欺骗识别方法,包括以下几个步骤:
步骤一:建立与无人机相关的地心坐标系、机体坐标系统、大地坐标系;
设飞机经度为飞机纬度为θLatJ,卫星经度为地球半径为Re,飞机到地面的高度为h,卫星到地面的高度为H,卫星到飞机的距离为D;
设地心坐标系为O(xe,ye,ze),原点Oe为地球的中心,xe轴过地球中心指向真北方向,ye轴过地球中心指向正东方向,在赤道平面内,ze轴与xeye轴成右手关系;
设大地坐标系为O(xg,yg,zg),原点Og为地球质心,xg轴过地球质心水平指向真北方向,yg轴过地球质心,指向正东方向,zg轴过地球质心,指向地心方向,与xgyg轴成右手关系,其中xgogyg为水平面,xgogzg为垂直面;
设机体坐标系为O(xj,yj,zj),原点Oj为机体重心,xj轴过质心的机体滚动轴线,飞行方向为正;yj轴在机体机翼水平面内,指向右边,zj轴在飞机水平对称平面内,与xjyj轴成右手关系;
步骤二:获得坐标系之间的变换关系;
机体相对大地坐标系下的角度定义为:
偏航角为机体ojxj轴在大地坐标系xgogyg水平面的投影与ogxg的夹角,自真北起顺时针方向为正,与ojxj构成右手旋,范围[0,360°];
俯仰角θ为机体ojxj轴与大地坐标系xgogyg水平面内的投影之间的夹角,以机头抬高为正,与ojyj构成右手旋,范围[-90°,90°];
横滚角φ为机体ojzj轴与大地坐标系xgogzg垂直面之间的夹角,右侧下降为正,与ojxj构成右手旋,范围[-90°,90°];
大地坐标与机体坐标之间的转换关系为:
<mrow>
<msub>
<mi>x</mi>
<mi>j</mi>
</msub>
<mo>=</mo>
<msubsup>
<mi>T</mi>
<mi>g</mi>
<mi>j</mi>
</msubsup>
<msub>
<mi>x</mi>
<mi>g</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,表示机体坐标下的一个向量,表示大地坐标坐标下的一个向量,为从大地坐标系到机体坐标系的旋转矩阵,具体为:
机体坐标与大地坐标之间的转换关系为:
<mrow>
<msub>
<mi>x</mi>
<mi>g</mi>
</msub>
<mo>=</mo>
<msubsup>
<mi>T</mi>
<mi>j</mi>
<mi>g</mi>
</msubsup>
<msub>
<mi>x</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
其中:为从机体坐标系到大地坐标系的旋转矩阵,具体为:
飞机所在点大地坐标与地心坐标之间的转换关系为:
<mrow>
<msub>
<mi>x</mi>
<mi>g</mi>
</msub>
<mo>=</mo>
<msubsup>
<mi>T</mi>
<mi>e</mi>
<mi>g</mi>
</msubsup>
<msub>
<mi>x</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
其中:表示地心坐标下的一个向量,飞机所在的点在大地坐标系位置的经度和纬度分别为θLat,地球半径为R,飞机的高度为h,为从地心坐标系到飞机所在点的大地坐标系的旋转矩阵;
步骤三:根据无人机天线跟踪误差电压跟踪卫星得到卫星在机体坐标下的方位角和俯仰角;
设卫星在大地坐标系中的方位、俯仰角为AgS和EgS,卫星在机体坐标系中方位、俯仰角为AjS和EjS,飞机姿态角为偏航角俯仰角θ、横滚角φ,D为卫星到飞机之间的距离,:
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>D</mi>
<mi> </mi>
<mi>cos</mi>
<mi> </mi>
<msub>
<mi>E</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<mi>cos</mi>
<mi> </mi>
<msub>
<mi>A</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>D</mi>
<mi> </mi>
<mi>cos</mi>
<mi> </mi>
<msub>
<mi>E</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<mi>sin</mi>
<mi> </mi>
<msub>
<mi>A</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>D</mi>
<mi> </mi>
<mi>sin</mi>
<mi> </mi>
<msub>
<mi>E</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>D</mi>
<mi> </mi>
<mi>cos</mi>
<mi> </mi>
<msub>
<mi>E</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
<mi>cos</mi>
<mi> </mi>
<msub>
<mi>A</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>D</mi>
<mi> </mi>
<mi>cos</mi>
<mi> </mi>
<msub>
<mi>E</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
<mi>sin</mi>
<mi> </mi>
<msub>
<mi>A</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>D</mi>
<mi> </mi>
<mi>sin</mi>
<mi> </mi>
<msub>
<mi>E</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,XgS为卫星在飞机所在点大地坐标系下的坐标,XjS为卫星在机体坐标系下的坐标,将(7)(8)式代入(1)式,得:
通过上式计算出卫星在机体坐标系下方位角AjS和俯仰角EjS;
<mrow>
<msub>
<mi>A</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>=</mo>
<msup>
<mi>tg</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfrac>
<msub>
<mi>y</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
<msub>
<mi>x</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
</mfrac>
<mo>,</mo>
<msub>
<mi>E</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>=</mo>
<msup>
<mi>tan</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfrac>
<msub>
<mi>z</mi>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
<msqrt>
<mrow>
<msub>
<msup>
<mi>x</mi>
<mn>2</mn>
</msup>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<msup>
<mi>y</mi>
<mn>2</mn>
</msup>
<mrow>
<mi>j</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</msqrt>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
2
步骤四:根据惯性导航测量的机体的方位角、俯仰角、横滚角,计算卫星在飞机所在点大地坐标系统下的大地方位角和俯仰角;
已知卫星在机体坐标系中方位、俯仰角为AjS和EjS及飞机的偏航角俯仰角θ、横滚角φ,将(7)(8)式代入(3)式,得:
通过上式计算出卫星在飞机所在点大地坐标系统下的大地方位角AgS和俯仰角EgS;
<mrow>
<msub>
<mi>A</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>=</mo>
<msup>
<mi>tg</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfrac>
<msub>
<mi>y</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<msub>
<mi>x</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
</mfrac>
<mo>,</mo>
<msub>
<mi>E</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>tan</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfrac>
<msub>
<mi>z</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<msqrt>
<mrow>
<msub>
<msup>
<mi>x</mi>
<mn>2</mn>
</msup>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<msup>
<mi>y</mi>
<mn>2</mn>
</msup>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
</mrow>
</msqrt>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
步骤五:根据卫星在飞机所在点大地坐标系统下的大地方位角和俯仰角,反推出飞机所在的经度和纬度θLat;
卫星在飞机所在点大地坐标系统下的大地方位角AgS和俯仰角EgS与飞机的坐标位置之间的关系:
假设卫星的经度为卫星到地面的高度为H,则卫星在地心坐标系下的坐标XeS为:
卫星在飞机所在点的大地坐标系下的坐标XgS为:
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>x</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>y</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
飞机位置点在地心坐标系下的坐标A为:
由飞机所在点大地坐标与地心坐标之间的转换关系得:
<mrow>
<msub>
<mi>x</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>=</mo>
<msubsup>
<mi>T</mi>
<mi>e</mi>
<mi>g</mi>
</msubsup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<mi>A</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msubsup>
<mi>T</mi>
<mi>e</mi>
<mi>g</mi>
</msubsup>
<msub>
<mi>x</mi>
<mi>e</mi>
</msub>
<mo>-</mo>
<msubsup>
<mi>T</mi>
<mi>e</mi>
<mi>g</mi>
</msubsup>
<mi>A</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
由上式得:
因为:
得到:
由已得知的AgS、EgS、反推出飞机经度、纬度和θLat:
设由式(20)化简得:
<mrow>
<msub>
<mi>A</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>=</mo>
<msup>
<mi>tg</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfrac>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&lambda;</mi>
</mrow>
<mrow>
<msub>
<mi>sin&theta;</mi>
<mrow>
<mi>L</mi>
<mi>a</mi>
<mi>t</mi>
</mrow>
</msub>
</mrow>
</mfrac>
<mo>=</mo>
<msup>
<mi>sin</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfrac>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&lambda;</mi>
</mrow>
<msqrt>
<mrow>
<mn>1</mn>
<mo>-</mo>
<msub>
<msup>
<mi>cos&theta;</mi>
<mn>2</mn>
</msup>
<mrow>
<mi>L</mi>
<mi>a</mi>
<mi>t</mi>
</mrow>
</msub>
<msup>
<mi>cos</mi>
<mn>2</mn>
</msup>
<mi>&lambda;</mi>
</mrow>
</msqrt>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>21</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>E</mi>
<mrow>
<mi>g</mi>
<mi>S</mi>
</mrow>
</msub>
<mo>=</mo>
<msup>
<mi>tan</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mfrac>
<mrow>
<msub>
<mi>cos&theta;</mi>
<mrow>
<mi>L</mi>
<mi>a</mi>
<mi>t</mi>
</mrow>
</msub>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&lambda;</mi>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>R</mi>
<mo>+</mo>
<mi>h</mi>
<mo>)</mo>
</mrow>
<mo>/</mo>
<mrow>
<mo>(</mo>
<mi>R</mi>
<mo>+</mo>
<mi>H</mi>
<mo>)</mo>
</mrow>
</mrow>
<msqrt>
<mrow>
<mn>1</mn>
<mo>-</mo>
<msub>
<msup>
<mi>cos&theta;</mi>
<mn>2</mn>
</msup>
<mrow>
<mi>L</mi>
<mi>a</mi>
<mi>t</mi>
</mrow>
</msub>
<msup>
<mi>cos</mi>
<mn>2</mn>
</msup>
<mi>&lambda;</mi>
</mrow>
</msqrt>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>22</mn>
<mo>)</mo>
</mrow>
</mrow>
由公式(21)简化得到:
设
则公式(23)简化为:cosθ2 Latcos2λ=1-T2
同理由公式(22)简化得到:(tan2EgS+1)T2+2H'tanEgST+(H'2-1)=0 (24)
则公式(24)简化为:
由公式(23)(24)结合计算得到飞机经度和纬度θLat:
步骤六:根据计算出的飞机的经纬度和导航下传的经纬度进行比较,如果两者值大于一定范围,或者误差单调变化则认为是受到欺骗。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510666815.8A CN105242285B (zh) | 2015-10-15 | 2015-10-15 | 一种基于卫星通信的无人机导航数据被欺骗识别方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510666815.8A CN105242285B (zh) | 2015-10-15 | 2015-10-15 | 一种基于卫星通信的无人机导航数据被欺骗识别方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105242285A CN105242285A (zh) | 2016-01-13 |
CN105242285B true CN105242285B (zh) | 2017-11-07 |
Family
ID=55039987
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510666815.8A Active CN105242285B (zh) | 2015-10-15 | 2015-10-15 | 一种基于卫星通信的无人机导航数据被欺骗识别方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105242285B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107544074B (zh) * | 2016-06-28 | 2020-08-28 | 东北大学 | 一种无人机识别虚假gps信号的方法 |
CN107665183B (zh) * | 2017-09-26 | 2021-02-12 | 北京电子工程总体研究所 | 一种异形装备车辆上两点位置换算方法 |
CN107783155A (zh) * | 2017-10-19 | 2018-03-09 | 杨锐 | 一种低成本无人机抗诱捕导航系统 |
CN107976690B (zh) * | 2017-11-17 | 2021-04-30 | 西安电子科技大学 | 一种智能协同环境下的多无人机抗gps欺骗方法 |
CN108801250B (zh) * | 2018-05-07 | 2021-11-26 | 约肯机器人(上海)有限公司 | 基于水下机器人的实时姿态获取方法及装置 |
CN111064002B (zh) * | 2018-10-16 | 2021-04-23 | 正成集团科技有限公司 | 一种低剖面卫星通信天线的伺服控制方法 |
CN109782789B (zh) * | 2019-03-27 | 2022-03-04 | 河南机电职业学院 | 一种无人机在卫星导航数据失效后的安全飞行控制方法 |
CN110412555B (zh) * | 2019-07-20 | 2022-05-17 | 中国船舶重工集团公司第七二四研究所 | 一种基于黎曼曲面的空中目标指示修正方法 |
CN110609567A (zh) * | 2019-09-16 | 2019-12-24 | 中国人民解放军国防科技大学 | 一种面向四旋翼无人机的卫星惯性组合导航终端欺骗方法 |
CN111308514B (zh) * | 2020-04-01 | 2024-01-09 | 湖南航天电子科技有限公司 | 一种无线同步通信网络中的卫星导航欺骗检测方法 |
CN111366950B (zh) * | 2020-05-31 | 2020-08-28 | 湖南跨线桥航天科技有限公司 | 卫星导航压制式干扰与欺骗干扰的综合检测方法及系统 |
CN111609849B (zh) * | 2020-06-08 | 2021-11-02 | 北京环境特性研究所 | 一种多站交会定位方法和系统 |
CN114282166B (zh) * | 2021-12-22 | 2024-04-19 | 中国西安卫星测控中心 | 基于环境函数矩阵的卫星经度计算方法、变轨判别方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6167347A (en) * | 1998-11-04 | 2000-12-26 | Lin; Ching-Fang | Vehicle positioning method and system thereof |
US6253125B1 (en) * | 2000-03-01 | 2001-06-26 | Space Systems/Loral, Inc. | Method and apparatus for generating orbital data |
US6483458B1 (en) * | 2001-05-30 | 2002-11-19 | The Boeing Company | Method for accurately tracking and communicating with a satellite from a mobile platform |
CN101598556B (zh) * | 2009-07-15 | 2011-05-04 | 北京航空航天大学 | 一种未知环境下无人机视觉/惯性组合导航方法 |
CN103852077B (zh) * | 2014-03-19 | 2017-01-11 | 北京航空航天大学 | 链路失效时无人机定位信息防欺骗自主判断方法 |
-
2015
- 2015-10-15 CN CN201510666815.8A patent/CN105242285B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105242285A (zh) | 2016-01-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105242285B (zh) | 一种基于卫星通信的无人机导航数据被欺骗识别方法 | |
CN103347785B (zh) | 一种无人机自动回收方法 | |
CN105698762A (zh) | 一种单机航迹上基于不同时刻观测点的目标快速定位方法 | |
ES2817699T3 (es) | Procedimiento automático de asistencia al aterrizaje de una aeronave | |
CA2857195C (en) | Wind calculation system using constant bank angle turn | |
CN108061889B (zh) | Ais与雷达角度系统偏差的关联方法 | |
CN104655135B (zh) | 一种基于地标识别的飞行器视觉导航方法 | |
CN102958805B (zh) | 显示装置、操纵支援系统以及显示方法 | |
CN101266150B (zh) | 一种无人机侧向领航方法 | |
US10866593B2 (en) | Aerial vehicle landing method, ground control system, and flight control system | |
CN106249755B (zh) | 一种无人机自主导航系统及导航方法 | |
CN106595668A (zh) | 一种用于光电吊舱的无源定位算法 | |
Huh et al. | A vision-based landing system for small unmanned aerial vehicles using an airbag | |
CN103176476A (zh) | 一种滑翔式无人机自主进场航路规划方法 | |
Chen et al. | An auto-landing strategy based on pan-tilt based visual servoing for unmanned aerial vehicle in GNSS-denied environments | |
CN109782789B (zh) | 一种无人机在卫星导航数据失效后的安全飞行控制方法 | |
JP7190699B2 (ja) | 飛行システム及び着陸制御方法 | |
BR112017019551B1 (pt) | Processo de assistência automática à aterrissagem de uma aeronave, mídia legível por computador e sistema de assistência automática à aterrissagem de uma aeronave | |
CN106339007A (zh) | 一种基于无人机位置预测的视距链路定向天线纠偏方法 | |
CN106885573A (zh) | 面向四旋翼飞行器的运动捕捉系统实时测姿方法 | |
CN103529852A (zh) | 一种基于双卫星接收机的无人机寻的回收导引控制方法 | |
CN108255190A (zh) | 基于多传感器的精确着陆方法及使用该方法的系留无人机 | |
CN102375150A (zh) | 一种航空喷药机gps短时自差分导航方法及装置 | |
CN106155081A (zh) | 一种旋翼无人机大范围目标监测和精确定位方法 | |
CN110243377A (zh) | 一种基于分层式结构的集群飞行器协同导航方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into 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 |
Application publication date: 20160113 Assignee: Beijing northern sky long hawk UAV Technology Co.,Ltd. Assignor: BEIHANG University Contract record no.: X2021990000039 Denomination of invention: A deception recognition method of UAV navigation data based on satellite communication Granted publication date: 20171107 License type: Exclusive License Record date: 20210119 |
|
EE01 | Entry into force of recordation of patent licensing contract |