CN114708335B - 双目立体相机的外参标定系统、标定方法、应用、存储介质 - Google Patents

Abstract

本申请公开了双目立体相机的外参标定系统、标定方法、应用；属于计算机视觉这一领域；其技术要点在于：包括：存储系统、数据源处理系统、旋转矩阵求解系统、平移矩阵求解系统；所述数据源处理系统读取所述存储系统中存储的图像上识别第一标识线、第二标识线的标识点，计算得到上述标识点在相机坐标系下的三维坐标，将计算得到的标识点在相机坐标系下的三维坐标存储到数据源存储系统中；所述旋转矩阵求解系统以及平移矩阵求解系统，用于给出外参参数的计算结果。采用本申请的双目立体相机的外参标定系统、标定方法、应用，能够方便双目立体相机作为传感器的应用。

Description

双目立体相机的外参标定系统、标定方法、应用、存储介质

技术领域

本申请涉及机器视觉(计算机视觉)领域，更具体地说，尤其涉及一种双目立体相机的外参标定系统、标定方法、应用、存储介质。

背景技术

双目立体相机作为传感器的使用，已经较为普遍。如：CN104567762A给出了双目立体相机在工程机械臂角度监测的应用；又如：CN114136562A给出了双目立体相机应用在工程测量中应用；又如：CN110812710B给出了双目立体相机在医疗器械转动架角度监测的应用。

综上所述，双目立体视觉系统作为角度传感器的应用，较为普遍。然而，现有技术的问题在于：

一是双目立体相机的数量较多(如CN110812710B需要4个相机才能监测到转动架的角度)；

二是双目立体相机监测的算法速度仍然不够优化。

对于双目立体相机而言，外参参数一般用Pitch、roll、Yaw、Ty来表示。申请人在以往的第一代双目立体相机的外参标定系统(申请号为：2021116313241)中，对上述参数的求解进行研究。但是，其具有以下几个缺点：

1)计算仅仅依据于4个点，坐标点的选择对于计算机标定的误差影响较大。对于机器而言，一般性的经验是：选择样本数越多，就越能接近于实际。然而，第一代双目立体相机的外参标定系统(RGBD参数标定)无法做到考虑多样本数。

2)计算需要多次进行三维重建。即在得到一个参数就需要进行一次三维重建(需要三次三维重建，才能得到全部参数)，即某个参数的取得依赖于前面参数的取得。

因此，申请人的第一代双目立体相机的外参标定系统虽然也能够解决实际问题，但是其处理速度相对较慢。应用在传感器方面就显得有些反应不足。

因此，寻找更方便快捷的双目立体相机的外参标定方法，以满足双目相机应用在传感器方面的应用，就成为一个新的技术问题。

发明内容

本申请的目的在于提供一种双目立体相机的外参标定系统，以解决现有技术的不足。

本申请的另一目的在于提供一种双目立体相机的外参标定的方法。

本申请的另一目的在于提供一种双目立体相机作为传感器的应用。

本申请的再一目的在于提供一种存储介质。

一种双目立体相机的外参标定系统，包括：存储系统、数据源处理系统、旋转矩阵求解系统、平移矩阵求解系统；

所述存储系统用于存储双目立体相机得到的图像、用于存储所述数据源处理系统得到的计算结果、用于存储旋转矩阵求解系统及平移矩阵求解系统得到的计算结果；

所述数据源处理系统读取所述存储系统中存储的图像上识别第一标识线、第二标识线的标识点，计算得到上述标识点在相机坐标系下的三维坐标，将计算得到的标识点在相机坐标系下的三维坐标存储到数据源存储系统中；

所述旋转矩阵求解系统，用于读取所述存储系统存储的标识点在相机坐标系下的三维坐标，得到β_x、β_y、β_z的结果，且将β_x、β_y、β_z的结果存入所述存储系统中；

所述平移矩阵求解系统，用于读取存储系统中的β_x、β_y、β_z的结果，以及标识点在相机坐标系下的三维坐标，计算得到Ty，将Ty存入所述存储系统中。

一种双目立体相机的外参标定的方法，相机坐标系与参考坐标系(即世界坐标系)均符合右手规则；

双目立体相机的外参参数为：β_x、β_y、β_z、T_y(四个参数属于R、T矩阵的参数，其属于公知常识)；四个参数的标定采用以下步骤：

S100，读取标识点在项目立体相机下的三维坐标：

所述的标识点来源是：在水平参考面上贴十字线：第一标识线标识Z_WORLD轴的方向，第二标识线标识X_WORLD轴的方向，在第一标识线、第二标识线上均设置有若干个标识点；

S200，计算Z_WORLD轴、X_WORLD轴在相机坐标系中的向量，分别表示为(a，b，c)、(d，e，f)；

S300，β_x的求解采用下式：

若b≥0，

若b<0，

β_y的求解采用下式：

当a≥0,

当a<0,

β_z的求解采用下式：

θ为中间参数；

当θ≥π/2,

当θ<π/2,

S400，待β_x、β_y、β_z求解完成后，求解T_y：

读取第一标识线和/或第二标识线共计n个点在相机坐标系下的三维坐标，任意第i个点的三维坐标表示为：(X_cami、Y_cami、Z_cami)；

进一步，第一标识线上按照Z_WORLD轴的前进方向设置有第1、2、…第Q个标识点，采用双目立体相机读取上述Q个点在相机坐标下的三维坐标，通过拟合求出第一标识线在相机坐标系的方向向量为(a，b，c)；

第二标识线上按照X_WORLD轴的前进方向设置有第1、2、…第m个标识点，采用双目立体相机读取上述m个点在相机坐标下的三维坐标，通过拟合求出第二标识线在相机坐标系的方向向量为(d，e，f)。

进一步，相机坐标系的建立如下：

1)采用右手规则坐标系：右手四指指向X_cam轴方向，四指握手90°指向Y_cam轴方向，大拇指指向Z_cam轴方向；

2)原点为深度相机的中心点；

3)X_cam轴为沿着深度相机-彩色相机的横向方向，Z_cam轴垂直于X_cam轴且指向拍摄的方向；

4)Y_cam轴、X_cam、Z_cam相互垂直；

参考坐标系的建立如下：

1)采用右手规则坐标系(X_WORLD轴朝右，Y_WORLD轴朝下，Z_WORLD轴朝前)：参考坐标系的原点为相机坐标系的原点在水平参考面的投影点；

2)Y_WORLD轴正向为竖直向下。

一种双目立体相机的应用，双目立体相机安装在机器人的机械臂上，在地面上设置贴置十字形或T字形标识线；基于双目立体相机能够获取机械臂的运动信息。

进一步，双目立体相机的Z_cam轴方向与机械臂的轴长方向保持平行。

进一步，所述的运动信息包括：机械臂在任意时刻t下的臂长的方位向量；其求解方法如下：

首先，求取任意t时刻对应的β_x、β_y、β_z，即采用：β_xt、β_yt、β_zt表示；

其次，Z_camt轴在t时刻下的参考坐标下的向量即为：

(cosβ_ztsinβ_ytcosβ_xt+sinβ_ztsinβ_xt，sinβ_ztsinβ_ytcosβ_xt-cosβ_ztsinβ_xt，cosβ_ytcosβ_xt)。

进一步，所述的运动信息还包括：机械臂在任意时刻t-t₁时刻下的转动角度(不表示方向)；其求解方法是

任意t时刻到t₁转动角度；

S100，求取t时刻对应的β_x、β_y、β_z，即采用：β_xt、β_yt、β_zt表示；

S200，求取t₁时刻对应的β_x、β_y、β_z，即采用：β_xt1、β_yt1、β_zt1表示；

S300，机械臂在t时刻——>t₁时刻的转动角度γ为：

