一种小型无人机侦察吊舱目标定位方法

黄佳; 崔乃刚

doi:10.15892/j.cnki.djzdxb.2019.05.024

弹箭与制导学报 >

2019 , Vol. 39 >Issue 5: 103 - 106

DOI: https://doi.org/10.15892/j.cnki.djzdxb.2019.05.024

一种小型无人机侦察吊舱目标定位方法

黄佳 ¹^,² ,
崔乃刚 ²

展开

¹ 中国工程物理研究院总体工程研究所, 四川绵阳 621900
² 哈尔滨工业大学航天学院, 哈尔滨 150001

黄佳(1985-),男,四川乐山人,工程师,硕士,研究方向:飞行器气动弹道与制导控制。

收稿日期: 2018-08-25

网络出版日期: 2025-05-12

收起

A Target Locating Method for Small UAVs with Reconnaissance Pod

HUANG Jia ¹^,² ,
CUI Naigang ²

Expand

¹ Institute of Systems Engineering, China Academy of Engineering Physics, Sichuan Mianyang 621900, China
² School of Astronautics, Harbin Institute of Technology, Harbin 150001, China

Received date: 2018-08-25

Online published: 2025-05-12

Fold

摘要

提出一种仅依靠无人机导航信息与侦察吊舱测量信息而无需激光测距仪数据的目标定位方法。利用速度与角速度在旋转坐标系的相对关系求出无人机与目标的相对距离,根据几何关系以及无人机自身位置解算出目标绝对位置。仿真结果表明尽管导航误差、侦察吊舱测量误差等误差源会导致不同程度的目标定位误差,但是对于静止目标和低速目标的定位精度可满足大部分小型无人机定位精度要求。

关键词： 目标定位; 小型无人机; 侦察吊舱; 定位精度

本文引用格式

黄佳 , 崔乃刚 . 一种小型无人机侦察吊舱目标定位方法[J]. 弹箭与制导学报, 2019 , 39(5) : 103 -106 . DOI: 10.15892/j.cnki.djzdxb.2019.05.024

Abstract

This paper proposes a new target locating method, which only uses the data from navigation system and reconnaissance pod but doesn’t need the data of laser rangefinder. First, the distance between the unmanned aerial vehicle (UAV) and the target was obtained using the relationship between velocity and angular velocity in a rotating coordinate system. Then, the absolute location of the target was solved using the geometrical relationships and the location of the UAV. The simulation results show that some error sources, such as the errors of navigation data, the measurement errors of reconnaissance pod, etc., can result in locating errors in different levels. But the location accuracy of stationary and low-speed targets can meet the requirement for most small UAVs.

Key words： target locating; small UAV; reconnaissance pod; locating accuracy

0 引言

目标定位是侦察型无人机的一项核心功能。文献[1-2]利用光学设备测量的角度信息与激光测距仪测得的距离信息通过几何关系求得目标相对无人机的位置参数。文献[3-4]在文献[1-2]的基础上,分别通过两点交会定位和三点交会定位进一步提高了定位精度。以上方法均要求无人机装配激光测距仪,然而对于小型无人机而言,侦察吊舱的体积与重量受到严格限制,加之成本的约束,使得装配激光测距仪不具有可行性。文献[5]给出了一种基于平坦地势假设的方法,即假设目标高度、无人机当前位置对应的地面高度、无人机起飞点高度三者相等,将无人机当前高度减去起飞点高度视为无人机相对地面高度,进而通过几何关系实现目标定位。该方法基于的平坦地势假设在实际工程应用中不具有普适性。文献[6]提出一种基于数字高程模型(DEM)的目标定位方法,但该方法需要装订目标所在区域的DEM,工程上同样不具有普适性。

为实现在不具备激光测距仪或其它测距设备条件下的目标定位,且在小型无人机上具有工程可实现性和普适性,文中提出一种新的目标定位方法。该方法基于速度与角速度的关系,仅利用无人机自身的导航信息和侦察吊舱测得的角度和角速度信息进行定位解算,不依赖于测距信息和DEM,也无需基于平坦地势假设,工程实现容易,仿真结果表明该方法具有一定的工程应用价值。

