• 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03
    • / 8
    • 下载费用:30 金币  

    重庆时时彩后二杀跨度: 一种双目立体相机与惯性测量单元相对姿态标定方法.pdf

    关 键 词:
    一种 双目 立体 相机 惯性 测量 单元 相对 姿态 标定 方法
      专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
    摘要
    申请专利号:

    CN201610012754.8

    申请日:

    2016.01.11

    公开号:

    CN105606127A

    公开日:

    2016.05.25

    当前法律状态:

    公开

    有效性:

    审中

    法律详情: 公开
    IPC分类号: G01C25/00 主分类号: G01C25/00
    申请人: 北京邮电大学
    发明人: 叶平; 贾庆轩; 孙汉旭; 高树会; 窦仁银; 杨俊锋
    地址: 100876 北京市海淀区西土城路10号
    优先权:
    专利代理机构: 代理人:
    PDF完整版下载: PDF下载
    法律状态
    申请(专利)号:

    CN201610012754.8

    授权公告号:

    法律状态公告日:

    2016.05.25

    法律状态类型:

    公开

    摘要

    本发明公开了一种简单可行的基于绝对重力方向的立体相机与惯性测量单元相对姿态标定方法。该方法使用重力方向向量作为参考向量,分别求取出重力方向向量在相机坐标系下与IMU坐标系下的表示,得到同一向量在两个不同坐标系下的表示,就可以求解出两个坐标系之间的姿态变化关系。最后,通过重投影误差进行精度校验,给出该标定方法在视觉里程计中的一种应用。实验表明,该方法可以准确的解算出相机与IMU之间的相对姿态。该方法可以用来辅助移动机器人、球形机器人视觉定位。

    权利要求书

    1.一种双目立体相机与惯性测量单元相对姿态标定方法,其特征在于,包括以下步骤:
    步骤一:对双目摄像机与IMU固连在一起,对双目摄像机进行标定。
    步骤二:将双目摄像机与IMU固连静止放置在细线前,开启相机与IMU,同时采集图像与IMU
    数据。
    步骤三:根据双目测距原理,测得细线在相机坐标系下的表示,单位化后即机坐标系下的重
    力方向向量。
    步骤四:静止状态下,惯性测量单元所测得的加速度即为重力加速速,单位化后就得到惯性
    测量单元在IMU下的表示。
    步骤四:使相机与IMU固连单元以不同的姿态,静止于细线前方,多采集几组数据,重复步
    骤二、步骤三与步骤四。
    步骤五:计算出相机坐标系与IMU坐标系间的姿态关系。
    步骤六:时间同步,有系统时间,进行时间同步。
    2.权利要求1所述的双目立体相机与惯性测量单元相对姿态标定方法,其特征在于所述步骤
    二中采用细线与重摆计算出相机坐标系下的重力方向该特征充分利用了双目测距原理,简便
    的得到了相机坐标系下的重力方向。
    3.权利要求1所述的双目立体相机与惯性测量单元相对姿态标定方法,其特征在于在静止条
    件惯性测量单元所测得的加速度即为IMU坐标系下。
    4.权利要求1所述的双目立体相机与惯性测量单元相对姿态标定方法,其特征在于,使用
    RANSIC算法,每次选取三组数据计算出相机坐标系与IMU坐标系间的旋转四元数,对其他相
    机坐标系下测得的重力方向向量,投影到IMU坐标系下,统计局内点数目,迭代N次后,以
    局内点数目最大的一组实验数据作为输入,计算相机坐标系与IMU坐标系间的旋转四元数。

    说明书

    一种双目立体相机与惯性测量单元相对姿态标定方法

    技术领域:

    本发明是涉及双目立体视觉及惯性测量单元的相对姿态的标定方法,该方法可以辅助视觉定位,为视觉传感器与IMU信息融合提供必要的条件。

    背景技术:

    在球形机器人、无人机导航、运动捕捉以及增强现实等领域中,经常将相机与惯性测量单元绑定在一个运动物体上,通过对两者信息的融合,确定出一个较精确的位姿。双目立体视觉模拟人类双眼处理景物的方式对空间点进行定位,可以很好地解决非线性误差,是其中一个重要研究方向。但仅仅依靠视觉信息实现机器人的自主定位等功能,有一定的缺陷,如传统的视觉里程计以相机的初始坐标系作为定位坐标系,当相机安装不平行于地面时,会导致垂直方向上定位不准确,可以使用IMU信息,给出全局参考坐标系,使定位结果更加准确。传统的相机与惯性测量单元标定方法有以下几点:

    (1)Mirzaei和Roumeliotis提出了一种使用扩展卡尔曼滤波器求取摄像机-IMU间的相对位姿的方法需要用到特定的标定板,当系统初始误差和噪声较大时,计算结果的精度较低。

    (2)Kelly和Sukhatme提出了一种基于无??ǘ瞬ㄆ鞯拇衅魑蛔吮甓ǚ椒?,不需要特定的标定板,但重力加速度对标定精度有一定影响,当对大地坐标系下的重力加速度进行估计时,模型的准确度有限,故对标定精度有一定影响。

    (3)Johnson等使用高精度3D激光扫描仪辅助求取摄像机-IMU相对位姿关系,但激光扫描仪一般较昂贵。

    (4)Lang和Pinz,根据手眼标定方程,提出了一种受限的非线性优化算法,可用于计算相机和IMU之间的旋转变化角度[5]。该方法中假定摄像机与IMU位置十分相近,忽落了两者之间的相对位置关系,但该假设是不成立的,对传感器数据融合的结果有一定的影响。

    (5)Lobo和Dias使用两个完全独立的步骤标定摄像机与IMU之间的位置关系与姿态关系。将IMU固定在一个可旋转的平台上,执行规定的运动,由手眼标定的方法得出摄像机与IMU之间的位置关系。该方法需要用到重物和旋转台,仪器安装的精度直接影响标定结果。

    如何让得到简便精确的求取相机坐标系与IMU坐标系的相对姿态关系以辅助双目立体视觉定位成为本专利申请人关注和研究的新课题。

    发明内容:

    本发明的目的在于解决现有的视觉里程计中存在的问题,提出一种双目立体相机与IMU相对姿态标定方法。标定系统由支架,重物,细线,双目立体相机与IMU组成。IMU与相机固连在一起,两传感器处于相对静止的状态,如图1所示。本发明的技术方案包括以下步骤:

    1:用已标定好的双目相机,进行左右图像连续采集。得到左图像与右图像中,细线的直线方程。

    2:根据双目测距原理,测得细线在相机坐标系下的表示,单位化后即机坐标系下的重力方向向量。

    3:静止状态下,惯性测量单元所测得的加速度即为重力加速速,单位化后就得到惯性测量单元在IMU下的表示。

    4:使相机与IMU固连单元以不同的姿态,静止于细线前方,多采集几组数据,重复步骤2与步骤3。

    5:计算出相机坐标系与IMU坐标系间的姿态关系。

    6:时间同步,由于IMU采集频率高于双目立体相机,故需要时间同步。

    本发明的优点在于:

    1)本发明通过细线确定绝对重力方向,减少了由于重力方向不准确带来的误差。

    2)求解旋转四元数过程中,使用了RANSIC算法,去除噪声较大的实验数据,增加了系统的鲁棒性。

    3)本文充分运用了已标定的双目立体相机可以直接测得空间一点在相机坐标系下的三维坐标的优势,更准确的确定了像机坐标系下的绝对重力方向。

    附图说明:

    图1是相机-陀螺仪标定系统示意图

    图2是双目测距原理示意图

    图3是本发明中定义的各个坐标系

    图4相机坐标系下重力方向向量表示

    具体实施方式:

    下面结合说明书附图对本发明方法做详细说明:

    步骤1:对双目摄像机进行标定,获取相机内外参数,包括:焦距f,基线长度b,图像中心像素位置u0,v0,整幅图像的校正矩阵等,相机的内参数矩阵:

    步骤2:开启双目相机,进行左右图像连续采集,利用步骤1获取的相机参数对图像进行校正。

    步骤3:得到左图像与右图像中,细线的直线方程。

    步骤3-1:可以使用霍夫变换或者手动选取细线端点的方法,获得直线方程,得到细线端点的像素坐标两个点(u1l,v1l)与点(u2l,v2l),可以求解出视差d=xl-xr使用立体几何原理求得像素点对应的三维坐标值,其计算公式为:

    步骤3-2:将相机坐标系下,细线方向向量单位化,就得到相机坐标系下重力方向向量的表示。

    步骤4:通常惯性测量单元的加速度计测得的加速度a由重力向量g和系统自身加速度ab两部分组成:a=-g+ab。在IMU静止或匀速运动的情况下,测得的加速度为重力加速度,将IMU所测得的加速度信息单位化后,即得到重力方向向量在IMU坐标系下的表示。测得重力加速度单位化公式为:

    步骤5:重复步骤二与步骤三,多采集几组数据,提高系统的鲁棒性。

    步骤6:解算IMU坐标系与相机坐标系之间的旋转四元数,假设Igi为第i次测得的重力方向在IMU坐标系下的单位向量,Cgi为第i次测得的重力方向在相机坐标系下的单位向量。现假设四元数表示从{I}系到{C}系的位姿变换,于是,有根据已有文献中求取旋转四元数方法可知:能够使取得最大值的旋转四元数即为所求。

    上式可以写为:

    令Igi=(IxiIyiIzi),cgi=(cxicyiczi)设:

    将公式(6)和(7)带入公式(5),有:

    所要求的单位四元组也就是使成立的解,其中:令N如下所示:

    N为对称矩阵,所要求的四元数即为N的最大特征值λmax所对应的特征向量。

    步骤7:重复步骤6,进行多次迭代,记录每一次迭代中得到的局内特征点数,找出局内特征点数最多的一次,作为像极坐标系与IMU坐标系之间的旋转四元数。

    步骤8:由于IMU采样频率相对立体相机而言较快,故IMU返回信息不能直接使用,本发明采用一种比较简便的方法,以系统时间作为参考,记录下每组图片的时间戳与IMU返回每组数据的时间戳,根据每组图片的时间戳寻找与其相对时间差最小的IMU数据。由于时间是线性增加的,在IMU先于相机采集数据的情况下,理论上每组图片都能够找到与之对应的IMU数据。

    关于本文
    本文标题:一种双目立体相机与惯性测量单元相对姿态标定方法.pdf
    链接地址://www.4mum.com.cn/p-5886386.html
    关于我们 - 网站声明 - 网站地图 - 资源地图 - 友情链接 - 网站客服 - 联系我们

    [email protected] 2017-2018 www.4mum.com.cn网站版权所有
    经营许可证编号:粤ICP备17046363号-1 
     


    收起
    展开
  • 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 2019-05-13
  • 银保监会新规剑指大企业多头融资和过度融资 2019-05-12
  • 韩国再提4国联合申办世界杯 中国网友无视:我们自己来 2019-05-11
  • 中国人为什么一定要买房? 2019-05-11
  • 十九大精神进校园:风正扬帆当有为 勇做时代弄潮儿 2019-05-10
  • 粽叶飘香幸福邻里——廊坊市举办“我们的节日·端午”主题活动 2019-05-09
  • 太原设禁鸣路段 设备在测试中 2019-05-09
  • 拜耳医药保健有限公司获第十二届人民企业社会责任奖年度企业奖 2019-05-08
  • “港独”没出路!“梁天琦们”该醒醒了 2019-05-07
  • 陈卫平:中国文化内涵包含三方面 文化复兴表现在其中 2019-05-06
  • 人民日报客户端辟谣:“合成军装照”产品请放心使用 2019-05-05
  • 【十九大·理论新视野】为什么要“建设现代化经济体系”?   2019-05-04
  • 聚焦2017年乌鲁木齐市老城区改造提升工程 2019-05-04
  • 【专家谈】上合组织——构建区域命运共同体的有力实践者 2019-05-03
  • 【华商侃车NO.192】 亲!楼市火爆,别忘了买车位啊! 2019-05-03
  • 快乐飞艇介绍 安徽快3玩法赌和值大小 河北十一选五遗漏top 扑克魔术猜牌 会赚钱的手机软件排行榜 今天湖北30选5开奖结果 德州扑克下载 彩票宝苹果 内蒙古快三连线走势图 东北老k棋牌官网下载 平特一尾 3d彩票投注中的投大小 甘肃11选5走势图top10遗漏 斗地主电脑版 旧版彩金捕鱼 双色球江西快3今天开奖结果