其中，γ₁、γ₂、γ₃为中间参数。

进一步，所述的运动信息还包括：机械臂上的双目立体相机在任意时刻t-t₁时刻下的运动距离信息；

其求解方法是：

对于沿着Y_world方向在t时刻——>t₁时刻前进的距离为：T_yt1-T_yt；

对于沿着X_world方向在t时刻——>t₁时刻前进的距离、沿着Z_world方向在t时刻——>t₁时刻前进的距离而言；

通过计算第一或第二标识线上的任意一点P在t、t₁时刻下的参考坐标系下的三维坐标：

(X_pt，Y_pt，Z_pt)，(X_pt1，Y_pt1，Z_pt1)；

能够知晓：

双目立体相机的原点在t时刻——>t₁时刻沿着X_world方向前进了：X_pt-X_pt1；若数值为正，表示沿着X_world正方向移动，若数值为负，表示沿着X_world负方向移动。

双目立体相机的原点在t时刻——>t₁时刻沿着Z_world方向前进了：Z_pt-Z_pt1；若数值为正，表示沿着Z_world正方向移动，若数值为负，表示沿着Z_world负方向移动。

一种存储介质，其存储有运行前述的方法的程序。

本申请的有益效果在于：

第一，本申请提出的双目立体相机的方法，对于：β_x、β_y、β_z的求解，在求解顺序上并没有任何限定，其均可一次性求解得到。

第二，本申请的难点在于确定：β_x、β_y、β_z的适用范围。β_x、β_y、β_z采用向量夹角的方式来求解。但是如何确定其正、负号就成为一个关键难题。

对于β_x而言，通过b、c的正、负号，来确定β_x的大小：

若b≥0，c>0,

若b≥0，c<0

若b<0，c≥0

若b<0，c≤0，

亦或下式来表达：

若b≥0，

若b<0，

对于β_y而言，则通过a的正、负号来确定β_y的正、负；

当a≥0,

当a<0,

对于β_z而言，则较为复杂，需要通过构建另外一个参数θ，通过判断θ的大小，来判断β_z的正负；

当θ≥π/2,

当θ<π/2,

第三，本申请的第三个发明点在于给出了：利用双目立体相机作为方位传感器的应用。通过外参参数能够直接求得方位信息。

附图说明

下面结合附图中的实施例对本申请作进一步的详细说明，但并不构成对本申请的任何限制。

图1是本申请的双目立体相机作为传感器的应用示意图。

图2是本申请的双目立体相机外参标定的坐标系示意图。

图3是本申请的双目立体相机外参标定的数学原理图。

图4是本申请的方案现场动态显示结果图(β_x＝-17.2°，β_y＝-6.1°，β_z＝2.4°，T_y＝-2613mm(图4显示的是绝对值))。

具体实施方式

<基础理论分析>

双目立体相机的外参可以采用下式表述：

R表示旋转矩阵，其是1个3×3的矩阵，其形式如下：

R矩阵是相机坐标系按照X、Y、Z的顺序，转动β_x角度、β_y角度、β_z角度转动，即转换为参考坐标系的方向(原点并不重合)。

T表示平移矩阵，其是1个3×1的矩阵，其形式如下：

T矩阵表示相机坐标系转化为参考坐标系后，相机坐标系原点到参考坐标系原点的距离。

<实施例一：双目立体相机的外参参数的标定方法>

<第一步：建立相机坐标系与参考坐标系>

结合附图1可知，几何结构两个坐标系的转换。

相机坐标系的建立与参考坐标系的建立均采用右手坐标系规则。

双目立体相机的外参参数标定方法，包括以下步骤：

1.1相机坐标系的建立如下：

1)采用右手规则坐标系：右手四指指向X_cam轴方向，四指握手90°指向Y_cam轴方向，大拇指指向Z_cam轴方向；

2)原点为深度相机的中心点；

3)X_cam轴为沿着深度相机-彩色相机的横向方向，Z_cam轴垂直于X_cam轴且指向拍摄的方向；

