Graph由vertex和edge构成,vertex有两种类型:pose vertex和landmark vertex。
pose vertex:
- x i \mathbf{x}_i xi
- 个数: m m m
landmark vertex:
- y j \mathbf{y}_j yj
- 个数: n n n, n n n 一般远大于 m m m
observation edge:
- observation: z i j \mathbf{z}_{ij} zij,
- reprojection error: f i j \mathbf{f}_{ij} fij
- partial differential: ∂ f i j ∂ x i \frac{\partial \mathbf{f}_{ij}}{\partial \mathbf{x}_i} ∂xi∂fij (dimension 2 × 6 2 \times 6 2×6) and ∂ f i j ∂ y j \frac{\partial \mathbf{f}_{ij}}{\partial \mathbf{y}_j} ∂yj∂fij (dimension 2 × 3 2 \times 3 2×3)
待求解的变量是
t
\mathbf{t}
t:
t
=
[
x
1
⋮
x
i
⋮
x
m
y
1
⋮
y
j
⋮
y
n
]
\mathbf{t} = \begin{bmatrix} \mathbf{x}_1 \\ \vdots \\ \mathbf{x}_i \\ \vdots \\ \mathbf{x}_m \\ \mathbf{y}_1 \\ \vdots \\ \mathbf{y}_j \\ \vdots \\ \mathbf{y}_n \\ \end{bmatrix}
t=
x1⋮xi⋮xmy1⋮yj⋮yn