一种无人机搜索目标快速定位方法
【专利摘要】本发明公开了一种无人机搜索目标快速定位方法。本方法采用一架搜索无人机搜索旷野中目标，通过自身无线系统传输可视图像进行目标锁定，通过特定航行轨迹配合无人机多点视角切换和所处的姿态信息、高度信息和GPS定位信息进行多点定位迭代计算来快速获得旷野目标的具体定位信息。本搜索定位方法可广泛适用于无人机目标搜索的目标定位。
【专利说明】一种无人机搜索目标快速定位方法
【技术领域】
[0001] 本发明涉机器人搜索领域，特别是涉及一种无人机搜索目标快速定位方法。
【背景技术】
[0002] 随着无人机应用的推广，旷野目标搜索逐步成为一种应用热点。
[0003] 旷野目标搜索中，目标定位的快速性和准确性是目标搜索定位的重要评定指标。
[0004]目前在现有技术的无人机搜索定位中，有些采用单机搜索定位，但是姿态传感传 感器、GPS定位系统等存在误差，使得单机定位精度不高的结果。
[0005] 有些场合采用多机、双机搜索，存在成本高、资源浪费等缺点。
[0006] 在多机搜索中采用视觉定位过程中，图像数据为平面两位数据且无法有效确立精 确的视角，为目标精确定位带来困难。
【发明内容】
[0007] 本发明的目的在于要解决现有技术存在的问题，提供一种无人机单机搜索目标的 快速定位方法，实现成本低、计算简单、快速快，精度高。
[0008] 为解决上述技术问题，本发明的构思是：本发明采用一架无人机系统进行搜索定 位，采用目标锁定后的垂直、平移、直飞的多点特定动作视角切换和坐标定位，配合在完成 相同视角锁定目标情况下的无人机捷联惯导信息、GPS信息、高度信息和视角信息进行数据 融合迭代定位计算，最终快速精确计算旷野目标的定位信息。
[0009] 根据上述发明构思，本发明采用下述技术方案： 一种无人机搜索目标快速定位方法，其特征在于：采用一架搜索无人机搜索旷野目标 信息，通过无线传输给所述接收基站，由接收基站进行目标定位迭代计算，快速精确获得目 标定位信息。
[0010] 上述搜索无人机包括一个无人机飞行机构、一个捷联惯导传感系统、一个高清摄 像机、一个高度传感器、一个GPS定位系统、一个中央控制器和一个无线通讯系统，所述中 央控制器分别与所述捷联惯导传感系统、高清摄像机、高度传感器、GPS定位系统、中央控制 器和无线通讯系统相连，并一起安装在所述无人机飞行机构之上，所述高清摄像机安装固 定在所述无人机飞行机构，中心视角预先测量确定。
[0011] 上述接收基站主要用于接收所述搜索无人机的捷联惯导信息、高度信息、GPS定位 信息和视角信息，控制无人机完成多点特定航迹巡航和定位，根据多点信息迭代计算，来确 定快速搜索目标的坐标。
[0012] 上述多点信息迭代计算方法是通过所述无人机锁定目标后获得无人机垂直、平移 和直飞的多点特定动作视角切换和坐标定位，完成相同视角锁定目标情况下所处的捷联惯 导信息、高度信息、GPS定位信息和视角信息进行定位迭代三角计算，获得旷野目标的具体 定位信息。
[0013] 本发明与现有技术相比较，具有如下显而易见的突出实质性特点和显著进步：本 发明采用单机视觉定位配合捷联惯导信息、高度信息、GPS定位信息，通过特定动作视角切 换和坐标定位，采用迭代三角计算获得旷野目标的具体定位信息。
[0014] 本发明的目标搜索定位方法可广泛适用于无人机目标搜索定位。
【专利附图】
【附图说明】
[0015] 附图1是本发明一个实施例的框图。
[0016] 附图2是图1示例中搜索无人机的结构示意图。
[0017] 附图3是本发明的迭代三角计算算法示意图。
[0018]
【具体实施方式】 本发明的优选实施例结合附图详述如下： 实施例一： 如图1所示，在本无人机搜索目标快速定位方法：采用两架搜索无人机（1)搜索旷野目 标信息，通过无线传输给接收基站（2)，由接收基站（2)进行目标定位迭代计算，快速精确 获得目标定位息。
[0019] 实施例二： 本实施例与实施例一基本相同，特别之处如下： 参见图2,所述搜索无人机（1)包括一个无人机飞行机构（101)、一个捷联惯导传感系 统（102)、一个高清摄像机（103)、一个高度传感器（104)、一个GPS定位系统（105)、一个 中央控制器（106)和一个无线通讯系统（107)，所述中央控制器（106)分别与所述捷联惯 导传感系统（102)、高清摄像机（103)、高度传感器（104)、GPS定位系统（105)、中央控制器 (106)和无线通讯系统（107)相连，并一起安装在所述无人机飞行机构（101)之上，所述高 清摄像机（103)安装固定在所述无人机飞行机构（101)，中心视角预先测量确定。
[0020]参见图3,所述多点信息迭代计算方法的具体操作步骤如下： ① 设在三维坐标图中目标为T点,无人机起始点为A; ② 通过捷联惯导信息对GPS定位信息进行校正计算出无人机所处各点的GPS定位信 息； ③ 在目标锁定情况下，记录目标锁定视角点，无人机锁定目标后对应视角为ZA'AT， 其中A'为所述无人机锁定目标后的位置点，获得视角角度过程中通过姿态角度信息进行 修正，以保证锁定视角的参考坐标为地面三维坐标系，且无姿态角偏差。记录A的GPS坐标 和高度，得A(xa,ya,ha),其中xa,ya,ha为A点的三维坐标值； ④ 无人机偏转一定角度后保持航行角度β，保持A的相同高度水平移动1距离后到Bl 点，记录Bl的GPS坐标和高度，得Bl点三维坐标（xb,yb,ha); ⑤ 无人机在BI点垂直下降hi到达B点，使得目标在无人机图像中的对应点相同，即视 角相同（ZA7AT=ZI^BT)，记录13点坐标（xb，yb，ha_hl); ⑥ 保持航行角度β，保持B的相同高度水平移动1距离到达Cl后垂直下降h2到达C 点，使得目标在无人机图像中的对应点相同，即视角相同（ZA'AT=ZB'BT=ZC'CT)， 记录C点坐标（xc,yc,ha_hl_h2); ⑦ 根据三维坐标图中已确定A、B、C、A1、B1和Cl的GPS坐标和高度，通过三角形投影和 三角形相似的三角坐标计算，可在不必知道具体目标锁定视角ZA'AT、ZB'BT、ZC' CT的精确大小的情况下，就可以精确获得目标T的GPS定位坐标； ⑧具体计算如下： i) 根据三角形投影，可以获得： ArBrI=IabiI=I (i) B'c' =IbciI=I ⑵ ii) 根据ZA'AT=ZB'BT=ZC'CT，直角三角形ZA'AT与ZB'BT三角形 相似，直角三角形」CCT与」BT三角形相似。
[0021] iii)根据三角形相似原理，可以获得：
【权利要求】
1. 一种无人机搜索目标快速定位方法，其特征在于：采用一架搜索无人机（1)搜索旷 野目标信息，通过无线传输给接收基站（2)，由接收基站（2)进行目标定位迭代计算，快速 精确获得目标定位息。
2. 根据权利要求1所述的无人机搜索目标快速定位方法，其特征在于：所述搜索无 人机（1)包括一个无人机飞行机构（101 )、一个捷联惯导传感系统（102)、一个高清摄像机 (103)、一个高度传感器（104)、一个GPS定位系统（105)、一个中央控制器（106)和一个无线 通讯系统（107)，所述中央控制器（106)分别与所述捷联惯导传感系统（102)、高清摄像机 (103)、高度传感器（104)、GPS定位系统（105)、中央控制器（106)和无线通讯系统（107)相 连，并一起安装在所述无人机飞行机构（101)之上，所述高清摄像机（103)安装固定在所述 无人机飞行机构（101 )，中心视角预先测量确定。
3. 根据权利要求1所述的无人机搜索目标快速定位方法，其特征在于：所述接收基站 (2)主要用于接收所述搜索无人机（1)的捷联惯导信息、高度信息、GPS定位信息和视角信 息，控制无人机完成多点特定航迹巡航和定位，根据多点信息迭代计算，来确定快速搜索目 标的坐标。
4. 根据权利要求3所述的无人机搜索目标快速定位方法，其特征在于：所述多点信息 迭代计算方法的具体操作步骤如下： ① 设在三维坐标图中目标为T点,无人机起始点为A; ② 通过捷联惯导信息对GPS定位信息进行校正计算出无人机所处各点的GPS定位信 息； ③ 在目标锁定情况下，记录目标锁定视角点，无人机锁定目标后对应视角为ZA'AT， 其中A'为所述无人机锁定目标后的位置点，获得视角角度过程中通过姿态角度信息进行 修正，以保证锁定视角的参考坐标为地面三维坐标系，且无姿态角偏差；记录A的GPS坐标 和高度，得A(xa,ya,ha),其中xa,ya,ha为A点的三维坐标值； ④ 无人机偏转一定角度后保持航行角度β，保持A点的相同高度水平移动1距离后到 Bl点，记录Bl的GPS坐标和高度，得Bl点三维坐标（xb，yb，ha); ⑤ 无人机在BI点垂直下降hi到达B点，使得目标在无人机图像中的对应点相同，即视 角相同（ZA7AT=ZI^BT)，记录13点坐标（xb，yb，ha_hl); ⑥ 无人机保持航行角度β，保持B点的相同高度水平移动1距离到达Cl后垂直下 降h2到达C点，使得目标在无人机图像中的对应点相同，即视角相同（ZA'AT=ZB' BT=ZC'CT)，记录C点坐标（xc,yc,ha_hl_h2); ⑦ 根据三维坐标图中已确定A、B、C、A1、B1和Cl的GPS坐标和高度，通过三角形投影和 三角形相似的三角坐标计算，可在不必知道具体目标锁定视角ZA'AT、ZB'BT、ZC' CT和偏转航行角度β的精确大小的情况下，就可以精确获得目标T的GPS定位坐标； ⑧ 具体计算如下： i) 根据三角形投影，可以获得： ArBrI=IabiI=I (i) B'c' =IbciI=I ⑵ ii) 根据ZA'AT=ZB'BT=ZC'CT，直角三角形ZA'AT与ZB'BT三角形 相似，直角三角形」CCT与」BT三角形相似； iii) 根据三角形相似原理，可以获得：
iv) #AA> Cw IV T中，枏据会弦宙理π?以荘得
在ΛΒ' C' T中,设ZC' B' T为Qf,
V)由于1、ha、hi、h2已知，公式（1)、（2)、（3)和（4)代入公式（5)、（6)，即可以求出|A^t|、Wτ| 和τ| 以及角度β; ￥：0在1〇7平面进行分析，在八六^1^1'中，根据点^(13，73)、1^(113,713)，以 及角度β、￡Τ: 设直线A '
C'在X0y平面的斜率为ka，则设直线T A^的斜率为kl，则
在Λ C T中，直线C在xoy平面的斜率也为ka，设直线T的斜率为 k2,则：
即可得到直线T A'的方程为：
直线T B^的方程为： y = k2(x-xb)+yb (8) 直线T和直线T的交点即为T点坐标（xt，yt):综合（7)、（8)得：
至此，目标T的精确坐标确定。
【文档编号】G01S19/49GK104316949SQ201410590112
【公开日】2015年1月28日 申请日期:2014年10月29日 优先权日:2014年10月29日
【发明者】唐智杰 申请人:上海大学