Visual SLAM: Why filter?
Bundle Adjustment - A Modern Synthesis