视觉引导的搬运机器人之视觉系统2D模型(下)
(1)计算初始工件坐标系为O1’ X ’Y’和图像坐标系OXY之间的转换关系,初始工件坐标系为以X’Y’和相机坐标系OXY之间的转换关系。进行此计算是为了通过相机图像中工件特征点位置的变换从而求得工件坐标系的偏差量,通过选取工件中特定位置的两个不重合点的工件坐标和此两个不重合点在图像坐标系中的位置点,求出图像坐标系和工件坐标系的转换关系,以第一次拍照得出的工件为参照,和第二次获取的工件位姿进行比较,能够得出两次工件坐标系之间的距离偏差。利用2点法的方法进行计算能够得出工件坐标系原点O’在图像坐标系中的位置(x0,Y,0)和两个坐标系在X轴方向的夹角。
(2)工件坐标系相对偏差量的具体计算过程为:根据需要求取的目标工件信息,我们只须求出工件当前坐标系和工件初始坐标系之间的偏差量即可。结合上面的理论推导可知,工件上点的位置信息在其坐标系上的表现是始终保持相同的,由于其坐标系也始终是不进行变化的,只需找到任一点相应的工件坐标,就能够运行对应于此点的机器人示教程序。我们通常利用在工件上选取的特征点当前位置相对于初始位置的偏差来确定工件的便宜量。假定以X ’Y’代表的是初始状态下的坐标系,O1’X ’Y’代表的是此时的坐标系。此时,我们以两坐标系的变化量来表示工件位姿的变化。此时的工件坐标系在图像坐标系中的位姿表达能够通过2点法进行求解,设x0,y0,α0为初始状态下工件坐标系和图像坐标系的关系参数,x1,y1,α1为当前状态下工件坐标系和图像坐标系中的的参数,则工件坐标偏差量为: