Amortized Constant Time State Estimation in Pose SLAM and Hierarchical SLAM Using a Mixed Kalman-Information Filter

Robotics and Autonomous Systems - Netherlands
doi 10.1016/j.robot.2011.02.010