4)Y_cam轴、X_cam、Z_cam相互垂直；

1.2参考坐标系的建立如下：

1)采用右手规则坐标系(X_WORLD轴朝右，Y_WORLD轴朝下，Z_WORLD轴朝前)：参考坐标系的原点为相机坐标系的原点在水平参考面的投影点；

2)Y_WORLD轴正向为竖直向下；

3)在水平参考面上贴十字型标识线或者T字型标识线：第一标识线(黑白纹理线)标识Z_WORLD轴的方向，第二标识线(黑白纹理线)标识X_WORLD轴的方向(第一、二标识线只是标识Z_WORLD轴、X_WORLD轴的方向，并不是指第一、二标识线就是Z_WORLD轴、X_WORLD轴)；

采用上述坐标系，R矩阵同前述；T矩阵则可表述为：

<第二步：输入信息>

第一标识线上按照Z_WORLD轴的前进方向设置有第1、2、…第Q个标识点，采用双目立体相机读取上述Q个点在相机坐标下的三维坐标，通过拟合求出第一标识线在相机坐标系的方向向量为(a，b，c)；

对于a，b，c而言：

对于方向向量的拟合方法，已知Q个点的三维坐标，通过数学拟合(Matlab即可实现)：

a、b、c的大小与a'、b'、c'的绝对值相同，即满足：

基于Q个标识点任意两个点：第g、h个标识点的三维坐标(X_g，Y_g，Z_g)，(X_h，Y_h，Z_h)，g到h标识点为Z轴的方向；

a的正负与X_h-X_g相同，b的正负与Y_h-Y_g相同，c的正负与Z_h-Z_g相同。

同理，第二标识线上按照X_WORLD轴的前进方向设置有第1、2、…第m个标识点，采用双目立体相机读取上述m个点在相机坐标下的三维坐标，通过拟合求出第二标识线在相机坐标系的方向向量为(d，e，f)。

<第三步：β_x、β_y、β_z、T _y的求解>

β_x、β_y、β_z的数学原理可以采用下面的流程解释。

首先X_cam轴转动β_x，Y_cam、Z_cam在Y_cam-O-Z_cam面内旋转，变为Y_c'_am、Z_c'_am；

然后，以Y_c'_am轴转动β_y，X_cam、Z_c'_am在X_cam-O-Z_c'_am面内旋转，变为：X_c'_am、Z_world；

再然后，以Z_world轴转动β_z，Y_c'_am、X_c'_am在Y_c'_am-O-X_c'_am面内旋转，变为：Y_world、X_world；

最后，将相机坐标系原点O；

3.1β_x的求解

Z_c'_am的位置确定是关键。

观察前述的绕轴转动的顺序，Z_c'_am与Z_world、X_cam在同一个面，同时：Z_c'_am还在Y_cam-O-Z_cam面内；

两个平面相交线即为Z_c'_am；

即在X_camY_camZ_cam(即相机坐标系)中，Z_world-O-X_cam面的方程为：

-cY+bZ＝0

由此可知：Z_c'_am的方程为：

或者

β_x也采用Z'_cam与Z_cam的夹角表示：

Z'_cam的单位向量为

Z_cam的单位向量为(0，0，1)

需要注意的是：

并不精确；例如：β_x＝5°、-5°时，上式并无法区分。

另外，更棘手的问题在于，β_x是顺时针转动，还是逆时针转动。这由于后面β_y的选择有关。

对此，精确的表述应当为(此处需要说明，基于右手坐标系规则的限定：β_y在[-90°，90°]之间)：

若b≥0，c>0,

若b≥0，c<0

若b<0，c≥0

若b<0，c≤0，

3.2β_y的求解

Z_c'_am在Z_c'_am-O-Z_world面内，即Z_c'_am到Z_world的转角；

在X_camY_camZ_cam(即相机坐标系)中；

