光电经纬仪跟踪测量的基本定位技术

1、光电测量技术课程读书报告光电经纬仪跟踪测量的基本定位技术院（系）名称：电气工程及自动化学院专业名称：自动化测试与控制系学生学号：学生姓名：指导教师：哈尔滨工业大学2016年11月目录第1章绪论错误！未定义书签。1.1 课题背景及研究意义11.2 国内外光电经纬仪技术的研究现状11.3 光电经纬仪测速方法和应用现状31.4 报告主要研究内容及结构安排41.5 本章小结5第2章跟踪测量理论基础错误！未定义书签。2.1 常用坐标系及坐标转换62.1.1 地心坐标系62.1.2 跑道坐标系72.1.3 测量坐标系72.1.4 辅助坐标系82.2 直角坐标系之间的转换82.3 目标空间定位方法92.3.

2、1 单站定位92.3.2 双站交会定位102.3.3 纯测距信息定位112.4 本章小结11第3章光电跟踪测量错误！未定义书签。3.1 激光测距仪123.2 单站双站综合测量133.3 本章小结14参考文献错误！未定义书签。第1章绪论1.1 课题背景及研究意义现代化靶场上的武器控制系统、激光通讯设备或者是天文观测仪器中，为了迅速地发现并精确地跟踪目标，都需要安装光电捕获跟踪与瞄准装置。光电经纬仪作为既能记录目标的运动姿态，又能实现对目标高精度空间测量的靶场光电跟踪测量设备，具有测量精度高、事后可复现、直观性强等优点，因此，在靶场跟踪测量领域得到了广泛的应用1。为了精确地跟踪运动目标，一旦确定运

3、动目标之后，需要将目标的运动轨迹以及运动状态记录下来。而运动目标的外弹道测量数据主要包括两方面的内容：第一，运动姿态；第二，弹道数据：如目标在各跟踪测量时刻的空间位置坐标、速度、距离、航迹倾角、航迹偏角等等20得到目标在当前时刻的速度，对于分析目标的空间运动特性、几何特性、物理特性以及后续跟踪测量时刻对目标的识别、运动过程的模拟仿真、航迹测量等具有非常重要的意义3。在靶场试验中，光电经纬仪对运动目标进行跟踪测量时，只能测得目标在各跟踪时刻的方位角和俯仰角，不能直接输出目标的速度测量值。因此，本文主要针对光电经纬仪不能直接测得跟踪目标的速度值这一问题，开展了光电测量仪器的测速误差分析及提高精度方

4、法这一研究。利用光电经纬仪输出的方位角和俯仰角的角度值，以及加装激光距仪输出的目标距光电经纬仪的距离，采用相应的数学算法获取目标的速度、加速度与测量时间的函数关系，据此外推目标在下一时刻的空间位置坐标、速度和加速度等运动参数40将目标的速度参数反馈给光电经纬仪自身的伺服控制系统，作为目标继续跟踪捕获的参考。这在光电跟踪测量领域中，对提高光电经纬仪的跟踪测量精度具有非常重要的现实意义，也是今后该领域研究的目标和方向。1.2 国内外光电经纬仪技术的研究现状光电经纬仪作为现代化靶场最基本的光电测量仪器，被广泛应用于航空航天以及武器试验等军事科研领域。从60年代初期开始，国内的一些研究所和高校开始自己

5、研制靶场试验专用光电经纬仪。其中，最具有代表性的研制单位是长春光机所和成都光电所，这两个研究所研制的靶场专用大型光电经纬仪代表了国内光电经纬仪技术的最高水平5o图1.1光电经纬仪60年代中期，长春光机所就己经研制了第一台光学电影经纬仪。60年代末，第二台光学电影经纬仪成功问世，这台经纬仪安装了光学轴角编码器，并且可以实时地对外输出测量角度值。在70年代生产的经纬仪，己经采用激光测距仪实现激光测距的功能，并且安装有电视实时记录目标序列图像6o80年代中期的第四代光学电影经纬仪，己经采用集成电路、微处理机等技术，可以实现变焦距捕获电视、红外、程序引导等多种跟踪手段，并且具有跟踪精度高、测量距离远等

6、优点。如今，在崭新的21世纪，长春光机所所生产的全新光电经纬仪不仅安装了全波段传感器，而且具有大口径、测量精度高、作用距离远的优点，能够全天候的工作，并且具有一定的对抗功能，在靶场光电跟踪测量领域，光电经纬仪己经成为了必不可少的试验工具。国外的导弹试验靶场配备的光电经纬仪不仅数量多、测量精度高，而且更新换代速度非常快。图1.2是美国的靶场光电经纬仪正在对发射的导弹进行跟踪测量试验的图片。图1.2国外的光电测量系统早在1791年，英国的威廉康格里夫就在英格兰伍尔威奇兵工厂用小型望远镜跟踪了射程高达4570m的“康格里夫”火箭。而真正开创了光学测量界先河的是美国的戈达德夫人，她在1926年，用锡尼

7、柯达摄影机对罗伯特H-戈达德博士的液体火箭研制过程做了摄影记录7。1937年，德国的冯布劳恩用阿斯卡尼亚经纬仪加装16mm的摄影机,用于320公里试验射程的V-2火箭轨迹的拍摄。在1940年，第一台电影经纬仪(KTH-41)正式装备德国的佩内明德试验靶场。至20世纪70年代初，美国的太平洋导弹靶场就己经装备了23台电影经纬仪，而大西洋导弹靶场仅次于太平洋导弹靶场。1993年，美国的BoeingDuluth公司研制出了高性能光电测量系统，它具有反应速度快、体积小、质量轻等特点。国外光电经纬仪的型号主要有KTH-500,RA-SUM,EOTS,GEODSS,K-400,RADOT,KINETO,M

8、AST等网。在现代化靶场上，光电经纬仪的工作状态主要有两种：固定站形式和活动站形式。而活动站的工作状态又分为两种：一种是把光电经纬仪安装在车载平台上；一种是把光电经纬仪直接安装到轮船的甲板上。国内靶场的光电经纬仪大都采用固定地基式的工作方式，这种安装方式虽然机动性能差，但钢筋混凝土结构的地基可以使光电经纬仪平稳地工作，且带动误差小。因此，光电经纬仪在跟踪测量过程中产生的测量误差也比较小。本文主要的研究对象是新型具有激光距功能的固定站式大型光电经纬仪。1.3 光电经纬仪测速方法和应用现状在靶场上，光电经纬仪对目标进行跟踪测量时，跟踪精度与响应速度是其实现精密跟踪的关键，而获取目标的运动特性是跟踪

9、系统的主要技术要求。其中，目标的运动特性主要包括目标的距离、空间位置坐标、速度及加速度等。因此，获得目标的速度并提高其测量精度，这在光电经纬仪的目标跟踪测量过程中具有非常重要的意义。通过阅读大量的国内外文献：发现以往光电经纬仪对目标进行跟踪测量试验时，对目标的测速方法和测速精度方面的研究，都是基于目标图像处理或姿态测量等问题，没有进行过系统的研究，并且从没有在真正的意义上提出过测量目标速度及提高其测量精度等方面的研究课题。而且在光电经纬仪的跟踪测量系统技术指标一览表上，也从没有提出过其对目标速度的测量精度这一技术指标。因此，通过光电经纬仪输出的测量数据,计算测量目标的速度、对测速误差来源进行分

