CN105698762B - 一种单机航迹上基于不同时刻观测点的目标快速定位方法 - Google Patents
一种单机航迹上基于不同时刻观测点的目标快速定位方法 Download PDFInfo
- Publication number
- CN105698762B CN105698762B CN201610025052.3A CN201610025052A CN105698762B CN 105698762 B CN105698762 B CN 105698762B CN 201610025052 A CN201610025052 A CN 201610025052A CN 105698762 B CN105698762 B CN 105698762B
- Authority
- CN
- China
- Prior art keywords
- mtd
- mrow
- mtr
- msub
- target
- 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
-
- 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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
Abstract
本发明提供一种单机航迹上基于不同时刻观测点的目标快速定位方法,由地面控制站通过无线数传链路与机载自驾仪进行通信,控制无人机飞行。无人机在飞行的过程中,将机载视频通过图传链路实时传输到图像地面站。图像地面站根据目标点在图像中的位置进行计算,结合飞机的位置、姿态及云台转动角度信息,通过目标快速定位算法进行目标位置估算。本发明弥补了目标点在无人机坐标系中的位置无法精确获取的不足,大大提高了目标定位的适用范围。同时,无人机多点协同定位能有效提高目标探测的准确性,改良单点、单传感器工作的缺陷,提高系统工作的可靠性、容错性。
Description
技术领域
本发明属于无人机技术领域,具体涉及一种单机航迹上基于不同时刻观测点的目标快速定位方法。
背景技术
无人机在海上应急搜索、靶场残骸搜索等方面的应用日益广泛,如对MH370、导弹残骸搜索等。为了进一步提高无人机执行搜索与定位任务的效果,需要研究无人机的目标快速定位问题。关于无人机的目标快速定位问题,现有技术存在的缺陷主要表现在以下方面:
一方面,无人侦察机现在一般采用的定位方法为单站测角测距定位方法,实际使用过程中暴露出了几个难以解决的问题,具体表现为:(1)目标定位过程局限明显。无人机现有系统结构在目标跟踪和定位阶段对飞机有两个必要约束条件,即跟踪阶段的盘旋和定位时的过顶,但从安全性上看,在现代高技术战场上几乎不可能。(2)对多目标连续定位能力不足。无人侦察机系统在特殊情况下需要对多个目标进行定位校射,一般也是采用以连续完成多个单目标定位校射任务的简单累加,耗时一般比较长,效率较低,风险大。(3)定位精度不高。虽然国内针对军用无人机电视图像定位精度不高的问题做了大量的研究,但是,一直没有找到行之有效的技术方案。现有的共线定位方法,定位精度远不能满足多种任务的要求。
另一方面,无人机空间两点交会定位的方法,在一定程度上提高了无人机电视图像的定位精度,但是在飞行实验中,多次定位误差还是很大,依然不能满足实际运用需求。
还有就是,空间三点定位的思想,通过GPS定位获得三次或多次无人机的空中位置,通过激光战场关键点目标进行三次或多次测距,求解距离方程,获得关键点目标的坐标。从本质上来说,这种技术方案是一种针对战场单目标的定位算法。但计算方法繁琐,测距误差较大,需要预先已知目标的近似高程,定位精度不高。
发明内容
针对现有技术存在的缺陷,本发明提供一种单机航迹上基于不同时刻观测点的目标快速定位方法,方法的原理示意图如图1所示:单个无人机沿着航迹飞行,结合不同时刻飞机在不同位置观测到的目标信息,进行多点目标快速定位。
本发明的工作流程图如图2所示:由地面控制站通过无线数传链路与机载自驾仪进行通信,控制无人机飞行。无人机在飞行的过程中,将机载视频通过图传链路实时传输到图像地面站。图像地面站根据目标点在图像中的位置进行计算,结合飞机的位置、姿态及云台转动角度信息,通过目标快速定位算法进行目标位置估算。
一种单机航迹上基于不同时刻观测点的目标快速定位方法,包括以下步骤:
S1.根据相机视场中每像素所对应的物理尺寸及相机焦距,计算出三个观测位置与目标点连线的空间观测射线在像空间坐标系下的方向向量;
S2.依据云台的俯仰角、方向角以及飞机的姿态角信息,将三条空间观测射线的方向向量统一到同一北东地坐标系中,进而可得出用直线的标准式表达的三条空间观测射线;
S3.利用平行于地面的一高度平面去截三条空间观测射线,得到高度平面与三条空间观测射线间的三个交点,根据三个交点的坐标可计算三个交点所围成的三角形面积,并将三角形面积作为目标函数;
S4.利用求解无约束优化问题的算法,对目标函数最优值进行搜索,得到相对应目标点的估计高度;
S5.当观测点的数目多于三个,空间观测射线多于三条时,对多条空间观测射线利用排列组合的原理获得种空间观测射线的组合方式,n大于3,每种组合方式中的三条空间观测射线进行步骤S1至S4的操作,得到相应的目标点的估计高度,对所有组合方式中得到的目标点的估计高度求和后取平均值,得到平均估计高度;所有组合方式得到的多个目标点的估计高度中,与平均估计高度最接近的那一组组合方式得到的目标点估计高度,即为理想的估计高度;
S6.利用平行于地面的且高度为S5中得到的理想的估计高度的高度平面、理想的估计高度对应的那组三条空间观测射线以及高度平面与三条空间观测射线间的三个交点,利用中心坐标公式,求出目标点的坐标,并将坐标转换到大地坐标系中。
本发明的优点包括:弥补了目标点在无人机坐标系中的位置无法精确获取的不足,大大提高了目标定位的适用范围。同时,无人机多点协同定位能有效提高目标探测的准确性,改良单点、单传感器工作的缺陷,提高系统工作的可靠性、容错性。另外,基于某准则的最速下降法简单可靠,适用性强,结果较为准确。
附图说明
图1是本发明的应用场景示意图
图2是本发明的流程图
图3是本发明原理框图
具体实施方式
本发明提出的一种单机航迹上基于不同时刻观测点的目标快速定位方法,涉及多个坐标系之间转换。因此,首先需要明确以下几个坐标系的定义:
a、地心惯性坐标系:GPS采集的数据是基于地心惯性坐标系定义的,其原点位于地球质心,z轴为地球自转轴,向上为正,x轴指向格林尼治起始子午面与地球赤道的交点E,y轴与x轴、z轴组成右手直角坐标系。通常表示为oE-xIyIzI。
b、像空间坐标系:其定义如下:原点位于图像中心点,x轴平行于像平面主纵线指向摄影方向,z轴正方向垂直于像平面向下,y轴平行于主横线且与其余三轴组成右手系,用op-xpypzp表示。
c、机体坐标系:其原点位于机体的质心,x轴正方向指向机头方向,y轴垂直于机身对称面向右,z轴指向下与其余两轴构成右手系。通常表示为ob-xbybzb。
d、云台坐标系:其原点定义在云台转动的中心处,x、y、z各轴均与机体坐标系平行,用o'b-xb'yb'zb'表示。
e、北东地坐标系:也是将不同位置的观测信息最终统一在一起的坐标系,其原点定义在基准点处,在该方案实施中,一般将某观测点定为基准点,x轴正方向指向水平正北方向,z轴沿当地参考椭球面法线,向下为正,y轴与其余两轴构成右手直角坐标系,通常表示为o1-x1y1z1。
具体地,一种单机航迹上基于不同时刻观测点的目标快速定位方法,包括以下步骤:
(1)由目标点在视频图像中的像素坐标(u,v),通过如下坐标变换公式得到以mm为单位的像空间坐标系下的坐标(x,y):
式中,Δx为x轴方向上每个像素所对应的物理尺寸,Δy为y轴方向上每个像素所对应的物理尺寸,u0、v0为图像中心处的像素坐标;
将像空间坐标系下的空间观测射线的方向向量表示为(x,y,f),其中f为相机焦距。
(2)根据云台的俯仰角p和方位角q,在像空间坐标系中,绕zp轴转角度q,再绕y'b轴转角度p,从而得到由像坐标系至云台坐标系的转换矩阵
进而根据飞机的三个姿态角—俯仰角θ、滚转角φ、偏航角ψ,按照滚转、俯仰、偏航的顺序求出云台坐标系至北东地坐标系的旋转矩阵
综上,将方向向量旋转至原点在当前时刻飞机质心的北东地坐标系中的方向向量的计算过程如下:
根据上述方向向量,同时对应的观测点的坐标可知为(xi0,yi0,zi0),i=1,2,3,则空间三条观测射线用直线的标准表达式可表示为:
(3)利用平行于地面的高度平面h去截三条空间观测射线,高度平面与三条空间观测射线的交点坐标为由三个交点的坐标值,可计算三点围成的三角形面积s:设定目标函数为s2,当目标函数取到最小值时,对应的高度h为目标点估计高度。
(4)最快下降法是求解无约束优化问题经典方法之一,利用最快下降法求s2的最小值,关键是用负梯度方向作为搜索方向进行运算求解。
根据上述三角形面积计算公式,若直接由s2的表达式对h求导进而计算梯度,表达式较复杂,对于之后的搜索也很不利。因此利用导数的定义式计算梯度,确定搜索方向。
搜索方向确定后,利用某准则对最优值进行搜索,可选取Armijo准则、Wolfe准则或精确先搜索方法,各准则之间具体求解过程不同,但方法基本一致,在本发明中选取Armijo搜索方法为例进行介绍,设定此时:
h'=h-f'*bi
代入到三角形面积计算公式计算得到s',式子中i是搜索步长,σ、b为搜索方法的参数。当s'≤s+σ*bi*[-(f')2]时结束搜索,输出此时的高度h为目标点的估计高度。
(5)在定位过程中,因受云台转动角度、飞机飞行不稳定等因素的影响,会在某些测量位置出现测量野值的情况。因此,仅利用三个测量点定位不能保证定位的精度,需要利用多点定位,对目标点进行筛选,得到更为准确的目标。
当观测点的数目多于三个,空间观测射线多于三条时,对多条空间观测射线利用排列组合的原理获得种空间观测射线的组合方式,n大于3,所每种组合方式中的三条空间观测射线进行步骤S1至S4的操作,得到相应的目标点的估计高度,对所有组合方式中得到的目标点的估计高度求和后取平均值,得到平均估计高度;所有组合方式得到的多个目标点的估计高度中,与平均估计高度最接近的那一组组合方式得到的目标点估计高度,即为理想的目标点估计高度。
比如有四个观测点,空间观测射线为4条,4条空间观测射线进行排列组合有种组合方式,对这四种组合方式分别进行步骤S1至S4的快速定位运算,解出4个目标点的估计高度,对这四个目标点的估计高度取平均值,得到将四个目标点的估计高度分别与平均值做差,与平均值最接近的即可认为是理想的目标点估计高度。
(6)根据上述理想的目标点的估计高度,利用理想的目标点估计高度对应的高度平面与理想的目标点估计高度对应的三条空间观测射线间的三个交点的坐标值,根据中心坐标公式求出目标点的坐标:
(7)结合飞机的GPS坐标即可求得目标点在大地坐标系下的坐标,具体如下:
其中Lat_int、Lon_int、H_int分别代表原点坐标在大地坐标系下的纬度、经度和高度,通常在建立空间射线观测方程时选取某观测点为坐标原点,RN、RE分别为子午圈、卯酉圈曲率半径。
Claims (7)
1.一种单机航迹上基于不同时刻观测点的目标快速定位方法,其特征在于:包括以下步骤:
S1.根据相机视场中每像素所对应的物理尺寸及相机焦距,计算出三个观测位置与目标点连线的空间观测射线在像空间坐标系下的方向向量;
S2.依据云台的俯仰角、方向角以及飞机的姿态角信息,将三条空间观测射线的方向向量统一到同一北东地坐标系中,进而可得出用直线的标准式表达的三条空间观测射线;
S3.利用平行于地面的一高度平面去截三条空间观测射线,得到高度平面与三条空间观测射线间的三个交点,根据三个交点的坐标可计算三个交点所围成的三角形面积,并将三角形面积作为目标函数;
S4.利用求解无约束优化问题的算法,对目标函数最优值进行搜索,得到相对应目标点的估计高度;
S5.当观测点的数目多于三个,空间观测射线多于三条时,对多条空间观测射线利用排列组合的原理获得种空间观测射线的组合方式,n大于3,每种组合方式中的三条空间观测射线进行步骤S1至S4的操作,得到相应的目标点的估计高度,对所有组合方式中得到的目标点的估计高度求和后取平均值,得到平均估计高度;所有组合方式得到的多个目标点的估计高度中,与平均估计高度最接近的那一组组合方式得到的目标点估计高度,即为理想的估计高度;
S6.利用平行于地面的且高度为S5中得到的理想的估计高度的高度平面、理想的估计高度对应的那组三条空间观测射线以及高度平面与三条空间观测射线间的三个交点,利用中心坐标公式,求出目标点的坐标,并将坐标转换到大地坐标系中。
2.根据权利要求1所述的单机航迹上基于不同时刻观测点的目标快速定位方法,其特征在于,在步骤S1中:
由目标点在视频图像中的像素坐标(u,v),通过如下坐标变换公式得到以mm为单位的像空间坐标系下的坐标(x,y):
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mi>x</mi>
<mo>=</mo>
<mo>(</mo>
<mi>u</mi>
<mo>-</mo>
<msub>
<mi>u</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
<mo>*</mo>
<mi>&Delta;</mi>
<mi>x</mi>
<mo>;</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>y</mi>
<mo>=</mo>
<mo>(</mo>
<mi>v</mi>
<mo>-</mo>
<msub>
<mi>v</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
<mo>*</mo>
<mi>&Delta;</mi>
<mi>y</mi>
<mo>;</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
式中,Δx为x轴方向上每个像素所对应的物理尺寸,Δy为y轴方向上每个像素所对应的物理尺寸,u0、v0为图像中心处的像素坐标;
将像空间坐标系下的空间观测射线的方向向量表示为(x,y,f),其中f为相机焦距。
3.根据权利要求1所述的单机航迹上基于不同时刻观测点的目标快速定位方法,其特征在于,在步骤S2中:
根据云台的俯仰角p和方位角q,在像空间坐标系中,绕zp轴转角度q,再绕y'b轴转角度p,从而得到由像空间坐标系至云台坐标系的转换矩阵
<mrow>
<msubsup>
<mi>M</mi>
<mi>p</mi>
<msup>
<mi>b</mi>
<mo>&prime;</mo>
</msup>
</msubsup>
<mo>=</mo>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>q</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi> </mi>
<mi>q</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi> </mi>
<mi>q</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>q</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>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>p</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi> </mi>
<mi>p</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi> </mi>
<mi>p</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi> </mi>
<mi>p</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
根据飞机的三个姿态角—俯仰角θ、滚转角φ、偏航角ψ,按照滚转、俯仰、偏航的顺序求出云台坐标系至北东地坐标系的旋转矩阵
<mrow>
<msubsup>
<mi>M</mi>
<msup>
<mi>b</mi>
<mo>&prime;</mo>
</msup>
<mi>n</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&psi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&psi;</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>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
将方向向量旋转至原点在当前时刻飞机质心的北东地坐标系中的方向向量的计算过程如下:
根据上述方向向量,同时对应的观测点的坐标可知为(xi0,yi0,zi0),i=1,2,3,则三条空间观测射线用直线的标准表达式可表示为:
<mrow>
<mfrac>
<mrow>
<mi>x</mi>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mi>i</mi>
<mn>0</mn>
</mrow>
</msub>
</mrow>
<msub>
<mi>p</mi>
<mi>i</mi>
</msub>
</mfrac>
<mo>=</mo>
<mfrac>
<mrow>
<mi>y</mi>
<mo>-</mo>
<msub>
<mi>y</mi>
<mrow>
<mi>i</mi>
<mn>0</mn>
</mrow>
</msub>
</mrow>
<msub>
<mi>q</mi>
<mi>i</mi>
</msub>
</mfrac>
<mo>=</mo>
<mfrac>
<mrow>
<mi>z</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mrow>
<mi>i</mi>
<mn>0</mn>
</mrow>
</msub>
</mrow>
<msub>
<mi>r</mi>
<mi>i</mi>
</msub>
</mfrac>
</mrow>
其中:(pi,qi,ri),i=1,2,3为三条空间观测射线的方向向量。
4.根据权利要求3所述的单机航迹上基于不同时刻观测点的目标快速定位方法,其特征在于,在步骤S3中:
利用平行于地面的高度平面h去截三条空间观测射线,高度平面与三条空间观测射线的交点坐标为其中i=1,2,3;
由三个交点(xi,yi),i=1,2,3的坐标值,可计算三点围成的三角形面积s:
设定目标函数为s2,当目标函数取到最小值时,对应的高度h为目标点估计高度。
5.根据权利要求4所述的单机航迹上基于不同时刻观测点的目标快速定位方法,其特征在于,在步骤S4中:
利用最快下降法求s2的最小值,用负梯度方向作为搜索方向进行运算求解;
根据步骤S3中的三角形面积计算公式,利用导数的定义式计算梯度,确定搜索方向。
6.根据权利要求5所述的单机航迹上基于不同时刻观测点的目标快速定位方法,其特征在于,在步骤S4中:
搜索方向确定后,利用Armijo搜索方法对最优值进行搜索,此时:
h'=h-f'*bi
代入到步骤S3中的三角形面积计算公式,计算得到s',当s'≤s+σ*bi*[-(f')2]时结束搜索,输出此时的高度h为目标点的估计高度;式中i是搜索步长,σ、b为Armijo搜索方法的参数。
7.根据权利要求6所述的单机航迹上基于不同时刻观测点的目标快速定位方法,其特征在于,在步骤S6中:
根据步骤S5得到的理想的估计高度,利用理想的估计高度对应的高度平面与理想的估计高度对应的三条空间观测射线间的三个交点(xi,yi,zi),i=1,2,3的坐标值,根据中心坐标公式求出目标点的坐标:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>x</mi>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
</mrow>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>y</mi>
<mn>3</mn>
</msub>
</mrow>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>z</mi>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
</mrow>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
将目标点的坐标转换为在大地坐标系下的坐标:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>L</mi>
<mi>a</mi>
<mi>t</mi>
<mo>_</mo>
<mi>a</mi>
<mi>i</mi>
<mi>m</mi>
<mo>=</mo>
<mi>L</mi>
<mi>a</mi>
<mi>t</mi>
<mo>_</mo>
<mi>int</mi>
<mo>+</mo>
<mfrac>
<mi>x</mi>
<mrow>
<msub>
<mi>R</mi>
<mi>N</mi>
</msub>
<mo>+</mo>
<mi>H</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>L</mi>
<mi>o</mi>
<mi>n</mi>
<mo>_</mo>
<mi>a</mi>
<mi>i</mi>
<mi>m</mi>
<mo>=</mo>
<mi>L</mi>
<mi>o</mi>
<mi>n</mi>
<mo>_</mo>
<mi>int</mi>
<mo>+</mo>
<mfrac>
<mi>y</mi>
<mrow>
<mrow>
<mo>(</mo>
<mrow>
<msub>
<mi>R</mi>
<mi>E</mi>
</msub>
<mo>+</mo>
<mi>H</mi>
</mrow>
<mo>)</mo>
</mrow>
<mo>*</mo>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mrow>
<mi>L</mi>
<mi>a</mi>
<mi>t</mi>
<mo>_</mo>
<mi>int</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>H</mi>
<mo>=</mo>
<mi>H</mi>
<mo>_</mo>
<mi>int</mi>
<mo>-</mo>
<mi>z</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中Lat_int、Lon_int、H_int分别代表原点坐标在大地坐标系下的纬度、经度和高度,RN、RE分别为子午圈、卯酉圈曲率半径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610025052.3A CN105698762B (zh) | 2016-01-15 | 2016-01-15 | 一种单机航迹上基于不同时刻观测点的目标快速定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610025052.3A CN105698762B (zh) | 2016-01-15 | 2016-01-15 | 一种单机航迹上基于不同时刻观测点的目标快速定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105698762A CN105698762A (zh) | 2016-06-22 |
CN105698762B true CN105698762B (zh) | 2018-02-23 |
Family
ID=56226426
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610025052.3A Active CN105698762B (zh) | 2016-01-15 | 2016-01-15 | 一种单机航迹上基于不同时刻观测点的目标快速定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105698762B (zh) |
Families Citing this family (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107783555B (zh) * | 2016-08-29 | 2021-05-14 | 杭州海康机器人技术有限公司 | 一种基于无人机的目标定位方法、装置及系统 |
CN107992064B (zh) * | 2016-10-26 | 2021-03-26 | 杭州海康机器人技术有限公司 | 基于主无人机的从无人机飞行控制方法、装置及系统 |
CN107192377B (zh) * | 2017-06-16 | 2021-01-15 | 深圳市可飞科技有限公司 | 远程测量物体坐标的方法、装置及飞行器 |
CN107976899B (zh) * | 2017-11-15 | 2020-09-11 | 中国人民解放军海军航空大学 | 一种基于有人/无人机协同作战系统的精确目标定位及打击方法 |
CN110445465A (zh) * | 2017-12-22 | 2019-11-12 | 晶科电力科技股份有限公司 | 一种光伏电站中热斑定位方法 |
CN108335353B (zh) * | 2018-02-23 | 2020-12-22 | 清华-伯克利深圳学院筹备办公室 | 动态场景的三维重建方法、装置和系统、服务器、介质 |
WO2019165612A1 (zh) * | 2018-02-28 | 2019-09-06 | 深圳市大疆创新科技有限公司 | 可移动平台的定位方法及相关装置、系统 |
CN108733066B (zh) * | 2018-05-07 | 2021-05-07 | 中国人民解放军国防科技大学 | 一种基于吊舱姿态反馈的目标跟踪控制方法 |
CN109684909B (zh) * | 2018-10-11 | 2023-06-09 | 武汉工程大学 | 一种无人机目标要害点实时定位方法、系统及存储介质 |
CN109754420B (zh) | 2018-12-24 | 2021-11-12 | 深圳市道通智能航空技术股份有限公司 | 一种目标距离估计方法、装置及无人机 |
CN111247389B (zh) * | 2019-03-29 | 2022-03-25 | 深圳市大疆创新科技有限公司 | 关于拍摄设备的数据处理方法、装置及图像处理设备 |
WO2021035756A1 (zh) * | 2019-08-31 | 2021-03-04 | 深圳市大疆创新科技有限公司 | 基于飞行器的巡检方法、设备及存储介质 |
CN110824295B (zh) * | 2019-10-22 | 2021-08-31 | 广东电网有限责任公司 | 一种基于三维图形的红外热像故障定位方法 |
CN110887461B (zh) * | 2019-11-19 | 2021-04-06 | 西北工业大学 | 基于gps姿态估计的无人机实时计算机视觉处理方法 |
CN111462182B (zh) * | 2020-03-31 | 2021-08-06 | 南京航空航天大学 | 一种基于红外预警图像的弹道导弹三维轨迹估计方法 |
CN112859907A (zh) * | 2020-12-25 | 2021-05-28 | 湖北航天飞行器研究所 | 少样本条件下基于三维特效仿真的火箭残骸高空检测方法 |
CN113534224A (zh) * | 2021-06-29 | 2021-10-22 | 杭州电子科技大学 | 一种用于有遮挡条件下的室外小车定位方法 |
CN116753918B (zh) * | 2023-06-19 | 2024-03-19 | 中国人民解放军61540部队 | 基于空天线阵传感器的地面目标位置估计方法和装置 |
CN116608851B (zh) * | 2023-07-19 | 2023-09-26 | 中山大学 | 地下管道双机器人步进式协同导航方法、系统及服务器 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104457704A (zh) * | 2014-12-05 | 2015-03-25 | 北京大学 | 基于增强地理信息的无人机地面目标定位系统及方法 |
CN104463884A (zh) * | 2014-12-19 | 2015-03-25 | 中国人民解放军第二炮兵装备研究院第八研究所 | 最小化空间距离的线性交会测量方法 |
CN104501779A (zh) * | 2015-01-09 | 2015-04-08 | 中国人民解放军63961部队 | 基于多站测量的无人机高精度目标定位方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7991226B2 (en) * | 2007-10-12 | 2011-08-02 | Pictometry International Corporation | System and process for color-balancing a series of oblique images |
JP5716273B2 (ja) * | 2009-11-27 | 2015-05-13 | 日本電気株式会社 | 捜索目標位置特定装置、捜索目標位置特定方法及びプログラム |
-
2016
- 2016-01-15 CN CN201610025052.3A patent/CN105698762B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104457704A (zh) * | 2014-12-05 | 2015-03-25 | 北京大学 | 基于增强地理信息的无人机地面目标定位系统及方法 |
CN104463884A (zh) * | 2014-12-19 | 2015-03-25 | 中国人民解放军第二炮兵装备研究院第八研究所 | 最小化空间距离的线性交会测量方法 |
CN104501779A (zh) * | 2015-01-09 | 2015-04-08 | 中国人民解放军63961部队 | 基于多站测量的无人机高精度目标定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105698762A (zh) | 2016-06-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105698762B (zh) | 一种单机航迹上基于不同时刻观测点的目标快速定位方法 | |
CN104848860B (zh) | 一种敏捷卫星成像过程姿态机动规划方法 | |
CN107247458A (zh) | 无人机视频图像目标定位系统、定位方法及云台控制方法 | |
CN106155081B (zh) | 一种旋翼无人机大范围目标监测和精确定位方法 | |
CN112197761B (zh) | 一种高精度多旋翼机协同定位方法及系统 | |
CN106871927A (zh) | 一种无人机光电吊舱安装误差标校方法 | |
CN105180963B (zh) | 基于在线标校的无人机遥测参数修正方法 | |
CN104655135B (zh) | 一种基于地标识别的飞行器视觉导航方法 | |
CN107450582B (zh) | 一种基于星上实时规划的相控阵数传引导控制方法 | |
CN106767705A (zh) | 一种光学遥感卫星点目标观测任务动中成像姿态建模方法 | |
CN106373159A (zh) | 一种简化的无人机多目标定位方法 | |
CN111366148B (zh) | 适用于机载光电观瞄系统多次观察的目标定位方法 | |
CN106595668A (zh) | 一种用于光电吊舱的无源定位算法 | |
CN107831515B (zh) | 水下定位方法和系统 | |
CN112698664B (zh) | 一种用于无人机集群协同导航优化的视线扇区动态估计方法 | |
CN107490364A (zh) | 一种大角度倾斜成像航空相机对地目标定位方法 | |
CN112710311B (zh) | 一种地形自适应无人机三维实景重建航摄点自动规划方法 | |
CN105160125A (zh) | 一种星敏感器四元数的仿真分析方法 | |
CN110470304A (zh) | 一种基于无人机光电平台的高精度目标定位测速方法 | |
CN107589431A (zh) | 一种提高机载光电系统目标定位精度的校靶方法 | |
CN105424060B (zh) | 一种飞行器星敏感器与捷联惯组安装误差的测量方法 | |
CN106289156A (zh) | 一种卫星以任意姿态成像时获取摄影点太阳高度角的方法 | |
CN207992458U (zh) | 复杂观测模式下碳卫星定位系统 | |
Cheng et al. | High precision passive target localization based on airborne electro-optical payload | |
CN104391311B (zh) | 基于gps广播数据的星上无源定位方法 |
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 |