[发明专利]基于单目视觉的IMU漂移补偿方法有效
申请号: | 201510455737.7 | 申请日: | 2015-07-29 |
公开(公告)号: | CN106709222B | 公开(公告)日: | 2019-02-01 |
发明(设计)人: | 梁炜;张吟龙;谈金东;张晓玲;李杨 | 申请(专利权)人: | 中国科学院沈阳自动化研究所 |
主分类号: | G06T7/207 | 分类号: | G06T7/207 |
代理公司: | 沈阳科苑专利商标代理有限公司 21002 | 代理人: | 徐丽 |
地址: | 110016 *** | 国省代码: | 辽宁;21 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 基于 目视 imu 漂移 补偿 方法 | ||
1.一种基于单目视觉的IMU漂移补偿方法,其特征在于,包括以下步骤:
步骤1:基于IMU的方向估计;
步骤2:单目摄像头的方向估计;
步骤3:视觉辅助IMU的误差补偿;
所述步骤1包括以下步骤:
步骤1.1:计算陀螺仪的方向估计
其中表示t时刻由IMU陀螺仪估计出的四元数,由(q0,q1,q2,q3)表示,q1、q2、q3分量分别对应旋转轴在X、Y、Z方向的投影,q0分量对应IMU围绕旋转轴旋转的角度;表示陀螺仪估计出的四元数的变化率,Δt表示采样间隔;
步骤1.2:以最小化估计值误差为目标,定义目标函数:
从而得到加速计与磁力计的方向估计其中,和分别表示加速计和磁力计估计值的误差;
步骤1.3:利用增益自适应互补滤波算法,估计求解IMU坐标系下的方向信息
其中,kt表示自适应的增益系数,表示最终的方向估计信息。
2.根据权利要求1所述的基于单目视觉的IMU漂移补偿方法,其特征在于,所述步骤2包括以下步骤:
步骤2.1:求取像素点偏差平方和SSD:针对单目摄像头采集到的相邻两帧图像,求取像素点偏差平方和SSD;
步骤2.2:如果SSD大于某一指定的阈值τ,则判断IMU处于运动状态;
步骤2.2.1:采用特征点检测与描述方法SURF方法生成64维特征点描述子;
步骤2.2.2:利用特征点对的描述子具有欧氏距离最小原则实现相邻帧图像间特征点的匹配,得到匹配点对集合:{{x1,x′1},{x2,x′2},…{xn,x′n}};
步骤2.2.3:结合重采样一致性分析算法RANSAC移除特征点对中存在的误匹配点;
步骤2.2.4:利用计算机视觉中的外级线约束方程x′Ex=0,得到本质矩阵E;
步骤2.2.5:利用奇异值分解,求得旋转矩阵R3×3,此处得到的旋转矩阵R3×3表示单目摄像头的方向估计值;
步骤2.3:如果SSD不大于某一指定的阈值τ,则判断IMU处于静止状态,判定当前时刻单目摄像头的方向估计值与上一时刻单目摄像头的方向估计一致。
3.根据权利要求2所述的基于单目视觉的IMU漂移补偿方法,其特征在于,所述像素点偏差平方和SSD通过下式得到:
其中,P(i,j,t)和P(i,j,t+1)分别表示像素点P(i,j)在t时刻和t+1时刻的图像像素值,M表示以像素为单位的图片长度,N表示以像素为单位的图片宽度。
4.根据权利要求2所述的基于单目视觉的IMU漂移补偿方法,其特征在于,所述步骤3具体为:
如果像素点偏差平方和SSD大于阈值τ,则判断载体处于运动状态,IMU漂移补偿的具体实现为:
步骤3.1.1:将基于视觉估计出的旋转矩阵R3×3转化成对应的欧拉角
其中,Rij,1≤i,j≤3表示旋转矩阵R3×3中的第i行,第j列的元素;
步骤3.1.2:利用欧拉角的线性插值来补偿IMU输出四元数,欧拉角对应的四元数为:
利用欧拉角解算出的四元数来实现IMU的漂移补偿;
如果SSD不大于阈值τ,则判断载体处于静止状态,IMU漂移补偿的具体实现为:
步骤3.2.1:将IMU中陀螺仪输出的t时刻的角速度ω(t)=(ωx,t,ωy,t,ωz,t)矢量设置为:
ωx,t=0,ωy,t=0,ωz,t=0
步骤3.2.2:设置t时刻加速度矢量α(t)=(αx,t,αy,t,αz,t)和磁力强度矢量m(t)=(mx,t,my,t,mz,t)为:
αx,t=αx,t-1,αy,t=αy,t-1,αz,t=αz,t-1
mx,t=mx,t-1,my,t=my,t-1,mz,t=mz,t-1。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国科学院沈阳自动化研究所,未经中国科学院沈阳自动化研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201510455737.7/1.html,转载请声明来源钻瓜专利网。