https://123dok.org/document/ozlr4noz-conditionally-independent-visual-slam-with-integrated-bundle-adjustment.html