Z_c'_am的向量为：(0，b，c)

Z_world的向量为：(a，b，c)

即：

并不精确；例如：β_y＝5°、-5°时，上式并无法区分。对此，精确的表述应当为：

当a≥0,

当a<0,

3.3β_z的求解

X'_cam、X_world之间的夹角即为β_z。

Y'_cam在原相机坐标系中的向量为：(0，c，-b)

Z_world上的轴在原相机坐标系中的向量为：(a，b，c)

X'_cam与Y'_cam、Z_world轴均保持垂直，由此可知，X'_cam在相机坐标系中的向量为：

(b²+c²，-ab，-ac)；

X_world在原相机坐标系中的向量为：(d，e，f)

则有：

β_z的范围在[-π，π]之间。

并不精确；例如：β_z＝5°、-5°时，上式并无法区分。对此，精确的表述应当为：

Y_world轴在相机坐标系下的向量为：(bf-ce，cd-af，ae-bd)；

X'_cam在相机坐标系下的向量为：

(b²+c²，-ab，-ac)；

X'_cam与Y_world轴的夹角：

当θ≥π/2,

当θ<π/2,

3.4T_y的求解

X_cami、Y_cami、Z_cami是第一标识线和/或第二标识线上任意一点在相机坐标系的三维坐标；

将上述三维坐标代入到R矩阵，可以求出相机坐标系原点到参考坐标系原点之间的距离；具体数学可表示为：

L、N是第一标识线和/或第二标识线在参考坐标系的X_world坐标、Z_world坐标(在求解T_y不需要)。

也即能够采用下式来求解：

T_yi＝-[sinβ_zcosβ_yX_cami+(sinβ_zsinβ_ysinβ_x+cosβ_zcosβ_x)Y_cami+(sinβ_zsinβ_ycosβ_x-cosβ_zsinβ_x)Z_cami]

n表示从第一标识线和/或第二标识线选取的点的总数，n≤m+Q。

需要说明的是，

对于β_x而言，

若b≥0

若b<0，

<实施例二：双目立体相机的外参标定系统>

双目立体相机的外参标定系统，包括：存储系统、数据源处理系统、旋转矩阵求解系统、平移矩阵求解系统；

所述存储系统用于存储双目立体相机得到的图像、用于存储所述数据源处理系统得到的计算结果、用于存储旋转矩阵求解系统及平移矩阵求解系统得到的计算结果；

所述数据源处理系统读取所述存储系统中存储的图像上识别第一标识线、第二标识线的标识点，计算得到上述标识点在相机坐标系下的三维坐标，将计算得到的标识点在相机坐标系下的三维坐标存储到数据源存储系统中；

所述旋转矩阵求解系统，用于读取所述存储系统存储的标识点在相机坐标系下的三维坐标，得到β_x、β_y、β_z的结果，且将β_x、β_y、β_z的结果存入所述存储系统中；

所述平移矩阵求解系统，用于读取存储系统中的β_x、β_y、β_z的结果，以及标识点在相机坐标系下的三维坐标，计算得到Ty，将Ty存入所述存储系统中。

<实施例三：双目立体相机作为传感器的应用>

如图1所示，在机器人的机械臂固定安装一个双目立体相机，双目立体相机的Z_cam轴方向与机械臂的轴长方向保持一致；在地面上设置贴置标识线。

t时刻下，双目立体相机能够得到一个R矩阵、一个T矩阵；在t₁时刻下，双目立体相机也能够得到一个R矩阵、一个T矩阵。

实质上，T矩阵中只有1个参数即T_y，T_y其表征了双目立体相机距离地面的高度。

第一，计算t时刻下的Z_camt轴在t时刻下的参考坐标系下向量；

1.1首先利用实施例一的方法求解得到：t时刻对应的β_x、β_y、β_z，即采用：β_xt、β_yt、β_zt表示；

1.2Z_camt轴在t时刻下的参考坐标下的向量即为：

