Hand-eye Calibration: 4D Procrustes Analysis Approach閱讀筆記

首先看下實驗部分：

這篇論文提出的手眼標定算法在精度和速度上表現得都很好。
下面介紹算法流程：
1、通過$T=\begin{bmatrix}R&t\\0&1\end{bmatrix}\leftrightarrow R_{T,SO(4)}=\begin{bmatrix}R&\epsilon t\\-\epsilon t^TR&1\end{bmatrix}$獲得$SO(4)$形式的位姿矩陣。
2、目標函數爲$\mathop{\arg\min}_{R\in SO(4)}\Sigma_{i=1}^N\|E_iR-RZ_i\|^2=\mathop{\arg\min}_{\sigma^T \sigma=1}\sigma^TF\sigma$
其中，$F=\begin{bmatrix}F_{11}&0\\0&F_{22}\end{bmatrix}$
$F_{11}=\Sigma_{i=1}^N\Sigma_{j=1}^4\Sigma_{k=1}^4J_{jk,i}J_{jk,i}^T$
$F_{22}=\Sigma_{i=1}^N\Sigma_{j=1}^4\Sigma_{k=1}^4J_{jk,i}^TJ_{jk,i}$
而$J_{jk,i}$的定義參見文末原文。
這裏，可以求得$\sigma$的值爲$F$的最小特徵值對應的特徵向量。
3、上面的$\sigma$定義爲$\sigma=\frac{1}{\sqrt{2}}(q^T_L,q^T_R)^T$
其中，$q_L=[a,b,c,d]^T$,$q_R=[p,q,r,s]^T$
對於$R_{T,SO(4)}$有：
$R_{T,SO(4)}=R_L(q_L)R_R(q_R)$
$R_L(q_L)=\begin{bmatrix}a&-b&-c&-d\\b&a&-d&c\\a&d&a&-b\\d&-c&b&a\end{bmatrix}$
$R_R(q_R)=\begin{bmatrix}p&-q&-r&-s\\q&p&s&-r\\r&-s&p&q\\s&r&-q&p\end{bmatrix}$

這樣就可以得到$R_{T,SO(4)}$
4、再通過1就可以解出$R、t$了。

原文鏈接：https://www.ram-lab.com/papers/2019/tim2019wu.pdf