CN104913776B - 无人机定位方法及装置 - Google Patents
无人机定位方法及装置 Download PDFInfo
- Publication number
- CN104913776B CN104913776B CN201510364554.4A CN201510364554A CN104913776B CN 104913776 B CN104913776 B CN 104913776B CN 201510364554 A CN201510364554 A CN 201510364554A CN 104913776 B CN104913776 B CN 104913776B
- Authority
- CN
- China
- Prior art keywords
- unmanned plane
- coordinate system
- mrow
- under
- translational speed
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Abstract
本发明提供无人机定位方法及装置,该无人机包括第一传感器,所述方法包括:通过第一传感器获取无人机在第一坐标系下的移动速度;根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度;根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置。因此,本发明通过第一传感器可以实现对无人机速度和相对于起飞点的水平位置的精确测量,并更快更精准的实现了对无人机的定位。
Description
技术领域
本发明涉及网络通信技术领域,尤其涉及无人机定位方法及装置。
背景技术
随着网络通信技术的发展,无人机也得到了广泛的应用。该无人机是一种由无线电遥控设备或自身程序控制装置操纵的无人驾驶飞行器,其用途很广泛,但是,如何对处于飞行状态的无人机进行定位则成了一个关键的问题。
现有技术中,无人机定位方法一般采用根据全球定位系统(Global PositioningSystem,GPS)进行定位。若没有GPS信号,则不能完成对无人机的定位。因此,现有技术中的无人机定位方法适用范围小,定位精度低,定位速度慢。
发明内容
本发明提供一种无人机定位方法及装置,以解决现有技术中的无人机定位方法适用范围小,定位精度低,定位速度慢的问题。
根据本发明实施例的第一方面,提供一种无人机定位方法,该无人机包括第一传感器,所述方法包括:
通过第一传感器获取无人机在第一坐标系下的移动速度;
根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度;
根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置。
根据本发明实施例的第二方面,提供一种无人机定位装置,该无人机包括第一传感器,所述装置包括:
获取单元,用于通过第一传感器获取无人机在第一坐标系下的移动速度;
第一确定单元,用于根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度;
第二确定单元,根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置。
应用本发明实施例,通过第一传感器获取无人机在第一坐标系下的移动速度,根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度,根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置,使得在无人机各种状态时,比如,无人机在悬停时、无人机低速飞行时或无人机高速飞行时,皆可以实现对无人机速度和相对于起飞点的水平位置的精确测量,并更快更精准的实现了对无人机的定位。
附图说明
图1A是本发明实施例无人机定位的一种应用场景示意图;
图1B是本发明实施例无人机定位的另一种应用场景示意图;
图2是本发明无人机定位方法的一个实施例流程图;
图3是本发明无人机定位方法的另一个实施例流程图;
图4是本发明无人机定位装置所在设备的一种硬件结构图;
图5是本发明无人机定位装置的一个实施例框图。
具体实施方式
为了使本技术领域的人员更好地理解本发明实施例中的技术方案,并使本发明实施例的上述目的、特征和优点能够更加明显易懂,下面结合附图对本发明实施例中技术方案作进一步详细的说明。
参见图1A和图1B,为应用本发明实施例无人机定位的应用场景示意图:
图1A中示出了一种无人机的飞行状态示意图。该飞行状态中无人机的滚转角和俯仰角皆为0度。由于滚转角θ、俯仰角φ皆为0度,所以图1A中没有标出。其中,俯仰角φ是左右方向的角度,滚转角θ是前后方向的倾斜角度,并且可以由无人机上携带的传感器,比如,陀螺仪和加速度计,联合测得。
另外,图1A中的h是无人机中的高度传感器,比如,超声波传感器,测得的当前对地高度,α是无人机中的鼠标传感器镜头的视野度数。v是无人机的移动速度。
为了提高鼠标传感器的感知距离,无人机中的鼠标传感器镜头可以是外加的普通摄像头的镜头。比如:为鼠标传感器加装了一个焦距16毫米约视野为12度的镜头。
图1B中示出了另一种无人机的飞行状态示意图。该飞行状态中无人机的滚转角和俯仰角不是皆为0度。如图1B所示,φ为俯仰角。由于图1B为平面图,故滚转角θ没有标出。
另外,图1B中的h是无人机中的高度传感器,比如,超声波传感器,测得的当前对地高度,α是无人机中的鼠标传感器镜头的视野度数。v是无人机的移动速度。
由上述图1A和图1B可见,在无人机飞行过程中,比如,在空中停留、低速飞行、或高速飞行时,皆需要测量该无人机的移动速度、以及与起飞点的相对位置,实现对无人机的定位。现有技术中一般采用根据GPS进行定位。若没有GPS信号,则不能完成对无人机的定位。
而在本发明实施例中,可以通过第一传感器获取无人机在第一坐标系下的移动速度,根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度,以及根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置,从而完成了对无人机的定位。其中,第一传感器可以为鼠标传感器,第一坐标系下的移动速度可以为无人机在图像坐标下的移动速度,第二坐标系下的移动速度可以是无人机在世界坐标下的移动速度。另外,由于本发明实施例中的鼠标传感器可以包括成像模块和数字信号处理(digital signal processing,DSP)模块,成像模块在预设的采样时间内对无人机的对地图像进行采集,数字信号处理模块所采集的对地图像进行对比后计算所采集后的对地图像中的各个特征点的平均像素移动速度。本发明实施例中可以将成像模块和数字信号处理模块皆封装到鼠标芯片内部,从而使得鼠标传感器获取图像、以及处理图像的速度非常快,适合无人机各种状态时的定位需要,比如,无人机在悬停时的定位需要,或无人机飞行过程中的定位需要,尤其适合无人机高速飞行过程中的定位需要,在保证无人机定位的稳定性和可靠性的同时,提高定位速度。
下面结合附图对本发明无人机定位的实施例进行详细描述。
参见图2,为本发明无人机定位方法的一个实施例流程图,该实施例应用于无人机上,该无人机包括第一传感器,包括以下步骤:
步骤210:通过第一传感器获取无人机在第一坐标系下的移动速度。
本实施例中,第一传感器可以为鼠标传感器,也可以为其他类型的传感器,本实施例中对传感器的类型不做具体限制,只要能够取无人机在第一坐标系下的移动速度即可。另外,第一坐标系下的移动速度可以为无人机在图像坐标下的移动速度。
比如,若第一传感器是鼠标传感器,由于鼠标传感器可以定时采集对地图像,并对该图像进行处理,可以根据处理结果输出无人机在图像坐标下的像素移动速度,又由于鼠标传感器是安装在无人机底面的,并且其镜头是朝向地面的,故鼠标传感器可以采集到对地图像。另外,本实施例中涉及到的鼠标传感器,可测量的最大移动加速度可以为30g,最大更新频率可以为12000Hz,使得其获取图像、以及处理图像的速度非常快,适合无人机飞行过程中定位的需要,尤其适合无人机高速飞行过程中定位的需要,可以提高无人机定位速度。
步骤220:根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度。
本实施例中,第二坐标系下的移动速度可以是无人机在世界坐标下的移动速度,该第二坐标系下的移动速度可以通过对无人机在第一坐标系下的移动速度进行坐标转换而得到。
其中,第一坐标系可以为图像坐标系,第二坐标系可以为世界坐标系。
该图像坐标系指的是以像素为单位的坐标系,传感器采集的数字图像可以存储为数组,数组中的每一个像素的值即是图像点的亮度,每一个像素的坐标是该像素在数组中的列数和行数。
该世界坐标系指的是系统的绝对坐标系,在没有建立用户坐标系之前画面上所有点的坐标都是以该坐标系的原点来确定各自的位置的。
比如:第一坐标系为图像坐标系,第二坐标系为世界坐标系,第一传感器是鼠标传感器,无人机在图像坐标下的移动速度与无人机在世界坐标下的移动速度之间的坐标转换过程,可以如公式(1)所示。
其中,h是当前测得的对地高度即无人机相对于地面的高度,θ为当前测得的滚转角、φ为当前测得的俯仰角,np为鼠标传感器的分辨率,α为鼠标传感器镜头的视野度数,t为鼠标传感器中成像模块的采样时间,nox和noy分别为鼠标传感器输出的图像坐标下的x轴方向和y轴方向的移动速度,vx和vy分别是无人机在世界坐标下x轴方向和y轴方向的移动速度。
上述无人机的对地高度h、滚转角θ和俯仰角φ皆是无人机的当前状态参数,随着无人机的飞行状态的改变而改变,而分辨率和视野度数α为鼠标传感器的性能参数,其是固定值,当确定鼠标传感器后,该鼠标传感器的性能参数也就确定了,不会随着无人机的飞行状态的改变而改变。故无人机的当前状态参数也是定时测量的一个数值,其测量频率可以随着无人机的飞行状态的改变而上下浮动。
步骤230:根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置。
本实施例中,可以对无人机在第二坐标系下的移动速度进行处理,处理方式可以为滤波处理,也可以为积分处理,进而确定无人机相对于起飞点的水平位置。
比如:对无人机在第二坐标系下的移动速度进行均值滤波时,其均值滤波过程如公式(2)所示。
其中,λ为常数,vx(k)和vy(k)分别是无人机的第k时刻在世界坐标下x轴方向和y轴方向的移动速度,k大于或等于1。和分别是无人机的第k时刻均值滤波后得到的x轴方向和y轴方向的速度值。
并且,根据均值滤波得到的速度值确定无人机相对于起飞点的水平位置时,其计算过程如公式(3)所示。
其中,px(k)和py(k)分别是无人机在第k时刻的x轴方向和y轴方向的位置坐标,k大于或等于1。
上述步骤220和步骤230可以通过无人机上的处理器实现,该处理器可以通过通用串行总线(Universal Serial Bus,USB)接口、PS2(Play Station 2)鼠标接口、串行外设接口(Serial Peripheral Interface,SPI)等接口与鼠标传感器进行通信,并可以读取鼠标传感器测量的无人机在第一坐标系下的移动速度,并根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度,最后在对无人机在第二坐标系下的移动速度进行均值滤波,并根据均值滤波得到的速度值计算无人机相对于起飞点的水平位置,从而完成对无人机的定位。
由上述实施例可见,通过第一传感器获取无人机在第一坐标系下的移动速度,根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度,根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置,使得在无人机各种状态时,比如,无人机在悬停时、无人机低速飞行时或无人机高速飞行时,皆可以实现对无人机速度和相对于起飞点的水平位置的精确测量,并更快更精准的实现了对无人机的定位。
参见图3,为本发明无人机定位方法的另一个实施例流程图,该实施例应用于无人机上,该无人机包括第一传感器,在执行步骤220中根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度时,可以包括以下步骤:
步骤310:判断无人机的滚转角和俯仰角是否都为零度,若判断结果为是,则执行步骤320;若判断结果为否,则执行步骤330。
本实施例中,滚转角θ和俯仰角φ皆是无人机的当前状态参数,随着无人机的飞行状态的改变而改变,可能都为零度,也可能只有一个为零度,也可能两个都不为零度。
步骤320:根据无人机的对地高度、第一传感器的第一参数和第二参数、无人机在第一坐标系下的移动速度,确定无人机在第二坐标系下的移动速度,流程结束。
本实施例中,第一传感器的第一参数为第一传感器的分辨率,第一传感器的第二参数为第一传感器镜头的视野度数。
比如:第一坐标系为图像坐标系,第二坐标系为世界坐标系,第一传感器可以为鼠标传感器,第一参数为鼠标传感器的分辨率,第二参数为鼠标传感器的分辨率。当滚转角θ和俯仰角φ都为零度时,可以利用公式(4)计算无人机在第二坐标系下的移动速度:
其中,h是当前测得的对地高度即无人机相对于地面的高度,np为鼠标传感器的分辨率,α为鼠标传感器镜头的视野度数,t为鼠标传感器中成像模块的采样时间,nox和noy分别为鼠标传感器输出的图像坐标下的x轴方向和y轴方向的移动速度,vx和vy分别是无人机在世界坐标下x轴方向和y轴方向的移动速度。
步骤330:根据无人机的对地高度、第一传感器的第一参数和第二参数、无人机在第一坐标系下的移动速度,获得无人机在第二坐标系下待修正的移动速度。
本实施例中,第一传感器的第一参数为第一传感器的分辨率,第一传感器的第二参数为第一传感器镜头的视野度数。
比如:第一坐标系为图像坐标系,第二坐标系为世界坐标系,第一传感器可以为鼠标传感器,第一参数为鼠标传感器的分辨率,第二参数为鼠标传感器的分辨率。当滚转角θ和俯仰角φ不是都为零度时,可以利用公式(5)计算无人机在第二坐标系下的待修正的移动速度:
其中,h是当前测得的对地高度即无人机相对于地面的高度,np为鼠标传感器的分辨率,α为鼠标传感器镜头的视野度数,t为鼠标传感器中成像模块的采样时间,nox和noy分别为鼠标传感器输出的图像坐标下的x轴方向和y轴方向的移动速度,和分别是无人机在世界坐标下x轴方向和y轴方向的待修正的移动速度。
步骤340:根据无人机的滚转角和俯仰角对无人机在第二坐标系下待修正的移动速度进行修正,获得无人机在第二坐标系下的移动速度,流程结束。
本实施例中,根据无人机的滚转角和俯仰角对无人机在第二坐标系下待修正的移动速度进行修正过程,如公式(6)所示。
其中,θ为当前测得的滚转角、φ为当前测得的俯仰角,和分别是无人机在世界坐标下x轴方向和y轴方向的待修正的移动速度,vx和vy分别是无人机在世界坐标下x轴方向和y轴方向的移动速度。
由上述实施例可见,根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度时,可以根据无人机的滚转角和俯仰角是否都为零度进行不同的处理,从而提高了无人机在第二坐标系下的移动速度的计算速度,进而提高了无人机的定位速度。
与前述无人机定位方法实施例相对应,本发明还提供了无人机定位装置的实施例。
本发明无人机定位装置的实施例可以应用在无人机上。装置实施例可以通过软件实现,也可以通过硬件或者软硬件结合的方式实现。以软件实现为例,作为一个逻辑意义上的装置,是通过其所在设备的处理器将非易失性存储器中对应的计算机程序指令读取到内存中运行形成的。从硬件层面而言,如图4所示,为本发明无人机定位装置所在设备的一种硬件结构图,除了图4所示的处理器、网络接口、内存以及非易失性存储器之外,实施例中装置所在的设备通常还可以包括其他硬件,如负责处理报文的转发芯片等等;从硬件结构上来讲该设备还可能是分布式的设备,可能包括多个接口卡,以便在硬件层面进行报文处理的扩展。
参见图5,为本发明无人机定位装置的一个实施例框图,所述装置可以应用在无人机上,该无人机包括第一传感器,可以用于执行图2或图3所示的无人机定位方法,所述装置包括:获取单元51、第一确定单元52和第二确定单元53。
其中,获取单元51用于通过第一传感器获取无人机在第一坐标系下的移动速度。
第一确定单元52用于根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度。
第二确定单元53根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置。
在一个可选的实现方式中,所述第一确定单元52包括:第一判断子单元和第一执行子单元(图5中未示出)。
其中,第一判断子单元用于判断无人机的滚转角和俯仰角是否都为零度。
第一执行子单元用于若第一判断子单元的判断结果为是,则根据无人机的对地高度、第一传感器的第一参数和第二参数、无人机在第一坐标系下的移动速度,确定无人机在第二坐标系下的移动速度。
在另一个可选的实现方式中,所述第一确定单元52包括:第二判断子单元、第二执行子单元和修正子单元(图5中未示出)。
其中,第二判断子单元用于判断无人机的滚转角和俯仰角是否都为零度。
第二执行子单元用于若第二判断子单元的判断结果为否,则根据无人机的对地高度、第一传感器的第一参数和第二参数、无人机在第一坐标系下的移动速度,获得无人机在第二坐标系下待修正的移动速度。
修正子单元用于根据无人机的滚转角和俯仰角对无人机在第二坐标系下待修正的移动速度进行修正,获得无人机在第二坐标系下的移动速度。
在另一个可选的实现方式中,所述第二确定单元53具体用于对无人机在第二坐标系下的移动速度进行均值滤波,并根据所述均值滤波得到的速度值确定所述无人机相对于起飞点的水平位置。
在另一个可选的实现方式中,所述第一坐标系为图像坐标系,所述第二坐标系为世界坐标系,所述第一传感器的第一参数为所述第一传感器的分辨率,所述第一传感器的第二参数为所述第一传感器镜头的视野度数。
上述装置中各个单元的功能和作用的实现过程具体详见上述方法中对应步骤的实现过程,在此不再赘述。
对于装置实施例而言,由于其基本对应于方法实施例,所以相关之处参见方法实施例的部分说明即可。以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本发明方案的目的。本领域普通技术人员在不付出创造性劳动的情况下,即可以理解并实施。
由上述实施例可见,通过第一传感器获取无人机在第一坐标系下的移动速度,根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度,根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置,使得在无人机各种状态时,比如,无人机在悬停时、无人机低速飞行时或无人机高速飞行时,皆可以实现对无人机速度和相对于起飞点的水平位置的精确测量,并更快更精准的实现了对无人机的定位。
本领域技术人员在考虑说明书及实践这里公开的发明后,将容易想到本发明的其它实施方案。本申请旨在涵盖本发明的任何变型、用途或者适应性变化,这些变型、用途或者适应性变化遵循本发明的一般性原理并包括本发明未公开的本技术领域中的公知常识或惯用技术手段。说明书和实施例仅被视为示例性的,本发明的真正范围和精神由下面的权利要求指出。
应当理解的是,本发明并不局限于上面已经描述并在附图中示出的精确结构,并且可以在不脱离其范围进行各种修改和改变。本发明的范围仅由所附的权利要求来限制。
Claims (10)
1.一种无人机定位方法,其特征在于,该无人机包括第一传感器,所述方法包括:
通过第一传感器获取无人机在第一坐标系下的移动速度nox和noy,其中,nox和noy分别为无人机在第一坐标系下的x轴方向和y轴方向的移动速度;
根据无人机在第一坐标系下的移动速度nox和noy确定无人机在第二坐标系下的移动速度vx和vy,
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>v</mi>
<mi>x</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>n</mi>
<mrow>
<mi>o</mi>
<mi>x</mi>
</mrow>
</msub>
<mi>h</mi>
<mi> </mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mi>&alpha;</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&phi;</mi>
</mrow>
<mrow>
<msub>
<mi>n</mi>
<mi>p</mi>
</msub>
<mi>t</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>v</mi>
<mi>y</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>n</mi>
<mrow>
<mi>o</mi>
<mi>y</mi>
</mrow>
</msub>
<mi>h</mi>
<mi> </mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mi>&alpha;</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
</mrow>
<mrow>
<msub>
<mi>n</mi>
<mi>p</mi>
</msub>
<mi>t</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,vx和vy分别为无人机在第二坐标系下x轴方向和y轴方向的移动速度,h是当前测得的无人机相对于地面的高度,θ为当前测得的滚转角、φ为当前测得的俯仰角,np为第一传感器的分辨率,α为第一传感器的视野度数,t为第一传感器的采样时间;
根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置。
2.根据权利要求1所述的方法,其特征在于,所述根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度具体包括:
判断无人机的滚转角和俯仰角是否都为零度;
若判断结果为是,则根据无人机的对地高度、第一传感器的第一参数和第二参数、无人机在第一坐标系下的移动速度,确定无人机在第二坐标系下的移动速度。
3.根据权利要求1所述的方法,其特征在于,所述根据无人机在第一坐标系下的移动速度确定无人机在第二坐标系下的移动速度具体包括:
判断无人机的滚转角和俯仰角是否都为零度;
若判断结果为否,则根据无人机的对地高度、第一传感器的第一参数和第二参数、无人机在第一坐标系下的移动速度,获得无人机在第二坐标系下待修正的移动速度;
根据无人机的滚转角和俯仰角对无人机在第二坐标系下待修正的移动速度进行修正,获得无人机在第二坐标系下的移动速度。
4.根据权利要求2或3所述的方法,其特征在于,所述根据无人机在第二坐标系下的移动速度确定所述无人机相对于起飞点的水平位置具体包括:
对无人机在第二坐标系下的移动速度进行均值滤波,并根据所述均值滤波得到的速度值确定所述无人机相对于起飞点的水平位置。
5.根据权利要求2或3所述的方法,其特征在于,所述第一坐标系为图像坐标系,所述第二坐标系为世界坐标系,所述第一传感器的第一参数为所述第一传感器的分辨率,所述第一传感器的第二参数为所述第一传感器镜头的视野度数。
6.一种无人机定位装置,其特征在于,该无人机包括第一传感器,所述装置包括:
获取单元,用于通过第一传感器获取无人机在第一坐标系下的移动速度nox和noy,其中,nox和noy分别为无人机在第一坐标系下的x轴方向和y轴方向的移动速度;
第一确定单元,用于根据无人机在第一坐标系下的移动速度nox和noy确定无人机在第二坐标系下的移动速度vx和vy,
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>v</mi>
<mi>x</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>n</mi>
<mrow>
<mi>o</mi>
<mi>x</mi>
</mrow>
</msub>
<mi>h</mi>
<mi> </mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mi>&alpha;</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&phi;</mi>
</mrow>
<mrow>
<msub>
<mi>n</mi>
<mi>p</mi>
</msub>
<mi>t</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>v</mi>
<mi>y</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>n</mi>
<mrow>
<mi>o</mi>
<mi>y</mi>
</mrow>
</msub>
<mi>h</mi>
<mi> </mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mi>&alpha;</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
</mrow>
<mrow>
<msub>
<mi>n</mi>
<mi>p</mi>
</msub>
<mi>t</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,vx和vy分别为无人机在第二坐标系下x轴方向和y轴方向的移动速度,h是当前测得的无人机相对于地面的高度,θ为当前测得的滚转角、φ为当前测得的俯仰角,np为第一传感器的分辨率,α为第一传感器的视野度数,t为第一传感器的采样时间;
第二确定单元,根据无人机在第二坐标系下的移动速度确定无人机相对于起飞点的水平位置。
7.根据权利要求6所述的装置,其特征在于,所述第一确定单元包括:
第一判断子单元,用于判断无人机的滚转角和俯仰角是否都为零度;
第一执行子单元,用于若第一判断子单元的判断结果为是,则根据无人机的对地高度、第一传感器的第一参数和第二参数、无人机在第一坐标系下的移动速度,确定无人机在第二坐标系下的移动速度。
8.根据权利要求6所述的装置,其特征在于,所述第一确定单元包括:
第二判断子单元,用于判断无人机的滚转角和俯仰角是否都为零度;
第二执行子单元,用于若第二判断子单元的判断结果为否,则根据无人机的对地高度、第一传感器的第一参数和第二参数、无人机在第一坐标系下的移动速度,获得无人机在第二坐标系下待修正的移动速度;
修正子单元,用于根据无人机的滚转角和俯仰角对无人机在第二坐标系下待修正的移动速度进行修正,获得无人机在第二坐标系下的移动速度。
9.根据权利要求7或8所述的装置,其特征在于,所述第二确定单元具体用于对无人机在第二坐标系下的移动速度进行均值滤波,并根据所述均值滤波得到的速度值确定所述无人机相对于起飞点的水平位置。
10.根据权利要求7或8所述的装置,其特征在于,所述第一坐标系为图像坐标系,所述第二坐标系为世界坐标系,所述第一传感器的第一参数为所述第一传感器的分辨率,所述第一传感器的第二参数为所述第一传感器镜头的视野度数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510364554.4A CN104913776B (zh) | 2015-06-19 | 2015-06-25 | 无人机定位方法及装置 |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510346443 | 2015-06-19 | ||
CN2015103464430 | 2015-06-19 | ||
CN201510364554.4A CN104913776B (zh) | 2015-06-19 | 2015-06-25 | 无人机定位方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104913776A CN104913776A (zh) | 2015-09-16 |
CN104913776B true CN104913776B (zh) | 2018-06-01 |
Family
ID=54083044
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510364554.4A Active CN104913776B (zh) | 2015-06-19 | 2015-06-25 | 无人机定位方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104913776B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106094868A (zh) * | 2016-08-01 | 2016-11-09 | 杨珊珊 | 无人飞行器的悬停控制装置及其悬停控制方法 |
CN110268224A (zh) | 2017-02-10 | 2019-09-20 | 深圳市大疆创新科技有限公司 | 用于无人机实时位置跟踪的系统和方法 |
WO2018188086A1 (zh) * | 2017-04-14 | 2018-10-18 | 深圳市大疆创新科技有限公司 | 无人机及其控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102175882B (zh) * | 2010-12-30 | 2013-02-27 | 清华大学 | 基于自然地标的无人直升机视觉测速方法 |
CN102156480A (zh) * | 2010-12-30 | 2011-08-17 | 清华大学 | 基于自然地标和视觉导航的无人直升机自主着陆方法 |
CN103853156B (zh) * | 2014-02-07 | 2016-06-01 | 中山大学 | 一种基于机载传感器的小型四旋翼飞行器控制系统及方法 |
-
2015
- 2015-06-25 CN CN201510364554.4A patent/CN104913776B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN104913776A (zh) | 2015-09-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7034530B2 (ja) | 情報処理方法、デバイス、および端末 | |
CN104913775B (zh) | 无人机对地高度的测量方法、无人机定位方法及装置 | |
CN109238240A (zh) | 一种顾及地形的无人机倾斜摄影方法及其摄影系统 | |
CN111156998A (zh) | 一种基于rgb-d相机与imu信息融合的移动机器人定位方法 | |
WO2022088973A1 (zh) | 展示车辆的行驶状态的方法以及电子设备 | |
CN108318038A (zh) | 一种四元数高斯粒子滤波移动机器人姿态解算方法 | |
CN107289910A (zh) | 一种基于tof的光流定位系统 | |
US11042984B2 (en) | Systems and methods for providing image depth information | |
CN110163087A (zh) | 一种人脸姿态识别方法及系统 | |
CN103940442A (zh) | 一种采用加速收敛算法的定位方法及装置 | |
CN112116651B (zh) | 一种基于无人机单目视觉的地面目标定位方法和系统 | |
CN113820735B (zh) | 位置信息的确定方法、位置测量设备、终端及存储介质 | |
CN104913776B (zh) | 无人机定位方法及装置 | |
CN108603933A (zh) | 用于融合具有不同分辨率的传感器输出的系统和方法 | |
CN106840111A (zh) | 物体间位置姿态关系实时统一系统及方法 | |
CN113597568A (zh) | 数据处理方法、控制设备及存储介质 | |
CN105043341B (zh) | 无人机对地高度的测量方法及装置 | |
WO2016187752A1 (zh) | 一种测量天线姿态的方法和装置 | |
CN115164936A (zh) | 高精地图制作中用于点云拼接的全局位姿修正方法及设备 | |
CN108286946A (zh) | 传感器位置标定和数据拼接的方法及系统 | |
CN113701750A (zh) | 一种井下多传感器的融合定位系统 | |
CN116952229A (zh) | 无人机定位方法、装置、系统和存储介质 | |
CN108257184A (zh) | 一种基于正方形点阵合作目标的相机姿态测量方法 | |
CN108564626B (zh) | 用于确定安装于采集实体的相机之间的相对姿态角的方法和装置 | |
EP4269044A1 (en) | Slope location correction method and apparatus, robot and readable storage medium |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |