[发明专利]一种基于双目3D视觉的休止角测量方法

摘要

本发明涉及一种基于双目3D视觉的休止角测量方法，通过参数相同，相对位置已知的两台摄像机对转速稳定的滚筒内颗粒进行测试采集数据，由透镜成像原理，将摄像机的线性成像模型简化为小孔成像模型，对两个摄像机数据进行计算，测得颗粒加工中的休止角及其变化情况。本发明方法能够从颗粒的正面进行休止角测量，避免了因侧面的滚筒壁摩擦力作用而导致的侧面测量休止角大于中间休止角的问题。

主权项

一种基于双目3D视觉的休止角测量方法，其特征在于，具体包括如下步骤：1)选定双摄像机装置，两台摄像机参数相同，两台摄像机的光轴平行，两光轴的距离为b，两台摄像机在同水平面并在同一高度，主摄像机坐标系xc1yc1zc1，原点为Oc1，xc1yc1zc1平面平行于水平台，yc1轴垂直于水平台，滚筒的等效转轴AB平行于xc1轴，双摄像机装置水平固定于水平台上且正对滚筒内颗粒崩塌面，双摄像机装置接图像采集模块，图像采集模块接计算机；2)启动滚筒装置，待其转速稳定；3)打开双摄像机装置、图像采集模块和计算机；4)图像采集模块通过双摄像机装置的主副摄像机同步等间隔采集颗粒的图像，并传输给计算机；5)计算机通过对同时刻双摄像机装置采集的两张图像分析，然后进行匹配得到测试颗粒的相同的第i个光点在两张图像中的像素坐标分别为：(uit1,vit1),(uit2,vit2),]]>计算机将得到的四个变量代入主摄像机坐标系下的坐标和计算机所读取的两个数字图像各像素点坐标的下面关系式中，获取第i个光点在主摄像机坐标系下的坐标(XC1i,YC1i,ZC1i)，关系式：XC1i=-b·(uit1-u0)uit1-uit2]]>YC1i=-b·(vi-v0)·dy(uit1-uit2)·dx]]>ZC1i=-b·f(uit1-uit2)·dx]]>其中成像坐标原点为(u0，vo)，f为摄像机的焦距，dx为摄像机中CCD感光颗粒的宽度，dy为摄像机中CCD感光颗粒的长度；其中第i个光点在主摄像机坐标系下的坐标(XC1i,YC1i,ZC1i)由下面方式获得：由透镜成像原理可知，摄像机的线性成像模型简化为小孔成像模型，则利用小孔成像原理进行计算：A):如摄像机线性成像原理图，成像平面平行于摄像机坐标系的xcoyc平面，摄像机坐标系xcyczc的原点o即为摄像机透镜的等效光心,光轴与zc轴重合；B):其中成像平面与图像坐标系xpy是重合的,为了计算方面直观，将成像平面向Zc轴正方向平移到对称位置；C):其中空间中的点M(Xc，Yc，Zc),M点为摄像机坐标系中的一点，在成像平面上的成像点为m(x，y)；由透镜的线性成像原理，△opm相似于△OEM，其中线段ME垂直于zc轴；由三角形相似原理可得如下测量原理：x=-fXC/ZCy=-fYC/ZC]]>式中f为摄像机焦距，x、y为成像点m的坐标值,采取双目3D视觉测量目标的景深从而计算出角度:设测量目标第i个光点在主摄像机C1坐标系下的坐标为：ri1＝[Xc1i,Yc1i,Zc1i],在第二个摄像机,即副摄像机C2坐标系下的坐标为：ri2＝[Xc2i,Yc2i,Zc2i]；ri1和ri2的关系为:XC2iYC2iZC2i=C{C2}{C1}(XC1iYC1iZC1i{C1}-M{C2}{C1})---(1)]]>其中为副摄像机坐标系相对于主摄像机坐标系的姿态旋转矩阵，为副摄像机坐标系原点在主摄像机坐标系下的坐标，C{C2}{C1}、M{C2}{C1}由两摄像机的相对安装位置决定；由测量原理可知第i个光点在两个摄像机坐标系下的成像坐标分别为：xit1=-fXC1i/ZC1iyit1=-fYC1i/ZC1ixit2=-fXC2i/ZC2iyit2=-fYC2i/ZC2i---(2)]]>其中像点坐标可由两个摄像机成像中提取，将⑴代入⑵，化简可得如下关系：其中t1、t2分别代表摄像机C1、C2成像平面，xit1ZC1i+fXC1i=0yit1ZC1i+fYC1i=0xit2[c31(XC1i-xc2)+c32(YC1i-yc2)+c33(ZC1i-zc2)]+f[c11(XC1i-xc2)+c12(YC1i-yc2)+c13(ZC1i-zc2)]=0yit2[c31(XC1i-xc2)+c32(YC1i-yc2)+c33(ZC1i-zc2)]+f[c21(XC1i-xc2)+c22(YC1i-yc2)+c23(ZC1i-zc2)]=0---(3)]]>将式⑶化成矩阵形式，令A=f0xit10fyit1c31xit2+c11fc32xit2+c12fc33xit2+c13fc31yit2+c21fc32yit2+c22fc33yit2+c23f]]>B=00xit2(c31xc2+c32yc2+c33zc2)+f(c11xc2+c12yc2+c13zc2)yit2(c31xc2+c32yc2+c33zc2)+f(c21xc2+c22yc2+c33zc2)]]>则式⑶改写为：Ari1＝B，式子中的C11～C33为计算中间值，当A为列满秩矩阵时，利用最小二乘法即可求得ri1；上述即为基本测量算法，根据实际需要推导出算法如下：为了减少数据处理量与复杂程度，令姿态旋转矩阵C{C2}{C1}=100010001]]>平移矩阵M{C2}{C1}＝[‑b 0 0]其中b称为基线，即两个摄像机的相对距离，A、B分别为点i到两个摄像机成像光轴垂线的垂点，姿态旋转矩阵、平移矩阵、基线长度b代入公式⑶得,第i个光点在主摄像机坐标系下的坐标：rit1=XC1iYC1iZC1i=-b·xit1xit1-xit2-b·yixit1-xit2-b·fxit1-xit2(yit1=yit2=yi)---(4)]]>式(4)中称为视差，ZC1i称为景深，分别为点m1、m2坐标，即i在两个摄像机成像平面上的坐标，上述中都为图像坐标系中的值，在读取时为连续量；计算机读取的实际是摄像机CCD感光元件的输出量，其为离散量；其中uo2v为像素坐标系，x'o3y'为图像坐标系，dx、dy为感光元件单个感光颗粒的长度和宽度；设成像坐标原点为o3(u0,v0),则像素坐标(u,v)与图像坐标(x,y)之间的关系为：u=xdx+u0,v=ydy+v0---(5)]]>将式⑸的关系代入⑷可得到第i个光点在主摄像机坐标系下的坐标关系式：XC1i=-b·(uit1-u0)uit1-uit2YC1i=-b·(vi-v0)·dy(uit1-uit2)·dxZC1i=-b·f(uit1-uit2)·dx---(6)]]>式⑹中dx为CCD感光颗粒宽度、dy为CCD感光颗粒长度、u0、v0为摄像机内部参数，为主摄像机下的数字图像坐标点，为主摄像机下的数字图像坐标点，两个摄像机同参数；6)对步骤5)两张图像再匹配得到测试颗粒的第j个光点在两张图像中的像素坐标代入步骤5)中关系式得到第j个光点在主摄像机坐标系中的(XC1j,YC1j,ZC1j)，其中i、j两光点连线平行于xc1oc1zc1平面；7)将步骤5)和6)的主摄像机坐标系对应两个光点坐标代入公式计算动态休止角θk：θk=tan-1|YC1i-YC1j||ZC1i-ZC1j|;]]>8)重复步骤5)～7)计算机取N个“点对”，计算出N个动态休止角θk，通过最小二乘法计算出精确的动态休止角θ。