发明内容
本发明要解决的技术问题是针对以上不足,提供一种车载屏幕壳体自动化打螺丝的视觉定位方法,本发明的视觉定位方法自动化程度高,通用性高,且视觉定位精准,误差小,稳定性高,可以满足车载屏幕产线自动化生产的需求。
为解决以上技术问题,本发明采用以下技术方案:
一种车载屏幕壳体自动化打螺丝的视觉定位方法,包括以下步骤:
步骤1、对相机进行内参标定,得到相机的内参参数;
步骤2、将相机固定于机械手的移动端上,对相机和机械手进行手眼标定,得到相机坐标系和机械手坐标系的转换关系;
步骤3、将机械手上的螺丝枪与待打孔的螺丝孔对准,此时的状态为标准对位状态,并进行对位标定,得到对准状态下的待打孔的螺丝孔的中心特征点的相机坐标;
步骤4、根据对准状态下的待打孔的螺丝孔的中心特征点的相机坐标计算待打孔的螺纹孔的中心特征点的相机坐标从待对准状态到对准状态的刚体转换关系;
根据相机坐标系和机械手坐标系的转换关系计算待打孔的螺纹孔的中心特征点的机械手坐标从待对准状态到对准状态的刚体转换关系;
步骤5、根据步骤4得到的刚体转换关系将待打孔的螺纹孔的中心特征点的坐标由待对准状态转换到对准状态,并根据转换后的螺纹孔的中心特征点坐标进行自动打螺丝。
进一步的,所述步骤1中内参标定采用张正友内参标定方法。
进一步的,所述步骤2具体包括以下步骤:
步骤21、将相机固定于机械手的移动端上;
步骤22、机械手带动相机从机械手的初始位置分别向X方向和Y方向移动至少两个位置,相机分别在两个位置处拍摄标定板,得到两个位置处的图像像素坐标,且通过内参标定得到的相机内参参数将两个图像像素坐标转换为相机坐标;
步骤23、分别构建每个位置处的手眼标定方程:AX=XB,其中,A代表对应位置处的机械手坐标,B代表对应位置处的相机坐标;
步骤24、通过所有手眼标定方程解出相机坐标系与机械手坐标系的转换关系X。
进一步的,所述步骤3具体包括以下步骤:
步骤31、在螺丝枪上设置标志点;
步骤32、将螺丝枪与螺纹孔进行人工对准,此时的状态为标准对位状态;
步骤33、在对准状态下,获取螺丝枪上标志点的世界坐标P1和待打孔的螺丝孔的中心特征点的世界坐标P2;
此时机械手上的相机拍摄螺丝枪上的标志点和待打孔的螺丝孔的中心特征点,得到螺丝枪上的标志点和待打孔的螺丝孔的中心特征点在相机坐标系下的相机坐标
和
步骤33、通过相机自校准的方式分别标定出P
1转换到相机坐标系下的相机坐标P
1 c的刚体转换关系
和P
2转换到相机坐标系下的相机坐标P
2 c的刚体转换关系
步骤34、通过式:
计算在对准状态下待打孔的螺丝孔的中心特征点的相机坐标
进一步的,所述步骤4具体包括以下步骤:
步骤41、固定好屏幕背壳的位置,在螺丝枪上设置标志点;
步骤42、机械手移动到待打孔的螺丝孔附近,进行粗定位;
步骤43、机械手上的相机分别拍摄螺丝枪上标志点和待打孔的螺丝孔的中心特征点,对拍摄的中心特征点图像进行特征提取,分别获取摄螺丝枪上标志点的图像像素坐标P3和待打孔的螺丝孔的中心特征点的图像像素坐标P4;
步骤44、通过相机自校准的方式分别标定出P
3转换到相机坐标系下的相机坐标P
3 c的刚体转换关系
和P
4转换到相机坐标系下的相机坐标P
4 c的刚体转换关系
步骤45、根据式:
计算在当前状态下待打孔的螺丝孔的中心特征点的相机坐标
根据刚体变换方程
求解出相机坐标系下的待打孔的螺丝孔的中心特征点从待对准状态到对准状态下的刚体变换关系R
c和t
c,其中,P
2为待打孔的螺丝孔的中心特征点的世界坐标;
步骤46、机械手坐标系下螺纹孔中心特征点从待对准状态到对准状态的刚体转换关系Rb和tb可根据下式进行计算:
其中,
为相机坐标系到机械手坐标系的旋转矩阵,R
b为
的逆矩阵,
为相机坐标系到机械手坐标系的平移向量,t
b为
的逆平移向量;
进一步的,在机械手坐标系下Rb可以使用俯仰角α,偏航角β和滚转角γ进行表示:
其中,根据模型的角度定义,α为模型绕Y轴的旋转角,β为模型绕Z轴的旋转角,γ为模型绕X轴的旋转角。
本发明采用以上技术方案后,与现有技术相比,具有以下优点:
本发明使用机器视觉来定位来引导机械手来对准螺丝孔,实现机器视觉自动化打螺丝,提高车载屏幕产线自动化的程度;
本发明的设计,结构简单,成本低,部署方便,相机的内外参数只需要标定一次,操作简单,能够自动修正机械手上螺丝枪与螺丝孔的相对位置,实现自动化打螺丝的高精度,高稳定性,并且能满足不同孔径、不同位置的螺丝与螺纹孔的装配。
下面结合附图和实施例对本发明进行详细说明。
具体实施方式
以下结合附图对本发明的原理和特征进行描述,所举实例只用于解释本发明,并非用于限定本发明的范围。
在本发明的描述中,需要说明的是,术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”“顺时针”“逆时针”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
一种车载屏幕壳体自动化打螺丝的视觉定位方法,其特征在于,包括以下步骤:
步骤1、对相机进行内参标定,得到相机的内参参数;
其中,内参标定采用张正友相机内参标定方法,在相机内部参数标定过程中,首先以标定板的第一个姿态为基准,根据标定板上标志点的对应关系,分别计算标定板在其他姿态下相对于第一个姿态的位姿关系,即可获得各标定板姿态下初始的外部参数,并通过初始三维重建获得标定板上标志点的粗略三维坐标。然后,建立所有标志点逆向投影误差最小的目标方程,使用最小二乘法优化同时优化相机的内部参数和标定板上标志点的三维坐标。假设设标定板上共有n个标志点,标定过程中标定板在测量空间摆放了m个姿态,那么第x个姿态下标定板上的第y个标志点的图像像素坐标可表示为mxy,则目标方程为:
其中,p表示投影方程,可以将空间内的三维点投影到二维图像平面上;A是相机的内部参数矩阵,其初值可以根据相机和镜头的标称值计算得到;为畸变系数,包含镜头的径向畸变和切向畸变;
采集13张不同的位置和角度的标定板图像进行相机内参标定,获取相机的内参矩阵
其中,a和b分别是水平和垂直两个方向上的归一化焦距,(u
0,v
0)是主点的图像像素坐标,γ是图像两个轴的倾斜角。
进一步的,所述的相机内参标定考虑了镜头的三阶径向畸变与二阶切向畸变:
其中,
为实际的图像点物理尺寸坐标,(x,y)为理想的图像点物理尺寸坐标,r
2=x
2+y
2,k
1,k
2,k
3分别为一阶、二阶和三阶径向畸变参数,p
1,p
2分别为一阶和二阶切向畸变。由于实际图像点像素坐标值为
理想图像点像素坐标值为u=u
0+a
xx+γy,v=v
0+a
yy,则根据公式(2)有:
假设每个姿态下有m个图像点,拍摄n个姿态后,联立方程(3)可得2mn个方程组,可求得畸变参数的最小二乘解。
步骤2、将相机固定于机械手的移动端上,对相机和机械手进行手眼标定,得到相机坐标系和机械手坐标系的转换关系,具体包括以下步骤:
步骤21、将相机固定于机械手的移动端上;
步骤22、机械手带动相机从机械手的初始位置分别向X方向和Y方向移动至少两个位置,相机分别在两个位置处拍摄标定板,得到两个位置处的图像像素坐标,且通过内参标定得到的相机内参参数将两个图像像素坐标转换为相机坐标;
步骤23、分别构建每个位置处的手眼标定方程:AX=XB,其中,A代表对应位置处的机械手坐标,B代表对应位置处的相机坐标;
步骤24、通过所有手眼标定方程解出相机坐标系与机械手坐标系的转换关系X;
具体的,如图3所示,以机械手带动相机从机械手的初始位置分别向X方向和Y方向移动两个位置为例,构建两个手眼标定方程:AiX=XBi和AjX=XBj,其中,Ai和Aj分别代表i处和j处的机械手坐标系的机械手坐标,Bi和Bj分别代表i处和j处的相机坐标系的相机坐标;
解算步骤包括:
步骤241、手眼标定的过程较为:以AX=XB形式的求解为例,如图3所示的场景中,根据两个手眼标定方程得到:
AiXBi=AjXBj
上式可转换为
其中,
即为相机从j位置到i位置的变换,
为机械手从i位置到j位置的变换;则:
AX=XB
其中,
其中,R是3 X 3的单位正交矩阵,代表旋转,中T是3 X 1的平移向量;则:
步骤242、由未知数的数目可知,还需一组方程才能完成求解,即
其中,I3代表3行3列的单位矩阵,O9×3代表9行3列的零矩阵,O9代表9行1列的零向量;
上式已经构成EX=b的形式,其中,E表示系数矩阵,因此可采用下式求解:
X=(ETE)-1ETb,
步骤3、将机械手上的螺丝枪与待打孔的螺丝孔对准,此时的状态为标准对位状态,并进行对位标定,得到对准状态下的待打孔的螺丝孔的中心特征点的相机坐标,具体包括以下步骤:
步骤31、在螺丝枪上设置标志点;
步骤32、将螺丝枪与螺纹孔进行人工对准,此时的状态为标准对位状态;
步骤33、在对准状态下,获取螺丝枪上标志点的世界坐标P1和待打孔的螺丝孔的中心特征点的世界坐标P2;
此时机械手上的相机拍摄螺丝枪上的标志点和待打孔的螺丝孔的中心特征点,得到螺丝枪上的标志点和待打孔的螺丝孔的中心特征点在相机坐标系下的相机坐标P1 c和P2 c;
步骤33、通过相机自校准的方式分别标定出P
1转换到相机坐标系下的相机坐标P
1 c的刚体转换关系
和P
2转换到相机坐标系下的相机坐标P
2 c的刚体转换关系
步骤34、通过式:
计算在对准状态下待打孔的螺丝孔的中心特征点的相机坐标
步骤4、根据对准状态下的待打孔的螺丝孔的中心特征点的相机坐标计算待打孔的螺纹孔的中心特征点的相机坐标从待对准状态到对准状态的刚体转换关系;
根据相机坐标系和机械手坐标系的转换关系计算待打孔的螺纹孔的中心特征点的机械手坐标从待对准状态到对准状态的刚体转换关系,具体包括以下步骤:
步骤41、固定好屏幕背壳的位置,在螺丝枪上设置标志点;
步骤42、机械手移动到待打孔的螺丝孔附近,进行粗定位;
步骤43、机械手上的相机分别拍摄螺丝枪上标志点和待打孔的螺丝孔的中心特征点,对拍摄的中心特征点图像进行特征提取,分别获取摄螺丝枪上标志点的图像像素坐标P3和待打孔的螺丝孔的中心特征点的图像像素坐标P4;
步骤44、通过相机自校准的方式分别标定出P
3转换到相机坐标系下的相机坐标P
3 c的刚体转换关系
和P
4转换到相机坐标系下的相机坐标P
4 c的刚体转换关系
步骤45、根据式:
计算在当前状态下待打孔的螺丝孔的中心特征点的相机坐标
根据刚体变换方程
求解出相机坐标系下的待打孔的螺丝孔的中心特征点从待对准状态到对准状态下的刚体变换关系R
c和t
c,其中,P
2为待打孔的螺丝孔的中心特征点的世界坐标;
步骤46、机械手坐标系下螺纹孔中心特征点从待对准状态到对准状态的刚体转换关系Rb和tb可根据下式进行计算:
其中,
为相机坐标系到机械手坐标系的旋转矩阵,R
b为
的逆矩阵,
为相机坐标系到机械手坐标系的平移向量,t
b为
的逆平移向量;
进一步的,在机械手坐标系下Rb可以使用俯仰角α,偏航角β和滚转角γ进行表示:
其中,根据模型的角度定义,α为模型绕Y轴的旋转角,β为模型绕Z轴的旋转角,γ为模型绕X轴的旋转角。
步骤5、根据步骤4得到的刚体转换关系将待打孔的螺纹孔的中心特征点的坐标由待对准状态转换到对准状态,并根据转换后的螺纹孔的中心特征点坐标进行自动打螺丝。
如图2所示,为屏幕壳体5,屏幕壳体5上分布设置有M1螺纹孔5-1、M3螺纹孔5-2和M5螺纹孔5-3;
使用上述的视觉标定方法后,即可对屏幕壳体5上的M1螺纹孔5-1、M3螺纹孔5-2和M5螺纹孔5-3进行视觉定位自动化打螺丝。
如图1所示,一种车载屏幕壳体自动化打螺丝的装置,包括机械手1、螺丝枪2、主视觉定位组件3、辅助视觉定位组件4和屏幕壳体5,所述螺丝枪2、主视觉定位组件3、辅助视觉定位组件4均设置于机械手1的末端,所述主视觉定位组件3和辅助视觉定位组件4均包括相机3-1、镜头3-2和光源3-3,所述螺丝枪2上设置有标志点;
在本实施例中,相机3-1采用工业相机,镜头3-2采用工业镜头;
使用时,通过主视觉定位组件3和辅助视觉定位组件4协同工作,当主视觉定位组件3和辅助视觉定位组件4的相机结果比较接近时,求取测量结果的平均值;当主视觉定位组件3和辅助视觉定位组件4两个相机的测量结果相差较大时,系统进行异常处理。
以上所述为本发明最佳实施方式的举例,其中未详细述及的部分均为本领域普通技术人员的公知常识。本发明的保护范围以权利要求的内容为准,任何基于本发明的技术启示而进行的等效变换,也在本发明的保护范围之内。