引言

侦察车等地面侦察设备是获取战场信息的重要手段，为避免建筑物、树木等障碍物的遮挡，也为了降低地球曲率对通视距离的影响，越来越多的侦察车采用桅杆式光电设备来实现远距离侦察^[1]。桅杆的举升高度从1.5 m到10 m不等。

桅杆由多节杆体组成，降落时各节重叠以降低高度，举升时则各节伸展以提高观察高度。桅杆机械结构的各节之间存在间隙，杆体举升过程中存在弯曲和变形^[2-4]，桅杆越高，则桅杆顶部存在越大的姿态变化，而且，桅杆举升的高度不同，这种扭转、变形也不同；举升后由于风吹、发动机振动等影响，也会加剧这种不稳定的变化，如一种收藏高度1.9 m、举升后高度超过8.7 m、由7节组成的桅杆，在倾斜地面上举升时，升到最高处的倾斜可以达到约1°，扭转变形角度可达45 mil左右。不准确测量出这些变化，显然就会在目标坐标的计算中引入很大的误差。桅杆的这些误差会影响侦察车的侦察定向精度^[5]，因此需要采取准确的测量方法，以降低这种变形对光电桅杆侦察精度的影响。

分析侦察车、桅杆与光电设备的误差因素能够为系统设计通过依据^[6-7]；在静止调平的平台上桅杆承载光电设备可以获得很高的定向精度^[8]；在野外应用的侦察车上桅杆及其承载的设备姿态是变化的，采用倾角传感器可以在车辆驻车时桅杆举升前后测量其俯仰、倾斜的角度，精度能够达到0.1 mil量级，通过惯性元件能够减少时间漂移^[9]；对于桅杆举升时的扭动，则倾角传感器无能为力。一种较好的方法是采用惯性导航装置，将这种包含有3个陀螺和3个加速度计的设备安装在桅杆顶部，可以动态测量出桅杆举升在不同高度下的倾斜、俯仰与扭动，寻北精度1.0 mil的惯性导航装置，姿态测量精度约0.7 mil。不过，采用这种方法也存在成本较高、尺寸较大的不足，该尺寸会影响运输限高下桅杆的收藏高度。若降低该设备高度100 mm，则6节活动杆体可以提高举升高度600 mm。采用单一陀螺与倾角传感器的组合，能够在驻车状态下有效获得桅杆顶部的方位、俯仰和倾斜角度^[10]。

因此研究一种侦察车载桅杆式光电侦察的侦察定向测量方法成为可能。

1   姿态测量与坐标转换

1.1   采用单一陀螺的姿态测量原理

采用双轴倾角传感器代替水平两个陀螺仪来完成姿态角测量，姿态方位测量精度要求达到0.03°/h，需要对其所测原始数据进行滤波处理。因此，在初始航向角已装定的基础上，采取在载体坐标系完成载体Z轴迭代更新计算，实现航向角测量，将更新后载体Z轴方位角根据倾角传感器所测的载体姿态角，投影到导航坐标系，再解算出载体航向真值，系统原理框图如图 1所示。

图  1  系统原理框图

Figure  1.  Principle block diagram of system

下载: 全尺寸图片 幻灯片

根据倾角传感器所测信息，实时判定载体姿态角是否处于完全静止状态，若为连续静止状态，则通过载体静止状态下方位角漂移估算Z轴陀螺零偏残差，并完成修正，提高系统精度。

根据上述测姿原理建立的测姿设备，可以测量倾斜量(即姿态角的俯仰、横滚分量)，而在方位分量上只能跟踪变化量。在其测量起始时刻给出当前北向角，通过测姿设备对方位变化量的跟踪，可以实时计算出北向角。

1.2   坐标转换关系

采用以下测量方法完成惯性导航设备向测姿设备的初始北向角传递：

在桅杆未升起、处于机械锁紧状态时，测姿设备通过惯性导航设备获得北向角，即：测姿设备初始北向角=惯性导航设备方位角+安装误差。

进行目标定位时，根据光电转塔输出的方位和俯仰角度、目标距离可以计算出目标在平台坐标系x_gy_gz_g中的坐标。这样，通过平台坐标系原点(图 2中O₂，即观测点)的大地坐标，以及平台坐标系相对于大地坐标系的旋转变换关系，即可求出目标的大地坐标。

