• 四川郎酒股份有限公司获第十二届人民企业社会责任奖年度环保奖 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
    • / 12
    • 下载费用:30 金币  

    重庆时时彩软件免费版下载: 一种使用激光器和单目相机测量球状目标几何参数的方法.pdf

    摘要
    申请专利号:

    重庆时时彩单双窍门 www.4mum.com.cn CN201610069434.6

    申请日:

    2016.02.01

    公开号:

    CN105606025A

    公开日:

    2016.05.25

    当前法律状态:

    授权

    有效性:

    有权

    法律详情: 授权|||实质审查的生效IPC(主分类):G01B 11/00申请日:20160201|||公开
    IPC分类号: G01B11/00; G01C11/00 主分类号: G01B11/00
    申请人: 西安交通大学
    发明人: 王飞; 董航; 李中衡; 何一聪; 陈亚南; 党政; 张观洲; 杨海伟
    地址: 710049 陕西省西安市碑林区咸宁西路28号
    优先权:
    专利代理机构: 西安通大专利代理有限责任公司 61200 代理人: 陆万寿
    PDF完整版下载: PDF下载
    法律状态
    申请(专利)号:

    CN201610069434.6

    授权公告号:

    105606025B||||||

    法律状态公告日:

    2017.06.27|||2016.06.22|||2016.05.25

    法律状态类型:

    授权|||实质审查的生效|||公开

    摘要

    一种使用激光器和单目相机测量球状目标几何参数的方法,包括设置相机与三个以上的激光器,使激光器射出的激光束照射到目标上并且不共面,相机朝向与激光束的方向相同;定义世界坐标系Ow与相机坐标系Oc,确定相机的内部参数矩阵以及相机坐标系与世界坐标系的转换关系;定义图像二维坐标系,使相机采集激光束照射到目标上的点,得到激光点在图像坐标系下的坐标以及目标在图像上的圆心坐标;通过几何关系和相机图像转换关系计算出目标的几何参数。本方法与单目测量方法相比,无需提前获取目标信息,适用于无纹理非合作目标的测量,与双目测量方法相比,效率、稳定性更高,且具备较好的容错性和鲁棒性。

    权利要求书

    1.一种使用激光器和单目相机测量球状目标几何参数的方法,其特征在于:
    步骤一、设置相机与激光器,使激光器射出的激光束照射到目标上,相机朝向与激光束
    的方向相同;所述的激光器设置三个以上,且射出的激光束不共面;
    步骤二、定义世界坐标系Ow与相机坐标系Oc;标定激光器在世界坐标系Ow下的坐标,确
    定激光束在世界坐标系Ow中的俯仰角以及偏航角;相机的内部参数矩阵为 A = f x 0 u 0 0 f y v 0 0 0 1 , ]]>
    其中(fx,fy)为相机的等效焦距,(u0,v0)为相机的光心坐标;
    步骤三、定义图像二维坐标系,采集相机图像,通过图像处理得到激光点在图像坐标系
    下的坐标以及目标在图像上的圆心坐标;
    步骤四、通过标定得到激光器在世界坐标系下的坐标以及激光束与世界坐标系的夹
    角,确定世界坐标系Ow下的激光直线方程,使之联立目标球体方程x02+y02+z02=r2,其中x0,
    y0,z0为球心的坐标,r是球体的半径,得到世界坐标系Ow下球面上的激光点坐标,并以此用
    x0,y0,z0,r表示目标的球心在世界坐标系Ow下的坐标;
    步骤五、相机坐标系Oc下的点坐标Sc表示为:Sc=R·Sw+T,其中Sw是世界坐标系Ow下的
    坐标,R、T为相机坐标系Oc与世界坐标系Ow之间的转换关系参数,由此将世界坐标系Ow下目
    标球面上的激光点、球心的坐标表示为相机坐标系Oc下的坐标;
    步骤六、根据相机成像模型,确定相机坐标系Oc下的激光点在图像坐标系下的坐标,将
    相机坐标系Oc下球面上的激光点、球心坐标与图像上激光点、球心坐标建立对应关系;
    步骤七、根据对应关系,列出每个激光点的方程组,求解该方程组得到目标的几何参
    数。
    2.根据权利要求1所述的使用激光器和单目相机测量球状目标几何参数的方法,其特
    征在于:所述世界坐标系Ow选择其中一个激光器的安装位置为原点,以地平面为标准,水平
    向前为Zw轴正方向,与Zw轴垂直,水平向右为Xw轴正方向,垂直地面向下为Yw轴正方向;所
    述相机坐标系Oc以相机的光心为原点,Zc为相机光轴指向相机前方,Xc轴与Yc轴分别平行
    于图像坐标系的U、V,向右为Xc轴正方向,向下为Yc轴正方向;所述图像坐标系原点位于图
    像左上方,以像素为单位,U、V分别代表像素点在图像上的列数和行数。
    3.根据权利要求2所述的使用激光器和单目相机测量球状目标几何参数的方法,其特
    征在于:激光束在世界坐标系Ow中的俯仰角即与世界坐标系XwOwZw平面的夹角,偏航角即
    激光束在世界坐标系XwOwZw平面的投影与世界坐标系YwOwZw平面的夹角。
    4.根据权利要求2所述的使用激光器和单目相机测量球状目标几何参数的方法,其特
    征在于,由世界坐标系Ow下的激光直线方程与目标球体方程联立,得到世界坐标系Ow下球
    面上的激光点坐标,P(Px,Py,Pz)表示为:
    P z = ( - B - B 2 - 4 × A × C ) 2 × A P x = x + ( P z - z ) × t a n β P y = y - ( P z - z ) × t a n α ; ]]>
    其中:A、B、C为中间变量:
    A = tan 2 α + ( t a n β c o s α ) 2 + 1 ]]>
    B = 2 × ( ( x - z t a n β c o s α - x 0 ) × t a n β c o s α - ( y + z × t a n α - y 0 ) × t a n α - z 0 ) ; ]]>
    C = x 0 2 + ( x - z × t a n β c o s α - x 0 ) 2 + ( y + z × t a n α - y 0 ) 2 - r 2 ]]>
    (x,y,z)为激光器在世界坐标系下的坐标,α为激光束与世界坐标系XwOwZw平面的夹
    角,β为激光束在世界坐标系XwOwZw平面的投影与世界坐标系YwOwZw平面的夹角,(x0,y0,
    z0)为目标球心在世界坐标系下的坐标,r为目标半径。
    5.根据权利要求2所述的使用激光器和单目相机测量球状目标几何参数的方法,其特
    征在于,相机坐标系Oc下的激光点在图像坐标系下的坐标(u,v)表示为:
    u = f x P c x P c z + u 0 v = f y P c y P c z + v 0 ; ]]>
    其中,Pc(Pcx,Pcy,Pcz)为激光点在相机坐标系下的坐标。
    6.根据权利要求2所述的使用激光器和单目相机测量球状目标几何参数的方法,其特
    征在于,球心对应在图像上的坐标为图像上目标对应的圆形轮廓的圆心。
    7.根据权利要求1所述的使用激光器和单目相机测量球状目标几何参数的方法,其特
    征在于:所述的步骤一中使所有激光器排列成规则的几何形状,激光束平行于相机光轴射
    出,以其中一个激光器坐标为世界坐标系的原点。

    说明书

    一种使用激光器和单目相机测量球状目标几何参数的方法

    技术领域

    本发明涉及计算机视觉与图像处理领域,具体涉及一种使用激光器和单目相机测
    量球状目标几何参数的方法。

    背景技术

    三维空间中的球状目标或类球状目标是现实环境中的一种常见目标,使用机器视
    觉的方法准确测量球状目标的大小和位置在工程中有着重要应用。当前解决这一问题的方
    法是通过双目视觉对三维目标进行重建或单目相机直接观测。这两种方法都存在着各自的
    弊端:双目视觉的方法由于受视场角限制,无法近距离测量半径较大的球状目标;而单目相
    机能够在很大范围内对球状目标进行观测,但是当球状目标大小未知时,无法对目标位置
    进行准确测量。

    发明内容

    本发明的目的在于针对上述现有技术中的缺陷,提供一种使用激光器和单目相机
    测量球状目标几何参数的方法,无论在较远距离和较近距离都能精确测量球状目标的位姿
    参数。

    为了实现上述目的,本发明采用的技术方案包括以下步骤:

    步骤一、设置相机与激光器,使激光器射出的激光束照射到目标上,相机朝向与激
    光束的方向相同;所述的激光器设置三个以上,且射出的激光束不共面;

    步骤二、定义世界坐标系Ow与相机坐标系Oc;标定激光器在世界坐标系Ow下的坐
    标,确定激光束在世界坐标系Ow中的俯仰角以及偏航角;相机的内部参数矩阵为
    A = f x 0 u 0 0 f y v 0 0 0 1 , ]]>其中(fx,fy)为相机的等效焦距,(u0,v0)为相机的光心坐标;

    步骤三、定义图像二维坐标系,采集相机图像,通过图像处理得到激光点在图像坐
    标系下的坐标以及目标在图像上的圆心坐标;

    步骤四、通过标定得到激光器在世界坐标系下的坐标以及激光束与世界坐标系的
    夹角,确定世界坐标系Ow下的激光直线方程,使之联立目标球体方程x02+y02+z02=r2,其中
    x0,y0,z0为球心的坐标,r是球体的半径,得到世界坐标系Ow下球面上的激光点坐标,并以此
    用x0,y0,z0,r表示目标的球心在世界坐标系Ow下的坐标;

    步骤五、相机坐标系Oc下的点坐标Sc表示为:Sc=R·Sw+T,其中Sw是世界坐标系
    Ow下的坐标,R、T为相机坐标系Oc与世界坐标系Ow之间的转换关系参数,由此将世界坐标系
    Ow下目标球面上的激光点、球心的坐标表示为相机坐标系Oc下的坐标;

    步骤六、根据相机成像模型,确定相机坐标系Oc下的激光点在图像坐标系下的坐
    标,将相机坐标系Oc下球面上的激光点、球心坐标与图像上激光点、球心坐标建立对应关
    系;

    步骤七、根据对应关系,列出每个激光点的方程组,求解该方程组得到目标的几何
    参数。

    所述世界坐标系Ow选择其中一个激光器的安装位置为原点,以地平面为标准,水
    平向前为Zw轴正方向,与Zw轴垂直,水平向右为Xw轴正方向,垂直地面向下为Yw轴正方向;
    所述相机坐标系Oc以相机的光心为原点,Zc为相机光轴指向相机前方,Xc轴与Yc轴分别平
    行于图像坐标系的U、V,向右为Xc轴正方向,向下为Yc轴正方向;所述图像坐标系原点位于
    图像左上方,以像素为单位,U、V分别代表像素点在图像上的列数和行数。

    激光束在世界坐标系Ow中的俯仰角即与世界坐标系XwOwZw平面的夹角,偏航角即
    激光束在世界坐标系XwOwZw平面的投影与世界坐标系YwOwZw平面的夹角。

    由世界坐标系Ow下的激光直线方程与目标球体方程联立,得到世界坐标系Ow下球
    面上的激光点坐标,P(Px,Py,Pz)表示为:

    P z = ( - B - B 2 - 4 × A × C ) 2 × A P x = x + ( P z - z ) × t a n β P y = y - ( P z - z ) × t a n α ; ]]>

    其中:A、B、C为中间变量:

    A = tan 2 α + ( t a n β c o s α ) 2 + 1 ]]>

    B = 2 × ( ( x - z t a n β c o s α - x 0 ) × t a n β c o s α - ( y + z × t a n α - y 0 ) × t a n α - z 0 ) ; ]]>

    C = x 0 2 + ( x - z × t a n β c o s α - x 0 ) 2 + ( y + z × t a n α - y 0 ) 2 - r 2 ]]>

    (x,y,z)为激光器在世界坐标系下的坐标,α为激光束与世界坐标系XwOwZw平面的
    夹角,β为激光束在世界坐标系XwOwZw平面的投影与世界坐标系YwOwZw平面的夹角,(x0,y0,
    z0)为目标球心在世界坐标系下的坐标,r为目标半径。

    相机坐标系Oc下的激光点在图像坐标系下的坐标(u,v)表示为:

    u = f x P α P c z + u 0 v = f y P c y P c z + v 0 ; ]]>

    其中,Pc(Pcx,Pcy,Pcz)为激光点在相机坐标系下的坐标。

    所述球心对应在图像上的坐标为图像上目标对应的圆形轮廓的圆心。

    所述的步骤一中使所有激光器排列成规则的几何形状,激光束平行于相机光轴射
    出,以其中一个激光器坐标为世界坐标系的原点。

    与现有技术相比,本发明将激光束照射在球状目标上,相机通过观测球状目标和
    照射到目标上的高亮激光点,便能够确定球状目标的几何参数(x0,y0,z0,r),其中(x0,y0,
    z0)为目标在世界坐标系下的球心坐标,即目标的位置,r是目标的半径,即目标的大小。本
    发明仅使用单目相机和若干个激光器即能够测量球状目标的位姿,成本低廉、设备简单,在
    精确设定激光器位置或保证光束平行的情况下还能够简化运算。本方法与传统的单目测量
    方法相比,无需提前获取目标信息,适用于无纹理非合作目标的测量。与双目测量方法相
    比,该方法效率更高、稳定性更高,且能够对近距离大半径球状目标进行测量。并且,本方法
    在增加激光器的情况下,图像上丢失若干激光点依然能准确测量目标参数,具备较高的容
    错性和鲁棒性。最后,本方法能够在DSP或FPGA等小型嵌入式平台上实时在线运行,硬件上
    实施容易。

    进一步的,本发明使所有激光器排列成规则的几何形状,激光束平行于相机光轴
    射出,以其中一个激光器坐标为世界坐标系的原点,这样设置能够使一些中间变量归零,简
    化运算。

    附图说明

    图1本发明方法的整体流程图;

    图2实施本发明的装置结构示意图;

    图3(a)本方法中世界坐标系和相机坐标系定义示意图;

    图3(b)本方法中图像坐标系定义示意图;

    图4本方法中激光束与世界坐标系之间的夹角定义示意图;

    图5(a)本方法采集图像正常时的示意图;

    图5(b)本方法采集图像缺失一个激光点的示意图。

    具体实施方式

    下面结合附图对本发明做进一步的详细说明。

    此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。

    参见图1,本实施例中使用激光器的数目为四个,实施步骤如下:

    1、如图2所示,将相机和四个激光器固定在一起,令四个激光器射出的激光束方向
    大致与相机朝向相同,每三条激光束均不共面??梢允构馐较蛏阅诰凼构馐菀渍丈涞?br />目标。如图3(a)所示,定义世界坐标系Ow,Ow为右手坐标系。Ow的定义由实际应用场景决定,
    以便于确定激光器坐标以及激光束与坐标轴之间的夹角为原则。本实施例选择其中一个激
    光器的安装位置为原点,以地平面为标准水平向前为Zw轴正方向,与Zw轴垂直,水平向右为
    Xw轴正方向,垂直于地面向下为Yw轴正方向;定义相机坐标系Oc,原点为相机光心,Zc为相
    机光轴指向相机前方,Xc轴与Yc轴分别平行于图像坐标系的U、V,向右为Xc轴正方向,向下
    为Yc轴正方向,通过标定得到相机坐标系Oc与世界坐标系Ow之间的旋转平移矩阵为R、T,世
    界坐标系中的点Sw在相机中的坐标为Sc,则:Sc=R·Sw+T(1)

    如图3(b),定义图像二维坐标系,原点为图像左上角,以像素为单位,U、V分别代表
    像素点在图像上的列数和行数。

    2、通过标定得到四个激光器在世界坐标系下的坐标分别为(xa,ya,za),(xb,yb,
    zb),(xc,yc,zc),(xd,yd,zd),如图4所示,激光束在世界坐标系内的俯仰角即激光束与世
    界坐标系XwOwZw平面的夹角分别为αa,αb,αc,αd,转向Yw轴正方向一侧为正;激光束在世界
    坐标系内的偏航角即激光束在世界坐标系XwOwZw平面的投影与世界坐标系YwOwZw平面的
    夹角分别为βa,βb,βc,βd,转向Xw轴正方向一侧为正。通过标定得到相机内参矩阵为
    A = f x 0 u 0 0 f y v 0 0 0 1 , ]]>其中(fx,fy)为相机的等效焦距,(u0,v0)为相机光心坐标;

    3、将四条激光束照射在球状目标上,使目标和激光束照射在目标上的四个点能够
    被相机完整捕捉,采集相机图像。通过图像处理的方法得到相机采集到的图像上激光点在
    图像坐标系下的坐标Pai(ua,va),Pbi(ub,vb),Pci(uc,vc),Pdi(ud,vd),目标在图像上圆心的坐
    标Po’i(uo’,vo’);

    4、根据图像上的激光点坐标、目标在图像上的圆心坐标、光束与球体之间的几何
    关系和相机成像模型,即可求得目标的几何参数(x0,y0,z0,r)。公式推导如下:

    球状目标在世界坐标系下的方程为:

    (x-x0)2+(y-y0)2+(z-z0)2=r2(2)

    如图2所示,(x0,y0,z0)为目标球心在世界坐标系下的坐标,r是目标的半径。用Pa
    =(Pax,Pay,Paz)、Pb=(Pbx,Pby,Pbz)、Pc=(Pcx,Pcy,Pcz)、Pd=(Pdx,Pdy,Pdz)分别表示激光束与
    球的交点在世界坐标系下的坐标,Pac=(Pacx,Pacy,Pacz)T、Pbc=(Pbcx,Pbcy,Pbcz)T、Pcc=(Pccx,
    Pccy,Pccz)T、Pdc=(Pdcx,Pdcy,Pdcz)T分别表示激光束与球的交点在相机坐标系下的坐标,则由
    激光点与球状目标间的几何关系,Pa在世界坐标系下的坐标满足方程:

    (Pax-x0)2+(Pay-y0)2+(Paz-z0)2=r2(3)

    由光束直线方程与球体方程,用激光器坐标表示激光点坐标,可得:

    ( x a + ( P a z - z a ) t a n β c o s α - x 0 ) 2 + ( y a - ( P a z - z a ) t a n α - y a ) 2 + ( P a z - z a ) 2 = r 2 - - - ( 4 ) ]]>

    求解这个方程,则Pa可表示为:

    P a z = ( - B - B 2 - 4 × A × C ) 2 × A P a x = x a + ( P a z - z a ) × tanβ a P a y = y a - ( P a z - z a ) × tanα a - - - ( 5 ) ]]>

    其中:


    A = tan 2 α a + ( tanβ a cosα a ) 2 + 1 B = 2 × ( ( x a - z a tanβ a cosα a - x 0 ) × tanβ a cosα a - ( y a + z a × tanα a - y 0 ) × tanα a - z 0 ) C = x 0 2 + ( x a - z a × tanβ a cosα a - x 0 ) 2 + ( y a + z a × tanα a - y 0 ) 2 - r 2 - - - ( 6 ) ]]>

    同理可得Pb、Pc、Pd。

    根据相机的成像原理,目标球心对应在图像上的点Poi(uo,vo)为图像上目标的圆
    心,即Poi(uo,vo)=Po’i(uo’,vo’),

    又由世界坐标系与相机坐标系间的旋转平移关系可得:

    Pac=R×Pa+T

    Pbc=R×Pb+T

    Pcc=R×Pc+T(7)

    Pdc=R×Pd+T

    Poc=R×Po+T

    根据相机的投影透视模型可得:

    u a = f x P a c x P a c z + u 0 v a = f y P a c y P a c z + v 0 - - - ( 8 ) ]]>

    u b = f x P b c x P b c z + u 0 u b = f y P b c y P b c z + v 0 - - - ( 9 ) ]]>

    u c = f x P c c x P c c z + u 0 v c = f y P c c y P c c z + v 0 - - - ( 10 ) ]]>

    u d = f x P d c x P d c z + u 0 v d = f y P d c y P d c z + v 0 - - - ( 11 ) ]]>

    u o = f x P o c x P o c z + u 0 v 0 = f y P o c y P o c z + v 0 - - - ( 12 ) ]]>

    上述方程中只有(x0,y0,z0,r)四个未知量,求解这十个方程,可以求得可得目标半
    径r和目标在世界坐标系下的球心坐标(x0,y0,z0),从而完成目标大小和位置的测量。

    由于三维空间中四个非共面的点能够唯一确定一个球体,而任意三个激光点与目
    标球心必然不共面,因此该方程组有唯一解,并且在图像上有一个激光点缺失的情况下不
    影响方程求解,增加了本方法的容错性和鲁棒性。图5为其中一种情况的示意图。

    若能精确设定激光器位置并保证激光器射出的光束平行,如本例中可令四个激光
    器排列成正方形,四束激光平行于相机光轴平行射出,以其中一个激光器坐标为世界坐标
    系原点,四个激光器组成世界坐标系,四个激光器在世界坐标系中的坐标分别为(0,0,0),
    (0,yb,0),(0,yc,zc),(0,0,zd),αa,αb,αc,αd与βa,βb,βc,βd均为0,则可以简化运算。同理,激
    光器能排列成其他规则几何形状或保证激光束的平行均可以简化运算过程。

    本发明对球体的内接多边形,如正26面体等类球体目标,也具备足够的计算精度。

    关 键 词:
    一种 使用 激光器 相机 测量 球状 目标 几何 参数 方法
      专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
    关于本文
    本文标题:一种使用激光器和单目相机测量球状目标几何参数的方法.pdf
    链接地址://www.4mum.com.cn/p-5886308.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