在进行机器人视觉相关项目的过程中，首先要进行相机标定，此博客记录相机标定的相关原概念及实施方法。

1. 简介

在图像测量过程以及机器视觉应用中，为确定空间物体表面某点的三维几何位置与其在图像中对应点之间的相互关系，必须建立相机成像的几何模型，这些几何模型参数就是相机参数。在大多数条件下这些参数必须通过实验与计算才能得到，这个求解参数的过程就称之为相机标定。相机标定是非常关键的环节。

• 进行摄像机标定的目的：求出相机的内、外参数，以及畸变参数。
• 标定相机后通常是想做两件事：一个是由于每个镜头的畸变程度各不相同，通过相机标定可以校正这种镜头畸变矫正畸变，生成矫正后的图像；另一个是根据获得的图像重构三维场景。

2. 原理

相机标定的基本原理是通过已知的三维世界坐标系中的点和对应的二维图像坐标系中的点，建立一个数学模型，将三维世界坐标系中的点投影到二维图像坐标系中。这个数学模型通常包括以下几个部分：

1. 相机内参矩阵（Intrinsic Matrix）：描述相机的内部几何特性，包括焦距、主点坐标等。
2. 畸变系数（Distortion Coefficients）：描述图像畸变，包括径向畸变和切向畸变。
3. 旋转矩阵和平移向量（Rotation Matrix and Translation Vector）：描述相机在世界坐标系中的姿态，也可以叫做外参数。

常用标定步骤：

1. 准备标定板：使用一个已知尺寸的标定板（如棋盘格），并拍摄多张不同角度和位置的图像。
2. 检测角点：在每张图像中检测标定板的角点，并记录其二维图像坐标。
3. 生成世界坐标：根据标定板的尺寸，生成标定板角点的三维世界坐标。
4. 计算内参和畸变系数：使用检测到的角点和生成的世界坐标，计算相机的内参矩阵和畸变系数。
5. 计算旋转矩阵和平移向量：计算每张图像的旋转矩阵和平移向量。
6. 计算重投影误差：将世界坐标系中的点投影到图像坐标系中，并与实际检测到的图像坐标进行比较，计算重投影误差。

常用术语

内参矩阵: Intrinsic Matrix
焦距: Focal Length
主点: Principal Point
角点: Corner Point
径向畸变: Radial Distortion
切向畸变: Tangential Distortion
旋转矩阵: Rotation Matrices
平移向量: Translation Vectors
平均重投影误差: Mean Reprojection Error
重投影误差: Reprojection Errors
重投影点: Reprojected Points

3. 相机模型

3.1 四大坐标系

世界坐标系是一个全局坐标系，用于描述物体在真实世界中的位置。世界坐标系用 (X_w, Y_w, Z_w) 表示，独立于相机，可以任意选择原点和坐标轴的方向。

**相机坐标系 (Camera Coordinate System)**以相机的光学中心为原点，$Z$轴指向相机的正前方，$X$轴和$Y$轴分别指向相机的右侧和下方，用于描述物体在相机视角下的位置。通常，相机坐标系用 $(X_c,Y_c,Z_c)$ 表示。

**图像坐标系 (Image Coordinate System)**是二维坐标系，用于描述物体在相机成像平面上的投影位置。通常，图像坐标系用 $(x,y)$表示，图像坐标系的原点通常位于成像平面的中心，$x$轴和$y$轴分别指向图像的右侧和下方。

**像素坐标系 (Pixel Coordinate System)**是二维坐标系，用于描述物体在数字图像中的像素位置。通常，像素坐标系用 $(u,v)$ 表示，即列数和行数。像素坐标系的原点通常位于图像的左上角，$u$轴和$v$轴分别指向图像的右侧和下方。

3.2 坐标系间的转换关系

3.2.1 世界坐标系到相机坐标系

世界坐标系到相机坐标系的转换通常通过一个刚体变换（旋转和平移）来实现。这个变换可以用一个4x4的变换矩阵 $T_{wc}$ 表示，包含旋转矩阵$R$和平移向量$t$

$$\left[\begin{array}{c}{X}_c\\ Y_c\\ Z_c\\ 1\end{array}\right]=T_{wc}\left[\begin{array}{c}{X}_w\\ Y_w\\ Z_w\\ 1\end{array}\right]=\left[\begin{array}{cc}R& t\\ 0& 1\end{array}\right]\left[\begin{array}{c}{X}_w\\ Y_w\\ Z_w\\ 1\end{array}\right]$$

3.2.2 相机坐标系到图像坐标系

