[发明专利]机器人足目标定方法和标定装置

权利要求书

1. 机器人足目标定方法，基于以下的标定装置，一个带有车载计算机的可移动车体，在该可移动车体上固定着摄像机，其特征在于，在可移动车体上分布着10～30个位置固定的特征点，这些特征点是车体棱边的交点或者固定在车体上的机械构件棱边的交点或者固定在车体上的摄像机支架棱边的交点，上述特征点在机器人坐标系下的坐标是已知的，构成特征点集Θ；在机器人前方放置有一面平面反射镜靶标M，使车体上特征点的镜像点集Θ′能够在摄像机中成像，在平面镜靶标M上有四个已知特征点，它们是一个矩形的四个顶点；标定的步骤如下：

1.1、建立坐标系；

符号说明：下文出现的下标字母代表不同的坐标系：c-摄像机坐标系，m-平面镜坐标系，om-辅助坐标系，ri-镜像坐标系，r机器人坐标系；

1.1.1、建立机器人坐标系O_r-x_ry_rz_r；以可移动车体前后轮轴中心连线的中点为原点O_r，y_r、z_r轴分别与车轴平行和垂直，按右手规则规定x_r的方向；

1.1.2、建立摄像机坐标系O_c-x_cy_cz_c；以摄像机光心为原点O_c，x_c、y_c轴分别与成像面的横、纵轴平行，z_c轴即光轴；

1.1.3、建立镜像坐标系O_ri-x_riy_riz_ri；以车体坐标系原点O_r的镜像点O_ri为原点，y_ri与z_ri轴分别和y_r与z_r轴关于平面镜中心对称，x_ri与x_r轴方向相反；

1.1.4、建立平面镜坐标系O_m-x_my_mz_m；以平面镜左上角的特征点为坐标原点，x_m与y_m轴在镜平面Ω上，与镜平面Ω上四个特征点构成的矩形的两边重合，按右手规则规定z_m轴的方向；

1.1.5、在平面镜的反面Ω′上建立辅助坐标系O_om-x_omy_omz_om；其原点与平面镜坐标系O_m-x_my_mz_m的原点重合，x_om和x_om分别与x_m和z_m相反，y_om与y_m重合；

1.2、标定过程；下面文字中的X_i＝(x_i y_i z_i)^T(i＝c，m，…)表示坐标系i下的三维点坐标，i表示上述建立的5个坐标系的下标其中之一；R_ij(i＝c，m，…，j＝m，om，…)与T_ij(i＝c，m，…，j＝m，om，…)分别表示坐标系j到坐标系i的旋转和平移矩阵，j也表示上述建立的5个坐标系的下标其中之一，但是i不同于j；

1.2.1、标定摄像机坐标系与平面镜坐标系之间的欧氏变换关系；

根据已标定的摄像机内部参数，确定摄像机坐标系O_c-x_cy_cz_c与平面镜坐标系O_m-x_my_mz_m间的R_cm和T_cm，使得：

X_c＝R_cmX_m+T_cm[1]

1.2.2、标定摄像机坐标系与镜像坐标系之间的欧氏变换关系；

以平面镜中的反射镜像点集Θ′为标定点，使用摄像机标定方法，确定O_c-x_cy_cz_c与O_ri-x_riy_riz_ri间的R_cri和T_cri，使得：

X_c＝R_criX_ri+T_cri    [2]

1.2.3、标定平面镜坐标系与镜像坐标系之间的欧氏变换关系；

由[1]和[2]式，得出O_ri-x_riy_riz_ri到O_m-x_my_mz_m的欧氏变换关系为：

Rmri=Rcm-1Rcri,]]>Tmri=Rcm-1(Tcri-Tcm)---[3]]]>

1.2.4、标定机器人坐标系与平面镜坐标系之间的欧氏变换关系；

在平面镜两侧，O_ri-x_riy_riz_ri和O_m-x_my_mz_m之间的关系与O_r-x_ry_rz_r和O_om-x_omy_omz_om的关系关于平面镜中心对称，因此可由(R_mri，T_mri)得到(R_omr，T_omr)：

设Rmri=r11r12r13r21r22r23r31r32r33,]]>Tmri=txtytz,]]>由镜面反射成像关系得出：

Romr=r11-r12-r13-r21r22r23-r31r32r33,]]>Tomr=-txtytz---[4]]]>

O_om-x_omy_omz_om绕y_om轴逆时针旋转180°即是O_m-x_my_mz_m，因此两个坐标系之间相差一个旋转矩阵：

以O_om-x_omy_omz_om为中介坐标系，由式[4]～[5]得到O_r-x_ry_rz_r与O_m-x_my_mz_m的欧氏变换关系：

R_mr＝R_mom·R_omr，T_mr＝R_mom·T_omr    [6]

1.2.5、标定足眼关系；

由以上1.2.1～1.2.4各标定步骤，机器人坐标系到摄像机坐标系间的中间坐标系转换关系都已确定，根据中介坐标统一方法，机器人坐标系到摄像机坐标系之间的欧氏变换矩阵R_cr和T_cr即可确定：

R_cr＝R_cm·R_mr，T_cr＝R_cm·T_mr+T_cm    [7]

而摄像机坐标系到机器人坐标系的欧氏变换矩阵R_rc和T_rc为：

Rrc=Rcr-1,]]>Trc=-Rcr-1·Tcr---[8]]]>

2. 如权利要求1所述方法所使用的机器人足目标定装置，其特征在于，在可移动车体上分布着10～30个位置固定的特征点，这些特征点是车体棱边的交点或者固定在车体上的机械构件棱边的交点或者固定在车体上的摄像机支架棱边的交点，上述特征点在机器人坐标系下的坐标是已知的，构成特征点集Θ；在机器人前方放置有一面平面反射镜靶标M，使车体上特征点的镜像点集Θ′能够在摄像机中成像，在平面镜靶标M上有四个已知特征点，它们是一个矩形的四个顶点。