(cosβ_ztsinβ_ytcosβ_xt+sinβ_ztsinβ_xt，sinβ_ztsinβ_ytcosβ_xt-cosβ_ztsinβ_xt，cosβ_ytcosβ_xt)。

上述求解如下：

Z_camt轴在相机坐标系下的两点：(0，0，0)，(0，0，1)在t时刻下的参考坐标系下的坐标可以采用下式求解得到：

(0，0，0)，(0，0，1)作为(X_cam，Y_cam，Z_cam)值代入下式：

(该式是将相机坐标系得到的任意一点在三维坐标转换为该点在参考坐标下的计算公式)

即可得到：相机坐标下的两点(0，0，0)，(0，0，1)，在参考坐标系下的三维坐标为：

(0，T_y，0)；

(cosβ_ztsinβ_ytcosβ_xt+sinβ_ztsinβ_xt，sinβ_ztsinβ_ytcosβ_xt-cosβ_ztsinβ_xt+T_y，cosβ_ytcosβ_xt)。

据此，可求出Z_camt轴在t时刻下的参考坐标下的向量即为：

(cosβ_ztsinβ_ytcosβ_xt+sinβ_ztsinβ_xt，sinβ_ztsinβ_ytcosβ_xt-cosβ_ztsinβ_xt，cosβ_ytcosβ_xt)。

第二，计算t₁时刻下的Z_camt1轴在参考坐标下的向量；

2.1首先利用实施例一的方法求解得到：t₁时刻对应的β_x、β_y、β_z，即采用：β_xt1、β_yt1、β_zt1表示；

2.2Z_camt轴在t₁时刻下的参考坐标下的向量即为：

(cosβ_zt1sinβ_yt1cosβ_xt1+sinβ_zt1sinβ_xt1，sinβ_zt1sinβ_yt1cosβ_xt1-cosβ_zt1sinβ_xt1，cosβ_yt1cosβ_xt1)。

上述求解如下：

Z_camt轴在相机坐标系下的两点：(0，0，0)，(0，0，1)在t时刻下的参考坐标系下的坐标可以采用下式求解得到：

(0，0，0)，(0，0，1)作为(X_cam，Y_cam，Z_cam)值代入下式：

即可得到：相机坐标下的两点(0，0，0)，(0，0，1)，在参考坐标系下的三维坐标为：

(0，T_y，0)；

(cosβ_zt1sinβ_yt1cosβ_xt1+sinβ_zt1sinβ_xt1，sinβ_zt1sinβ_yt1cosβ_xt1-cosβ_zt1sinβ_xt1+T_y，cosβ_yt1cosβ_xt1)。

据此，可求出Z_camt轴在t₁时刻下的参考坐标下的向量即为：

(cosβ_zt1sinβ_yt1cosβ_xt1+sinβ_zt1sinβ_xt1，sinβ_zt1sinβ_yt1cosβ_xt1-cosβ_zt1sinβ_xt1，cosβ_yt1cosβ_xt1)。

第三，基于第一、第二的信息，可以求出：

机械臂在t时刻——>t₁时刻的转动角度γ为(利用向量知识来求解即可，虽然t时刻的参考坐标系与t₁时刻的参考坐标系不同，但是坐标系的XYZ轴的方向并不会产生变化)：

需要说明的是：

基于双目立体相机，还能求出沿着X_world方向在t时刻——>t₁时刻前进了多少距离，沿着Y_world方向在t时刻——>t₁时刻前进了多少距离，沿着Z_world方向在t时刻——>t₁时刻前进了多少距离。

对于沿着Y_world方向在t时刻——>t₁时刻前进了多少距离这个问题而言，直接用：T_yt1-T_yt求解即可(T_yt1、T_yt分别是t₁、t时刻下得到的外参参数)。

对于“沿着X_world方向在t时刻——>t₁时刻前进了多少距离、沿着Z_world方向在t时刻——>t₁时刻前进了多少距离”这两个问题，通过计算标识线上的任意一点P在t、t₁时刻下的参考坐标系下的三维坐标：