相机坐标系到图像坐标系的转换是通过透视投影实现的。假设相机焦距为$f$，则成像面是与$X_{c}O{Y}_c$平面平行且距离为$f$的平面，在相机坐标系中，$p(x_c,y_c,z_c)$，在图像坐标系中的成像点是$p^{\prime }(x,y)$

利用相似三角形求得：$\frac{x}{x_c}=\frac{y}{y_c}=\frac{f}{z_c}$

即$x=\frac{f}{z_c}\cdot x_c$, $y=\frac{f}{z_c}\cdot y_c$，写为矩阵形式：
$$\left[\begin{array}{c}x\\ y\\ 1\end{array}\right]=\left[\begin{array}{cccc}\frac{f}{z_c}& 0& 0& 0\\ 0& \frac{f}{z_c}& 0& 0\\ 0& 0& \frac{1}{z_c}& 0\end{array}\right]\cdot \left[\begin{array}{c}{x}_c\\ y_c\\ z_c\\ 1\end{array}\right]$$
也可以写作：
$$z_c\cdot \left[\begin{array}{c}x\\ y\\ 1\end{array}\right]=\left[\begin{array}{cccc}f& 0& 0& 0\\ 0& f& 0& 0\\ 0& 0& 1& 0\end{array}\right]\cdot \left[\begin{array}{c}{x}_c\\ y_c\\ z_c\\ 1\end{array}\right]$$

3.2.3 像素坐标系转换为图像坐标系

像素坐标系uov是一个二维直角坐标系，反映了相机CCD/CMOS芯片中像素的排列情况。原点o位于图像的左上角，u轴、v轴分别于像面的两边平行。像素坐标系中坐标轴的单位是像素（整数）。

像素坐标系不利于坐标变换，因此需要建立图像坐标系XOY，其坐标轴的单位通常为毫米（mm），原点是相机光轴与相面的交点（称为主点），即图像的中心点，X轴、Y轴分别与u轴、v轴平行。故两个坐标系实际是平移关系，即可以通过平移就可得到。
其中，$dx$、$dy$分别为像素在$x$、$y$轴方向上的物理尺寸，$u_0$,$v_0$为主点（图像坐标系原点）坐标。

3.2.4 世界坐标转换为像素坐标

3.3 畸变

3.3.1 畸变类型

3.3.1.1 径向畸变（Radial Distortion）

径向畸变是由于镜头的形状引起的，通常表现为图像中心区域的放大或缩小。径向畸变可以进一步分为两种类型：

• 桶形畸变（Barrel Distortion）：图像向外凸起，类似于桶的形状。
• 枕形畸变（Pincushion Distortion）：图像向内凹陷，类似于枕头的形状。

$$\begin{gathered} x_{\text{corrected}}=x(1+k_1{r}^2+k_2{r}^4+k_3{r}^6) \\ {y}_{\text{corrected}}=y(1+k_1{r}^2+k_2{r}^4+k_3{r}^6) \end{gathered}$$
其中：

• $(x,y)$ 是畸变前的像素坐标。
• $(x_{\text{corrected}},y_{\text{corrected}})$ 是畸变校正后的像素坐标。
• $r^2=x^2+y^2$ 是像素点到图像中心的距离的平方。
• $k_1,k_2,k_3$ 是径向畸变系数。

3.3.1.2 切向畸变（Tangential Distortion）

切向畸变是由于镜头和成像平面不完全平行引起的。这种畸变会导致图像中的某些区域相对于其他区域发生偏移。切向畸变可以用以下公式描述：

$$\begin{gathered} x_{\text{corrected}}=x+[2p_{1}xy+p_2(r^2+2x^2)] \\ {y}_{\text{corrected}}=y+[p_1(r^2+2y^2)+2p_{2}xy] \end{gathered}$$

其中, $p_1,p_2$ 是切向畸变系数。

3.3.2 畸变模型

综合径向畸变和切向畸变，完整的畸变模型可以表示为：
$$\begin{gathered} x_{\text{corrected}}=x(1+k_1{r}^2+k_2{r}^4+k_3{r}^6)+[2p_{1}xy+p_2(r^2+2x^2)] \\ {y}_{\text{corrected}}=y(1+k_1{r}^2+k_2{r}^4+k_3{r}^6)+[p_1(r^2+2y^2)+2p_{2}xy] \end{gathered}$$

在相机标定过程中，通过拍摄已知几何形状的标定板（如棋盘格），可以计算出畸变系数 $k_1,k_2,k_3,p_1,p_2$。然后，利用这些系数对图像进行畸变校正，恢复图像的几何形状。