CN104655135B - 一种基于地标识别的飞行器视觉导航方法 - Google Patents
一种基于地标识别的飞行器视觉导航方法 Download PDFInfo
- Publication number
- CN104655135B CN104655135B CN201510084399.0A CN201510084399A CN104655135B CN 104655135 B CN104655135 B CN 104655135B CN 201510084399 A CN201510084399 A CN 201510084399A CN 104655135 B CN104655135 B CN 104655135B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- mtr
- msubsup
- 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
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
- G01C11/04—Interpretation of pictures
- G01C11/06—Interpretation of pictures by comparison of two or more pictures of the same area
- G01C11/08—Interpretation of pictures by comparison of two or more pictures of the same area the pictures not being supported in the same relative position as when they were taken
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Abstract
本发明公开了一种基于地标识别的飞行器视觉导航方法,属于飞行器视觉导航领域。该方法具体包括:通过对成像传感器采集待处理图像序列中的地标进行识别,利用序列图像中相邻两帧图像中识别出的地标位置和飞行器的飞行参数信息解算出地标到当前帧图像对应的飞行器的距离,进而解算出飞行器在地球坐标系下的坐标信息;最后,根据解算出的飞行器在地球坐标系下的坐标信息和飞行器的规划的航迹进行航迹校正。本发明在成像制导、飞行器视觉导航等方面提供了技术支撑,该发明具有可靠性好、实用价值高等特点。
Description
技术领域
本发明涉及一种基于地标识别的飞行器视觉导航方法,属于计算机视觉与航空航天的技术领域。
背景技术
飞行器的精确导航一直是各国航空航天技术领域的重要研究课题之一。目前在制导中采用捷联惯导,其具有制导精度高、完全自主、隐蔽性好、不受气候条件影响、体积小、价格低等特点,但是,其制导误差也是积累性的,随着飞行时间的增长,积累的误差增大。“惯导+GPS”组合导航系统也易受干扰,“惯导+地形匹配”组合导航系统也仅能在有特定地形起伏的区域使用。而本发明能够很好地解决上面的问题。
发明内容
本发明目的在于提供了一种基于地标识别的飞行器视觉导航方法,该方法采用图像匹配导航,能够很好地解决飞行器纯惯性导航中精度不足和惯导系统的误差积累的问题,而且匹配导航也大大提高了飞行器导航精度。该方法主要应用于飞行器的视觉精确导航,通过引入视觉精确导航,能识别出传感器采集图像中的地标位置和飞行器飞行参数信息进行飞行器导航,不需要其他辅助的测距仪器,便可计算出飞行器的空间位置,从而进行飞行器的视觉导航。
方法流程:
步骤1:计算飞行器和地面之间的距离
本发明可以利用当前帧地标的识别结果和相邻帧飞行参数去解算出地标和飞行器之间的距离。设Δx,Δy表示飞行器在空间位置点Pi-1和Pi在地面坐标系下X和Y轴的距离,vx,vy表示飞行器在空间沿X和Y轴的运动速度。和为地标在第(i-1)帧和第i帧的俯仰角和方位角,是地标在第(i-1)帧实时图中的位置。对应第i-1帧成像时的地面坐标系Xi-1Oi-1Yi-1中,沿地标L向Yi-1轴作垂线交于点N,则Pi-1N与Pi-1L之间的夹角为
Pi-1N与Pi-1Oi-1之间的夹角φi-1为
从而可得P′i-1到N的距离P′i-1N为
第(i-1)帧飞行器位置Pi-1到N的距离Pi-1N为
从而求得地标L到Yi-1轴的垂直距离LN为
因此,得到地标L在第(i-1)帧的方位角为
其中,
则
由此可得到地标L在第(i-1)帧的俯仰角为
按同样方法可求出地标L在第i帧的方位角和俯仰角和
其中
根据所求得的和利用飞行参数信息,本发明可进而推算出在当前帧(即第i帧)地标L与飞行器Pi之间的距离li,具体过程如下。已知红外成像器的成像频率为k赫兹,即则可求得飞行器在相邻两帧之间沿X轴的飞行距离,即
不妨,设则,
同理可求得相邻两帧之间沿Y轴的飞行距离:
由上面公式,本发明可以解算出飞行器位置Pi到地标L的距离li为
在得到了li后,需要将其转换到地心坐标系下,再与规划的航迹进行比较,进而进行校正。
步骤2:飞行器在地心坐标系下的坐标解算
为了更精确的解算出飞行器的位置,本发明解决了地球的曲率半径带来的影响问题。通常设地球是个椭球体,地标的经度和纬度为μ,λ,建立以地心为坐标原点的坐标系O-XYZ,简称为地心坐标系。本发明默认选择的地标都是平面地标,则地标L在在地心坐标系下的坐标为:
其中,为椭球的第一离心率,Re为地球的长半径,为地球的扁率。表示表示椭球卯酉圈的曲率半径。
以L为原点建立坐标系L-XYZ(北东天),则矢量在L-XYZ坐标系下的坐标为:
则其在地心坐标系下的坐标为:
其中A为坐标系L-XYZ到地心坐标系O-XYZ的坐标转换矩阵
因此,根据矢量关系可求得在地心坐标系O-XYZ下的坐标为
利用计算出的飞行器在地心坐标系下的坐标下面对航迹进行校正。
步骤3:航迹校正
假设飞行器规划航迹被拟合为函数
f(x,y,z)=0 (21)
当飞行器实际飞行位置存在偏差时,则飞行器位置坐标不能满足上面公式。以第i帧飞行器实际位置为例,则
此时需要对飞行器实际飞行航迹进行校正,具体过程如下。
飞行器的实际飞行位置到规划航迹上任意一点(x,y,z)的距离为:
则可以根据拉格朗日定理,求得规划航迹上离距离最近的点,即求解方程组。
假设求得方程组的解为Qi(xi,yi,zi),且在规划航迹中,设帧频为50赫兹,则可以找到点Qi(xi,yi,zi)的下一个点Qi+1(xi+1,yi+1,zi+1)。如果将规划航迹上的点Qi+1(xi+1,yi+1,zi+1)作为飞行器在实际飞行中的第i+1帧位置,则可求得点Pi到点Qi+1的矢量即
于是可以通过调整各坐标轴方向上的位置误差和进行校正,也可以通过调整的角度误差Δη进行校正,即
其中
为点Qi到点Qi+1的矢量。
本发明主要应用于那些本身具有飞行时间长、飞行高度低和飞行速度低等特点的飞行器。
本发明利用飞行器光电平台上图像成像系统获取外界基准信息,对飞行器惯性导航系统进行误差修正,以实现对飞行器的精确导航,尤其适用于地形起伏不大且具有显著性地标的情况。
有益效果:
1、本发明对飞行器视觉导航领域提供了技术支撑,而且不需要其他辅助测距仪器,导航精度高,可靠性强,具有较强的实用价值。
2、本发明的“惯导+景象匹配”的组合导航系统作为地形匹配的补充。
3、本发明很好地满足了当前飞行器导航的高精度需求,具有可靠性好、实用价值高的特点。
4、本发明为成像制导、飞行器视觉导航等领域提供了技术支撑。
附图说明
图1为本发明的方法流程图。
图2为飞行器的空间位置计算示意图。
图3为飞行器与地标之间的距离在地心坐标系下的解算。
图4为飞行器位置估计误差与测量的俯仰角之间的关系。
具体实施方式
下面结合说明书附图对本发明创造作进一步详细的说明。
实施例一
本发明提供了一种基于地标识别的飞行器视觉导航方法,该方法不需要其他测距和导航设备,只通过视觉成像对飞行器的导航。
本发明是根据发明者利用当前帧地标的识别结果和相邻帧飞行参数去解算出地标和飞行器之间的距离。具体解算过程如下:
记Δx,Δy表示飞行器在空间点Pi-1和Pi在X和Y轴的距离,vx,vy表示飞行器在空间沿X和Y轴的运动速度。和为地标在第(i-1)帧和第i帧的俯仰角和方位角,是地标在第(i-1)帧实时图中的位置。由红外成像器的成像频率k赫兹,可得,进而可以解算出飞行器位置Pi到地标L的距离li为
在得到了li后,需要将其转换到地心坐标系下的位置。
设地球是个椭球体,地标的经度和纬度为μ,λ,建立以地心为坐标原点的坐标系O-XYZ,简称为地心坐标系,其中,为椭球的第一离心率,Re为地球的长半径,为地球的扁率。表示表示椭球卯酉圈的曲率半径,飞行器在地心坐标系O-XYZ下的坐标为
利用计算出的飞行器在地心坐标系下的坐标下面对航迹进行校正。
假设飞行器规划航迹被拟合为函数f(x,y,z)=0,飞行器的实际飞行位置到规划航迹上任意一点(x,y,z)的距离为则可以根据拉格朗日定理,求得规划航迹上离距离最近的点为Qi(xi,yi,zi),且在规划航迹中,设帧频为50赫兹,则可以找到点Qi(xi,yi,zi)的下一个点Qi+1(xi+1,yi+1,zi+1)。如果将规划航迹上的点Qi+1(xi+1,yi+1,zi+1)作为飞行器在实际飞行中的第i+1帧位置,则可求得点Pi到点Qi+1的矢量即于是可以通过调整各坐标轴方向上的位置误差和进行校正,也可以通过调整的角度误差Δη进行校正,即其中为点Qi到点Qi+1的矢量。
本发明对飞行器的位置进行解算,具体包括如下步骤:
(1)计算飞行器和地面之间的距离
如图2所示,本发明利用当前帧地标的识别结果和相邻帧飞行参数去解算出地标和飞行器之间的距离,飞行器的空间位置计算示意图,包括:
记Δx,Δy表示飞行器在空间点Pi-1和Pi在X和Y轴的距离,Vx,Vy表示飞行器在空间沿X和Y轴的运动速度。和为地标在第(i-1)帧和第i帧的俯仰角和方位角,是地标在第(i-1)帧实时图中的位置。由图2可知,在坐标系Xi-1Oi-1Yi-1中,沿地标L向Yi-1轴作垂线交于点N,则Pi-1N与Pi-1L之间的夹角为
Pi-1N与Pi-1Oi-1之间的夹角φi-1为
从而可得P′i-1到N的距离P′i-1N为
第(i-1)帧飞行器位置Pi-1到N的距离Pi-1N为
从而求得地标L到Yi-1轴的垂直距离LN为
因此可以得到地标L在第(i-1)帧的方位角为
其中,
由图2可知,
则
由此可得到地标L在第(i-1)帧的俯仰角为
按同样方法可求出地标L在第i帧的方位角和俯仰角和
其中
根据所求得的和利用飞行参数信息,本发明可进而推算出在第i帧地标L与飞行器Pi之间的距离li,具体过程如下。
已知红外成像器的成像频率为k赫兹,即则可求得飞行器在相邻两帧之间沿X轴的飞行距离,即
不妨,设则,
同理可求得相邻两帧之间沿Y轴的飞行距离:
根据上面公式,本发明可以解算出飞行器位置Pi到地标L的距离li为
在得到了li后,需要将其转换到地心坐标系下,再与规划的航迹进行比较,进而进行校正。
(2)飞行器在地心坐标系下的坐标解算
为了更精确的解算出飞行器的位置,本发明解决了地球的曲率半径带来的影响问题。设地球是个椭球体,地标的经度和纬度为μ,λ,如图3所示,建立以地心为坐标原点的坐标系O-XYZ,简称为地心坐标系。本发明默认选择的地标都是平面地标,则地标L在在地心坐标系下的坐标为:
其中,为椭球的第一离心率,Re为地球的长半径,为地球的扁率。表示表示椭球卯酉圈的曲率半径。
以L为原点建立坐标系L-XYZ(北东天),则矢量在L-XYZ坐标系下的坐标为:
则其在地心坐标系下的坐标为:
其中A为坐标系L-XYZ到地心坐标系O-XYZ的坐标转换矩阵
因此,根据矢量关系可求得在地心坐标系O-XYZ下的坐标为
利用计算出的飞行器在地心坐标系下的坐标下面对航迹进行校正。
(2)航迹校正
假设飞行器规划航迹被拟合为函数
f(x,y,z)=0 (50)
当飞行器实际飞行位置存在偏差时,则飞行器位置坐标不能满足上面公式。以第i帧飞行器实际位置为例,则
此时需要对飞行器实际飞行航迹进行校正,具体过程如下。
飞行器的实际飞行位置到规划航迹上任意一点(x,y,z)的距离为:
则可以根据拉格朗日定理,求得规划航迹上离距离最近的点,即求解方程组。
假设求得方程组的解为Qi(xi,yi,zi),且在规划航迹中,设帧频为50赫兹,则可以找到点Qi(xi,yi,zi)的下一个点Qi+1(xi+1,yi+1,zi+1)。如果将规划航迹上的点Qi+1(xi+1,yi+1,zi+1)作为飞行器在实际飞行中的第i+1帧位置,则可求得点Pi到点Qi+1的矢量即
于是可以通过调整各坐标轴方向上的位置误差和进行校正,也可以通过调整的角度误差Δη进行校正,即
其中
为点Qi到点Qi+1的矢量。
(3)飞行器位置解算误差分析
飞行器位置解算误差主要与姿态角测量数据误差有关,其它测量数据误差,其性质也可等效为姿态角测量数据误差。通常只利用角度数据去估计斜距。因此,本发明也只给出测量俯仰角的误差对算法进行性能分析。
图4给出了飞行高度为1500米,对应的俯仰角误差分别为0.3°,0.6°,1.0°和1.5°时飞行器位置估计误差与测量的俯仰角之间的关系。由图可见,在相同俯仰角情况下,俯仰角误差越大,飞行器位置估计误差越大;在相同俯仰角误差情况下,随着俯仰角的增大,飞行器的空间位置估计误差越小。
实施例二
如图1所示,本发明提供了一种基于地标识别的飞行器视觉导航方法,该方法包括如下步骤:
步骤1:计算飞行器和地面之间的距离;
利用当前帧地标的识别结果和相邻帧飞行参数去解算出地标和飞行器之间的距离;已知成像器的成像频率为k赫兹,则设Δx,Δy表示飞行器在空间位置点Pi-1和Pi在地面坐标系下X和Y轴的距离,vx,vy表示飞行器在空间沿X和Y轴的运动速度,和为地标在第(i-1)帧和第i帧的俯仰角和方位角,解算出飞行器位置Pi到地标L的距离li为:
在得到了li后,将其转换到地心坐标系下,再与规划的航迹进行比较,进而进行校正;
步骤2:飞行器在地心坐标系下的坐标解算;
默认选择的地标都是平面地标,根据飞行器在空间位置点Pi的坐标转换关系,可得到飞行器在Pi位置下地心坐标系的坐标为:
利用计算出的飞行器在地心坐标系下的坐标再对航迹进行校正;
步骤3:航迹校正;
如果将规划航迹上的点Qi+1(xi+1,yi+1,zi+1)作为飞行器在实际飞行中的第i+1帧位置,则点Pi到点Qi+1的矢量为通过调整各坐标轴方向上的位置误差和进行校正,也可以通过调整的角度误差Δη进行校正,即
其中,为点Qi到点Qi+1的矢量。
上述本发明的飞行器位置解算过程,包括如下步骤:
利用当前帧地标的识别结果和相邻帧飞行参数去解算出地标和飞行器之间的距离;
记Δx,Δy表示飞行器在空间点Pi-1和Pi在X和Y轴的距离,vx,vy表示飞行器在空间沿X和Y轴的运动速度,和为地标在第(i-1)帧和第i帧的俯仰角和方位角,是地标在第(i-1)帧实时图中的位置;在坐标系Xi-1Oi-1Yi-1中,沿地标L向Yi-1轴作垂线交于点N,则Pi-1N与Pi-1L之间的夹角为
Pi-1N与Pi-1Oi-1之间的夹角φi-1为
从而可得P′i-1到N的距离P′i-1N为
第(i-1)帧飞行器位置Pi-1到N的距离Pi-1N为
从而求得地标L到Yi-1轴的垂直距离LN为
因此得到地标L在第(i-1)帧的方位角为
其中,
得到:
则
由此可得到地标L在第(i-1)帧的俯仰角为
按同样方法可求出地标L在第i帧的方位角和俯仰角和
其中
根据所求得的和利用飞行参数信息,进而推算出在第i帧地标L与飞行器Pi之间的距离li,包括:
已知红外成像器的成像频率为k赫兹,即则可求得飞行器在相邻两帧之间沿X轴的飞行距离,即
不妨,设则,
同理可求得相邻两帧之间沿Y轴的飞行距离:
由上面公式,解算出飞行器位置Pi到地标L的距离li为:
在得到了li后,需要将其转换到地心坐标系下,再与规划的航迹进行比较,进而进行校正。
以上所述仅为本发明的实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.一种基于地标识别的飞行器视觉导航方法,其特征在于,所述方法采用图像匹配导航,应用于飞行器的视觉精确导航,通过引入视觉精确导航,识别出传感器采集图像中的地标位置和飞行器飞行参数信息,不需要其他辅助的测距仪器,便可计算出飞行器的空间位置,从而进行飞行器的视觉导航,利用飞行器光电平台上图像成像系统获取外界基准信息,对飞行器惯性导航系统进行误差修正,包括如下步骤:
步骤1:计算飞行器和地面之间的距离;
利用当前帧地标的识别结果和相邻帧飞行参数去解算出地标和飞行器之间的距离;已知成像器的成像频率为k赫兹,则设Δx,Δy表示飞行器在空间位置点Pi-1和Pi在地面坐标系下X和Y轴的距离,vx,vy表示飞行器在空间沿X和Y轴的运动速度,和为地标在第i-1帧和第i帧的俯仰角和方位角,解算出飞行器位置Pi到地标L的距离li为:
<mrow>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>v</mi>
<mi>y</mi>
</msub>
<mo>&CenterDot;</mo>
<mi>&Delta;</mi>
<mi>t</mi>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&alpha;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>L</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>v</mi>
<mi>x</mi>
</msub>
<mo>&CenterDot;</mo>
<mi>&Delta;</mi>
<mi>t</mi>
<mo>&CenterDot;</mo>
<msubsup>
<mi>sin&alpha;</mi>
<mi>i</mi>
<mi>L</mi>
</msubsup>
</mrow>
<mrow>
<msubsup>
<mi>cos&theta;</mi>
<mi>i</mi>
<mi>L</mi>
</msubsup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>cos&alpha;</mi>
<mi>i</mi>
<mi>L</mi>
</msubsup>
<msubsup>
<mi>sin&alpha;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>L</mi>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>sin&alpha;</mi>
<mi>i</mi>
<mi>L</mi>
</msubsup>
<msubsup>
<mi>cos&alpha;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>L</mi>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>15</mn>
<mo>)</mo>
</mrow>
</mrow>
在得到了li后,将其转换到地心坐标系下,再与规划的航迹进行比较,进而进行校正;
步骤2:飞行器在地心坐标系下的坐标解算;
设地球是个椭球体,地标的经度和纬度为μ,λ,建立以地心为坐标原点的坐标系O-XYZ,简称为地心坐标系,默认选择的地标都是平面地标,则地标L在在地心坐标系下的坐标为:
<mrow>
<mi>O</mi>
<mi>L</mi>
<mo>=</mo>
<mfenced open = "{" close = "}">
<mtable>
<mtr>
<mtd>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "{" close = "}">
<mtable>
<mtr>
<mtd>
<mi>N</mi>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&mu;</mi>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&lambda;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>N</mi>
<mo>&CenterDot;</mo>
<mi>cos</mi>
<mi>&mu;</mi>
<mo>&CenterDot;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&lambda;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>N</mi>
<mo>&CenterDot;</mo>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msup>
<mi>e</mi>
<mn>2</mn>
</msup>
<mo>)</mo>
<mo>&CenterDot;</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&mu;</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为椭球的第一离心率,Re为地球的长半径,为地球的扁率,表示表示椭球卯酉圈的曲率半径;
以L为原点建立坐标系L-XYZ北东天,则矢量在L-XYZ坐标系下的坐标为:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>x</mi>
<msub>
<mi>P</mi>
<mi>i</mi>
</msub>
<mo>&prime;</mo>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>y</mi>
<msub>
<mi>P</mi>
<mi>i</mi>
</msub>
<mo>&prime;</mo>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>z</mi>
<msub>
<mi>P</mi>
<mi>i</mi>
</msub>
<mo>&prime;</mo>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>sin&theta;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&theta;</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>sin&alpha;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&theta;</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&alpha;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>17</mn>
<mo>)</mo>
</mrow>
</mrow>
则其在地心坐标系下的坐标为:
<mrow>
<mi>A</mi>
<mo>&CenterDot;</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>x</mi>
<msub>
<mi>P</mi>
<mi>i</mi>
</msub>
<mo>&prime;</mo>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>y</mi>
<msub>
<mi>P</mi>
<mi>i</mi>
</msub>
<mo>&prime;</mo>
</msubsup>
</mtd>
</mtr>
<mtr>
<mtd>
<msubsup>
<mi>z</mi>
<msub>
<mi>P</mi>
<mi>i</mi>
</msub>
<mo>&prime;</mo>
</msubsup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&mu;cos&lambda;sin&theta;</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>sin&mu;cos&theta;</mi>
<mi>i</mi>
</msub>
<msub>
<mi>sin&alpha;</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&mu;sin&lambda;cos&theta;</mi>
<mi>i</mi>
</msub>
<msub>
<mi>cos&alpha;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>sin&mu;cos&lambda;sin&theta;</mi>
<mi>i</mi>
</msub>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&mu;sin&theta;</mi>
<mi>i</mi>
</msub>
<msub>
<mi>sin&alpha;</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>sin&mu;sin&lambda;cos&theta;</mi>
<mi>i</mi>
</msub>
<msub>
<mi>cos&alpha;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>sin&lambda;sin&theta;</mi>
<mi>i</mi>
</msub>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&lambda;cos&theta;</mi>
<mi>i</mi>
</msub>
<msub>
<mi>cos&alpha;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>18</mn>
<mo>)</mo>
</mrow>
</mrow>
其中A为坐标系L-XYZ到地心坐标系O-XYZ的坐标转换矩阵:
<mrow>
<mi>A</mi>
<mo>=</mo>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&mu;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&mu;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&mu;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&mu;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>&CenterDot;</mo>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&mu;</mi>
<mi>cos</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&mu;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>cos</mi>
<mi>&mu;</mi>
<mi>sin</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&mu;</mi>
<mi>cos</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&mu;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&mu;</mi>
<mi>sin</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&lambda;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>19</mn>
<mo>)</mo>
</mrow>
</mrow>
默认选择的地标都是平面地标,根据飞行器在空间位置点Pi的坐标转换关系,可得到飞行器在Pi位置下地心坐标系的坐标为:
<mrow>
<msub>
<mover>
<mrow>
<mi>O</mi>
<mi>P</mi>
</mrow>
<mo>&RightArrow;</mo>
</mover>
<mi>i</mi>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>N</mi>
<mi>cos</mi>
<mi>&mu;</mi>
<mi>cos</mi>
<mi>&lambda;</mi>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&mu;cos&lambda;sin&theta;</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>sin&mu;sin&theta;</mi>
<mi>i</mi>
</msub>
<msub>
<mi>sin&alpha;</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&mu;sin&lambda;cos&theta;</mi>
<mi>i</mi>
</msub>
<msub>
<mi>cos&alpha;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>N</mi>
<mi>cos</mi>
<mi>&mu;</mi>
<mi>sin</mi>
<mi>&lambda;</mi>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>sin&mu;cos&lambda;sin&theta;</mi>
<mi>i</mi>
</msub>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&mu;cos&theta;</mi>
<mi>i</mi>
</msub>
<msub>
<mi>sin&alpha;</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>sin&mu;sin&lambda;cos&theta;</mi>
<mi>i</mi>
</msub>
<msub>
<mi>cos&alpha;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>N</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<msup>
<mi>e</mi>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
<mi>sin</mi>
<mi>&mu;</mi>
<mo>+</mo>
<msub>
<mi>L</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>sin&lambda;sin&theta;</mi>
<mi>i</mi>
</msub>
<mo>+</mo>
<msub>
<mi>L</mi>
<mi>i</mi>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>cos&lambda;cos&theta;</mi>
<mi>i</mi>
</msub>
<msub>
<mi>cos&alpha;</mi>
<mi>i</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>20</mn>
<mo>)</mo>
</mrow>
</mrow>
利用计算出的飞行器在地心坐标系下的坐标再对航迹进行校正;
步骤3:航迹校正;
如果将规划航迹上的点Qi+1(xi+1,yi+1,zi+1)作为飞行器在实际飞行中的第i+1帧位置,则点Pi到点Qi+1的矢量为通过调整各坐标轴方向上的位置误差和进行校正,也可以通过调整的角度误差Δη进行校正,即
其中,为点Qi到点Qi+1的矢量;
所述方法的飞行器位置解算过程,包括如下步骤:
利用当前帧地标的识别结果和相邻帧飞行参数去解算出地标和飞行器之间的距离;
记Δx,Δy表示飞行器在空间点Pi-1和Pi在X和Y轴的距离,vx,vy表示飞行器在空间沿X和Y轴的运动速度,和为地标在第i-1帧和第i帧的俯仰角和方位角,是地标在第i-1帧实时图中的位置;在坐标系Xi-1Oi-1Yi-1中,沿地标L向Yi-1轴作垂线交于点N,则Pi-1N与Pi-1L之间的夹角为
Pi-1N与Pi-1Oi-1之间的夹角φi-1为
<mrow>
<msub>
<mi>&phi;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>L</mi>
</msubsup>
<mo>-</mo>
<mfrac>
<mi>C</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<mfrac>
<mi>&phi;</mi>
<mi>C</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
从而可得P'i-1到N的距离P'i-1N为
第i-1帧飞行器位置Pi-1到N的距离Pi-1N为
从而求得地标L到Yi-1轴的垂直距离LN为
<mrow>
<mi>L</mi>
<mi>N</mi>
<mo>=</mo>
<msub>
<mi>P</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mi>N</mi>
<mo>&CenterDot;</mo>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&phi;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<msub>
<mi>h</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&phi;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>&CenterDot;</mo>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&phi;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
因此得到地标L在第i-1帧的方位角为
<mrow>
<msubsup>
<mi>&alpha;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>L</mi>
</msubsup>
<mo>=</mo>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,
得到:
<mrow>
<msubsup>
<mi>P</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>&prime;</mo>
</msubsup>
<mi>L</mi>
<mo>=</mo>
<mfrac>
<mrow>
<msubsup>
<mi>P</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>&prime;</mo>
</msubsup>
<mi>N</mi>
</mrow>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>=</mo>
<mfrac>
<msub>
<mi>h</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
则
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>L</mi>
</msubsup>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfrac>
<msub>
<mi>h</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mrow>
<msubsup>
<mi>P</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>&prime;</mo>
</msubsup>
<msub>
<mi>T</mi>
<mn>0</mn>
</msub>
</mrow>
</mfrac>
<mo>=</mo>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
由此可得到地标L在第i-1帧的俯仰角为
<mrow>
<msubsup>
<mi>&theta;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>L</mi>
</msubsup>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mo>(</mo>
<mrow>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>-</mo>
<msub>
<mi>&beta;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
</mrow>
<mo>)</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
按同样方法可求出地标L在第i帧的方位角和俯仰角和
<mrow>
<msubsup>
<mi>&alpha;</mi>
<mi>i</mi>
<mi>L</mi>
</msubsup>
<mo>=</mo>
<msub>
<mi>&alpha;</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
其中
根据所求得的和利用飞行参数信息,进而推算出在第i帧地标L与飞行器Pi之间的距离li,包括:
已知红外成像器的成像频率为k赫兹,即则可求得飞行器在相邻两帧之间沿X轴的飞行距离,即
不妨,设则,
<mrow>
<mi>&Delta;</mi>
<mi>x</mi>
<mo>=</mo>
<msub>
<mi>v</mi>
<mi>x</mi>
</msub>
<mo>&CenterDot;</mo>
<mi>&Delta;</mi>
<mi>t</mi>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>l</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<msubsup>
<mi>cos&theta;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>L</mi>
</msubsup>
<msubsup>
<mi>cos&alpha;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mi>L</mi>
</msubsup>
<mo>+</mo>
<msub>
<mi>l</mi>
<mi>i</mi>
</msub>
<msubsup>
<mi>cos&theta;</mi>
<mi>i</mi>
<mi>L</mi>
</msubsup>
<msubsup>
<mi>cos&alpha;</mi>
<mi>i</mi>
<mi>L</mi>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
同理可求得相邻两帧之间沿Y轴的飞行距离:
所述方法的飞行器在相同俯仰角情况下,俯仰角误差越大,飞行器位置估计误差越大;在相同俯仰角误差情况下,随着俯仰角的增大,飞行器的空间位置估计误差越小。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510084399.0A CN104655135B (zh) | 2015-02-09 | 2015-02-09 | 一种基于地标识别的飞行器视觉导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510084399.0A CN104655135B (zh) | 2015-02-09 | 2015-02-09 | 一种基于地标识别的飞行器视觉导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104655135A CN104655135A (zh) | 2015-05-27 |
CN104655135B true CN104655135B (zh) | 2018-03-06 |
Family
ID=53246539
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510084399.0A Active CN104655135B (zh) | 2015-02-09 | 2015-02-09 | 一种基于地标识别的飞行器视觉导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104655135B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR3033649B1 (fr) * | 2015-03-12 | 2018-06-15 | Sagem Defense Securite | Equipement aeroporte de detection de tirs et d'aide au pilotage |
CN105353772B (zh) * | 2015-11-16 | 2018-11-09 | 中国航天时代电子公司 | 一种无人机机动目标定位跟踪中的视觉伺服控制方法 |
CN105571593B (zh) * | 2015-11-27 | 2018-08-31 | 中国电子科技集团公司第二十研究所 | 一种基于mls的地理位置信息获取方法 |
CN105629990B (zh) * | 2016-01-25 | 2019-01-11 | 谭圆圆 | 一种无人飞行器的校准方法及装置 |
CN109029495B (zh) * | 2017-06-09 | 2020-11-20 | 苏州触达信息技术有限公司 | 一种反向校准仪、校准点坐标的反向校准系统和方法 |
CN108491633B (zh) * | 2018-03-24 | 2021-10-01 | 中国人民解放军海军航空大学 | 一种基于标准椭球牛顿迭代法空间目标/诱饵测量数据产生方法 |
CN110388940B (zh) * | 2019-06-28 | 2023-05-02 | 西安应用光学研究所 | 一种利用电子地图及典型地标校准光电转台方位零位的方法 |
CN113358135B (zh) * | 2021-08-09 | 2021-11-26 | 青州耐威航电科技有限公司 | 一种用光电测量数据修正飞行器位置的方法 |
CN114577205B (zh) * | 2022-02-10 | 2023-06-06 | 北京空间飞行器总体设计部 | 一种基于序列图像的行星软着陆自主导航陆标优选方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101509782A (zh) * | 2009-03-09 | 2009-08-19 | 华中科技大学 | 一种小型地标捕获定位方法 |
CN101532841A (zh) * | 2008-12-30 | 2009-09-16 | 华中科技大学 | 基于地标捕获跟踪的飞行器导航定位方法 |
CN101629827A (zh) * | 2009-08-14 | 2010-01-20 | 华中科技大学 | 一种飞行器前视末制导导航定位方法 |
CN102768042A (zh) * | 2012-07-11 | 2012-11-07 | 清华大学 | 一种视觉-惯性组合导航方法 |
CN102788580A (zh) * | 2012-06-20 | 2012-11-21 | 天津工业大学 | 无人机视觉导航中的飞行路线合成方法 |
EP2685292A2 (en) * | 2012-07-12 | 2014-01-15 | General Electric Company | Systems and methods for flight management |
-
2015
- 2015-02-09 CN CN201510084399.0A patent/CN104655135B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101532841A (zh) * | 2008-12-30 | 2009-09-16 | 华中科技大学 | 基于地标捕获跟踪的飞行器导航定位方法 |
CN101509782A (zh) * | 2009-03-09 | 2009-08-19 | 华中科技大学 | 一种小型地标捕获定位方法 |
CN101629827A (zh) * | 2009-08-14 | 2010-01-20 | 华中科技大学 | 一种飞行器前视末制导导航定位方法 |
CN102788580A (zh) * | 2012-06-20 | 2012-11-21 | 天津工业大学 | 无人机视觉导航中的飞行路线合成方法 |
CN102768042A (zh) * | 2012-07-11 | 2012-11-07 | 清华大学 | 一种视觉-惯性组合导航方法 |
EP2685292A2 (en) * | 2012-07-12 | 2014-01-15 | General Electric Company | Systems and methods for flight management |
Non-Patent Citations (4)
Title |
---|
Image Based Navigation for low flying Aerial Vehicles;Nikolaus Schweyer, et al;《International Society for Optics and Photonics》;20031231;第669-676页 * |
基于图像匹配的飞行器导航定位算法及仿真;王民钢,孙传新;《计算机仿真》;20120531;第29卷(第5期);第86-89页 * |
基于矢量角度和优化技术的定位误差新算法;秦国华,叶海潮;《计算机集成制造系统》;20091231;第15卷(第12期);第2445-2450页 * |
捕获跟踪水体地标的飞行器导航定位方法;杨效余,张天序;《华中科技大学学报》;20100531;第38卷(第5期);第61-64页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104655135A (zh) | 2015-05-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104655135B (zh) | 一种基于地标识别的飞行器视觉导航方法 | |
CN109911188B (zh) | 非卫星导航定位环境的桥梁检测无人机系统 | |
CN108871336B (zh) | 一种车辆位置估算系统及方法 | |
CN103674021B (zh) | 基于捷联惯导与星敏感器的组合导航系统及方法 | |
CN104165640B (zh) | 基于星敏感器的近空间弹载捷联惯导系统传递对准方法 | |
CN102538781B (zh) | 基于机器视觉和惯导融合的移动机器人运动姿态估计方法 | |
CN106595668B (zh) | 一种用于光电吊舱的无源定位算法 | |
CN109556632A (zh) | 一种基于卡尔曼滤波的ins/gnss/偏振/地磁组合导航对准方法 | |
CN111426320B (zh) | 一种基于图像匹配/惯导/里程计的车辆自主导航方法 | |
CN104390646B (zh) | 水下潜器地形辅助惯性导航系统的位置匹配方法 | |
CN106871927A (zh) | 一种无人机光电吊舱安装误差标校方法 | |
CN105698762A (zh) | 一种单机航迹上基于不同时刻观测点的目标快速定位方法 | |
CN109556631A (zh) | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法 | |
CN106885571B (zh) | 一种结合imu和导航影像的月面巡视器快速定位方法 | |
CN107490364A (zh) | 一种大角度倾斜成像航空相机对地目标定位方法 | |
CN102175882B (zh) | 基于自然地标的无人直升机视觉测速方法 | |
CN105737858A (zh) | 一种机载惯导系统姿态参数校准方法与装置 | |
CN110220491A (zh) | 一种无人机的光学吊舱安装误差角估算方法 | |
CN109032153A (zh) | 基于光电-惯性组合导引的无人机自主着舰方法和系统 | |
CN102901485B (zh) | 一种光电经纬仪快速自主定向的方法 | |
CN103712621B (zh) | 偏振光及红外传感器辅助惯导系统定姿方法 | |
CN103968844B (zh) | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 | |
CN106885573A (zh) | 面向四旋翼飞行器的运动捕捉系统实时测姿方法 | |
CN109084760A (zh) | 一种楼宇间导航系统 | |
CN106441372A (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 |