Visual SLAM – Bundle Adjustment

1. FoundationIn feature point-based visual SLAM, we generally optimize the camera pose and map point location by minimizing the reprojection error. The following is an introduction to this issue.1.1 Map parameteriseTwo method: 3-d vector $X=\left[ x,y,z \right]^{T}$ , or inverse depth parametrization. Here we use 3-d vector for simplicity.1.2 Camera Read more…

3D Transformation

There are 3 categories of the most used methods to parameterize 3D solid body motion. i.e. matrix, quaternion and Lie group. Matrix Rotation $$ R=\begin{bmatrix} r_{11} &r_{12} &r_{13} \\ r_{21} &r_{22} &r_{23} \\ r_{31} &r_{32} &r_{33} \end{bmatrix}\in \mathbb{R^{3\times3}}, s.t. R~R^T=I, det(R)=1 $$ Transformation $$ T=\begin{bmatrix} R&t \\ 0^T&1 \end{bmatrix}\in \mathbb{R^{4\times4}} Read more…