1 坐标系定义与转换

地心坐标系(O_ex_ey_ez_e,简称地心系),原点O_e位于地心,O_ez_e指向北极,O_ex_e在赤道面内指向格林尼治子午线,O_ey_e由右手定则确定。

无人机机体坐标系(O_bx_by_bz_b,简称体系),原点O_b位于无人机质心,O_bx_b沿纵轴指向前,O_by_b垂直于纵对称面指向右,O_bz_b在纵对称面内指向下,即“前右下”。

导航坐标系(O_nx_ny_nz_n,简称导航系),原点O_n位于无人机质心,O_nx_n在当地水平面内指向北,O_ny_n在当地水平面内指向东,O_nz_n垂直于当地水平面指向下,即“北东地”。

视线坐标系(O_sx_sy_sz_s,简称视线系),视线系与光学侦察吊舱固联,原点O_s位于光学侦察吊舱旋转中心,O_sx_s沿镜头中心指向前,O_sy_s垂直于镜头纵对称面指向右,O_sz_s在镜头纵对称面指向下,即“前右下”。

目标坐标系(O_tx_ty_tz_t,简称目标系),原点O_t位于目标几何中心,O_tx_t在当地水平面内指向北,O_ty_t在当地水平面内指向东,O_tz_t垂直于当地水平面指向下,即“北东地”。

导航系到体系的坐标转换矩阵为:

(1)

C nb = 100 0 cos φ sin φ 0 − sin φ cos φ cos θ 0 − sin θ 010 sin θ 0 cos θ cos ψ sin ψ 0 − sin ψ cos ψ 0 001

式中:ψ、θ、φ分别为无人机偏航角、俯仰角与滚转角,可由无人机导航系统给出。

体系到视线系的坐标转换矩阵为:

(2)

C bs = cos α 0 − sin α 010 sin α 0 cos α cos β sin β 0 − sin β cos β 0 001

式中:α、β分别为侦察吊舱的高低角与方位角。

地心系到导航系的坐标转换矩阵为:

(3)

C en = − sin B cos λ − sin B sin λ cos B − sin λ cos λ 0 − cos B cos λ − cos B sin λ − sin B

式中:B、λ分别为大地纬度与经度。

2 基于姿态/激光测距的目标定位方法

传统的基于姿态测量与激光测距的目标定位原理如下。

设侦察吊舱到目标的连线矢量(视线)为r,则r在视线系的分量为,根据坐标转换可得r在地心系的分量为:

(4)

r e, x r e, y r e, z = C ne C bn C sb r 00

式中:下标e表示地心系,下标x、y、z表示分量的方向。

根据无人机的大地纬度B、经度λ以及大地高度h可求得无人机在地心系的坐标^[7],即:

(5)

x e y e z e = N + h cos B cos λ N + h cos B sin λ N 1 − e 2 + h sin B

式中:N为地球卯酉圈半径,e为地球第一偏心率。

进而可得,目标在地心系的坐标:

(6)

x t e y e t z e t = x e y e z e + r e, x r e, y r e, z

最后,目标的大地纬度B_t、经度L_t以及大地高度h_t可由下式求出^[7]:

(7)

B t = arctan z t e + b e' 2 sin 3 u p − a e 2 cos 3 u L t = arctan y e t / x e t h t = p cos B t + z e t sin B t − a 1 − e 2 sin 2 B t p = (x e t) 2 + (y e t) 2 u = arctan a z e t b p

式中:a、b、e、e'为地球长半轴、短半轴、第一偏心率、第二偏心率。

3 基于速度/角速度的目标定位方法

根据矢量在旋转坐标系中的导数关系^[8],有

(8)

r ˙ n = r ˙ s + ω ns × r

式中:

r · n