(X_pt，Y_pt，Z_pt)，(X_pt1，Y_pt1，Z_pt1)；

则可以知晓：

双目立体相机的原点在t时刻——>t₁时刻沿着X_world方向前进了：X_pt-X_pt1；若数值为正，表示沿着X_world正方向移动，若数值为负，表示沿着X_world负方向移动。

双目立体相机的原点在t时刻——>t₁时刻沿着Z_world方向前进了：Z_pt-Z_pt1；若数值为正，表示沿着Z_world正方向移动，若数值为负，表示沿着Z_world负方向移动。

基于上述信息，就可以明确的知晓，机械臂在空间中的变化信息。

以上所举实施例为本申请的较佳实施方式，仅用来方便说明本申请，并非对本申请作任何形式上的限制，任何所属技术领域中具有通常知识者，若在不脱离本申请所提技术特征的范围内，利用本申请所揭示技术内容所作出局部更动或修饰的等效实施例，并且未脱离本申请的技术特征内容，均仍属于本申请技术特征的范围内。

Claims (10)

1.一种双目立体相机的外参标定的方法，其特征在于，相机坐标系与参考坐标系均符合右手规则；

双目立体相机的外参参数为：β_x、β_y、β_z、T_y；四个参数的标定采用以下步骤：

S100，读取标识点在双目 立体相机下的三维坐标：

所述的标识点来源是：在水平参考面上贴十字线：第一标识线标识Z_WORLD轴的方向，第二标识线标识X_WORLD轴的方向，在第一标识线、第二标识线上均设置有若干个标识点；

S200，计算Z_WORLD轴、X_WORLD轴在相机坐标系中的向量，分别表示为(a，b，c)、(d，e，f)；

S300，β_x的求解采用下式：

若b≥0，

若b<0，

β_y的求解采用下式：

当a≥0,

当a<0,

β_z的求解采用下式：

θ为中间参数；

当θ≥π/2,

当θ<π/2,

S400，待β_x、β_y、β_z求解完成后，求解T_y：

读取第一标识线和/或第二标识线共计n个点在相机坐标系下的三维坐标，任意第i个点的三维坐标表示为：(X_cami、Y_cami、Z_cami)；

2.根据权利要求1所述的一种双目立体相机的外参标定的方法，其特征在于，第一标识线上按照Z_WORLD轴的前进方向设置有第1、2、…第Q个标识点，采用双目立体相机读取上述Q个点在相机坐标下的三维坐标，通过拟合求出第一标识线在相机坐标系的方向向量为(a，b，c)；

第二标识线上按照X_WORLD轴的前进方向设置有第1、2、…第m个标识点，采用双目立体相机读取上述m个点在相机坐标下的三维坐标，通过拟合求出第二标识线在相机坐标系的方向向量为(d，e，f)。

3.根据权利要求1所述的一种双目立体相机的外参标定的方法，其特征在于，相机坐标系的建立如下：

1)采用右手规则坐标系：右手四指指向X_cam轴方向，四指握手90°指向Y_cam轴方向，大拇指指向Z_cam轴方向；

2)原点为深度相机的中心点；

3)X_cam轴为沿着深度相机-彩色相机的横向方向，Z_cam轴垂直于X_cam轴且指向拍摄的方向；

4)Y_cam轴、X_cam、Z_cam相互垂直；

参考坐标系的建立如下：

1)参考坐标系的原点为相机坐标系的原点在水平参考面的投影点；

2)采用右手规则坐标系：X_WORLD轴朝右，Y_WORLD轴正向为竖直向下，Z_WORLD轴朝前。

4.一种双目立体相机作为传感器的应用，其特征在于，双目立体相机安装在机器人的机械臂上，在地面上设置贴置十字形或T字形标识线；基于双目立体相机获取机械臂的运动信息；

所述的双目立体相机采用如权利要求1的方法进行外参标定。

5.根据权利要求4所述的一种双目立体相机作为传感器的应用，其特征在于，双目立体相机的Z_cam轴方向与机械臂的轴长方向保持平行。

6.根据权利要求4所述的一种双目立体相机作为传感器的应用，其特征在于，所述的运动信息包括：机械臂在任意时刻t下的臂长的方位向量；其求解方法如下：

首先，求取任意t时刻对应的β_x、β_y、β_z，即采用：β_xt、β_yt、β_zt表示；

其次，Z_camt轴在t时刻下的参考坐标下的向量即为：

(cosβ_ztsinβ_ytcosβ_xt+sinβ_ztsinβ_xt，sinβ_ztsinβ_ytcosβ_xt-cosβ_ztsinβ_xt，cosβ_ytcosβ_xt)。

7.根据权利要求4所述的一种双目立体相机作为传感器的应用，其特征在于，所述的运动信息还包括：机械臂在任意时刻t-t₁时刻下的转动角度；其求解方法是

任意t时刻到t₁转动角度；

S100，求取t时刻对应的β_x、β_y、β_z，即采用：β_xt、β_yt、β_zt表示；

S200，求取t₁时刻对应的β_x、β_y、β_z，即采用：β_xt1、β_yt1、β_zt1表示；

S300，机械臂在t时刻——>t₁时刻的转动角度γ为：

其中，γ₁、γ₂、γ₃为中间参数。

8.根据权利要求6所述的一种双目立体相机作为传感器的应用，其特征在于，所述的运动信息还包括：机械臂上的双目立体相机在任意时刻t-t₁时刻下的运动距离信息；

其求解方法是：

求取t、t₁时刻对应的T_y，采用T_yt、T_yt1表示；

对于沿着Y_world方向在t时刻——>t₁时刻前进的距离为：T_yt1-T_yt；

对于沿着X_world方向在t时刻——>t₁时刻前进的距离、沿着Z_world方向在t时刻——>t₁时刻前进的距离而言；

通过计算第一或第二标识线上的任意一点P在t、t₁时刻下的参考坐标系下的三维坐标：

(X_pt，Y_pt，Z_pt)，(X_pt1，Y_pt1，Z_pt1)；

能够知晓：

双目立体相机的原点在t时刻——>t₁时刻沿着X_world方向前进了：X_pt-X_pt1；若数值为正，表示沿着X_world正方向移动，若数值为负，表示沿着X_world负方向移动；

双目立体相机的原点在t时刻——>t₁时刻沿着Z_world方向前进了：Z_pt-Z_pt1；若数值为正，表示沿着Z_world正方向移动，若数值为负，表示沿着Z_world负方向移动。

9.一种存储介质，其特征在于，其存储有运行如权利要求1或2或3的方法的程序。

10.一种双目立体相机的外参标定系统，其采用如权利要求1所述的双目立体相机的外参标定的方法；其特征在于，包括：存储系统、数据源处理系统、旋转矩阵求解系统、平移矩阵求解系统；

所述存储系统用于存储双目立体相机得到的图像、用于存储所述数据源处理系统得到的计算结果、用于存储旋转矩阵求解系统及平移矩阵求解系统得到的计算结果；

所述数据源处理系统读取所述存储系统中存储的图像上识别第一标识线、第二标识线的标识点，计算得到上述标识点在相机坐标系下的三维坐标，将计算得到的标识点在相机坐标系下的三维坐标存储到数据源存储系统中；

所述旋转矩阵求解系统，用于读取所述存储系统存储的标识点在相机坐标系下的三维坐标，得到β_x、β_y、β_z的结果，且将β_x、β_y、β_z的结果存入所述存储系统中；

所述平移矩阵求解系统，用于读取存储系统中的β_x、β_y、β_z的结果，以及标识点在相机坐标系下的三维坐标，计算得到Ty，将Ty存入所述存储系统中。

Images