1.一种基于像素空间优化的相机与机器人相对位姿标定方法,其特征在于,机器人在末端固定标定板,通过运动控制使标定板在固定安装的相机视野下摆放不同位姿,结合各个姿态下已知的机器人末端运动信息和标定板在图像中的识别结果,迭代优化相机与机器人基座和标定板与机器人末端两个参数,最终获得精确的相机与机器人基座相对位姿关系,具体标定步骤如下:
1)、固定标定板在机器人末端,控制机器人运动,使得运动停止时,标定板在相机视野内;
r
2)、当运动停止后,记录机器人末端坐标系到基座坐标系的转换关系Te ,采集图像得到标定板上棋盘格角点像坐标{(u1,v1),(u2,v2),...,(um,vm)},计算标定板坐标系到相机坐标系的转换关系Tbc;
3)、再控制机器人运动n次,得到n+1运动停止时的状态数据
r c
{Te ,Tb ,{(u1,v1),(u2,v2),...,(um,vm)}}(1,2,...,n+1);
4)、根据运动状态转移中相机、标定板、机器人与机器人基座坐标系之间的转换关系,建立以下状态转移方程:
(Tbc)(1)=Trc·(Ter)(1)·Tbe
(Tbc)(2)=Trc·(Ter)(2)·Tbe
(Tbc)(n+1)=Trc·(Ter)(n+1)·Tbe
Trc是机器人基座坐标系到相机坐标系的齐次转换矩阵,Tbe是标定板坐标系到机器人末端坐标系的齐次转换矩阵;
5)、消去Tbe,令 Tb表示标定板的状态转
移矩阵,Te表示机器人末端的转移矩阵,得到n个齐次转换方程:(Tb)(i)·Trc=Trc·(Te)(i),即AX=XB;
6)、利用旋转矩阵的线性不变性求解齐次转换方程AX=XB,将求得的Trc'作为优化求解的初始值;
7)、在像素空间迭代优化,得到精确的Trc和Tbe,根据相机的成像模型以及方程(Tbc)(i)=Trc·(Ter)(i)·Tbe,可得:
此方程为优化求解的目标方程,其中相机的内参数矩阵 是已知参数。
2.根据权利要求1所述的基于像素空间优化的相机与机器人相对位姿标定方法,其特征在于,所述的步骤7)中的迭代优化过程包括两个阶段:标定板到机器人末端位姿关系求解阶段和机器人基座到相机位姿关系求解阶段。
3.根据权利要求1或2所述的基于像素空间优化的相机与机器人相对位姿标定方法,其特征在于,所述的迭代优化求解的具体步骤如下:
1)、将权利要求1中步骤6)中得到的结果作为初始值(Trc)(0)=Trc',将代入方程(Tbc)(i)=Trc·(Ter)(i)·Tbe得到Tbe的初始值(Tbe)(0);
2)、标定板到机器人末端位姿关系求解阶段:n+1组状态数据作为输入数据,将(Trc)(k-1)作为已知量带入优化目标方程,(Tbe)(k-1)作为优化的初始值,优化的目标为最小化重投影误差 其中(uj,vj)为观测角点像坐标,(uj',vj')为重投
影后的角点像坐标,采用Levenberg-Marquardt算法求解(Tbe)(k);
3)、机器人基座到相机位姿关系求解阶段:n+1组状态数据
{Ter,Tbc,{(u1,v1),(u2,v2),...,(um,vm)}}(1,2,...,n+1)作为输入数据,将(Tbe)(k)作为已知量带入优化目标方程,(Trc)(k-1)作为优化的初始值,优化的目标为最小化重投影误差其中(uj,vj)为观测角点像坐标,(uj',vj')为重投影后
的角点像坐标,采用Levenberg-Marquardt算法求解(Trc)(k);
4)、根据(Tbe)(k),(Trc)(k)和(Tbe)(k-1),(Trc)(k-1)判断标定结果是否收敛:计算err=||(Trc)(k)-(Trc)(k-1)||f+||(Tbe)(k)-(Tbe)(k-1)||f
||·||f表示矩阵的Frobenius范数,如果err小于设定的阈值,则停止迭代,得到最终的标定结果Trc=(Trc)(k),否则置k=k+1。