手眼标定（一）：AX = XB方程详细推导

主要介绍eye_in_hand手眼标定，如下图，Ｂ为机械臂固定基座坐标系，E为机械臂末端坐标系，C为相机坐标系，相机坐标系与末端坐标系间无相对运动，手眼标定的目标就是要求得相机坐标系到末端坐标系的变换关系矩阵: Pe = Rce * Pc + Tce , 其中 Pc为相机坐标系下的一个坐标点，通过手眼变换关系可以得到点Pc在末端坐标系下的坐标值，标定的目的是要求出两个坐标系的变换矩阵 Rce 和平移向量Tce，也可以写成Pe = Hce * Pc 。

手眼标定方程推导：

如上图，W 是用于标定的棋盘格坐标系，标定过程中基座坐标系Ｂ和棋盘格坐标系W是固定不动的。

step 1: 首先来看机械臂末端从E点运动到Ｅ’前后的坐标关系：
在E点处: $$Pb=He\ast Pe（\mathrm{１}）$$ $$Pc=Hwc\ast Pw（\mathrm{２}）$$
在Ｅ’ 处: $$Pb=H{e}^{\prime }\ast P{e}^{\prime }（\mathrm{３}）$$ $$P{c}^{\prime }=Hw{c}^{\prime }\ast Pw（\mathrm{４}）$$

step 2: 相机从C运动到C’，结合公式（２）与（４）: 公式中　Hwc　和　Hwc’　是事先标定得到相机内参然后求得的外参，即棋盘格坐标系到相机坐标系的变换矩阵，参考相机内参与外参标定。
因 为 P w = ( H w c ′ ) − 1 ∗ P c ′ 因为 Pw = (Hwc')^{-1} * Pc'