10、析及提出提高测速精度的方法显得尤为重要。由于光电经纬仪不能直接输出运动目标的速度，因此，为了获取跟踪目标的速度及其测量精度，需要对光电经纬仪输出的测量数据进行数据处理。首先，根据光电经纬仪输出的测量数据计算目标的空间位置坐标。其次，采用曲线拟合的方法拟合目标的运动轨迹。最后，对目标的轨迹函数进行微分运算，即可得到对应的速度值。综上，获得了目标的速度值之后，根据函数误差传递原理及误差合成原理分析经纬仪测量误差对速度精度的影响因子。1.4 报告主要研究内容及结构安排本文主要针对靶场试验用光电经纬仪不能实时输出跟踪目标的速度这一问题展开研究。利用光电经纬仪输出的目标方位角、俯仰角以及目标距离信息，首

11、先通过坐标计算和坐标转换得到目标的空间位置。其次，采用相应的曲线拟合算法得到目标的运动轨迹曲线函数。最后，通过微分运算得到目标的速度，并分析测速误差的来源，及测量误差对测速精度的影响因子。因此，本论文的主要研究内容包括以下五个章节：第一章为绪论。主要介绍了本课题的研究背景和意义，以及光电经纬仪技术的研究现状。重点分析了光电经纬仪测速方法、理论及应用的研究现状和问题。最后介绍了本文的主要研究内容及结构安排。第二章主要介绍了目标跟踪测量的理论基础。首先阐述了目标空间定位过程中常用的坐标系及其坐标转换方法。其次论述了目前常用的目标空间定位方法及理论，为后面第三章的研究内容做好了铺垫。最后是对第二章节

12、的总结，阐述了基础理论知识的重要性。第三章给出了测量目标速度的相关算法。通过第二章对于不同分类方法的介绍，提出了光电跟踪测量中目标空间定位的方法一单站双站综合测量方法，在一定程度上提高了空间定位精度，减小了测速误差。其次，提出了采用三次样条插值方法拟合目标运动轨迹。区别于之前的方法，减少了因轨迹拟合过程中带来的拟合残差，使后续对速度的误差分析变得更加简单。1.5 本章小结本章主要介绍了报告的研究背景和意义、国内外光电经纬仪技术的研究现状，以及光电跟踪测量系统测速的方法、理论应用和工程应用，在此基础上，提出了本文的主要研究内容及结构安排。第2章跟踪测量理论基础2.1 常用坐标系及坐标转换2.1.

13、1 地心坐标系地心坐标系是全球统一的坐标系，它包括地心球面坐标系、地心空间直角坐标系、地心大地坐标系三种。地心坐标系以地球的质心作为坐标原点，以与大地水准面实现最佳密合的地球椭球面作为其基准面。地心坐标系对航空航天技术、远程跟踪控制技术以及地球科学研究等都具有十分重要的意义，尤其对靶场光电跟踪测量设备而言，地心坐标系作为坐标转换的一个重要中间媒介，起着无可替代的作用。在光测事后数据处理中，地心空间直角坐标系更适用于光电经纬仪测量数据的处理，因此，本文所涉及的地心坐标系均为地心空间直角坐标系9。图2.1地心空间直角坐标系如图2.1所示，Oa为地球中心，是地心空间直角坐标系的坐标原点。Za轴是地球

14、自转的旋转轴，指向地球自转轴的方向。Xa轴与Za轴垂直，由地心指向起始大地子午面与赤道的交点。X轴位于赤道面上，Xa轴与Ya轴共同构成赤道面，Xa、工与Za三轴符合右手定则10。2.1.2跑道坐标系跑道坐标系是站心坐标系的一种，主要用来确定目标机体上某点相对于跑道上某周定点位的具体位置，通常以跑道上过某固定点的铅垂线和水平面为基准建立符合右手定则的坐标系11。图2.2跑道坐标系跑道坐标系的坐标原点Ob通常为目标机体的起飞点或者着陆区阻拦索的中心点。Xb轴通常位于水平面内，由坐标原点指向跑道延伸的方向，其方向为从大地北向东顺时针转过P角度。Yb轴为过坐标原点的铅垂线，且竖直向上为正方向。Xb轴位

