CN113654528A - 通过无人机位置和云台角度估测目标坐标的方法和系统 - Google Patents

通过无人机位置和云台角度估测目标坐标的方法和系统 Download PDF

Info

Publication number
CN113654528A
CN113654528A CN202111101909.2A CN202111101909A CN113654528A CN 113654528 A CN113654528 A CN 113654528A CN 202111101909 A CN202111101909 A CN 202111101909A CN 113654528 A CN113654528 A CN 113654528A
Authority
CN
China
Prior art keywords
angle
holder
data
camera
coordinates
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202111101909.2A
Other languages
English (en)
Other versions
CN113654528B (zh
Inventor
刘新阳
陈海诺
唐佰文
李冬青
王炜
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Tt Aviation Technology Co ltd
Original Assignee
Beijing Tt Aviation Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Tt Aviation Technology Co ltd filed Critical Beijing Tt Aviation Technology Co ltd
Priority to CN202111101909.2A priority Critical patent/CN113654528B/zh
Publication of CN113654528A publication Critical patent/CN113654528A/zh
Application granted granted Critical
Publication of CN113654528B publication Critical patent/CN113654528B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
    • G01C11/04—Interpretation of pictures
    • G01C11/06—Interpretation of pictures by comparison of two or more pictures of the same area
    • G01C11/08—Interpretation of pictures by comparison of two or more pictures of the same area the pictures not being supported in the same relative position as when they were taken
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64C—AEROPLANES; HELICOPTERS
    • B64C39/00—Aircraft not otherwise provided for
    • B64C39/02—Aircraft not otherwise provided for characterised by special use
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
    • B64D47/00—Equipment not otherwise provided for
    • B64D47/08—Arrangements of cameras
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B11/00—Measuring arrangements characterised by the use of optical techniques
    • G01B11/002—Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B64—AIRCRAFT; AVIATION; COSMONAUTICS
    • B64U—UNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U2101/00—UAVs specially adapted for particular uses or applications
    • B64U2101/30—UAVs specially adapted for particular uses or applications for imaging, photography or videography

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Multimedia (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Image Analysis (AREA)

Abstract

本发明涉及一种通过无人机位置和云台角度估测目标坐标的方法，包括：获取无人机的坐标数据和云台的角度数据；云台设置在无人机上；坐标数据与角度数据一一对应；根据坐标数据和角度数据确定出多条第一直线；确定出距离所有第一直线最短的第一目标点；将第一目标点的坐标定义为待测物体的位置坐标。本发明仅通过无人机、摄像头和图像处理设备便可完成对目标坐标的估测，具有成本低和估测过程简单便捷的优点。

Description

通过无人机位置和云台角度估测目标坐标的方法和系统
技术领域
本发明涉及无人机侦测技术领域，具体涉及一种通过无人机位置和云台角度估测目标坐标的方法和系统。
背景技术
目前，无人机在侦察任务中通过机载的测距模块上的激光雷达或者双目摄像头来获取目标的位置坐标信息，并根据该位置坐标信息计算出目标的位置。然而，相关技术需要在无人机上额外配备传感器模块，使得相关技术存在成本高的缺点。
发明内容
有鉴于此，提供一种通过无人机位置和云台角度估测目标坐标的方法和系统，以解决相关技术的无人机存在的侦察成本高的问题。
本发明采用如下技术方案：
第一方面，本发明提供了一种通过无人机位置和云台角度估测目标坐标的方法，包括：
获取无人机的坐标数据和云台的角度数据；所述云台设置在所述无人机上；所述坐标数据与所述角度数据一一对应；
根据所述坐标数据和所述角度数据确定出多条第一直线；
确定出距离所有所述第一直线最短的第一目标点；
将所述第一目标点的坐标定义为待测物体的位置坐标。
优选的，所述根据所述坐标数据和所述角度数据确定出多条第一直线之前，本发明的通过无人机位置和云台角度估测目标坐标的方法还包括：
获取固定在所述云台上的相机的相机参数和所述相机画面中的目标框中心点坐标；所述相机参数包括焦距、视场角和相机画面的像素；
根据所述相机参数和所述相机画面中的目标框中心点坐标确定所述云台的各角度数据对应的补偿角度；
根据所述云台的各角度数据对应的补偿角度对应修正所述云台的角度数据，得到修正后的所述云台的角度数据；
所述根据所述坐标数据和所述角度数据确定出多条第一直线，包括：
根据所述坐标数据和修正后的所述云台的角度数据确定出多条第一直线。
优选的，所述确定出距离所有所述第一直线最短的第一目标点之后，本发明的通过无人机位置和云台角度估测目标坐标的方法还包括：
采集所述无人机的当前坐标数据、所述云台的当前角度数据、固定在所述云台上的相机的相机参数和所述相机当前画面中的目标框中心点坐标；
根据所述相机参数和所述相机当前画面中的目标框中心点坐标确定所述云台的当前角度数据对应的补偿角度；
根据所述云台的当前角度数据对应的补偿角度修正所述云台的当前角度数据，得到修正后的所述云台的当前角度数据；
根据所述当前坐标数据和修正后的所述云台的当前角度数据确定出对应的第二直线；
确定出距离所有所述第一直线和所述第二直线最短的第二目标点；
判断所述第一目标点的位置坐标和所述第二目标点的位置坐标是否满足预设收敛条件；
当所述第一目标点的位置坐标和所述第二目标点的位置坐标满足预设收敛条件时，执行步骤：将所述第一目标点的坐标定义为待测物体的位置坐标；
当所述第一目标点的位置坐标和所述第二目标点的位置坐标不满足预设收敛条件时，执行步骤：采集所述无人机的当前坐标数据、所述云台的当前角度数据、固定在所述云台上的相机的相机参数和所述相机当前画面中的目标框中心点坐标。
优选的，所述第一直线为以所述无人机位置为起点，以固定在所述云台上的相机的视线角度为方向的射线。
优选的，所述根据所述坐标数据和所述角度数据确定出多条第一直线，包括：
将所述WGS84坐标数据转换为笛卡尔坐标数据；
根据所述笛卡尔坐标数据和所述角度数据确定出多条第一直线。
优选的，所述笛卡尔坐标数据对应的笛卡尔坐标系的原点为所述无人机取得的第一个WGS84坐标点。
优选的，确定出距离所有所述第一直线最短的第一目标点，包括：
通过如下计算公式计算出空间中任意一点P到所有所述第一直线的距离之和：
Figure BDA0003270963660000031
其中，D(p；X,V)表示距离之和；xk表示第k条第一直线对应的所述无人机的笛卡尔坐标数据；vk表示第k条第一直线对应的所述云台的角度数据；
通过如下计算公式计算所述距离之和的最小值，得到距离所有所述第一直线最短的第一目标点：
Figure BDA0003270963660000032
第二方面，本发明还提供了一种通过无人机位置和云台角度估测目标坐标的系统，包括：无人机、云台、相机和图像处理设备；
所述云台设置在所述无人机上，用于固定所述相机；
所述图像处理设备与所述相机连接，用于获取所述相机采集的图像，并根据所述图像实现本发明所述的通过无人机位置和云台角度估测目标坐标的方法。
本发明采用以上技术方案，一种通过无人机位置和云台角度估测目标坐标的方法，包括：获取无人机的坐标数据和云台的角度数据；所述云台设置在所述无人机上；所述坐标数据与所述角度数据一一对应；根据所述坐标数据和所述角度数据确定出多条第一直线；确定出距离所有所述第一直线最短的第一目标点；将所述第一目标点的坐标定义为待测物体的位置坐标。基于此，本发明仅通过无人机、摄像头和图像处理设备便可完成对目标坐标的估测，具有成本低和估测过程简单便捷的优点。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的一种工作情景图；
图2是本发明实施例提供的一种通过无人机位置和云台角度估测目标坐标的方法的流程示意图；
图3是本发明实施例提供的另一种工作情景图；
图4是本发明实施例提供的另一种通过无人机位置和云台角度估测目标坐标的方法的流程示意图；
图5是本发明实施例提供的一种通过无人机位置和云台角度估测目标坐标的系统的结构示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚，下面将对本发明的技术方案进行详细的描述。显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其它实施方式，都属于本发明所保护的范围。
图1是本发明实施例提供的一种工作情景图。如图1所示，无人机绕目标盘旋，期间，相机和云台需要一直保持对目标的锁定。在理想状态下，以无人机的位置为端点，以相机的视线角度为方向，可以得到一条指向目标的射线，所有射线汇集的位置，即为目标点的位置。
然而，在实际工作环境中，由于多种原因的影响，比如云台的抖动、云台的转向速度、无人机的位置偏移和相机的跟踪速度等原因，多条射线往往难以汇聚到同一个交点。
考虑到上述情况，本实施例提供了一种通过无人机位置和云台角度估测目标坐标的方法，如图2所示，本实施例的通过无人机位置和云台角度估测目标坐标的方法，包括：
S201、获取无人机的坐标数据和云台的角度数据；所述云台设置在所述无人机上；所述坐标数据与所述角度数据一一对应。
具体的，坐标数据可以是WGS84坐标数据，还可以是现有技术中其他能够实现本申请的坐标数据。其中，WGS84坐标系是GPS定位用的坐标系，由(经度，纬度，高度)组成。无人机的坐标数据为目前无人机所取得的的所有坐标数据，每个坐标数据对应一个云台的角度数据。
此外，无人机的坐标数据和云台的角度数据的获取方式为实时获取，即在无人机环绕目标飞行的过程中实时获取无人机的坐标数据和云台的角度数据，并实时运算。
S202、根据所述坐标数据和所述角度数据确定出多条第一直线。
具体的，可以以WGS84坐标为端点，以WGS84坐标对应的角度为方向可以得到一条以所述无人机位置为起点，以固定在所述云台上的相机的视线角度为方向的射线，如此，根据无人机的坐标数据和云台的角度数据确定出所有的射线。
S203、确定出距离所有所述第一直线最短的第一目标点。
详细的，在实际工作环境中，由于多种原因的影响，比如云台的抖动、云台的转向速度、无人机的位置偏移和相机的跟踪速度等原因，多条射线往往难以汇聚到同一个交点。因此，确定出距离所有所述第一直线最短的第一目标点，该第一目标点为目标最可能存在的位置。
S204、将所述第一目标点的坐标定义为待测物体的位置坐标。
本实施例采用以上技术方案，一种通过无人机位置和云台角度估测目标坐标的方法，包括：获取无人机的坐标数据和云台的角度数据；所述云台设置在所述无人机上；所述坐标数据与所述角度数据一一对应；根据所述坐标数据和所述角度数据确定出多条第一直线；确定出距离所有所述第一直线最短的第一目标点；将所述第一目标点的坐标定义为待测物体的位置坐标。基于此，本实施例仅通过无人机、摄像头和图像处理设备便可完成对目标坐标的估测，具有成本低和估测过程简单便捷的优点。
优选的，当获取到的无人机的坐标数据为WGS84坐标数据时，所述根据所述坐标数据和所述角度数据确定出多条第一直线，包括：
将所述WGS84坐标数据转换为笛卡尔坐标数据；
根据所述笛卡尔坐标数据和所述角度数据确定出多条第一直线。
具体的，要从WGS84坐标系转换为笛卡尔坐标系，首先要确定一个坐标作为笛卡尔坐标系的原点，这个点可以是空间中任意一个点。具体的转换过程如下：
1、将array1中的经度longi换算为array2中的x。详细的，经度所在的半径radius恒等于赤道半径radius_true(假设地球是正球体)，然后计算WGS84坐标与原点坐标的角度差θ，即array1(1)-base(1),将该角度差θ转换为弧度制后与radius相乘得到x。
2、将array1中的纬度latit换算为array2中的y。详细的，纬度所在的半径radius取决于纬度本身，所以需要先计算当前纬度半径radius_now，然后将当前纬度转换为弧度制，得到当前纬度的余弦，最后，将当前纬度的余弦乘赤道半径radius_true得到当前维度半径radius_now。接下来计算WGS84坐标与原点坐标的角度差θ，即array1(2)-base(2),将该角度差θ转换为弧度制后与radius相乘得到y。
3、将array1中的纬度altit换算为array2中的z，即array1(3)-base(3)。
需要说明的是，本说明书中，所有加粗字体对应的变量名(例如：array1)表示向量数组，非加粗字体对应的变量名(例如：longi)表示标量。WGS84坐标系到笛卡尔坐标系的转换函数，输入为WGS84坐标系数组array1＝[longi1,latit1,altit1；longi2,latit2,altit2。...],转换用坐标原点base＝[longi1,latit1,altit1]，输出为笛卡尔坐标系数组array2＝[x1,y1,z1；x2,y2,z2；...]。array1需与array2长度相同。
优选的，所述笛卡尔坐标数据对应的笛卡尔坐标系的原点为所述无人机取得的第一个WGS84坐标点，如此，计算之后的笛卡尔坐标系的第一个点永远是[0,0,0]。
优选的，确定出距离所有所述第一直线最短的第一目标点，包括：
1、通过如下计算公式计算出空间中任意一点P到所有所述第一直线的距离之和：
Figure BDA0003270963660000071
其中，D(p；X,V)表示距离之和；xk表示第k条第一直线对应的所述无人机的笛卡尔坐标数据；vk表示第k条第一直线对应的所述云台的角度数据。
详细的，第一直线为一条用y＝x+vt描述的射线，其中，x＝[x1；x2；x3]是一个描述射线端点的向量，v＝[v1；v2；v3]是一个描述射线方向的向量。空间内任意一个点p＝[p1；p2；p3]到射线y的距离是D(p；x,v)。在最小二乘法中，假如射线有k条，那么点p到所有k条射线的距离之和是D(p；X,V)。
2、通过如下计算公式计算所述距离之和的最小值，得到距离所有所述第一直线最短的第一目标点：
Figure BDA0003270963660000081
具体的，将上述计算所述距离之和的最小值的计算公式整理成线性方程组的格式Ap＝b后，得到如下计算公式：
Figure BDA0003270963660000082
Figure BDA0003270963660000083
最后，通过p＝b\A，可以得到离所有射线距离最近的点p的坐标，即第一目标点的坐标。
在实际应用过程中，当无人机移动速度较快时，不能保证追踪的目标始终在图像的中心点位置。此时，仅凭云台角度确定出射线是不准确的，需要根据目标在图像中的实际位置和相机的视场角DFOV，计算云台的补偿角度。如图3所示，相机的视场角DFOV即∠POM，补偿角度即∠AOB。
具体的，所述根据所述坐标数据和所述角度数据确定出多条第一直线之前，本实施例的通过无人机位置和云台角度估测目标坐标的方法还包括：
获取固定在所述云台上的相机的相机参数和所述相机画面中的目标框中心点坐标；所述相机参数包括焦距、视场角和相机画面的像素；
根据所述相机参数和所述相机画面中的目标框中心点坐标确定所述云台的各角度数据对应的补偿角度；
根据所述云台的各角度数据对应的补偿角度对应修正所述云台的角度数据，得到修正后的所述云台的角度数据；
所述根据所述坐标数据和所述角度数据确定出多条第一直线，包括：
根据所述坐标数据和修正后的所述云台的角度数据确定出多条第一直线。
更具体的，所述相机当前画面中的目标框中心点坐标即图3中的点B的位置坐标。无人机的云台角度L0S数组是由偏航角yaw＝[yaw1；yaw2；...]和俯仰角pitch＝[pitch1；pitch2；...]组成的，LOS＝[yaw,pitch]，因此计算得到的补偿角度也要符合这个格式，即补偿角角度CA＝[dx,dy]，其中，画面中横向的补偿量dx＝[dx1；dx2；...]对应偏航角yaw,画面中纵向的补偿量dy＝[dy1；dy2；...]对应俯仰角pitch。
补偿角度具体的计算方法如下：
1、获取相机的焦距f，相机的视场角DFOV，相机画面的像素[xMAX,yMAX],图像算法给出的目标坐标FOV＝[x,y](即相机画面中的目标框中心点坐标)。
2、根据如下计算公式计算相机画面的对角线长度：
dMAX＝sqrt(xMAX^2+yMAX^2)。
3、根据如下计算公式分别计算dx补偿量和dy补偿量。
Figure BDA0003270963660000091
Figure BDA0003270963660000092
如此，得到补偿角角度CA＝[dx,dy]。
根据补偿角度修正所述云台的角度数据，得到修正后的所述云台的角度数据如下：
A＝LOS+CA，A＝[YAW,PITCH]。
用修正后的所述云台的角度数据，可以得到射线y射线方向v，v＝[sin(A(1)),cos(A(1)),tan(A(2))]。
图4是本发明实施例提供的另一种通过无人机位置和云台角度估测目标坐标的方法的流程示意图。如图4所示，本实施例的通过无人机位置和云台角度估测目标坐标的方法包括：
S401、获取无人机的坐标数据和云台的角度数据；所述云台设置在所述无人机上；所述坐标数据与所述角度数据一一对应；
S402、根据所述坐标数据和所述角度数据确定出多条第一直线；
S403、确定出距离所有所述第一直线最短的第一目标点；
S404、采集所述无人机的当前坐标数据、所述云台的当前角度数据、固定在所述云台上的相机的相机参数和所述相机当前画面中的目标框中心点坐标；
S405、根据所述相机参数和所述相机当前画面中的目标框中心点坐标确定所述云台的当前角度数据对应的补偿角度；
S406、根据所述云台的当前角度数据对应的补偿角度修正所述云台的当前角度数据，得到修正后的所述云台的当前角度数据；
S407、根据所述当前坐标数据和修正后的所述云台的当前角度数据确定出对应的第二直线；
S408、确定出距离所有所述第一直线和所述第二直线最短的第二目标点；
S409、判断所述第一目标点的位置坐标和所述第二目标点的位置坐标是否满足预设收敛条件；当所述第一目标点的位置坐标和所述第二目标点的位置坐标满足预设收敛条件时，执行步骤S410，当所述第一目标点的位置坐标和所述第二目标点的位置坐标不满足预设收敛条件时，执行步骤S404；
S410、将所述第一目标点的坐标定义为待测物体的位置坐标。
具体的，预设收敛条件为p(t)-p(t-1)<tol,其中，tol为可被接受的错误界限值。通过上述方法，可以更加精确的确定目标的位置坐标。
基于一个总的发明构思，本发明还提供了一种通过无人机位置和云台角度估测目标坐标的系统。如图5所示，本实施例的通过无人机位置和云台角度估测目标坐标的系统，包括：无人机51、云台52、相机53和图像处理设备54；
所述云台52设置在所述无人机51上，用于固定所述相机53；
所述图像处理设备54与所述相机53连接，用于获取所述相机53采集的图像，并根据所述图像实现本发明上述实施例所述的通过无人机位置和云台角度估测目标坐标的方法。
需要说明的是，本实施例和上述实施例基于一个总的发明构思，具备相同或相应的执行过程和有益效果，在此不再赘述。
可以理解的是，上述各实施例中相同或相似部分可以相互参考，在一些实施例中未详细说明的内容可以参见其他实施例中相同或相似的内容。
需要说明的是，在本发明的描述中，术语“第一”、“第二”等仅用于描述目的，而不能理解为指示或暗示相对重要性。此外，在本发明的描述中，除非另有说明，“多个”的含义是指至少两个。
流程示意图中或在此以其他方式描述的任何过程或方法描述可以被理解为，表示包括一个或更多个用于实现特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分，并且本发明的优选实施方式的范围包括另外的实现，其中可以不按所示出或讨论的顺序，包括根据所涉及的功能按基本同时的方式或按相反的顺序，来执行功能，这应被本发明的实施例所属技术领域的技术人员所理解。
应当理解，本发明的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中，多个步骤或方法可以用存储在存储器中且由合适的指令执行系统执行的软件或固件来实现。例如，如果用硬件来实现，和在另一实施方式中一样，可用本领域公知的下列技术中的任一项或他们的组合来实现：具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路，具有合适的组合逻辑门电路的专用集成电路，可编程门阵列(PGA)，现场可编程门阵列(FPGA)等。
本技术领域的普通技术人员可以理解实现上述实施例方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成，所述的程序可以存储于一种计算机可读存储介质中，该程序在执行时，包括方法实施例的步骤之一或其组合。
此外，在本发明各个实施例中的各功能单元可以集成在一个处理模块中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现，也可以采用软件功能模块的形式实现。所述集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时，也可以存储在一个计算机可读取存储介质中。
上述提到的存储介质可以是只读存储器，磁盘或光盘等。
在本说明书的描述中，参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不一定指的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
尽管上面已经示出和描述了本发明的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本发明的限制，本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。

Claims (9)

1.一种通过无人机位置和云台角度估测目标坐标的方法，其特征在于，包括：
获取无人机的坐标数据和云台的角度数据；所述云台设置在所述无人机上；所述坐标数据与所述角度数据一一对应；
根据所述坐标数据和所述角度数据确定出多条第一直线；
确定出距离所有所述第一直线最短的第一目标点；
将所述第一目标点的坐标定义为待测物体的位置坐标。
2.根据权利要求1所述的通过无人机位置和云台角度估测目标坐标的方法，其特征在于，所述坐标数据为WGS84坐标数据。
3.根据权利要求1所述的通过无人机位置和云台角度估测目标坐标的方法，其特征在于，所述根据所述坐标数据和所述角度数据确定出多条第一直线之前，还包括：
获取固定在所述云台上的相机的相机参数和所述相机画面中的目标框中心点坐标；所述相机参数包括焦距、视场角和相机画面的像素；
根据所述相机参数和所述相机画面中的目标框中心点坐标确定所述云台的各角度数据对应的补偿角度；
根据所述云台的各角度数据对应的补偿角度对应修正所述云台的角度数据，得到修正后的所述云台的角度数据；
所述根据所述坐标数据和所述角度数据确定出多条第一直线，包括：
根据所述坐标数据和修正后的所述云台的角度数据确定出多条第一直线。
4.根据权利要求1所述的通过无人机位置和云台角度估测目标坐标的方法，其特征在于，所述确定出距离所有所述第一直线最短的第一目标点之后，还包括：
采集所述无人机的当前坐标数据、所述云台的当前角度数据、固定在所述云台上的相机的相机参数和所述相机当前画面中的目标框中心点坐标；
根据所述相机参数和所述相机当前画面中的目标框中心点坐标确定所述云台的当前角度数据对应的补偿角度；
根据所述云台的当前角度数据对应的补偿角度修正所述云台的当前角度数据，得到修正后的所述云台的当前角度数据；
根据所述当前坐标数据和修正后的所述云台的当前角度数据确定出对应的第二直线；
确定出距离所有所述第一直线和所述第二直线最短的第二目标点；
判断所述第一目标点的位置坐标和所述第二目标点的位置坐标是否满足预设收敛条件；
当所述第一目标点的位置坐标和所述第二目标点的位置坐标满足预设收敛条件时，执行步骤：将所述第一目标点的坐标定义为待测物体的位置坐标；
当所述第一目标点的位置坐标和所述第二目标点的位置坐标不满足预设收敛条件时，执行步骤：采集所述无人机的当前坐标数据、所述云台的当前角度数据、固定在所述云台上的相机的相机参数和所述相机当前画面中的目标框中心点坐标。
5.根据权利要求1所述的通过无人机位置和云台角度估测目标坐标的方法，其特征在于，所述第一直线为以所述无人机位置为起点，以固定在所述云台上的相机的视线角度为方向的射线。
6.根据权利要求2所述的通过无人机位置和云台角度估测目标坐标的方法，其特征在于，所述根据所述坐标数据和所述角度数据确定出多条第一直线，包括：
将所述WGS84坐标数据转换为笛卡尔坐标数据；
根据所述笛卡尔坐标数据和所述角度数据确定出多条第一直线。
7.根据权利要求6所述的通过无人机位置和云台角度估测目标坐标的方法，其特征在于，所述笛卡尔坐标数据对应的笛卡尔坐标系的原点为所述无人机取得的第一个WGS84坐标点。
8.根据权利要求6所述的通过无人机位置和云台角度估测目标坐标的方法，其特征在于，确定出距离所有所述第一直线最短的第一目标点，包括：
通过如下计算公式计算出空间中任意一点P到所有所述第一直线的距离之和：
Figure FDA0003270963650000031
其中，D(p；X,V)表示距离之和；xk表示第k条第一直线对应的所述无人机的笛卡尔坐标数据；vk表示第k条第一直线对应的所述云台的角度数据；
通过如下计算公式计算所述距离之和的最小值，得到距离所有所述第一直线最短的第一目标点：
Figure FDA0003270963650000032
9.一种通过无人机位置和云台角度估测目标坐标的系统，其特征在于，包括：无人机、云台、相机和图像处理设备；
所述云台设置在所述无人机上，用于固定所述相机；
所述图像处理设备与所述相机连接，用于获取所述相机采集的图像，并根据所述图像实现如权利要求1-8任意一项所述的通过无人机位置和云台角度估测目标坐标的方法。
CN202111101909.2A 2021-09-18 2021-09-18 通过无人机位置和云台角度估测目标坐标的方法和系统 Active CN113654528B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111101909.2A CN113654528B (zh) 2021-09-18 2021-09-18 通过无人机位置和云台角度估测目标坐标的方法和系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111101909.2A CN113654528B (zh) 2021-09-18 2021-09-18 通过无人机位置和云台角度估测目标坐标的方法和系统

Publications (2)

Publication Number Publication Date
CN113654528A true CN113654528A (zh) 2021-11-16
CN113654528B CN113654528B (zh) 2024-02-06

Family

ID=78483913

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111101909.2A Active CN113654528B (zh) 2021-09-18 2021-09-18 通过无人机位置和云台角度估测目标坐标的方法和系统

Country Status (1)

Country Link
CN (1) CN113654528B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117406777A (zh) * 2023-11-17 2024-01-16 广州源颢工程信息技术有限公司 用于水利测绘的无人机云台智能控制方法及装置

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102707726A (zh) * 2012-05-28 2012-10-03 北京航空航天大学 一种无人机目标定位方法
CN104501779A (zh) * 2015-01-09 2015-04-08 中国人民解放军63961部队 基于多站测量的无人机高精度目标定位方法
CN107783555A (zh) * 2016-08-29 2018-03-09 杭州海康机器人技术有限公司 一种基于无人机的目标定位方法、装置及系统
CN108680143A (zh) * 2018-04-27 2018-10-19 南京拓威航空科技有限公司 基于远程测距的目标定位方法、装置及无人机
CN109753076A (zh) * 2017-11-03 2019-05-14 南京奇蛙智能科技有限公司 一种无人机视觉追踪实现方法
CN110771141A (zh) * 2018-11-19 2020-02-07 深圳市大疆创新科技有限公司 拍摄方法和无人机
CN112000130A (zh) * 2020-09-07 2020-11-27 哈尔滨工业大学 一种无人机的多机协同高精度建图定位系统
CN112229380A (zh) * 2020-10-15 2021-01-15 西北工业大学 一种基于多旋翼无人机协同的无源目标实时定位方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102707726A (zh) * 2012-05-28 2012-10-03 北京航空航天大学 一种无人机目标定位方法
CN104501779A (zh) * 2015-01-09 2015-04-08 中国人民解放军63961部队 基于多站测量的无人机高精度目标定位方法
CN107783555A (zh) * 2016-08-29 2018-03-09 杭州海康机器人技术有限公司 一种基于无人机的目标定位方法、装置及系统
CN109753076A (zh) * 2017-11-03 2019-05-14 南京奇蛙智能科技有限公司 一种无人机视觉追踪实现方法
CN108680143A (zh) * 2018-04-27 2018-10-19 南京拓威航空科技有限公司 基于远程测距的目标定位方法、装置及无人机
CN110771141A (zh) * 2018-11-19 2020-02-07 深圳市大疆创新科技有限公司 拍摄方法和无人机
CN112000130A (zh) * 2020-09-07 2020-11-27 哈尔滨工业大学 一种无人机的多机协同高精度建图定位系统
CN112229380A (zh) * 2020-10-15 2021-01-15 西北工业大学 一种基于多旋翼无人机协同的无源目标实时定位方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117406777A (zh) * 2023-11-17 2024-01-16 广州源颢工程信息技术有限公司 用于水利测绘的无人机云台智能控制方法及装置
CN117406777B (zh) * 2023-11-17 2024-03-19 广州源颢工程信息技术有限公司 用于水利测绘的无人机云台智能控制方法及装置

Also Published As

Publication number Publication date
CN113654528B (zh) 2024-02-06

Similar Documents

Publication Publication Date Title
US10928838B2 (en) Method and device of determining position of target, tracking device and tracking system
US9185289B2 (en) Generating a composite field of view using a plurality of oblique panoramic images of a geographic area
US10048084B2 (en) Star tracker-aided airborne or spacecraft terrestrial landmark navigation system
CN110927708B (zh) 智能路侧单元的标定方法、装置及设备
US8666661B2 (en) Video navigation
JP5688793B2 (ja) 関心のある地点の位置を決定するハンドヘルド測地装置、コンピュータ実装方法およびコンピュータ読み取り可能な記憶媒体
US10935381B2 (en) Star tracker-aided airborne or spacecraft terrestrial landmark navigation system
JP2008304260A (ja) 画像処理装置
CN105184776A (zh) 目标跟踪方法
CN107192377B (zh) 远程测量物体坐标的方法、装置及飞行器
Bachmann et al. Micro UAV based georeferenced orthophoto generation in VIS+ NIR for precision agriculture
US20210208608A1 (en) Control method, control apparatus, control terminal for unmanned aerial vehicle
EP3550263B1 (en) Locating method and apparatus
Qiao et al. Ground target geolocation based on digital elevation model for airborne wide-area reconnaissance system
CN113654528B (zh) 通过无人机位置和云台角度估测目标坐标的方法和系统
KR101183866B1 (ko) Ｇｐｓ／ｉｎｓ／영상ａｔ를 통합한 실시간 위치／자세 결정 장치 및 방법
CN114979956A (zh) 一种无人机航拍地面目标定位方法及系统
RU2513900C1 (ru) Способ и устройство определения координат объектов
WO2020019175A1 (zh) 图像处理方法和设备、摄像装置以及无人机
KR101821992B1 (ko) 무인비행체를 이용한 목표물의 3차원 위치 산출 방법 및 장치
KR102028323B1 (ko) 영상 레이더의 영상 보정 장치 및 시스템
CN110017833B (zh) 基于像元类地模型的全屏像点地理坐标定位方法
CN112985398A (zh) 目标定位方法及系统
US11415990B2 (en) Optical object tracking on focal plane with dynamic focal length
GB2573090A (en) Calibration of object position-measuring apparatus

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant