本发明公开了一种基于机载光电吊舱位置和姿态的目标定位系统，该系统设置在机载光电吊舱内部；该测量系统具有：获得所在机载光电吊舱俯仰角θ和横滚角γ信息的动态倾角获取模块；获得所在机载光电吊舱经度Bc、纬度Lc、高度Hc和偏航角φ信息的定位模块；处理模块根据机载光电吊舱的经纬高以及地面参考点的经度Bm、纬度Lm和高度Hm，最终转化成东北天坐标系(Xwk,Ywk,Zwk)；处理模块根据机载光电吊舱获取的目标图像，获取图像中目标的像素坐标(u,v)；结合吊舱的相机的焦距f、吊舱与相机轴中心成像在海面上的距离Yc以及地面参考点的大地直角坐标系(Xck,Yck,Zck)生成的平移矩阵T1，将目标的像素坐标最终得到目标的实际经纬度和高程，完成目标的测量。
1.一种基于机载光电吊舱位置和姿态的目标定位系统，其特征在于该系统设置在机载光电吊舱内部；
获得所在机载光电吊舱俯仰角θ和横滚角γ信息的动态倾角获取模块；
获得所在机载光电吊舱经度Bc、纬度Lc、高度Hc和偏航角φ信息的定位模块；
处理模块根据机载光电吊舱的经纬高以及地面参考点的经度Bm、纬度Lm和高度Hm，经由大地直角坐标系(Xck,Yck,Zck)，最终转化成东北天坐标系(Xwk,Ywk,Zwk)；
处理模块根据机载光电吊舱获取的目标图像，获取图像中目标的像素坐标(u,v)；结合吊舱内相机的焦距f、吊舱与相机轴中心成像在海面上的距离Yc以及地面参考点的大地直角坐标系(Xck,Yck,Zck)生成的平移矩阵T1，将目标的像素坐标经由吊舱坐标系、东北天坐标系和大地直角坐标系的转换，最终得到目标的实际经纬度和高程，完成目标的测量；
所述处理模块通过如下公式将机载光电吊舱转换成东北天坐标系下的坐标(Xwk,Ywk,Zwk)：其中R1为旋转矩阵，T1为平移矩阵
其中，B为地面参考点的纬度，L为地面参考点的经度，(Xmk,Ymk,Zmk)为地面参考点坐标。
2.根据权利要求1所述的基于机载光电吊舱位置和姿态的目标定位系统，其特征还在于所述的动态倾角获取模块还包括：获取动态倾角获取模块自身位置和姿态的陀螺仪和加速度计。
3.根据权利要求1所述的基于机载光电吊舱位置和姿态的目标定位系统，其特征还在于：所述的定位模块与处于不同位置的定位天线连接；
工作时，定位模块接收处于不同位置的定位天线分别传输的定位信息，综合计算得出定位模块所处的位置信息；
双定位天线接收基于GPS、格洛纳斯GLONASS、伽利略GALILEO或北斗卫星定位系统的卫星定位信息。
4.根据权利要求1所述的基于机载光电吊舱位置和姿态的目标定位系统，其特征还在于：所述处理模块通过下式：
分别将机载光电吊舱的经度Bc、纬度Lc、高度Hc和地面参考点的经度Bm、纬度Lm和高度Hm转换成机载光电吊舱大地坐标(Xck,Yck,Zck)和地面参考点坐标(Xmk,Ymk,Zmk)；
其中， N为椭球的曲率半径，a＝6378137米，e2＝0.0066943799013；
5.根据权利要求1所述的基于机载光电吊舱位置和姿态的目标定位系统，其特征还在于所述的处理模块将目标在图像中的像素坐标(u,v)结合吊舱的姿态信息，得到目标在东北天坐标系下的坐标，坐标转换过程如下：根据公式：
将像素坐标(u,v)转换成图像物理坐标(x,y)；
根据小孔成像和共线方程，结合相机焦距f、吊舱与相机光轴中心成像在海面上的距离YC，得到目标在吊舱坐标系下的坐标(XC，YC，ZC)；
根据光电吊舱的俯仰角θ，偏航角 横滚角γ，将目标在光电吊舱坐标系下的坐标(XC，YC，ZC)转为目标在东北天坐标系下的坐标(Xw,Yw,Zw)；
其中，R′代表旋转矩阵，T′代表平移矩阵，(Xwk,Ywk,Zwk)是光电吊舱在东北天坐标系下的坐标。
6.根据权利要求1所述的基于机载光电吊舱位置和姿态的目标定位系统，其特征还在于所述的处理模块在计算得到东北天坐标系下的坐标(Xw,Yw,Zw)后，通过坐标计算得出目标在大地直角坐标系中的坐标(Xk,Yk,Zk)，过程如下：其中，R2代表旋转矩阵，L、B分别代表地面参考点的经度和纬度，T2代表平移矩阵,(Xmk,Ymk,Zmk)为地面参考点在大地直角坐标系下坐标；
最后根据如下公式即可得到目标的经纬高(LO,BO,HO)；
其中， 为椭球的曲率半径，a＝6378137米，e2＝0.0066943799013。
基于机载光电吊舱位置和姿态的目标定位系统
技术领域
[0001] 本发明涉及一种基于机载光电吊舱位置和姿态信息的目标定位系统。主要涉及专利号：G01测量；测试G01S无线电定向；无线电导航；采用无线电波测距或测速；采用无线电波的反射或再辐射的定位或存在检测；采用其他波的类似装置G01S19/00卫星无线电信标定位系统；利用这种系统传输的信号确定位置、速度或姿态G01S19/38利用卫星无线电信标定位系统传输的信号来确定导航方案G01S19/39传输带有时间戳信息的卫星无线电信标定位系统，例如GPS[全球定位系统],GLONASS[全球导航卫星系统]或GALILEO G01S19/42确定位置。
背景技术
[0002] 随着船舶、飞机和人员在海上活动的数量、密度不断加大，通航环境日益复杂，加上全球气候异常，发生海上突发事件的概率及复杂性随之增加，使海上救助系统应急抢险救灾能力面临严峻考验。快速发现海上遇险目标、准确进行目标定位是缩短搜救时间，实施高效救助，降低遇险目标危险的首要条件。对于未知地点的海面遇险目标，国内外普遍采用搜救直升机搭载近红外/中红外/远红外或可见光成像设备组成光电吊舱系统在事故海域进行大范围快速扫描的方法进行海面遇险目标远距离搜寻。遇险目标在红外或可见光图像中往往呈现为点状或斑点状的小目标，且目标强度很低，图像信噪比相对也低，目标基本上会被背景和噪声淹没，再加上由于飞机的振动，目标的图像清晰度不高，尤其当恶劣海况下，图像模糊情况更为严重，难以对目标进行准确定位，而目标准确定位又是进行快速搜救的关键，因此，对于海面遇险目标的识别和准确定位一直是海上应急救助的研究热点。
[0003] 在实际应用中，为了进行海面目标定位，需通过飞机上导航设备的专用接口获取飞机载体的位置姿态信息(也即通常所说的导航信息)，然后采用软件将飞机载体的导航信息经坐标转换为光电吊舱的位置姿态信息，再结合目标的红外或可见光图像进行目标定位。经研究发现，影响目标定位精度的误差因素主要包括：光电吊舱系统的指向误差；光电吊舱系统与飞机载体导航系统之间的安装对准误差；飞机载体导航系统自身的测量误差。其中，飞机载体导航系统自身测量误差为影响定位精度的主要因素。
[0004] 现有的采用飞机载体导航信息进行目标定位的方法存在以下几个主要问题：
[0005] 导航信息来源于飞机载体，由于导航系统是专用设备，无论是接口的选配还是数据格式的获取都较为困难。
[0006] 由于真正与目标定位直接相关的是光电吊舱的位置姿态信息，而引入定位计算的却是飞机载体的导航信息，虽然光电吊舱是安装于飞机载体上，但两者的位置姿态信息并非同步，对位置姿态信息的实时性难以保证。另外，飞机载体的位置姿态信息的获取本身也无法做到实时，根据非实时的位置姿态信息无法计算得到准确的目标定位信息。
[0007] 飞机载体与光电吊舱是通过减振器相连接，减振器有效地隔离了对光电吊舱目标成像有害的大部分振动，但由于减振器为刚性或金属塑料材质，其自身特性难以获取，因此也需考虑减振器的运动特性，飞机载体的导航信息实际并不能直接等效为光电吊舱的位置姿态。
[0008] 正是由于存在上述三个问题，通过结合海面目标红外或可见光图像与飞机载体导航信息进行定位的方法难以达到高精度。
发明内容
[0009] 本发明针对以上问题的提出，而研制的一种基于机载光电吊舱位置和姿态的目标定位系统，该系统设置在机载光电吊舱内部；
[0010] 该测量系统具有：
[0011] 获得所在机载光电吊舱俯仰角θ和横滚角γ信息的动态倾角获取模块；
[0012] 获得所在机载光电吊舱经度Bc、纬度Lc、高度Hc和偏航角φ信息的定位模块；
[0013] 处理模块根据机载光电吊舱的经纬高以及地面参考点的经度Bm、纬度Lm和高度Hm，经由大地直角坐标系(Xck,Yck,Zck)，最终转化成东北天坐标系(Xwk,Ywk,Zwk)；
[0014] 处理模块根据机载光电吊舱获取的目标图像，获取图像中目标的像素坐标(u,v)；结合吊舱的相机的焦距f、吊舱与相机轴中心成像在海面上的距离Yc以及地面参考点的大地直角坐标系(Xck,Yck,Zck)生成的平移矩阵T1，将目标的像素坐标经由吊舱坐标系、东北天坐标系和大地直角坐标系，最终得到目标的实际经纬度和高程，完成目标的测量。
[0015] 作为优选的实施方式，所述的测量仪还包括：获取测量仪自身位置和姿态的陀螺仪和加速度计。
[0016] 作为优选的实施方式，所述的定位模块与双定位天线连接；所述的定位模块与双定位天线连接；工作时，定位模块接收处于不同位置的定位天线分别传输的定位信息，综合计算得出定位模块所处的位置信息；双定位天线接收基于GPS、格洛纳斯GLONASS、伽利略GALILEO或北斗卫星定位系统的卫星定位信息。
[0017] 作为优选的实施方式，所述处理模块通过下式：
[0018]
[0019] 分别将机载光电吊舱的精度Bc、纬度Lc、高度Hc和地面参考点的经度Bm、纬度Lm和高度Hm转换成机载光电吊舱大地坐标(Xck,Yck,Zck)和地面参考点坐标(Xmk,Ymk,Zmk)；
[0020] 其中， a＝6378137(米)，e2＝0.0066943799013；
[0021] B为地面参考点的纬度，L为地面参考点的经度。
[0022] 作为优选的实施方式，所述处理模块通过如下公式将机载光电吊舱转换成东北天坐标系下的坐标(Xwk,Ywk,Zwk)：
[0023]
[0024] 其中R1为旋转矩阵，T1为平移矩阵
[0025]
[0026] 其中，B为地面参考点的纬度，L为地面参考点的经度。
[0027] 作为优选的实施方式，所述的处理模块将目标在图像中的像素坐标(u,v)结合吊舱的姿态信息，得到目标在东北天坐标下的坐标的过程如下：
[0028] 根据公式：
[0029]
[0030] 将像素坐标素坐标(u,v)转换成图像物理坐标(x,y)；
[0031] 根据小孔成像和共线方程，结合相机焦距f、吊舱与相机光轴中心成像在海面上的距离YC，得到目标在吊舱坐标系下的坐标(XC，YC，ZC)；
[0032]
[0033] 根据光电吊舱的俯仰角θ，偏航角 横滚角γ，将目标在光电吊舱坐标系下的坐标(XC，YC，ZC)转为目标在东北天坐标系下的坐标(Xw,Yw,Zw)；
[0034]
[0035]
[0036] 其中，R′代表旋转矩阵，T′代表平移矩阵，(Xwk,Ywk,Zwk)是光电吊舱在东北天坐标系下的坐标。
[0037] 作为优选的实施方式，所述的处理模块在计算得到东北天坐标系下的坐标(Xw,Yw,Zw)后，通过坐标计算得出目标在大地直角坐标系中的坐标(Xk,Yk,Zk)，过程如下：
[0038]
[0039] 其中，R2代表旋转矩阵，L、B分别代表地面参考点的经度和纬度，T2代表平移矩阵,(Xmk,Ymk,Zmk)为地面参考点在大地直角坐标系下坐标；
[0040]
[0041] 最后根据如下公式即可得到目标的经纬高(LO,BO,HO)；
[0042]
[0043] 其中， 为椭球的曲率半径，a＝6378137(米)，e2＝0.0066943799013。
[0044] 通过采用上述技术方案，本发明公开的一种基于机载光电吊舱位置和姿态的目标定位系统，具有如下的优点及效果：
[0045] 1采用直接测量光电吊舱本体位置姿态信息进行海面目标定位的方法，从根本上解决了用飞机载体导航信息等效光电吊舱位置姿态信息所引入的定位误差，有效提高定位精度。
[0046] 2姿态位置测量装置的测量仪直接紧固在光电吊舱内的稳定平台内壳体上，双定位天线安装在光电吊舱与飞机之间安装架的外缘，因此能直接测量得到光电吊舱的全部位置姿态信息，由于所有测量设备均与光电吊舱同步运动，所以隔离了各种飞机载体振动以及减震器对光电吊舱位置姿态测量的影响。
[0047] 3姿态位置测量装置仅需一根数据线即可与机舱内的外设进行连接，无需经过飞机上的数据接口，获取数据方法简单。
[0048] 4采用惯性导航技术作为全球定位技术的补充，能够确保全球定位系统受到天气等因素干扰时仍可获得测量装置的准确位置信息。
附图说明
[0049] 为了更清楚的说明本发明的实施例或现有技术的技术方案，下面将对实施例或现有技术描述中所需要使用的附图做一简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0050] 图1为本发明位置姿态测量设备安装位置图
[0051] 图2为本发明求解目标在大地坐标系坐标的方法示意图
具体实施方式
[0052] 为使本发明的实施例的目的、技术方案和优点更加清楚，下面结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚完整的描述：
[0053] 图1示出了本发明的位置姿态测量设备在光电吊舱上的安装位置。位置姿态测量设备包括1测量仪、2双定位天线、3天线馈线、4数据线和5 RS422接口。
[0054] 测量仪1安装在图1所示的光电吊舱内壳壳壁处，安装时需保证不与光电吊舱稳定平台的俯仰框架有任何接触，不阻碍俯仰框架的角度调节，不同内部结构的光电吊舱可根据吊舱内实际情况进行装配。
[0055] 双定位天线2经由支架安装在光电吊舱与飞机载体接口的安装盘上，安装时保证前后天线在同一水平线上，定位天线通过天线馈线3与测量仪1连接。测量仪1的数据经由数据线4送入位于机舱内的光电吊舱基座，再由光电吊舱基座处的RS422接口5即可将测量仪1的所有数据导出。。
[0056] 对于海面目标定位的实质是根据光电载荷的位置姿态信息，结合对目标所拍摄的红外/可见光图像，通过旋转矩阵实现坐标系转换，如图2所示，将目标的位置由O1X1Y1Z1坐标系转换为O2X2Y2Z2坐标系，然后解算目标位置，获得目标的经度、纬度和高程信息。具体计算包括如下4个步骤：
[0057] 步骤1：飞机从停机位置起飞，在海面进行目标搜寻，当发现目标后，对目标进行拍摄，并实时记录光电吊舱的经纬高(Bc,Lc,Hc)和俯仰角θ，偏航角 横滚角γ；在地面处，将该设备放置在地面参考点处，在本实施例中该参考点为飞机起飞位置，测量其经纬高(Bm,Lm,Hm)。通过坐标转换分别转换到大地直角坐标系下的光电吊舱坐标(Xck,Yck,Zck)和地面参考点坐标(Xmk,Ymk,Zmk)。
[0058]
[0059] 其中， 为椭球的曲率半径，a＝6378137(米)，e2＝0.0066943799013
[0060] 将光电吊舱的大地直角坐标(Xck,Yck,Zck)转变为以地面参考点为原点的东北天坐标系下的坐标(Xwk,Ywk,Zwk),
[0061]
[0062] 其中R1为旋转矩阵，T1为平移矩阵
[0063]
[0064] 其中，B为地面参考点的纬度，L为地面参考点的经度，(Xmk,Ymk,Zmk)为地面参考点在大地直角坐标系下坐标。经过坐标变换后得到光电吊舱在东北天坐标系下的坐标(Xwk,Ywk,Zwk)。
[0065] 步骤2：采集到的图像经过目标识别等处理得到目标在图像中的像素坐标(u,v)，结合光电吊舱当时的姿态信息，经过坐标解算，得到目标在东北天坐标下的坐标，解算过程如下：
[0066] 目标在图像上可以读取的是像素信息(u,v),整个图像的像素中心坐标为(u0,v0)，dx,dy分别表示图像中每个像素的宽高，则可通过坐标转换变为目标的图像物理坐标(x,y)。
[0067]
[0068] 根据小孔成像和共线方程，结合相机焦距f、吊舱与相机光轴中心成像在海面上的距离YC，得到目标在吊舱坐标系下的坐标(XC，YC，ZC)。
[0069]
[0070] 根据光电吊舱的俯仰角θ，偏航角 横滚角γ，将目标在光电吊舱坐标系下的坐标(XC，YC，ZC)转为目标在东北天坐标系下的坐标(Xw,Yw,Zw)。
[0071]
[0072] 其中，R′代表旋转矩阵，T′代表平移矩阵，(Xwk,Ywk,Zwk)是光电吊舱在东北天坐标系下的坐标。
[0073]
[0074] 步骤3：得到目标在东北天坐标系下的坐标(Xw,Yw,Zw)后，通过坐标解算得出目标在大地直角坐标系中的坐标(Xk,Yk,Zk)，最后通过公式得到目标的经纬高(LO,BO,HO)。
[0075]
[0076] 其中，R2代表旋转矩阵，L、B分别代表地面参考点的经度和纬度，T2代表平移矩阵,(Xmk,Ymk,Zmk)为地面参考点在大地直角坐标系下坐标。
[0077]
[0078] 最后根据如下公式即可得到目标的经纬高(LO,BO,HO)。
[0079]
[0080] 按照上述步骤，在本地进行了目标定位测试试验，采用无人机加装小型光电吊舱飞行，对地面事先选定的4个目标点进行定位，分别利用飞机载体导航信息和本发明所述方法获取的光电吊舱位置姿态信息进行目标位置计算，得到的结果如下表所示。
[0081]
[0082]
[0083] 由测试试验分析结果可见，采用光电吊舱本体的位置姿态信息进行目标定位，在定位准确度上显著优于采用飞机载体的导航信息计算获得的目标位置信息。
[0084] 以上所述，仅为本发明较佳的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，根据本发明的技术方案及其发明构思加以等同替换或改变，都应涵盖在本发明的保护范围之内。
