[SLAM] INS Correction Graph With A Gauss-Markov Prior
Correction Nodes, Gauss-Markov Edges, Sonar Loop Closures, Stationary Variance, Information Matrix
Nodes Are Pose Corrections, Not Poses
In traditional SLAM, a node contains an unknown robot pose:
\[\begin{gather*}
x_k=(x,y,\theta)
\end{gather*}\]
The INS already provides poses, so this graph...