图  2  侦察相关坐标系

Figure  2.  Related coordinate system for reconnaissance

下载: 全尺寸图片 幻灯片

卫星定位装置测得的是O₁点坐标，因为桅杆举升倾角较小，故O₂点与O₁点坐标可近似认为仅存在高程差。

光电转塔基座与测姿仪固连，使得可以直接由测姿设备姿态角推算出转塔坐标系x_gy_gz_g与天-东-北坐标系的旋转变换关系。特别的，当安装使x_dy_dz_d与x_gy_gz_g平行时，测姿设备给出的方位、俯仰、横滚角可作为x_gy_gz_g向天-东-北坐标系进行旋转变换的3个欧拉角。一般情况下，考虑x_dy_dz_d与x_gy_gz_g的旋转变换，该变换相关的欧拉角作为安装误差参数，可以作为修正系统固有偏差的依据。

坐标系均采用右手系。平台坐标系x_gy_gz_g以平台中心为原点，方位轴为x轴，方位角度解算器零位为z轴，方位角度解算器-90°位置为y轴。导航坐标系x_dy_dz_d以测姿仪安装定位面为基准，安装尽量保证与平台坐标系平行。本地坐标系xyz即天-东-北坐标系，原点与平台坐标系重合，以本地地平面法线方向为x轴，正东方向为y轴，正北方向为z轴。本地基准坐标系x′y′z′原点与本地坐标系重合，x, y, z轴方向与地心坐标系平行，本地基准坐标系与本地坐标系的方位偏离为经度L₀，俯仰偏离为纬度B₀。地心坐标系x″y″z″以地心为原点，以赤道0经度位置为x轴，以地理北极为z轴。

定位模型中姿态角统一采用如下的三欧拉角定义：坐标系I′[O′:X′, Y′, Z′](旋转后的坐标系)相对于坐标系I[O′: X′, Y′, Z′]的欧拉角为(φ, θ, γ)，即，坐标系I’由坐标系I分别绕OZ轴、OY轴，OX轴旋转φ、θ、γ角得到，角度方向按照右手准则定义。

根据矢量转动原理，可得旋转变换矩阵T_φ、T_θ、T_γ分别为

则旋转变换矩阵为A=T_γT_θT_φ，即旋转变换关系为

其中，

则逆变换为

变量定义如下：DH_Yaw为测姿设备方位角，DH_Pitch为测姿设备俯仰角，DH_Roll为测姿设备横滚角；GD_Yaw为平台方位角，GD_Pitch为平台俯仰角；ZeroEr_Yaw为平台系统零位与测姿仪系统零位的安装误差方位偏差，ZeroEr_Pitch为俯仰偏差，ZeroEr_Roll为横滚偏差，系统校准时测得的固定参数；L₀为基准点经度，B₀为基准点纬度，Tg_Distance为目标距离。

其中，GD_Yaw、GD_Pitch指示了目标在平台坐标系下的方位角，Tg_Distance表示目标与平台坐标系原点的距离，可根据这3个参数计算出目标在平台坐标系下的坐标：

1) 平台坐标系到导航坐标系的转换

建立过渡坐标系x_by_bz_b，x_cy_cz_c，其坐标轴定义为

则有：

A₁由(2)式计算出，其中

2) 导航坐标系到本地坐标系的转换

建立过渡坐标系x_by_bz_b，x_cy_cz_c，其坐标轴定义为

则有：

A₂由(2)式计算出，其中，

3) 本地坐标系到本地基准坐标系的转换

本地坐标系与本地基准坐标系方位、俯仰偏离分别为L₀，B₀，因此，变换关系为

A3由式(2)计算出，其中，

4) 本地基准坐标到地心坐标的变换

本地基准坐标系与地心坐标系平移量即为本地基准坐标系原点在地心坐标系下的xyz坐标{x₀, y₀, z₀}，可推导出：

其中, $N = \frac{a}{{\sqrt {1 - {e^2}{{\sin }^2}B} }} $，则变换关系为

5) 地心坐标转换到经纬度

根据(13)式，可导出地心坐标到经纬度的反算公式，其中纬度B的计算采用递归算法求解：