15、于水平面内且过坐标原点，Xb、K与Zb构成符合右手定则的空间直角坐标系，如图2-2所示。2.1.3 测量坐标系测量坐标系也是站心坐标系的一种，主要用来描述目标相对测站的空间位置坐标。测量坐标系通常采用垂直坐标系，适用于光电经纬仪和弹道相机等现代化靶场光电测量设备。测量坐标系以设备的垂直轴、照准轴和水平轴的几何交点为坐标原点Oc。Oc即为光电经纬仪的光心。Xc轴过坐标原点Oc,且指向大地北方向。YC轴为经过坐标原点Oc的铅垂线，向上为正。Zc轴与Xc轴同位于过坐标原点Oc的水平面内，与Xc轴、Yc轴共同构成符合右手定则的坐标系12,如图2.3所示。图2.3测量坐标系2.1.4 辅助坐标系辅助坐标

16、系又称为过渡坐标系，是为了简化计算或易于建模而专门设立的坐标系，它的坐标原点和三个坐标轴的方向可以任意设置130在获得最终参数估计量之后，需要将坐标值转换到指定坐标系。例如，在光电经纬仪交会测量目标的空间位置时，首先以某观测站为坐标原点求取目标相对于测量坐标系的空间位置，然后通过辅助坐标系将测量坐标系下的坐标转换到发射坐标系下，得到目标在发射坐标系下的空间位置，使得计算过程得到简化。2.2 直角坐标系之间的转换以跑道坐标系与地心空间直角坐标系的转换为例，假设目标在跑道坐标系下的坐标可表示为（Xb乂Zb），在地心空间直角坐标系下的坐标为（XaYaZa）,跑道坐标系坐标原点的天文经度、纬度以及Xb

17、与正北方向的夹角分别为L。、&、P0,坐标原点相对于地心空间直角坐标系的坐标为（XaYaZa设Rx伊）、Ry（¥）、RzB）分别为跑道坐标系Xb轴、K轴、Zb轴绕地心空间直角坐标系旋转角的旋转矩阵，如（2-1）式所示。一1Rx(P)=00-sinPRy二cos001sinPcosP-sin0(2-1)_sin?cos'-R尸尸sin中I0cossin'-0coW001结合上式可得跑道坐标系与地心空间直角坐标系的转换关系为：XIXol.、,dbl+p。kNJYaYo+Rz7aj7oj71-LoRx(-Bo<2)'(2-2)其他坐标系间的转换同理。2

18、.3 目标空间定位方法2.3.1 单站定位靶场上，单台光电经纬仪对目标进行跟踪测量时，只能得到目标的方位角和俯仰角，只根据测角信息不能测得目标在每个时间点的空间位置，因此，在光电经纬仪上加装激光测距仪，并在目标机体上加装激光合作目标。这样，不仅可以获得目标在每一时间序R,进而可以得到目标的空间位置坐标，如图2.4所示。列上的方位角A、俯仰角Ei的测量值，还可以得到目标距光电经纬仪光心的距离值图2.4单台光电经纬仪匹配激光测距仪定位由此可见，单台光电经纬仪匹配激光测距装置，观测站能够获得目标的距离值R、方位角A、俯仰角E三个信息，完全可以确定目标的空间位置140靶场上采用单台光电经纬仪对目标进行

19、空间定位比较容易实现，因此，单站定位方法得到了越来越广泛的应用。但单站测量的定位精度低于双站交会测量的定位精度，尤其是当目标距光电经纬仪较远时，激光测距仪的测距精度明显降低，更降低了单站测量的定位精度。2.3.2 双站交会定位在光电经纬仪不安装激光测距装置或目标机体不加装激光合作目标的情况下，单台光电经纬仪不能获得目标的空间位置，只能利用满足交会测量条件（两观测视线在同一平面内且相交）的两台光电经纬仪通过交会测量测得目标的空间位置坐标。Mi图2.5双站交会定位如图2.5所示，A、B两站各有一台光电经纬仪，Oi、。2分别为两台经纬仪的光心位置，它们之间的距离为L。当目标位于Mi点时，其在测量水平

20、面的投影点，A、B两台经纬仪测得的目标的方位角和俯仰角分别为Az、Eiio双站交会测量的定位精度高于单站测量的定位精度，但低于多站交会测量并采用融合算法处理获取目标空间位置的精度15。总的来说，双站交会定位方法计算过程较简单，测量精度较高，实用性比较强。同理，多站交会与双站交会测量类似，多台经纬仪要同时满足多站布站的原则，多台经纬仪输出的测量数据较多，为提高测量精度需要切换交会公式，因此数据的利用率低，且带来较多的误差项，后续误差计算较麻烦，因此，本文不过多赘述。2.3.3 纯测距信息定位基地的光电经纬仪一般安装有激光钢距仪，可以测得目标距经纬仪光心的距离值,在事后光测数据处理中，只要有三个或

21、三个以上的激光测距元就可以确定目标的空间位置。当有三个测站时，我们可以根据测站间的空间几何关系求解目标的空间位置坐标，因此也称为3R测元定位法。图2.63R测元定位2.4 本章小结本章主要介绍了光电经纬仪跟踪测量的理论基础：一、常用坐标系；如地心空间直角坐标系、测量坐标系、跑道坐标系、辅助坐标系二、坐标系之间的转换；介绍了几种常用坐标系之间的转换关系，为后续目标空间定位打好基础。三、几种常用的目标空间位置的测量方法。通过在实际工程中的应用，对比数据处理的复杂程度和精确度，为后面目标空间定位方法的选取提供了依据，并为计算分析目标的速度提供了参考。第3章光电跟踪测量3.1激光测距仪激光测距仪是通过

22、测量激光往返目标所需的时间来确定目标距离的一种传感器。激光测距仪因结构简单、探测距离远、响应时间快等优点，被广泛应用于靶场光电跟踪测量领域16。目前，靶场的光电经纬仪大都通过激光测距仪完成高精度空间测距，与测量电视输出的数据配合实现单站高精度空间定位。发肘机接收机C*)旋转镜面图3.1激光传感器工作原理图一般情况下，靶场的光电经纬仪上安装的激光测距子系统由激光器、激光发射装置和接收装置以及处理电路组成。如图3.1所示，传感器工作时，由激光二极管向目标发射脉冲宽度极窄的激光脉冲，经目标反射后激光脉冲向各个方向散射，部分散射光返回到传感器的接收装置，记录并处理从激光脉冲发出到返回被接收所经历的时间

23、，即可确定目标的距离16,如式(3-1)所示。1 .，、R=-c4t(3-1)2其中，R即为光电经纬仪的光心距目标机体的距离，c为光速，虫为激光脉冲从激光二极管发射到返回至接收器被接收的时间。激光测距的误差主要包括系统误差和随机误差，系统误差事后可得到修正。测距过程中随机误差的来源主要有：计数器分辨率产生的误差；晶振频率稳定度产生的误差；触发器和放大器延时产生的误差。因此，激光测距仪测距过程中产生的总误差。为:CJ-;.-12二2(3-2)般情况下激光测距仪的测距精度可做到a<1m3.2 单站双站综合测量在靶场光电跟踪测量试验中，利用满足交会测量条件的两台光电经纬仪输出的观测数据就可以确

24、定运动目标在任一时刻的空间位置坐标。但是，当目标位于两台经纬仪的基线上方时，通过计算目标的空间定位误差知道定位误差为极大值，此时，不易选用交会测量方法170因此，本文给出了一种新的测量目标空间位置坐标的方法一单站双站综合测量方法，基本流程图如图3.2所示18。图3.2基本流程图Mn图3.3经纬仪布站图采用单站双站综合测量方法测量目标的空间位置坐标，在理论上解决了双站交会测量过程中出现极大测量误差的情况，以及单站定位过程中目标易丢失的情况，因此，有助于提高目标的空间坐标测量精度，进而提高目标的测速精度19。之后，基于三次样条插值法就可以拟合出目标运动轨迹20。根据光电经纬仪输出的测量数据，通过单

25、站双站综合测量方法得到了目标在各时间节点的空间位置坐标，即获得了目标的空间离散运动轨迹。而获取目标的连续运动轨迹往往是求取目标速度和加速度的前提和必要条件，因此，选择采用插值方法来获取目标运动轨迹的变化规律。鉴于高次插值既不稳定也不收敛的特点，而低次插值既具有收敛性又具有一定的稳定性，因此，选择低次插值方法更具有实用意义。低次插值方法虽然在插值区间具有连续性，但在插值节点处的一阶导数却不存在，而三次样条插值函数由分段三次曲线并接而成，不仅在连接点上二阶导数连续、具有二阶光滑度，还克服了高次插值既不收敛又不稳定的特点，因此，更适合运用于目标速度和加速度的进一步求取20。具体方法可参照相关专业参考

26、书，本报告中不再赘述。3.3 本章小结还解决了双站交会本章首先主要给出了一种新的光电跟踪测量定位方法：单站双站综合定位方法。这种方法不仅克服了多站融合测量数据冗余及数据利用率不高的弊端，测量中会出现极大测量误差的情况，大大地提高了目标空间定位精度参考文献1 J.L.Martnez,etal.Objectfollowingandobstacleavoidanceusingalaserscannerinoutdoormobilerobotauriga-a.Proc.ofIEEE/RSJInt.Conf.onIntelligenRobotsandSystems.pp.204-209,19982 S.

27、I.RoumeliotisandGA.Bekey.SEGEMENTS:Alayered,dual-Kalmanfilteralgorithmforindoorfeatureextraction.Proc.ofIEEE/RSJInt.Conf.onIntelligentRobotsandSystems.pp.454-461,20003 Y.D.KwonandJ.S.Lee.Astochasticmapbuildinmethodformobilerobotusing2-Dlaserrangefinder.AutonomousRobots.Vl.7,No.2,pp.187-200,19994 B.G

28、iesler,etal.FastmappingusingtheLog-HoughTransformation.Proc.IEEE/RSJInt.Conf.onIntelligentRobotsandSystems.pp.1702-1707,19985 A.Scott,etal.Quantitativeandqualitativecomparisonofthreelaser-rangemappingalgorithmsusingtwotypesoflaserscannerdata.Proc.IEEEInt.Conf.onSystems,Man,andCybernetics.pp.1422-142

29、7,20006 J.Guivant,etal.Highaccuracynavigationusinglaserrangesensorsinoutdoorapplication.Proc.IEEEInt.Conf.onRoboticsandAutomation.pp.3817-3821,20007刘明.激光在测距方面的应用.技术监督实用技术.1999,58 M.D.AdamsandA.J.Kerstens.TheinterpretationofphaseandintensitydatafromAMCWlightdetectionsensorsforreliableranging.Int.J.of

30、RoboticsResearch.No.5,pp.441-458,19969 M.HebertandE.Krotkov.3Dmeasurementsfromimaginglaserradars:howgoodarethey?.ImageandVisionComputing.vol.10,no.3,pp.170-178,199210 D.Nitzan,etal.Themeasurementanduseofregisteredreflectanceandrangedatainsceneanalysis.ProceedingsoftheIEEE.vol.65,no.2,197711 CangYe,J

31、ohannBorenstein.Characterizationofa2-DLaserScannerforMobileRobotObstacleNegotiation.Proceedingsofthe2002IEEEInternationalConferenceonRoboticsandAutomation.WashingtonDC,USA,10-17May2002,pp.2512-251812 Leonard,J.J.andDurrant-Whyte,H.F.ApplicationofMulti-targetTrackingtoSonarBasedMobileRobotNavigation.In