CN106017463A - 一种基于定位传感装置的飞行器定位方法 - Google Patents
一种基于定位传感装置的飞行器定位方法 Download PDFInfo
- Publication number
- CN106017463A CN106017463A CN201610362320.0A CN201610362320A CN106017463A CN 106017463 A CN106017463 A CN 106017463A CN 201610362320 A CN201610362320 A CN 201610362320A CN 106017463 A CN106017463 A CN 106017463A
- Authority
- CN
- China
- Prior art keywords
- information
- aircraft
- prime
- formula
- axis direction
- 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
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/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
-
- 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/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Image Processing (AREA)
- Image Analysis (AREA)
Abstract
本发明涉及一种基于定位传感装置的飞行器定位方法,通过惯性传感单元获取飞行器姿态信息,利用超声波传感器收集相对高度信息,利用摄像头获取地面的实时图像信息;利用改进的光流法获取飞行器相对位移信息,利用网格信息获取飞行器全局位置与姿态信息;利用滤波算法实现多传感器信息融合获取飞行器准确鲁棒的定位方法。在无GPS信号等外界辅助导航情况下,能实现飞行器的长期准确定位,且鲁棒性好,无累积误差。
Description
技术领域
本发明涉及飞行器定位领域,具体涉及一种基于定位传感装置的飞行器定位方法。
背景技术
由于缺乏外界辅助导航,无人飞行器难以在未知环境下估计无人飞行器的位姿与运动,飞行器自主导航的过程中需要解决这个关键问题。而这个问题的解决方法与飞行器机载传感器的类型紧密联系,因此无人飞行器的硬件构架对相关算法的选择有直接影响。目前针对不同的飞行器硬件构建,为上述问题提出了不同解决方案。
对于地面移动机器人,姿态信息的估计值通常利用惯性测量单元IMU(InertialMeasurement Unit)解算获得。而位置信息的获取,则有赖于一类被称为里程计(Odometry)的导航方法。就其本质而言,里程计是一类采用了匹配与积分技术的算法。根据里程计匹配数据的类型,可将里程计划分为视觉里程计、激光里程计以及编码盘里程计等。里程计的解算精度不仅与匹配算法有关,对传感器的测量误差也十分敏感。无人飞行器由于负载有限,无法沿用许多在地面移动机器人上得到广泛应用的高精度IMU与里程计。为此,需要从重量、大小、实时性与精度等方面对机载传感器的选择进行权衡考虑。在近十年的相关研究中,比较有代表性的组合方案包括如下几种:
1)单/双目视觉系统与IMU的组合。视觉系统在机器人领域的应用较为成熟。单目视觉系统的运动恢复结构算法通过计算序列图像对应的基础矩阵,估算摄像机投影矩阵,可恢复场景特征点的投影结构,获得载体的姿态变化;在载体运动已知的情况下,能够恢复特征点在世界坐标系的真实位置,从而实现基于单目视觉的相对局部环境的位置估计。双目立体视觉系统通过匹配两个摄像头视野的图像特征,利用空间特征的投影关系,获得载体的相对位置信息。但该方法鲁棒性差,可能存在错匹配等情况,将直接影响位姿估计的准确性。
2)光流法与IMU的组合。光流法同样依赖于机载摄像头提供的图像灰度信息。但与1)所不同的是,光流法无需对图像进行特征提取与特征匹配,转而考虑图像灰度在时间上的变化率与摄像头和图像场景之间相对变化的关系。在灰度信息之外,光流法还要求提供图像像素对应的深度信息,从而完成对位姿的解算。但该方法存在累积误差,在飞行器长期飞行的情况下,其定位误差将逐渐累积,因此无法保证飞行器的长期稳定准确飞行定位。
3)激光测距仪与IMU的组合。激光测距仪可以感知环境的结构信息,得到环境的二维点云数据。利用迭代最近邻点ICP(Iterative Closest Point)算法,对相邻时间的两帧点云数据进行匹配,可求取载体在该时间段内的平移运动分量及旋转运动分量。对平移运动分量和旋转运动分量进行积分,进而可获得飞行器的位置和姿态估计值。可利用ICP算法对激光测距仪的二维点云数据进行匹配,得到飞行器在运动平面上的位置及飞行器朝向的估计值,并采用扩展卡尔曼滤波器EKF(Extended Kalman Filter)将ICP算法解算得到的飞行器位姿信息与IMU解算获得的飞行器姿态信息进行融合,实现了无人飞行器在局部场景下的位姿估计。但利用该方法需要在飞行器上安装激光测距仪,该装置体积较大,价格昂贵,并不适用于微飞行器平台的安装及推广使用。
4)深度摄像机(RGB-D摄像机)与IMU的组合。RGB-D摄像机是结合了摄像头与测距仪优点的一种新型传感器,其在获得视野图像灰度信息的同时,也可获得相应的深度信息。同双目立体视觉系统相比,RGB-D摄像机采样深度信息的效率更高,获得的深度信息更为精确。在无人飞行器上配备Microsoft Kinect,利用和双目立体视觉系统类似的原理,从场景图像中提取特征点及其深度信息并进行特征匹配,得到空间特征的投影关系,获得载体的相对运动信息。使用该传感器同样由于体积较大,并不适用于安装在微小飞行器平台中。
发明内容
本发明的目的在于针对现有技术的不足,提供一种基于定位传感装置的飞行器定位方法,本方法在无GPS信号等外界辅助导航情况下,能实现飞行器的长期准确定位,且鲁棒性好,无累积误差。
本发明所提供的技术方案为:一种基于定位传感装置的飞行器定位方法,包括如下步骤:
1)通过惯性传感单元中的加速度计和陀螺仪分别测得飞行器实时的加速度和角速度信息,通过磁力计确定方位,获得飞行器的实时姿态信息;所述的实时姿态信息包括偏航角、横滚角和俯仰角;
利用超声波传感器收集飞行器相对于地面的高度信息,并利用惯性传感单元获取的实时姿态信息进行姿态补偿,实时校正垂直高度信息;
利用摄像头,获取地面的实时图像信息;
2)对获取的实时图像信息作灰度化处理,获取灰度图,对每帧灰度图选择固定间隔固定数量的像素块,通过匹配相邻两帧灰度图,计算光流向量,并通过差分,获取光流速度;
3)同步惯性传感单元、超声波传感器和摄像头的时间戳,利用惯性传感单元获取的实时姿态信息,对光流速度进行姿态补偿,得到光流速度的水平面分量;利用超声波传感器获取的垂直高度信息对光流速度的水平面分量进行尺度还原,得到飞行器的水平速度;
4)对飞行器的水平速度积分得到相对位移信息,累加相对位移信息,即得水平的位置信息,结合超声波传感器得到的垂直高度信息,即可得到飞行器的位置信息。
所述的步骤2)中光流速度的获取方法为:
对每帧灰度图选择固定间隔固定数量的像素块,将前一帧灰度图中的像素块位置作为后一帧灰度图的像素块的初始位置,并建立一个搜索区域,阈值函数的公式如下:
式(1)中,u表示x轴方向的搜索像素个数,v表示y轴方向的搜索像素个数;G0和G1分别表示前一帧和后一帧像素块中某一个像素点的灰度值;i,j分别表示图像平面像素块中某一个像素点的x,y轴方向的坐标,N表示像素块的x轴或者y轴方向上的像素个数,G1(i,j)表示前一帧像素块中每一像素点的灰度值,G0(i+u,j+v)表示将前一帧图像中的像素块投射到后一帧图像中相同位置后并沿x轴、y轴方向分别移动u、v像素的像素块中每一像素点的灰度值;
通过令前一帧的像素块在后一阵的灰度图的搜索区域内搜索灰度差和最小,求得后一帧的像素块位置,两帧像素块的距离差,即为光流向量,通过差分,获取光流速度。
进一步,所述的步骤3)中获得飞行器的水平速度的方法为:
建立图像平面中的点与摄像机坐标系中的点的转换关系:
式(2)中,u为图像平面中的点的坐标,pc为摄像机坐标系的点的坐标,f为焦距,z为垂直高度;
对式(2)两边求导,即得光流速度:
式(3)中,vc为摄像头坐标系下点的运动速度,vz为垂直方向上的运动速度,v为图像平面的运动速度,即光流速度;
利用刚体运动学的公式:
vc=-vw-ω×pc (4)
式(4)中,vw表示世界坐标系下点的运动速度,ω表示角速度;
将公式(4)带入公式(3),展开可得到x轴和y轴方向的光流速度与世界坐标系下的飞行器速度的关系:
式(5)中,vu表示图像平面x轴方向的光流速度,vcx表示相机坐标系下x轴方向的速度,vwx表示世界坐标系下x轴方向的速度,vwz表示世界坐标系下z轴方向的速度,wx,wy,wz分别表示x,y,z轴方向上的角速度,xc表示相机坐标系下x轴方向的坐标,yc表示相机坐标系下y轴方向的坐标;u,v分别表示图像平面x,y轴方向的坐标;
式(6)中,vv表示图像平面y轴方向的光流速度,vwy表示世界坐标系下y轴方向的速度;vwz表示世界坐标系下z轴方向的速度;对垂直高度信息差分可以求得世界坐标系下z轴方向的速度,即
根据式(5)和(6),以及已知的世界坐标系下z轴方向的速度,可以求得世界坐标系下x轴和y轴方向的飞行器的速度,即为飞行器的水平速度。
进一步,当飞行器定高飞行时,式(5)和(6)简化为:
作为改进,对所述的飞行器定位方法进行优化,所述的摄像头获取地面的实时图像信息为规则的网格信息,包括如下步骤:
i)利用摄像头,获取地面的实时图像信息,进一步处理实时图像信息中的规则的网格信息,使用霍夫变换算法,调整筛选直线的阈值,对其中的直线信息进行准确提取,从而获取实时图像信息中的直线交点坐标;
ii)同步惯性传感单元、超声波传感器和摄像头的时间戳,对飞行器的水平速度积分,计算飞行器的初始相对位移;给定飞行器的初始位置估计;利用惯性传感单元给定实时姿态信息,给定飞行器的初始姿态信息估计;使用摄像头的投影模型和实时图像信息中获取的直线交点坐标,获取地面网格交点的坐标;
iii)根据地面网格交点相邻距离恒定的条件,对求得的地面网格交点的坐标进行求精操作,获取准确的地面网格交点的坐标,再利用实时图像信息对应的坐标,建立匹配点对,使用直接线性变换算法或者迭代算法,求得飞行器准确的位置信息及姿态信息。
进一步,所述的步骤ii)中获取地面网格交点的实际坐标的方法为:
根据实时图像信息中的粗略位置估计,公式如下:
式(9)中,vw为水平光流速度,为前一时刻水平位置,为后一时刻水平位置,dt为间隔时间,另外令超声波传感器在k-1时刻和k时刻给入的垂直高度信息分别为:和给定飞行器的初始位置估计,其中均为三维列向量,表示x,y,z轴方向的位置;
由惯性传感单元给定飞行器实时的姿态信息,包括偏航角、横滚角和俯仰角,如下:
roll=γ,pitch=θ,yaw=ψ (10)
式(10)中,roll、pitch、yaw分别为该时刻的横滚角、俯仰角和偏航角;
对于步骤i)中获取的实时图像信息中的直线交点坐标(u,v),都满足直线方程:
au+bv+c=0 (11);
摄像头的投影模型由以下公式表达:
式(12)中,λ表示相机坐标系下特征点的z轴坐标,(u,v,1)T表示实时图像信息中特征点的齐次坐标,K表示摄像头的内参矩阵,fx,fy,cx,cy分别表示x,y轴方向的像素焦距以及主点的像素坐标;表示世界坐标系相对于相机坐标系的转换矩阵,即外参矩阵,前三行三列矩阵表示旋转矩阵,最后一列矩阵表示平移向量;(xw,yw,zw,1)T表示世界坐标系下特征点的齐次坐标;
将直线方程公式(11)代入摄像头的投影模型公式(12),得到公式如下:
给定飞行器的初始姿态信息估计和初始位置估计,如下:
将给定的参数代入公式(13),求解公式(13)的直线方程,设求出的世界坐标系的坐标点pw为:
pw=(xw',yw',zw') (16)
对世界坐标系中的直线交点(xw,yw,zw),同样建立直线方程:
a'xw+b'yw+c'zw+d'=0 (17)
利用规则的网格信息的特征,直线只分为两类,两类直线互相垂直,且认为地面为平面,则zw=0,将直线方程分为两类:
由公式(18)对世界坐标系的坐标点进行求精操作,即水平和垂直的两类直线分布间隔均匀,地面的直线实际交点坐标为常值,以此可以对pw=(xw',yw',zw')求出的坐标中的xw',yw'取与之相差绝对值最小的常值xw″,yw″,zw'认为是0;求精后的世界坐标系下的直线交点的坐标值为pw=(xw″,yw″,0);
利用公式(13)代入求精后pw的坐标,如下:
简化后得到:
由公式(18)知直线方程有两种,故将方程(19)分为两类:
提取未知数r11,r21,r31,r12,r22,r32,tx,ty,tz,重写方程(13),有:
方程(22)是在取两类直线中的各一条建立的方程组,由于存在9个未知数,至少需要五条直线才能解该线性方程组;但直线数超过5条后,该方程组为超定方程组,对其进行奇异值分解即可解该方程组;
至此,解出旋转矩阵R和平移向量t,如下:
在已求出r11,r21,r31,r12,r22,r32的情况下,可利用旋转矩阵是单位正交矩阵这一特性,求出r13,r23,r33;
再将旋转矩阵转换为姿态角,得到姿态信息:
roll=a tan2(r32,r33)
yaw=a tan2(r21,r11)
进一步改进,对所述的飞行器定位方法进一步优化,采用光流速度信息,网格定位的位置信息、惯性传感单元的加速度信息,建立状态方程和观测方程,对视觉算法和惯性传感单元获取的结果使用扩展卡尔曼滤波算法,进行融合处理,获取飞行器准确的位置及姿态信息。
所述的获取飞行器准确的位置及姿态信息具体的算法推导如下:
非线性连续状态方程如下:
xk+1=f(xk,wk)
对其进行离散化操作,状态量包括有网格定位得到的位置信息p,光流法提供的光流速度信息v和惯性传感单元提供的加速度a;Δt表示连续两次采样的间隔时间,A表示状态转移矩阵;
观测方程如下,分为视觉算法部分的观测方程,观测量位置p;惯性传感单元的观测方程,观测量取加速度a:
其中公式(26)中,zv,k,zi,k分别是视觉算法和惯性传感单元的观测量,分别是世界坐标系下的水平方向的位置信息和加速度信息;
根据卡尔曼滤波算法的公式:
可分别计算视觉算法部分和惯性传感单元部分的卡尔曼增益Kv,k,Ki,k,其中Pk-1表示对应于状态xk-1的协方差,表示对应于状态的协方差,Q表示系统噪声的协方差矩阵,Rv,Ri分别表示视觉算法和惯性传感单元噪声的协方差矩阵;再结合预测值和测量值,分别求取视觉部分和惯性传感单元部分状态量的最优估值xk,其中xvision,xIMU分别表示视觉算法的测量值和惯性传感单元的测量值;最后再次更新相对于状态量xk的协方差矩阵。
同现有技术相比,本发明的有益效果体现在:
(1)本发明利用改进的光流法获取飞行器相对位移信息;利用网格信息获取飞行器全局位置与姿态信息;利用滤波算法实现多传感器信息融合获取飞行器准确鲁棒的定位方法。
(2)采用光流与网格信息相结合的组合定位方法,各自巧妙地将两者的优势结合起来,相比单纯使用光流信息,避免了累计误差,定位效果可保证长期较高的准确度。
(3)采用视觉算法与惯性传感单元信息融合的扩展卡尔曼滤波算法,不仅确保了提供飞行器飞行轨迹的平滑性,更进一步保证了定位算法的鲁棒性。
附图说明
图1为本发明飞行器的定位传感装置的结构示意图;
图2为本发明实现飞行器定位的场景图;
图3为本发明实现飞行器定位的传感数据处理流程图;
图4为本发明基于定位传感装置的飞行器定位方法的流程图。
具体实施方式
如图1所示为飞行器的定位传感装置,由微处理器(NUC)1,惯性传感单元(IMU)2,超声波传感器3,摄像头4组成。
微处理器采用Intel公司的NUC(NUC5i7RYH)系列,整重仅0.607Kg,该系列处理器具备体积纤小、多接口、处理速度快、功能强大、低功耗、散热快等特点,本发明由于摄像头的高帧率采集到的图像信息庞大,对数据处理的实时能力有很高的要求;且所有的数据处理要求均在linux(ubuntu)系统下进行;要求整套装置能安装于微型飞行器上,故基于以上要求,由于NUC5i7RYH的大容量数据处理能力、轻薄外观、跨平台的特性(全面支持Windows、Linux),选择它非常合适。
摄像头与超声波模块,选用PX4FLOW,它是一款开源智能光学流动传感器,拥有752×480像素分辨率以及250Hz刷新率,计算光学流的过程中采用了4倍分级和裁剪算法,具备非常高的感光度,能够在室内或者室外暗光环境下工作,且硬件和软件结构均开源,适合对设计的算法进行重新编程,二次开发;
惯性传感单元采用LPMS系列,LP-RESEARCH公司该系列产品使用了先进的数据融合算法,为用户提供高精度高稳定性的姿态动作信息以及3轴加速度/角速度/地磁量/方位角等数据,为算法实现提供准确的姿态信息。
如图2所示:飞行器在大理石地面、地板等有规则和纹理地面条件下飞行示意图。下标w的坐标系意为世界坐标系,即在整个场景下建立的全局坐标系。飞行器上下标为c的坐标系意为机体坐标系,由于设计了多传感固连装置,惯性传感单元、摄像头、超声波传感器、机体均为刚性连接,因此各自坐标系只存在一个固定的坐标转换关系,该关系在设计固连装置时已给定,如此解决了各传感器之间的坐标转换问题。坐标轴为u,v的为图像坐标系,任意地面一点投影到图像平面将在该平面建立一个像素单位的坐标。相机为下视视野,能够向下观测到部分地面的网格和纹理信息。
如图3所示:定位传感装置中的传感器套件进行初始化操作。在微处理器下运行各节点,主要包括图像节点,用于接收地面图像信息;超声波节点,用于检测相对高度信息;惯性传感单元节点,用于接收整个模块的角速度,加速度信息;时间同步节点,用于对多传感器数据进行同步操作;处理运算节点,对同步后的数据进行定位算法运算处理。运算主节点将订阅其他节点的信息,若无数据通信,则保持通讯状态;若接收到传感器信息,将首先对各传感器的时间戳进行识别,以时间戳作为同步原则,对不同帧率的传感器数据首先进行同步处理。接下来,运算主节点将根据本实施例设计的算法,对处理后的数据进行运算,实时输出飞行器的位置与姿态,作为飞行器控制器的输入量。
如图4所示,基于定位传感装置的飞行器定位方法:包括如下步骤:
1)通过惯性传感单元中的加速度计和陀螺仪分别测得飞行器实时的加速度和角速度信息,通过磁力计确定方位,获得飞行器的实时姿态信息;所述的实时姿态信息包括偏航角、横滚角和俯仰角;
利用超声波传感器收集飞行器相对于地面的高度信息,并利用惯性传感单元获取的实时姿态信息进行姿态补偿,实时校正垂直高度信息;
利用摄像头,获取地面的实时图像信息;
2)对获取的实时图像信息作灰度化处理,获取灰度图,对每帧灰度图选择固定间隔固定数量的像素块,通过匹配相邻两帧灰度图,计算光流向量,并通过差分,获取光流速度;
3)同步惯性传感单元、超声波传感器和摄像头的时间戳,利用惯性传感单元获取的实时姿态信息,对光流速度进行姿态补偿,得到光流速度的水平面分量;利用超声波传感器获取的垂直高度信息对光流速度的水平面分量进行尺度还原,得到飞行器的水平速度;
4)对飞行器的水平速度积分得到相对位移信息,累加相对位移信息,即得水平的位置信息,结合超声波传感器得到的垂直高度信息,即可得到飞行器的位置信息。
所述的步骤2)中光流速度的获取方法为:
对每帧灰度图选择固定间隔固定数量的像素块,将前一帧灰度图中的像素块位置作为后一帧灰度图的像素块的初始位置,并建立一个搜索区域,阈值函数的公式如下:
式(1)中,u表示x轴方向的搜索像素个数,v表示y轴方向的搜索像素个数;G0和G1分别表示前一帧和后一帧像素块中某一个像素点的灰度值;i,j分别表示图像平面像素块中某一个像素点的x,y轴方向的坐标,N表示像素块的x轴或者y轴方向上的像素个数,G1(i,j)表示前一帧像素块中每一像素点的灰度值,G0(i+u,j+v)表示将前一帧图像中的像素块投射到后一帧图像中相同位置后并沿x轴、y轴方向分别移动u、v像素的像素块中每一像素点的灰度值;
通过令前一帧的像素块在后一阵的灰度图的搜索区域内搜索灰度差和最小,求得后一帧的像素块位置,两帧像素块的距离差,即为光流向量,通过差分,获取光流速度。
进一步,所述的步骤3)中获得飞行器的水平速度的方法为:
建立图像平面中的点与摄像机坐标系中的点的转换关系:
式(2)中,u为图像平面中的点的坐标,pc为摄像机坐标系的点的坐标,f为焦距,z为垂直高度;
对式(2)两边求导,即得光流速度:
式(3)中,vc为摄像头坐标系下点的运动速度,vz为垂直方向上的运动速度,v为图像平面的运动速度,即光流速度;
利用刚体运动学的公式:
vc=-vw-ω×pc (4)
式(4)中,vw表示世界坐标系下点的运动速度,ω表示角速度;
将公式(4)带入公式(3),展开可得到x轴和y轴方向的光流速度与世界坐标系下的飞行器速度的关系:
式(5)中,vu表示图像平面x轴方向的光流速度,vcx表示相机坐标系下x轴方向的速度,vwx表示世界坐标系下x轴方向的速度,vwz表示世界坐标系下z轴方向的速度,wx,wy,wz分别表示x,y,z轴方向上的角速度,xc表示相机坐标系下x轴方向的坐标,yc表示相机坐标系下y轴方向的坐标;u,v分别表示图像平面x,y轴方向的坐标;
式(6)中,vv表示图像平面y轴方向的光流速度,vwy表示世界坐标系下y轴方向的速度;vwz表示世界坐标系下z轴方向的速度;对垂直高度信息差分可以求得世界坐标系下z轴方向的速度,即
根据式(5)和(6),以及已知的世界坐标系下z轴方向的速度,可以求得世界坐标系下x轴和y轴方向的飞行器的速度,即为飞行器的水平速度。
进一步,当飞行器定高飞行时,式(5)和(6)简化为:
对所述的飞行器定位方法进行优化,所述的摄像头获取地面的实时图像信息为规则的网格信息,包括如下步骤:
i)利用摄像头,获取地面的实时图像信息,进一步处理实时图像信息中的规则的网格信息,使用霍夫变换算法,调整筛选直线的阈值,对其中的直线信息进行准确提取,从而获取实时图像信息中的直线交点坐标;
ii)同步惯性传感单元、超声波传感器和摄像头的时间戳,对飞行器的水平速度积分,计算飞行器的初始相对位移;给定飞行器的初始位置估计;利用惯性传感单元给定实时姿态信息,给定飞行器的初始姿态信息估计;使用摄像头的投影模型和实时图像信息中获取的直线交点坐标,获取地面网格交点的坐标;
iii)根据地面网格交点相邻距离恒定的条件,对求得的地面网格交点的坐标进行求精操作,获取准确的地面网格交点的坐标,再利用实时图像信息对应的坐标,建立匹配点对,使用直接线性变换算法或者迭代算法,求得飞行器准确的位置信息及姿态信息。
进一步,所述的步骤ii)中获取地面网格交点的实际坐标的方法为:
根据实时图像信息中的粗略位置估计,公式如下:
式(9)中,vw为水平光流速度,为前一时刻水平位置,为后一时刻水平位置,dt为间隔时间,另外令超声波传感器在k-1时刻和k时刻给入的垂直高度信息分别为:和给定飞行器的初始位置估计,其中和均为三维列向量,表示x,y,z轴方向的位置;
由惯性传感单元给定飞行器实时的姿态信息,包括偏航角、横滚角和俯仰角,如下:
roll=γ,pitch=θ,yaw=ψ (10)
式(10)中,roll、pitch、yaw分别为该时刻的横滚角、俯仰角和偏航角;
对于步骤i)中获取的实时图像信息中的直线交点坐标(u,v),都满足直线方程:
au+bv+c=0 (11);
摄像头的投影模型由以下公式表达:
式(12)中,λ表示相机坐标系下特征点的z轴坐标,(u,v,1)T表示实时图像信息中特征点的齐次坐标,K表示摄像头的内参矩阵,fx,fy,cx,cy分别表示x,y轴方向的像素焦距以及主点的像素坐标;表示世界坐标系相对于相机坐标系的转换矩阵,即外参矩阵,前三行三列矩阵表示旋转矩阵,最后一列矩阵表示平移向量;(xw,yw,zw,1)T表示世界坐标系下特征点的齐次坐标;
将直线方程公式(11)代入摄像头的投影模型公式(12),得到公式如下:
给定飞行器的初始姿态信息估计和初始位置估计,如下:
将给定的参数代入公式(13),求解公式(13)的直线方程,设求出的世界坐标系的坐标点pw为:
pw=(xw',yw',zw') (16)
对世界坐标系中的直线交点(xw,yw,zw),同样建立直线方程:
a'xw+b'yw+c'zw+d'=0 (17)
利用规则的网格信息的特征,直线只分为两类,两类直线互相垂直,且认为地面为平面,则zw=0,将直线方程分为两类:
由公式(18)对世界坐标系的坐标点进行求精操作,即水平和垂直的两类直线分布间隔均匀,地面的直线实际交点坐标为常值,以此可以对pw=(xw',yw',zw')求出的坐标中的xw',yw'取与之相差绝对值最小的常值xw″,yw″,zw'认为是0;求精后的世界坐标系下的直线交点的坐标值为pw=(xw″,yw″,0);
利用公式(13)代入求精后pw的坐标,如下:
简化后得到:
由公式(18)知直线方程有两种,故将方程(19)分为两类:
提取未知数r11,r21,r31,r12,r22,r32,tx,ty,tz,重写方程(13),有:
方程(22)是在取两类直线中的各一条建立的方程组,由于存在9个未知数,至少需要五条直线才能解该线性方程组;但直线数超过5条后,该方程组为超定方程组,对其进行奇异值分解即可解该方程组;
至此,解出旋转矩阵R和平移向量t,如下:
在已求出r11,r21,r31,r12,r22,r32的情况下,可利用旋转矩阵是单位正交矩阵这一特性,求出r13,r23,r33;
再将旋转矩阵转换为姿态角,得到姿态信息:
roll=a tan2(r32,r33)
yaw=a tan2(r21,r11)
对所述的飞行器定位方法进一步优化,采用光流速度信息,网格定位的位置信息、惯性传感单元的加速度信息,建立状态方程和观测方程,对视觉算法和惯性传感单元获取的结果使用扩展卡尔曼滤波算法,进行融合处理,获取飞行器准确的位置及姿态信息。
所述的获取飞行器准确的位置及姿态信息具体的算法推导如下:
非线性连续状态方程如下:
xk+1=f(xk,wk)
对其进行离散化操作,状态量包括有网格定位得到的位置信息p,光流法提供的光流速度信息v和惯性传感单元提供的加速度a;Δt表示连续两次采样的间隔时间,A表示状态转移矩阵;
观测方程如下,分为视觉算法部分的观测方程,观测量位置p;惯性传感单元的观测方程,观测量取加速度a:
其中公式(26)中,zv,k,zi,k分别是视觉算法和惯性传感单元的观测量,分别是世界坐标系下的水平方向的位置信息和加速度信息;
根据卡尔曼滤波算法的公式:
可分别计算视觉算法部分和惯性传感单元部分的卡尔曼增益Kv,k,Ki,k,其中Pk-1表示对应于状态xk-1的协方差,表示对应于状态的协方差,Q表示系统噪声的协方差矩阵;Rv,Ri分别表示视觉算法和惯性传感单元噪声的协方差矩阵;再结合预测值和测量值,分别求取视觉部分和惯性传感单元部分状态量的最优估值xk,其中xvision,xIMU分别表示视觉算法的测量值和惯性传感单元的测量值;最后再次更新相对于状态量xk的协方差矩阵。
Claims (8)
1.一种基于定位传感装置的飞行器定位方法,其特征在于,包括如下步骤:
1)通过惯性传感单元中的加速度计和陀螺仪分别测得飞行器实时的加速度和角速度信息,通过磁力计确定方位,获得飞行器的实时姿态信息;所述的实时姿态信息包括偏航角、横滚角和俯仰角;
利用超声波传感器收集飞行器相对于地面的高度信息,并利用惯性传感单元获取的实时姿态信息进行姿态补偿,实时校正垂直高度信息;
利用摄像头,获取地面的实时图像信息;
2)对获取的实时图像信息作灰度化处理,获取灰度图,对每帧灰度图选择固定间隔固定数量的像素块,通过匹配相邻两帧灰度图,计算光流向量,并通过差分,获取光流速度;
3)同步惯性传感单元、超声波传感器和摄像头的时间戳,利用惯性传感单元获取的实时姿态信息,对光流速度进行姿态补偿,得到光流速度的水平面分量;利用超声波传感器获取的垂直高度信息对光流速度的水平面分量进行尺度还原,得到飞行器的水平速度;
4)对飞行器的水平速度积分得到相对位移信息,累加相对位移信息,即得水平的位置信息,结合超声波传感器得到的垂直高度信息,即可得到飞行器的位置信息。
2.根据权利要求1所述的基于定位传感装置的飞行器定位方法,其特征在于,所述的步骤2)中光流速度的获取方法为:
对每帧灰度图选择固定间隔固定数量的像素块,将前一帧灰度图中的像素块位置作为后一帧灰度图的像素块的初始位置,并建立一个搜索区域,阈值函数的公式如下:
式(1)中,u表示x轴方向的搜索像素个数,v表示y轴方向的搜索像素个数;G0和G1分别表示前一帧和后一帧像素块中某一个像素点的灰度值;i,j分别表示图像平面像素块中某一个像素点的x,y轴方向的坐标,N表示像素块的x轴或者y轴方向上的像素个数,G1(i,j)表示前一帧像素块中每一像素点的灰度值,G0(i+u,j+v)表示将前一帧图像中的像素块投射到后一帧图像中相同位置后并沿x轴、y轴方向分别移动u、v像素的像素块中每一像素点的灰度值;
通过令前一帧的像素块在后一阵的灰度图的搜索区域内搜索灰度差和最小,求得后一帧的像素块位置,两帧像素块的距离差,即为光流向量,通过差分,获取光流速度。
3.根据权利要求2所述的基于定位传感装置的飞行器定位方法,其特征在于,所述的步骤3)中获得飞行器的水平速度的方法为:
建立图像平面中的点与摄像机坐标系中的点的转换关系:
式(2)中,u为图像平面中的点的坐标,pc为摄像机坐标系的点的坐标,f为焦距,z为垂直高度;
对式(2)两边求导,即得光流速度:
式(3)中,vc为摄像头坐标系下点的运动速度,vz为垂直方向上的运动速度,v为图像平面的运动速度,即光流速度;
利用刚体运动学的公式:
vc=-vw-ω×pc (4)
式(4)中,vw表示世界坐标系下点的运动速度,ω表示角速度;
将公式(4)带入公式(3),展开可得到x轴和y轴方向的光流速度与世界坐标系下的飞行器速度的关系:
式(5)中,vu表示图像平面x轴方向的光流速度,vcx表示相机坐标系下x轴方向的速度,vwx表示世界坐标系下x轴方向的速度,vwz表示世界坐标系下z轴方向的速度,wx,wy,wz分别表示x,y,z轴方向上的角速度,xc表示相机坐标系下x轴方向的坐标,yc表示相机坐标系下y轴方向的坐标;u,v分别表示图像平面x,y轴方向的坐标;
式(6)中,vv表示图像平面y轴方向的光流速度,vwy表示世界坐标系下y轴方向的速度;vwz表示世界坐标系下z轴方向的速度;对垂直高度信息差分可以求得世界坐标系下z轴方向的速度,即
根据式(5)和(6)以及已知的世界坐标系下z轴方向的速度,可以求得世界坐标系下x轴和y轴方向的飞行器的速度,即为飞行器的水平速度。
4.根据权利要求3所述的基于定位传感装置的飞行器定位方法,其特征在于,当飞行器定高飞行时,式(5)和(6)简化为:
5.根据权利要求1所述的基于定位传感装置的飞行器定位方法,其特征在于,对所述的飞行器定位方法进行优化,所述的摄像头获取地面的实时图像信息为规则的网格信息,包括如下步骤:
i)利用摄像头,获取地面的实时图像信息,进一步处理实时图像信息中的规则的网格信息,使用霍夫变换算法,调整筛选直线的阈值,对其中的直线信息进行准确提取,从而获取实时图像信息中的直线交点坐标;
ii)同步惯性传感单元、超声波传感器和摄像头的时间戳,对飞行器的水平速度积分,计算飞行器的初始相对位移;给定飞行器的初始位置估计;利用惯性传感单元给定实时姿态信息,给定飞行器的初始姿态信息估计;使用摄像头的投影模型和实时图像信息中获取的直线交点坐标,获取地面网格交点的坐标;
iii)根据地面网格交点相邻距离恒定的条件,对求得的地面网格交点的坐标进行求精操作,获取准确的地面网格交点的坐标,再利用实时图像信息对应的坐标,建立匹配点对,使用直接线性变换算法或者迭代算法,求得飞行器准确的位置信息及姿态信息。
6.根据权利要求5所述的基于定位传感装置的飞行器定位方法,其特征在于,所述的步骤ii)中获取地面网格交点的实际坐标的方法为:
根据实时图像信息中的粗略位置估计,公式如下:
式(9)中,vw为水平光流速度,为前一时刻水平位置,为后一时刻水平位置,dt为间隔时间,另外令超声波传感器在k-1时刻和k时刻给入的垂直高度信息分别为:和给定飞行器的初始位置估计,其中和均为三维列向量,表示x,y,z轴方向的位置;
由惯性传感单元给定飞行器实时的姿态信息,包括偏航角、横滚角和俯仰角,如下:
roll=γ,pitch=θ,yaw=ψ (10)
式(10)中,roll、pitch、yaw分别为该时刻的横滚角、俯仰角和偏航角;
对于步骤i)中获取的实时图像信息中的直线交点坐标(u,v),都满足直线方程:
au+bv+c=0 (11);
摄像头的投影模型由以下公式表达:
式(12)中,λ表示相机坐标系下特征点的z轴坐标,(u,v,1)T表示实时图像信息中特征点的齐次坐标,K表示摄像头的内参矩阵,fx,fy,cx,cy分别表示x,y轴方向的像素焦距以及主点的像素坐标;表示世界坐标系相对于相机坐标系的转换矩阵,即外参矩阵,前三行三列矩阵表示旋转矩阵,最后一列矩阵表示平移向量;(xw,yw,zw,1)T表示世界坐标系下特征点的齐次坐标;
将直线方程公式(11)代入摄像头的投影模型公式(12),得到公式如下:
给定飞行器的初始姿态信息估计和初始位置估计,如下:
将给定的参数代入公式(13),求解公式(13)的直线方程,设求出的世界坐标系的坐标点pw为:
pw=(xw',yw',zw') (16)
对世界坐标系中的直线交点(xw,yw,zw),同样建立直线方程:
a'xw+b'yw+c'zw+d'=0 (17)
利用规则的网格信息的特征,直线只分为两类,两类直线互相垂直,且认为地面为平面,则zw=0,将直线方程分为两类:
由公式(18)对世界坐标系的坐标点进行求精操作,即水平和垂直的两类直线分布间隔均匀,地面的直线实际交点坐标为常值,以此可以对pw=(xw',yw',zw')求出的坐标中的xw',yw'取与之相差绝对值最小的常值xw”,yw”,zw'认为是0;求精后的世界坐标系下的直线交点的坐标值为pw=(xw”,yw”,0);
利用公式(13)代入求精后pw的坐标,如下:
简化后得到:
由公式(18)知直线方程有两种,故将方程(19)分为两类:
提取未知数r11,r21,r31,r12,r22,r32,tx,ty,tz,重写方程(13),有:
方程(22)是在取两类直线中的各一条建立的方程组,由于存在9个未知数,至少需要五条直线才能解该线性方程组;但直线数超过5条后,该方程组为超定方程组,对其进行奇异值分解即可解该方程组;
至此,解出旋转矩阵R和平移向量t,如下:
在已求出r11,r21,r31,r12,r22,r32的情况下,可利用旋转矩阵是单位正交矩阵这一特性,求出r13,r23,r33;
再将旋转矩阵转换为姿态角,得到姿态信息:
7.根据权利要求6所述的基于定位传感装置的飞行器定位方法,其特征在于,对所述的飞行器定位方法进一步优化,采用光流速度信息,网格定位的位置信息、惯性传感单元的加速度信息,建立状态方程和观测方程,对视觉算法和惯性传感单元获取的结果使用扩展卡尔曼滤波算法,进行融合处理,获取飞行器准确的位置及姿态信息。
8.跟据权利要求7所述的基于定位传感装置的飞行器定位方法,其特征在于,所述的获取飞行器准确的位置及姿态信息具体的算法推导如下:
非线性连续状态方程如下:
对其进行离散化操作,状态量包括有网格定位得到的位置信息p,光流法提供的光流速度信息v和惯性传感单元提供的加速度a;Δt表示连续两次采样的间隔时间,A表示状态转移矩阵;
观测方程如下,分为视觉算法部分的观测方程,观测量位置p;惯性传感单元的观测方程,观测量取加速度a:
其中公式(26)中,zv,k,zi,k分别是视觉算法和惯性传感单元的观测量,分别是世界坐标系下的水平方向的位置信息和加速度信息;
根据卡尔曼滤波算法的公式:
可分别计算视觉算法部分和惯性传感单元部分的卡尔曼增益Kv,k,Ki,k,其中Pk-1表示对应于状态xk-1的协方差,表示对应于状态的协方差,Q表示系统噪声的协方差矩阵,Rv,Ri分别表示视觉算法和惯性传感单元噪声的协方差矩阵;再结合预测值和测量值,分别求取视觉部分和惯性传感单元部分状态量的最优估值xk,其中xvision,xIMU分别表示视觉算法的测量值和惯性传感单元的测量值;最后再次更新相对于状态量xk的协方差矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610362320.0A CN106017463B (zh) | 2016-05-26 | 2016-05-26 | 一种基于定位传感装置的飞行器定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610362320.0A CN106017463B (zh) | 2016-05-26 | 2016-05-26 | 一种基于定位传感装置的飞行器定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106017463A true CN106017463A (zh) | 2016-10-12 |
CN106017463B CN106017463B (zh) | 2019-02-26 |
Family
ID=57094381
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610362320.0A Active CN106017463B (zh) | 2016-05-26 | 2016-05-26 | 一种基于定位传感装置的飞行器定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106017463B (zh) |
Cited By (36)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106382472A (zh) * | 2016-11-02 | 2017-02-08 | 浙江理工大学 | 一种基于小型飞行器的城市地下综合管廊的智能监测系统 |
CN106483968A (zh) * | 2016-12-13 | 2017-03-08 | 广西师范大学 | 一种用于无人机自动降落的地表面识别装置 |
CN106482711A (zh) * | 2016-10-18 | 2017-03-08 | 哈尔滨工业大学 | 一种基于灰度特征提取和稠密光流法的室内定位方法 |
CN106681336A (zh) * | 2016-12-29 | 2017-05-17 | 湖北三江航天红峰控制有限公司 | 基于容错处理的无人飞行器高度测量控制系统及控制方法 |
CN106920259A (zh) * | 2017-02-28 | 2017-07-04 | 武汉工程大学 | 一种定位方法及系统 |
CN106950976A (zh) * | 2017-02-28 | 2017-07-14 | 北京天恒长鹰科技股份有限公司 | 基于卡尔曼和粒子滤波的室内飞艇三维定位装置及方法 |
CN106989744A (zh) * | 2017-02-24 | 2017-07-28 | 中山大学 | 一种融合机载多传感器的旋翼无人机自主定位方法 |
CN107014371A (zh) * | 2017-04-14 | 2017-08-04 | 东南大学 | 基于扩展自适应区间卡尔曼的无人机组合导航方法与装置 |
CN107117268A (zh) * | 2017-05-12 | 2017-09-01 | 西南科技大学 | 一种异构系统的海洋垃圾回收方法及系统 |
CN107390704A (zh) * | 2017-07-28 | 2017-11-24 | 西安因诺航空科技有限公司 | 一种基于imu姿态补偿的多旋翼无人机光流悬停方法 |
CN107450591A (zh) * | 2017-08-23 | 2017-12-08 | 浙江工业大学 | 基于英伟达tx2处理器的无人机运动跟踪系统 |
CN107704106A (zh) * | 2017-10-17 | 2018-02-16 | 宁波视睿迪光电有限公司 | 姿态定位方法、装置及电子设备 |
CN107932514A (zh) * | 2017-12-15 | 2018-04-20 | 天津津航计算技术研究所 | 基于机器人视觉伺服控制的机载设备挂装方法 |
CN108007474A (zh) * | 2017-08-31 | 2018-05-08 | 哈尔滨工业大学 | 一种基于地面标识的无人飞行器自主定位及位姿校正技术 |
CN108036785A (zh) * | 2017-11-24 | 2018-05-15 | 浙江大学 | 一种基于直接法与惯导融合的飞行器位姿估计方法 |
CN108074247A (zh) * | 2016-11-11 | 2018-05-25 | 财团法人工业技术研究院 | 视频帧产生方法及其系统 |
CN108445891A (zh) * | 2018-05-28 | 2018-08-24 | 山东华力机电有限公司 | 一种agv小车光学导航系统和导航方法 |
CN108470351A (zh) * | 2018-02-01 | 2018-08-31 | 汕头大学 | 一种利用图像斑块追踪测量偏移的方法、装置及存储介质 |
CN108507571A (zh) * | 2017-07-14 | 2018-09-07 | 佛山科学技术学院 | 一种高速运动学下imu姿态捕捉方法及系统 |
CN109254587A (zh) * | 2018-09-06 | 2019-01-22 | 浙江大学 | 可在无线充电条件下稳定悬停的小型无人机及其控制方法 |
CN109283539A (zh) * | 2018-09-20 | 2019-01-29 | 清华四川能源互联网研究院 | 一种适用于高层非平整结构的定位方法 |
CN109405821A (zh) * | 2018-09-21 | 2019-03-01 | 北京三快在线科技有限公司 | 用于定位的方法、装置及目标设备 |
CN109592057A (zh) * | 2018-12-07 | 2019-04-09 | 天津津航计算技术研究所 | 一种基于视觉伺服的空中加油机受油实现方法 |
CN110032201A (zh) * | 2019-04-19 | 2019-07-19 | 成都飞机工业(集团)有限责任公司 | 一种基于卡尔曼滤波的imu机载视觉姿态融合的方法 |
CN110047108A (zh) * | 2019-03-07 | 2019-07-23 | 中国科学院深圳先进技术研究院 | 无人机位姿确定方法、装置、计算机设备及存储介质 |
WO2020019130A1 (zh) * | 2018-07-23 | 2020-01-30 | 深圳市大疆创新科技有限公司 | 运动估计方法及可移动设备 |
CN110749327A (zh) * | 2019-08-08 | 2020-02-04 | 南京航空航天大学 | 一种合作环境下的车辆导航方法 |
CN111723624A (zh) * | 2019-03-22 | 2020-09-29 | 京东方科技集团股份有限公司 | 一种头部运动跟踪方法和系统 |
CN112254721A (zh) * | 2020-11-06 | 2021-01-22 | 南京大学 | 一种基于光流相机的姿态定位方法 |
CN112556691A (zh) * | 2020-11-26 | 2021-03-26 | 广东工业大学 | 一种基于相对距离与位移测量值的无人机自主导航与温度测量系统及其方法 |
CN113155119A (zh) * | 2020-06-02 | 2021-07-23 | 西安天和防务技术股份有限公司 | 天文导航的振动补偿方法、装置及电子设备 |
CN113538477A (zh) * | 2020-04-14 | 2021-10-22 | 北京达佳互联信息技术有限公司 | 平面位姿的获取方法、装置、电子设备及存储介质 |
CN114018241A (zh) * | 2021-11-03 | 2022-02-08 | 广州昂宝电子有限公司 | 用于无人机的定位方法和设备 |
CN114216454A (zh) * | 2021-10-27 | 2022-03-22 | 湖北航天飞行器研究所 | 一种gps拒止环境下基于异源图像匹配的无人机自主导航定位方法 |
WO2023015566A1 (zh) * | 2021-08-13 | 2023-02-16 | 深圳市大疆创新科技有限公司 | 控制方法、控制装置、可移动平台及存储介质 |
CN116090097A (zh) * | 2022-12-30 | 2023-05-09 | 北京机电工程研究所 | 基于等效撞水设计的近水面流固耦合有限元高效计算方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040246463A1 (en) * | 2003-01-29 | 2004-12-09 | Milinusic Tomislav F. | Method and apparatus for optical inertial measurement |
CN102829779A (zh) * | 2012-09-14 | 2012-12-19 | 北京航空航天大学 | 一种飞行器多个光流传感器与惯导组合导航方法 |
CN104154910A (zh) * | 2014-07-22 | 2014-11-19 | 清华大学 | 一种微型无人机室内定位方法 |
CN104729506A (zh) * | 2015-03-27 | 2015-06-24 | 北京航空航天大学 | 一种视觉信息辅助的无人机自主导航定位方法 |
US20150293138A1 (en) * | 2012-11-07 | 2015-10-15 | Ecole Polytechnique Federale De Lausanne (Epfl) | Method to determine a direction and amplitude of a current velocity estimate of a moving device |
-
2016
- 2016-05-26 CN CN201610362320.0A patent/CN106017463B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20040246463A1 (en) * | 2003-01-29 | 2004-12-09 | Milinusic Tomislav F. | Method and apparatus for optical inertial measurement |
CN102829779A (zh) * | 2012-09-14 | 2012-12-19 | 北京航空航天大学 | 一种飞行器多个光流传感器与惯导组合导航方法 |
US20150293138A1 (en) * | 2012-11-07 | 2015-10-15 | Ecole Polytechnique Federale De Lausanne (Epfl) | Method to determine a direction and amplitude of a current velocity estimate of a moving device |
CN104154910A (zh) * | 2014-07-22 | 2014-11-19 | 清华大学 | 一种微型无人机室内定位方法 |
CN104729506A (zh) * | 2015-03-27 | 2015-06-24 | 北京航空航天大学 | 一种视觉信息辅助的无人机自主导航定位方法 |
Non-Patent Citations (1)
Title |
---|
杨天雨,等,: "惯性/光流/磁组合导航技术在四旋翼飞行器中的应用", 《传感器与微系统》 * |
Cited By (53)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106482711A (zh) * | 2016-10-18 | 2017-03-08 | 哈尔滨工业大学 | 一种基于灰度特征提取和稠密光流法的室内定位方法 |
CN106482711B (zh) * | 2016-10-18 | 2018-10-09 | 哈尔滨工业大学 | 一种基于灰度特征提取和稠密光流法的室内定位方法 |
CN106382472A (zh) * | 2016-11-02 | 2017-02-08 | 浙江理工大学 | 一种基于小型飞行器的城市地下综合管廊的智能监测系统 |
CN108074247A (zh) * | 2016-11-11 | 2018-05-25 | 财团法人工业技术研究院 | 视频帧产生方法及其系统 |
CN106483968A (zh) * | 2016-12-13 | 2017-03-08 | 广西师范大学 | 一种用于无人机自动降落的地表面识别装置 |
CN106483968B (zh) * | 2016-12-13 | 2023-05-05 | 桂林理工大学南宁分校 | 一种用于无人机自动降落的地表面识别装置 |
CN106681336A (zh) * | 2016-12-29 | 2017-05-17 | 湖北三江航天红峰控制有限公司 | 基于容错处理的无人飞行器高度测量控制系统及控制方法 |
CN106989744A (zh) * | 2017-02-24 | 2017-07-28 | 中山大学 | 一种融合机载多传感器的旋翼无人机自主定位方法 |
CN106920259A (zh) * | 2017-02-28 | 2017-07-04 | 武汉工程大学 | 一种定位方法及系统 |
CN106950976A (zh) * | 2017-02-28 | 2017-07-14 | 北京天恒长鹰科技股份有限公司 | 基于卡尔曼和粒子滤波的室内飞艇三维定位装置及方法 |
CN106920259B (zh) * | 2017-02-28 | 2019-12-06 | 武汉工程大学 | 一种定位方法及系统 |
CN107014371A (zh) * | 2017-04-14 | 2017-08-04 | 东南大学 | 基于扩展自适应区间卡尔曼的无人机组合导航方法与装置 |
CN107117268B (zh) * | 2017-05-12 | 2019-04-30 | 西南科技大学 | 一种异构系统的海洋垃圾回收方法及系统 |
CN107117268A (zh) * | 2017-05-12 | 2017-09-01 | 西南科技大学 | 一种异构系统的海洋垃圾回收方法及系统 |
CN108507571B (zh) * | 2017-07-14 | 2020-07-07 | 佛山科学技术学院 | 一种高速运动学下imu姿态捕捉方法及系统 |
CN108507571A (zh) * | 2017-07-14 | 2018-09-07 | 佛山科学技术学院 | 一种高速运动学下imu姿态捕捉方法及系统 |
CN107390704A (zh) * | 2017-07-28 | 2017-11-24 | 西安因诺航空科技有限公司 | 一种基于imu姿态补偿的多旋翼无人机光流悬停方法 |
CN107450591A (zh) * | 2017-08-23 | 2017-12-08 | 浙江工业大学 | 基于英伟达tx2处理器的无人机运动跟踪系统 |
CN108007474A (zh) * | 2017-08-31 | 2018-05-08 | 哈尔滨工业大学 | 一种基于地面标识的无人飞行器自主定位及位姿校正技术 |
CN107704106A (zh) * | 2017-10-17 | 2018-02-16 | 宁波视睿迪光电有限公司 | 姿态定位方法、装置及电子设备 |
CN107704106B (zh) * | 2017-10-17 | 2021-04-09 | 宁波视睿迪光电有限公司 | 姿态定位方法、装置及电子设备 |
CN108036785A (zh) * | 2017-11-24 | 2018-05-15 | 浙江大学 | 一种基于直接法与惯导融合的飞行器位姿估计方法 |
CN107932514A (zh) * | 2017-12-15 | 2018-04-20 | 天津津航计算技术研究所 | 基于机器人视觉伺服控制的机载设备挂装方法 |
CN108470351A (zh) * | 2018-02-01 | 2018-08-31 | 汕头大学 | 一种利用图像斑块追踪测量偏移的方法、装置及存储介质 |
CN108445891A (zh) * | 2018-05-28 | 2018-08-24 | 山东华力机电有限公司 | 一种agv小车光学导航系统和导航方法 |
WO2020019130A1 (zh) * | 2018-07-23 | 2020-01-30 | 深圳市大疆创新科技有限公司 | 运动估计方法及可移动设备 |
CN109254587B (zh) * | 2018-09-06 | 2020-10-16 | 浙江大学 | 在无线充电条件下稳定悬停的小型无人机及其控制方法 |
CN109254587A (zh) * | 2018-09-06 | 2019-01-22 | 浙江大学 | 可在无线充电条件下稳定悬停的小型无人机及其控制方法 |
CN109283539A (zh) * | 2018-09-20 | 2019-01-29 | 清华四川能源互联网研究院 | 一种适用于高层非平整结构的定位方法 |
CN109405821B (zh) * | 2018-09-21 | 2020-01-03 | 北京三快在线科技有限公司 | 用于定位的方法、装置及目标设备 |
CN109405821A (zh) * | 2018-09-21 | 2019-03-01 | 北京三快在线科技有限公司 | 用于定位的方法、装置及目标设备 |
CN109592057B (zh) * | 2018-12-07 | 2021-12-31 | 天津津航计算技术研究所 | 一种基于视觉伺服的空中加油机受油实现方法 |
CN109592057A (zh) * | 2018-12-07 | 2019-04-09 | 天津津航计算技术研究所 | 一种基于视觉伺服的空中加油机受油实现方法 |
CN110047108A (zh) * | 2019-03-07 | 2019-07-23 | 中国科学院深圳先进技术研究院 | 无人机位姿确定方法、装置、计算机设备及存储介质 |
CN110047108B (zh) * | 2019-03-07 | 2021-05-25 | 中国科学院深圳先进技术研究院 | 无人机位姿确定方法、装置、计算机设备及存储介质 |
CN111723624B (zh) * | 2019-03-22 | 2023-12-05 | 京东方科技集团股份有限公司 | 一种头部运动跟踪方法和系统 |
WO2020192326A1 (zh) * | 2019-03-22 | 2020-10-01 | 京东方科技集团股份有限公司 | 一种头部运动跟踪方法和系统 |
CN111723624A (zh) * | 2019-03-22 | 2020-09-29 | 京东方科技集团股份有限公司 | 一种头部运动跟踪方法和系统 |
CN110032201A (zh) * | 2019-04-19 | 2019-07-19 | 成都飞机工业(集团)有限责任公司 | 一种基于卡尔曼滤波的imu机载视觉姿态融合的方法 |
CN110749327A (zh) * | 2019-08-08 | 2020-02-04 | 南京航空航天大学 | 一种合作环境下的车辆导航方法 |
CN113538477B (zh) * | 2020-04-14 | 2023-08-29 | 北京达佳互联信息技术有限公司 | 平面位姿的获取方法、装置、电子设备及存储介质 |
CN113538477A (zh) * | 2020-04-14 | 2021-10-22 | 北京达佳互联信息技术有限公司 | 平面位姿的获取方法、装置、电子设备及存储介质 |
CN113155119B (zh) * | 2020-06-02 | 2024-01-30 | 西安天和防务技术股份有限公司 | 天文导航的振动补偿方法、装置及电子设备 |
CN113155119A (zh) * | 2020-06-02 | 2021-07-23 | 西安天和防务技术股份有限公司 | 天文导航的振动补偿方法、装置及电子设备 |
CN112254721A (zh) * | 2020-11-06 | 2021-01-22 | 南京大学 | 一种基于光流相机的姿态定位方法 |
CN112556691B (zh) * | 2020-11-26 | 2022-08-02 | 广东工业大学 | 一种用于无人机自主导航与温度测量系统的方法 |
CN112556691A (zh) * | 2020-11-26 | 2021-03-26 | 广东工业大学 | 一种基于相对距离与位移测量值的无人机自主导航与温度测量系统及其方法 |
WO2023015566A1 (zh) * | 2021-08-13 | 2023-02-16 | 深圳市大疆创新科技有限公司 | 控制方法、控制装置、可移动平台及存储介质 |
CN114216454B (zh) * | 2021-10-27 | 2023-09-08 | 湖北航天飞行器研究所 | 一种gps拒止环境下基于异源图像匹配的无人机自主导航定位方法 |
CN114216454A (zh) * | 2021-10-27 | 2022-03-22 | 湖北航天飞行器研究所 | 一种gps拒止环境下基于异源图像匹配的无人机自主导航定位方法 |
CN114018241B (zh) * | 2021-11-03 | 2023-12-26 | 广州昂宝电子有限公司 | 用于无人机的定位方法和设备 |
CN114018241A (zh) * | 2021-11-03 | 2022-02-08 | 广州昂宝电子有限公司 | 用于无人机的定位方法和设备 |
CN116090097A (zh) * | 2022-12-30 | 2023-05-09 | 北京机电工程研究所 | 基于等效撞水设计的近水面流固耦合有限元高效计算方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106017463B (zh) | 2019-02-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106017463B (zh) | 一种基于定位传感装置的飞行器定位方法 | |
CN110262546B (zh) | 一种隧道智能无人机巡检方法 | |
CN106708066B (zh) | 基于视觉/惯导的无人机自主着陆方法 | |
KR102001728B1 (ko) | 스테레오 카메라 드론을 활용한 무기준점 3차원 위치좌표 취득 방법 및 시스템 | |
CN103033189B (zh) | 一种深空探测巡视器惯性/视觉组合导航方法 | |
CN110243358A (zh) | 多源融合的无人车室内外定位方法及系统 | |
CN110361010B (zh) | 一种基于占据栅格地图且结合imu的移动机器人定位方法 | |
CN110095116A (zh) | 一种基于lift的视觉定位和惯性导航组合的定位方法 | |
CN111156998A (zh) | 一种基于rgb-d相机与imu信息融合的移动机器人定位方法 | |
CN102829785B (zh) | 基于序列图像和基准图匹配的飞行器全参数导航方法 | |
Shen et al. | Optical Flow Sensor/INS/Magnetometer Integrated Navigation System for MAV in GPS‐Denied Environment | |
CN105953796A (zh) | 智能手机单目和imu融合的稳定运动跟踪方法和装置 | |
Mercado et al. | Gps/ins/optic flow data fusion for position and velocity estimation | |
Steiner et al. | A vision-aided inertial navigation system for agile high-speed flight in unmapped environments: Distribution statement a: Approved for public release, distribution unlimited | |
CN111426320A (zh) | 一种基于图像匹配/惯导/里程计的车辆自主导航方法 | |
CN112833892B (zh) | 一种基于轨迹对齐的语义建图方法 | |
CN114608554B (zh) | 一种手持slam设备以及机器人即时定位与建图方法 | |
Rhudy et al. | Unmanned aerial vehicle navigation using wide‐field optical flow and inertial sensors | |
CN106352897B (zh) | 一种基于单目视觉传感器的硅mems陀螺误差估计与校正方法 | |
CN110533719A (zh) | 基于环境视觉特征点识别技术的增强现实定位方法及装置 | |
Wang et al. | Monocular vision and IMU based navigation for a small unmanned helicopter | |
CN103017773B (zh) | 一种基于天体表面特征和天然卫星路标的环绕段导航方法 | |
Wang et al. | Micro aerial vehicle navigation with visual-inertial integration aided by structured light | |
CN116027351A (zh) | 一种手持/背包式slam装置及定位方法 | |
Ready et al. | Inertially aided visual odometry for miniature air vehicles in gps-denied environments |
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 |