2   系统设计与结果

2.1   系统设计

方案采用一只激光陀螺、一个双轴倾角仪，以及一块计算机板和一套二次电源，形成测量设备。将激光陀螺与双轴倾角仪组合安装于桅杆顶部，安装时保证激光陀螺仪的敏感轴与双轴倾角仪的敏感轴保持基本正交，利用软件通过旋转矩阵进行剩余安装偏角的补偿，使系统能够感测到3个正交轴上的角度变化或角增量变化。其中，双轴倾角仪感测导航系下水平方向上的角度变化，即俯仰角与横滚角变化。激光陀螺感测载体系下天向的角增量变化。

车载的惯性导航装置为姿态测量装置传递初始信息，利用传感器感测到的角度与角增量信息在初始信息的基础上进行迭代解算，得到载体的航向变化。

器件选型方面，选用的激光陀螺的精度为0.01°/h；倾角仪精度不低于0.011 2°；二次电源最大输出功率50 W；计算机板与激光陀螺采用RS422接口通信。

光电设备上获得目标距离、相对平台零位的方位角、俯仰角后，经过平台坐标系与本方案设备坐标系、本地坐标系、本地基准坐标系、地心坐标系等的转换，应用卫星定位装置获得的本地坐标值，得到目标的大地坐标。

2.2   设备与系统试验

将完成的设备固定在两轴转台上，进行室温下的静态和动态试验。

在室温条件下，进入航向姿态测量状态后，模拟使用环境，同时摆动转台的主轴与俯仰轴(俯仰轴不超过±15°)，将转台摆动到测量航向姿态的真实位置(以转台为基准)，停止后记录下该时刻系统输出的航向角、俯仰角与横滚角信息，并与真值比较(以转台为基准)，计算误差。测量出航向姿态的真实位置并记录数据。通过32组数据统计的结果如表 1所示。

表  1  设备测试数据

Table  1.  Measured data of equipment

误差/mill
俯仰	横滚	航向
0.095 3	0.087 1	0.093

下载: 导出CSV 

| 显示表格

利用水平仪调平两轴转台，固定测量设备，用水平仪测量出基准，使航向角、俯仰角与横滚角基准处于基准位置，将当前姿态信息与地理位置信息作为初始装订信息发送给航向姿态测量装置。当其进入航姿测量状态后每30 min记录一组航向角、俯仰角与横滚角，测试2 h。每测完一组，断电冷却2 h，再次进行相同测试。共测试5组，每组4个数据。测试结果如表 2所示。

表  2  设备时间变化情况

Table  2.  Variation with time of equipment

	0.5 h	1 h	1.5 h	2 h
航向误差/mil	0.133 9	0.313 9	0.567 8	0.706 8
俯仰误差/mil	0.103 0	0.106 4	0.107 4	0.095 6
横滚误差/mil	0.079 0	0.075	0.073 4	0.073 0

下载: 导出CSV 

| 显示表格

将桅杆式光电系统及测姿设备等安装在侦察车上，进行了外场试验，在桅杆举升(光电设备离地约5 m)、降落和车辆行进间桅杆举升(光电设备离地约3.5 m)、收藏等情况下，获得了目标大地坐标的多组数据，侦察车系统的水平圆概率误差满足了使用要求。

表  3  系统对目标的定位侦察精度

Table  3.  Positioning accuracy for target reconnaissance of system

车辆状态	桅杆状态	定位精度
驻车侦察	收藏	高程4.19 m，水平7.47 m
	举升	高程4.46 m，水平9.03 m
	收藏	高程7.29 m，水平7.26 m
	举升	高程8.79 m，水平4.55 m
行进侦察	收藏	高程2.04 m，水平6.22 m
	举升	高程6.10 m，水平3.80 m

下载: 导出CSV 

| 显示表格

3   结束语

采用桅杆式光电设备是提高侦察车战场适应性的重要措施。采用单一陀螺和倾角传感器组合，实现对桅杆升降过程中的航向角变化测量，结合侦察车的惯性导航装置给出的北向角度，通过各设备间坐标系的合理转换，能够有效控制桅杆升降中的误差对侦察车目标定位精度的影响，经过实验室测试和外场试验，结果表明能够满足侦察车的精度要求。