本发明涉及机器视觉中两相机标定技术,具体涉及基于激光测距仪辅助无公共视场的两相机标定方法及装置,即没有公共视场的相机标定,利用激光测距仪提高两相机的标定精度。
背景技术:
视觉传感器(相机)具有非接触、精度高、速度快等一系列优点,常用在三维坐标测量系统中;单个视觉传感器由于视场受限,无法满足大型系统测量需求,所以需要将两个传感器结合起来;如何确定两个传感器之间的位姿关系是整个测量系统不可或缺的重要步骤;目前,现有技术中的两相机标定法,例如:同名坐标统一法以及世界坐标统一法,都需要大型的外部辅助设备参与工作,可标定现场的空间往往有限,并不是任何环境都能安装这些大型的外部辅助设备,使得现有技术在采用两相机标定工作中,遇到较多的推广阻力,实施困难,且标定精度低。
技术实现要素:
为了解决上述技术问题,本发明提供基于激光测距仪辅助无公共视场的两相机标定方法及装置,通过科学、优化的方法设计,完成了无需占用较大空间及支配较多辅助设备的前提下,高精度的完成标定测量,且该发明技术方案灵活简便,工作安全可靠;
基于激光测距仪辅助无公共视场的两相机标定方法及装置,其中,
基于激光测距仪辅助的无公共视场的两相机标定方法,包括如下步骤:
步骤一、第一相机和第二相机分别拍摄第一靶标和第二靶标,并测量第一、第二靶标分别与第一、第二相机的位姿关系,设定第一相机坐标系为全局坐标系,测量过程中利用激光测距仪辅助提高相机光轴方向上的位移测量精度;
步骤二、标定无公共视场的第一、第二相机之间的位姿关系;包括:
进一步的,采用激光测距仪辅助视觉传感器进行测量,以提高光轴方向上位移侧测量精度,具体步骤如下:
首先,将所述第一、第二相机与激光测距仪固连,保证所述激光测距仪的测距方向与所述第一、第二相机光轴方向基本一致;
作为一种举例说明,所述基本一致是指保证所述激光测距仪与相机构成相机-激光测距仪位姿测量系统;
其次,标定激光出光点在第一、第二相机坐标系下的坐标;
再次,标定激光光束的方向;
最后,对相机-激光测距仪组合测量模块建模,求取高精度的特征点在所述第一、第二相机坐标系下的坐标;
进一步的,标定出无公共视场的所述第一相机和第二相机的相对位姿关系,由所述第一靶标和第二靶标上特征点之间构建的矢量与距离关系、标定出所述第一相机和第二相机之间的位姿关系,具体包括如下技术步骤:
第一、变换连杆位置,由所述第一靶标和第二靶标上任意点构建的矢量夹角在全局坐标系中不变的原则建立角度关系式:
其中,
第二、第一靶标和第二靶标上各取一个点,变换连杆的位置,在全局坐标系下两点之间的距离不变,以此约束建立位置关系式:
其中,
基于激光测距仪辅助无公共视场的两相机标定装置,包括:第一相机、第二相机、第一靶标、第二靶标、连杆、两个激光测距仪;
进一步的,所述第一相机和第二相机分别用于拍摄第一靶标和第二靶标;所述第一、第二靶标通过所述连杆固连连接;所述的两个激光测距仪分别辅助第一、第二相机测量第一靶标和第二靶标分别与第一相机、第二相机的位姿关系;
本发明的有益效果:
1、本发明针对无公共视场的两相机标定问题,首先将激光测距仪与相机构成组合测量模块,对组合测量模块进行建模求取更精确的特征点在相机坐标系下的坐标,然后利用两个靶标上特征点的约束关系,通过解方程的形式得到两相机之间的位姿关系;
2、该方法能够实现高精度的标定,且不必知道两靶标之间的关系,只需两靶标和连杆固连,并且该方法使用的激光测距仪体积小,使用方便、灵活,克服传统标定方法中外部辅助设备较大,受空间限制,通过扩展相机的数量,可实现对更多相机的标定。
附图说明
图1是本发明基于激光测距仪辅助无公共视场的两相机标定方法及装置之相机和激光测距仪构成的组合测量模块示意图
图2是本发明基于激光测距仪辅助无公共视场的两相机标定方法及装置之两相机标定示意图
图3是本发明基于激光测距仪辅助无公共视场的两相机标定方法之工作流程示意图
具体实施方式
下面,参考附图1至图3所示,基于激光测距仪辅助无公共视场的两相机标定方法及装置,其中:
基于激光测距仪辅助的无公共视场的两相机标定方法,包括如下步骤:
步骤一、第一相机101和第二相机102分别拍摄第一靶标103和第二靶标104,并测量第一靶标103、第二靶标104分别与第一相机101、第二相机102的位姿关系,设定第一相机101坐标系为全局坐标系,测量过程中利用激光测距仪105辅助提高相机光轴方向上的位移测量精度;
步骤二、标定无公共视场的第一101、第二相机102之间的位姿关系;包括:
进一步的,采用激光测距仪105辅助视觉传感器进行测量,以提高光轴方向上位移侧测量精度,具体步骤如下:
首先,将所述第一相机101、第二相机102与激光测距仪105固连,保证所述激光测距仪105的测距方向与所述第一相机101、第二相机102光轴方向基本一致;
作为一种举例说明,所述基本一致是指保证所述激光测距仪105与相机构成相机-激光测距仪位姿测量系统;
其次,标定激光出光点在第一相机101、第二相机102坐标系下的坐标;
再次,标定激光光束的方向;
最后,对相机-激光测距仪组合测量模块建模,求取高精度的特征点在所述第一相机101、第二相机102坐标系下的坐标;
进一步的,标定出无公共视场的所述第一相机101和第二相机102的相对位姿关系,由所述第一靶标103和第二靶标104上特征点之间构建的矢量与距离关系、标定出所述第一相机101和第二相机102之间的位姿关系,具体包括如下技术步骤:
第一、变换连杆106位置,由所述第一靶标103和第二靶标104上任意特征点构建的矢量夹角在全局坐标系中不变的原则建立角度关系式:
其中,
第二、第一靶标103和第二靶标104上各取一个点,变换连杆106的位置,在全局坐标系下两点之间的距离不变,以此约束建立位置关系式:
其中,
基于激光测距仪辅助无公共视场的两相机标定装置,包括:第一相机101、第二相机102、第一靶标103、第二靶标104、连杆106、两个激光测距仪105;
进一步的,所述第一相机101和第二相机102分别用于拍摄第一靶标103和第二靶标104;所述第一靶标103、第二靶标104通过所述连杆106固连连接;所述的两个激光测距仪105分别辅助第一相机101、第二相机102测量第一靶标103和第二靶标104分别与第一相机101、第二相机102的位姿关系;
为了更好的说明本发明的设计原理,现通过优选实施例举例说明该发明的工作过程如下:
首先,针对组合测量模块a107,标定激光出光点在第一相机101坐标系下的坐标;第一靶标103所在的世界坐标系ow-xwywzw与第一相机101坐标系oc-xcyczc之间的位姿关系可以通过单目视觉测量得到;
其次,将激光测距仪105测的距离值与第一相机101测量得到的数据融合起来,需要标定出激光出光点d在第一相机101坐标系下的坐标
(1)激光光斑坐标求取
设ai(i=1,2,3,4)为上述平面上的4个已知坐标的特征点,它们在世界坐标系中的空间坐标分别为(xi,yi,0),i=1,2,3,4。对应的像点坐标分别为(ui,vi),i=1,2,3,4;s为激光光斑点,其空间坐标
式中(x,y)为点在第一靶标平面上的坐标,(u,v)为对应的像点坐标,a0,a1,a2,b0,b1,b2,c1,c2为投影变换参数;由上式可以看出,平面的投影变换共有8个待定参数;因此,利用不在同一直线上的4个点即可确定变换关系。上式可改写为如下形式:
a0+a1u+a2v-c1ux-c2vx=x
b0+b1u+b2v-c1uy-c2vy=y
当已知平面上n(n≥4)个点的图像坐标和对应的第一靶标平面坐标时,即可列出如下所示的线性方程,从而实时求解出该平面的投影变换参数a0,a1,a2,b0,b1,b2,c1,c2:
激光光斑点s的像点坐标(us,vs)容易求出,再利用上述求得的投影变换参数,然后即可得到激光光斑点s在第一靶标坐标系下的坐标,最后利用相机求得的r、t,计算光斑s在第一相机坐标系下的坐标。
(2)激光出光点d在第一相机101坐标系下的坐标
上式第二边是关于待标定参数
未知数的个数为3,因此只要n(n≥3)次测量就可以解出
然后,激光光束l单位方向矢量在第一相机101坐标系下坐标的求取;激光出光点d和激光光斑点s在第一相机101坐标系下的坐标在步骤1中已经求出,那么很容易得到激光光束l在第一相机101坐标系下的单位方向矢量(a,b,c)t为:
其中,
再次:相机-激光测距仪组合测量模块a107的建模;δocds中,doc的单位方向向量为(p,q,r)t:
设∠ocds的大小为θ,则:
由三角形余弦定理有:
|ocs|2=|ocd|2+|ds|2-2|ocd|·|ds|cosθ
将cosθ的表达式代入上式,可得激光光斑点s与第一相机101坐标系原点oc之间的距离为:
通过第一相机101外参数标定的r,t阵,得到激光光斑点s到第一相机101坐标系原点oc的距离为:
式中激光光斑点s在第一相机101坐标系中的空间坐标
在单目视觉位姿测量算法中,由于tx,ty的测量精度一般要远大于tz的测量精度,因此可以将tx,ty视为误差小量,而仅对tz进行修正。由|ocs|、|ocs′的计算表达式可将激光测距仪测量得到的数据l与由第一相机101测量得到的数据(tx,ty,tz)联系起来,令|ocs|=|ocs|′,其中
式中
基于标定后的r,t(经过tz修正以后的t)求取特征点ai(i=1,2,3,4)在第一相机101坐标系下的坐标。已知第一靶标103上的特征点ai的坐标为:(xi,yi,0),i=1,2,3,4及
由此可得:
即为特征点ai(i=1,2,3,4)在第一相机101坐标系下的坐标;
针对组合测量模块b108,第二相机102和激光测距仪105的数据融合方法同组合测量模块a107,见前述描述;
再后:标定第一101、第二相机102之间的旋转矩阵
假设aij:i表示靶标上第i点,j表示靶标运动的第j个位置,则由靶标上任意两点在相机坐标系下的坐标得到单位方向矢量:
此时,两个单位向量均在第一相机101坐标系下,两向量之间存在角度常值θ:
式中,
则上式可变换为:
mj·[r1r2r3r4r5r6r7r8r9]t=cosθ
其中,mj=[ajxbjxajxbjyajxbjzajybjxajybjyajybjzajzbjxajzbjyajzbjz]
进一步上式可变换为:
(mk-mh)·[r1r2r3r4r5r6r7r8r9]t=0(k≠h)
k,h表示任意两次移动的靶标。
最后:标定第一101、第二相机102之间的平移矢量
式中:
由上式得:
由于
以上公开的仅为本申请的一个具体实施例,但本申请并非局限于此,任何本领域的技术人员能思之的变化,都应落在本申请的保护范围内。