2
$\begingroup$

The first node in the graph SLAM should be fixed. The famous "a tutorial on graph based slam" paper is showing that we can fix a node by adding identity matrix. Why adding identity to the Hessian of the specific node results in fixing that node? What is the theory behind it? Any good material to read?

enter image description here

$\endgroup$
1
  • $\begingroup$ Same question. Have you got the answer? $\endgroup$
    – nn0p
    Commented Oct 30, 2023 at 12:32

1 Answer 1

1
$\begingroup$

Not a definitive answer but here are my thoughts: Fixing node $k$ is equivalent to enforcing $\Delta x_{k} = 0$. Now we must show that adding $I$ to diagonal block $H_{kk}$ will result in $\Delta x_{k} = 0$. Let's name $H_{orig}$ the original matrix $H$ before adding $I$ to diagonal block $H_{kk}$, we have: $$ (H_{orig}+\begin{bmatrix} 0 & & & & & \\ & ... & & & & \\ & & 0 & & & \\ & & & I & & \\ & & & & 0 & \\ & & & & & ... \\ & & & & & & 0 \end{bmatrix})\Delta x = -b \Leftrightarrow H_{orig}\Delta x + \Delta x_{k} = -b $$ Can we show that $H_{orig}\Delta x + \Delta x_{k} = -b \Rightarrow \Delta x_{k} = 0$ ?

$\endgroup$
1
  • $\begingroup$ I think not, since $b$ is not $0$. $\endgroup$
    – nn0p
    Commented Oct 30, 2023 at 12:28

Your Answer

By clicking “Post Your Answer”, you agree to our terms of service and acknowledge you have read our privacy policy.

Not the answer you're looking for? Browse other questions tagged or ask your own question.