为r在导航系中的导数,即在导航系中观测到的目标相对无人机的速度;

r · s

为r在视线系中的导数,即在视线系中观测到的目标相对无人机的速度;ω^ns为视线角速度。

将式(8)分解到视线系,可得:

(9)

C ns v n, x t − v n, x v n, y t − v n, y v n, z t − v n, z = r ˙ 00 + ω s, x ns ω s, y ns ω s, z ns × r 00 = r ˙ r ω s, z ns − r ω s, y ns

式中:C_ns=C_bsC_nb为导航系到视线系的转换矩阵;v_n,_x、v_n,_y、v_n,_z为无人机速度在导航系的分量,可由导航系统给出;

v n, x t

、

v n, y t

、

v n, z t

为目标点速度在导航系的分量,对于静止目标或当目标速度远小于无人机速度时可忽略,此时式(9)可近似为:

(10)

C ns − v n, x − v n, y − v n, z = r ˙ 00 + ω s, x ns ω s, y ns ω s, z ns × r 00 = r ˙ r ω s, z ns − r ω s, y ns

进而可得:

(11)

r = − C ns 2, 1 v n, x − C ns 2, 2 v n, y − C ns 2, 3 v n, z ω s, z ns r = C ns 3, 1 v n, x + C ns 3, 2 v n, y + C ns 3, 3 v n, z ω s, y ns

由式(11)可见,只要

ω s, y n s

和

ω s, z n s

中任何一个不为0,即可求得r,求得r后即可应用第2节基于姿态/激光测距的目标定位方法求出目标位置。

ω s, y n s

和

ω s, z n s

可通过两种方式获取:

第1种方式是若侦察吊舱带有速率陀螺,可将速率陀螺测得的吊舱相对惯性系的角速度

ω s, y i s

和

ω s, z i s

视为

ω s, y n s

和

ω s, z n s

,两者仅相差一个地球自转角速度,可忽略。

第2种方式是利用侦察吊舱测得的框架角速度

α ·

、

β ·

以及无人机惯性组件测得的角速度

ω b i b

求解

ω s n s

,即:

(12)

ω s ns ≈ ω s is = 0 α ˙ 0 + C bs ω b, x ib ω b, y ib ω b, z ib + β ˙

式(12)同样忽略了地球自转角速度。

4 定位精度仿真与分析

4.1 静止目标仿真与分析

对于静止目标,影响定位精度的误差源包括:无人机导航系统速度误差、姿态角误差、位置误差;吊舱的框架角误差、视线角速度误差。另外,误差源对定位误差的影响还与无人机和目标的相对运动关系有关,如相对距离、相对高度、相对速度。

文中以某小型无人机的6自由度仿真模型为例,设计无人机以200 m高度和35 m/s速度对目标进行盘旋跟踪。表1为几种典型仿真条件下的最大定位误差。

表1 几种典型仿真条件下的最大定位误差

误差源水平		最大定位误差/m
误差源水平		盘旋半径500 m	盘旋半径1 000 m
无人机速度误差/ (m·s^-1)	0.5	8.0	15.5
无人机速度误差/ (m·s^-1)	1	16.3	30.0
无人机姿态误差/(°)	0.5	2.9	6.6
无人机姿态误差/(°)	1	5.8	13.3
无人机位置误差/m	5	5.0	5.0
无人机位置误差/m	10	10.0	10.0
框架角误差/(°)	0.2	1.8	3.3
框架角误差/(°)	0.5	4.5	8.1
视线角速度误差/ ((°)/s)	0.01	1.2	4.6
视线角速度误差/ ((°)/s)	0.05	6.0	22.5

由表1可见,几种典型误差源产生的定位误差在量值上基本相当;不同误差水平对定位误差的影响基本是线性的;无人机位置误差对定位误差的影响是平移关系,即多大的无人机位置误差就产生多大的定位误差,其余误差源对定位误差的影响均随盘旋半径的增大而增大。

根据表1中单项误差源对定位误差的影响,可由式(13)估算出多种误差源作用下的综合定位误差。

