1.一种工业机器人末端相机在线标定方法,其特征在于,所述方法适用于工业机器人,所述工业机器人包括末端执行器和工业相机,所述末端执行器与所述工业相机连接,所述方法包括如下步骤:
通过末端执行器控制工业相机在第一位置采集标定物的图像,通过所述标定物的图像得到特征点的成像坐标;
根据所述特征点的物理坐标和成像坐标确定初始重投影变换坐标模型的初始第一参数和初始第二参数,所述第一参数用于定义手眼变换坐标的旋转矩阵,所述第二参数用于定义手眼变换坐标的平移向量;
通过末端执行器控制工业相机在多个位置采集标定物的图像,通过所述多个位置的标定物的图像得到特征点的实际像点坐标;
将所述初始重投影变换坐标模型作为当前重投影变换坐标模型,并重复执行如下步骤直至符合停止条件,确定符合停止条件的当前重投影变换坐标模型为标定的重投影变换坐标模型,所述停止条件至少包括第一参数或第二参数的梯度范数;
标定物的物理坐标通过当前重投影变换坐标模型获得重投影像点坐标,至少确定调整第一参数和调整第二参数使标定物的实际像点和重投影像点之间距离和最小,并将包括调整第一参数和调整第二参数的重投影变换坐标模型作为新的当前坐标模块;
所述停止条件至少包括第一参数或第二参数的梯度范数的步骤,包括:标定物的物理坐标通过当前重投影变换坐标模型获得重投影像点坐标,根据所述第一参数的梯度范数或第二参数的梯度范数调整第一参数或第二参数,至少确定调整第一参数和调整第二参数使标定物的实际像点和重投影像点之间距离和最小。
2.根据权利要求1所述的工业机器人末端相机在线标定方法,其特征在于,所述至少确定调整第一参数和调整第二参数使标定物的实际像点和重投影像点之间距离和最小的方法包括:通过非线性参数模型至少确定调整第一参数和调整第二参数使标定物的实际像点和重投影像点之间距离和最小,所述非线性参数模型为:其中,i为末端执行器控制工业相机第i次运动,n为末端执行器控制工业相机运动的总次数,u和v为相机成像平面的坐标轴,Wiu为特征点的实际像点和重投影像点在u轴上的坐标差值,Wiv为特征点的实际像点和重投影像点在v轴上的坐标差值;
其中,特征点在标定物坐标系Co的物理坐标值为oi,特征点在相机图像坐标系的实际像点坐标值为pi,piu和piv分别为pi在相机图像坐标系中u、v轴上的分量,Fu(oi)和Fv(oi)分别为oi经重投影变换后的重投影像点在u、v轴上的分量。
3.根据权利要求2所述的工业机器人末端相机在线标定方法,其特征在于,所述重投影变换坐标模型为:
p=F(o)=MJc=MJTecTweTowo其中,o为标定特征点在标定物坐标系Co的物理坐标值,Tow为标定物坐标系到基座世界坐标系的变换矩阵,Twe为基座世界坐标系到末端执行器坐标系的变换矩阵,Tec为末端执行器坐标系到相机坐标系的变换矩阵,Tec即手眼变换坐标X,矩阵M为相机内参数矩阵,J为相机畸变参数矩阵。
4.根据权利要求3所述的工业机器人末端相机在线标定方法,其特征在于,所述手眼变换坐标X为:
其中,R为手眼变换矩阵的旋转矩阵,即R为第一参数,t为手眼变换矩阵的平移向量,即T
t为第二参数,O为标定特征点在末端执行器坐标系下的物理坐标值。
5.根据权利要求3所述的工业机器人末端相机在线标定方法,其特征在于,所述相机畸变参数矩阵包括镜头径向畸变公式,所述镜头径向畸变公式为:式中,un和vn表示畸变模型下的实际像点,u和v表示无畸变理想像点,u0和v0表示像素坐标系主点,k1、k2为径向畸变比例系数,(x,y)为像点物理坐标实际值。
6.根据权利要求1所述的工业机器人末端相机在线标定方法,其特征在于,所述通过末端执行器控制工业相机在多个位置采集标定物的图像的方法包括:工业相机在成像平面上获取特征点的成像坐标(u,v):其中,random表示按照括号内的给定范围取随机值,umax为相机u轴方向分辨率,vmax为相机v轴方向分辨率,k为比例系数。
7.根据权利要求1所述的工业机器人末端相机在线标定方法,其特征在于,所述通过末端执行器控制工业相机在多个位置采集标定物的图像的方法包括:所述通过末端执行器依据姿态规划结果控制工业相机在多个位置采集标定物的图像。
8.根据权利要求7所述的工业机器人末端相机在线标定方法,其特征在于,所述姿态规划的方法包括:
特征点在标定物坐标系的物理坐标通过相机投射模型和手眼变换模型得到末端执行器的相对位置,根据该相对位置设置末端执行器的运动。
9.根据权利要求8所述的工业机器人末端相机在线标定方法,其特征在于,所述相机投射模型为:
其中,fx和fy为相机归一化焦距,cx和cy为光心所在像平面位置,(xc,yc,zc)为相机坐标系下的像点坐标;
所述手眼变换模型为:
其中,(xe,ye,ze)为像点在执行器坐标下的坐标,Tec为末端执行器坐标系到相机坐标系的变换矩阵,Tec即手眼变换坐标X。
10.一种工业机器人末端相机在线标定装置,其特征在于,包括:初始参数采集模块,用于通过末端执行器控制工业相机在第一位置采集标定物的图像,通过所述标定物的图像得到特征点的成像坐标;
初始参数定义模块,用于根据所述特征点的物理坐标和成像坐标确定初始重投影变换坐标模型的初始第一参数和初始第二参数,所述第一参数用于定义手眼变换坐标的旋转矩阵,所述第二参数用于定义手眼变换坐标的平移向量;
迭代参数采集模块,用于通过末端执行器控制工业相机在多个位置采集标定物的图像,通过所述多个位置的标定物的图像得到特征点的实际像点坐标;
迭代优化模块,用于将所述初始重投影变换坐标模型作为当前重投影变换坐标模型,并重复执行如下步骤直至符合停止条件:标定物的物理坐标通过当前重投影变换坐标模型获得重投影像点坐标,至少确定调整第一参数和调整第二参数使标定物的实际像点和重投影像点之间距离和最小,并将包括调整第一参数和调整第二参数的重投影变换坐标模型作为新的当前坐标模块;
确定符合停止条件的当前重投影变换坐标模型为标定的重投影变换坐标模型,所述停止条件至少包括第一参数或第二参数的梯度范数;
所述停止条件至少包括第一参数或第二参数的梯度范数的步骤,包括:标定物的物理坐标通过当前重投影变换坐标模型获得重投影像点坐标,根据所述第一参数的梯度范数或第二参数的梯度范数调整第一参数或第二参数,至少确定调整第一参数和调整第二参数使标定物的实际像点和重投影像点之间距离和最小。