上一节:视觉伺服

Eye-in-hand Setup:

相机在基本坐标系中的姿态为 [公式]  [公式]

物体相对于相机的位置 [公式]

在图像上的特征位置 [公式] , [公式]

有如下关系:

[公式]

[公式]

[公式] 是特征空间的维度, [公式] 是任务空间(操作空间)的维度

例: [公式]

[公式]

推导:

第一步 [公式] ,已知 [公式]  [公式] ,根据3D的透视投影有

[公式]

其中 [公式] 是相机焦距, [公式] 是物体相对于相机的3个方向上的距离。

第二步 [公式] ,对第一步的 [公式]  [公式] 求导有:

[公式]

第三步 [公式] ,已知 [公式]

[公式]

同时,我们也知道,如果我们移动点 [公式] 

[公式]

而当我们移动末端执行器/相机有:

[公式]

由第一步有: [公式]  [公式] 代入第三步有:

[公式]

于是把 [公式] [公式] [公式] [公式] [公式] 代入第二步:

[公式]

写成矩阵的形式:

[公式]

[公式]

第二种方式:矩阵

第二步改写成矩阵形式:

[公式]

第三步改写成矩阵形式:

[公式]

于是有:

[公式]

那么: [公式]

即:

[公式]

例:

假设一个机械手臂要跟随一个圆(一张纸上打印一个圆)运动,用圆的圆心位置和半径作为特征,即: [公式] ,相机始终正对着圆,所以这里不用考虑旋转,所以相机相对于基本坐标系可以用 [公式] 表示。那么 [公式] 将是一个 [公式] 的矩阵。

第一步:根据3D透视投影可以得出特征和相机位置的关系:

[公式]

其中, [公式] 分别是圆相对于相机的宽、高和距离, [公式] 是圆的半径(相对于相机而言),是个常量。

第二步:对特征进行微分:

[公式]

第三步:根据物体相对于相机的位置关系和相机相对于基本坐标系的关系,得到物体相对于基本坐标系的关系

移动相机坐标系 [公式] ,相当于移动相机坐标系中的特征 [公式] ,即: [公式] ,把 [公式]  [公式]  [公式]  [公式] 代入第二步:

[公式]

[公式] 也就呼之欲出了。