(13)

σ 2 = ∑ i = 1 n σ i 2

式中:σ为综合定位误差标准差;σ_i为单项误差源产生的定位误差标准差。

根据表1中的误差水平,由式(13)可求得综合定位误差为10.1~41.8 m,该定位误差可满足大部分小型无人机侦察任务的定位精度要求。

4.2 低速运动目标仿真与分析

由式(9)可知,文中的目标定位算法理论上需要已知目标的运动速度,而实际中目标的运动速度是难以获取的,因此文中的算法不适用于高速运动目标。对于低速运动目标(速度小于10 m/s),这里将目标运动速度视为误差源,通过仿真分析目标运动速度对定位误差的影响。

仿真场景为:无人机以200 m高度、35 m/s速度绕目标以800 m半径盘旋跟踪;不考虑表1中的误差源,仅分析目标运动对定位误差的影响;目标分别以5 m/s和10 m/s做匀速直线运动,如图1和图2。

显示原图|下载原图ZIP|生成PPT

图1 目标5 m/s匀速直线运动的定位结果

显示原图|下载原图ZIP|生成PPT

图2 目标10 m/s匀速直线运动的定位结果

由图1和图2可见,无人机和目标的相对运动关系直接影响到定位误差的大小。当无人机与目标的速度方向相互垂直时定位误差接近于0,因为此时目标速度在无人机运动方向上的分量为0。而当无人机与目标速度平行时定位误差最大,因为此时目标速度在无人机运动方向上的分量最大。图1和图2中最大定位误差分别为:104 m与209 m。该误差水平可满足对定位精度要求不高的侦察任务的指标要求。

5 结论

研究了一种仅利用无人机导航信息和光学侦察吊舱测量信息进行目标定位的新方法。该方法无需激光测距仪或其它测距设备的测距信息,无需基于平坦地面假设以及装订DEM,具有较高的工程可实现性和普适性。通过仿真设计了几种典型场景并分析了各项误差源对定位误差的影响。结果表明,在目标静止条件下,本方法具有较高的定位精度;对于运动目标,定位误差随目标运动速度增大而增大,且定位误差受无人机与目标的相对运动关系影响较大,当无人机与目标的速度方向相互垂直时定位误差接近于0,

而当无人机与目标速度平行时定位误差最大。该方法可满足大部分小型无人机对静止目标的定位精度要求。对于10 m/s以内的低速运动目标,其定位精度同样可满足对定位精度要求不高的侦察任务的指标要求。

参考文献

原文顺序 | 文献年度倒序 | 文中引用次数倒序

[1]	吴艳梅, 李刚, 张霞. 无人机载光学侦察系统实时目标定位器设计[J]. 电光与控制, 2008, 15(11):47-49.

[2]	毛昭军, 汪德虎. 姿态测量/激光测距的无人机目标定位模型[J]. 火力与指挥控制, 2003, 28(5):14-17.

[3]	孙超, 都基焱, 段连飞. 一种空间两点交会无人机定位方法[J]. 兵工自动化, 2011, 30(6):35-36.

[4]	姚新. 无人机提高目标定位精度方法研究[J]. 舰船电子工程, 2011, 31(10):56-59.

[5]	林旻序, 乔彦峰, 戴明, 等. 单载荷航空吊舱目标定位方法研究[J]. 红外技术, 2011, 33(10):593-597.

[6]	淡金强, 马国华, 蒋胜平, 等. 基于DEM的战场目标侦察定位技术研究[J]. 光学技术, 2008, 34(1):100-104.

[7]	中国人民解放军总装备部. 2000中国大地测量系统:GJB 6304—2008[S]. 北京: 总装备部军标出版发行部, 2008:11-12.

[8]	肖业伦. 航空航天器运动的建模:飞行动力学的理论基础[M]. 北京: 北京航空航天大学出版社, 2003:15-16.

Options

文章导航

模态框（Modal）标题

摘要