Factor Graph

A probabilistic graphical model where variable nodes (states to estimate) and factor nodes (constraints from measurements) are connected by edges. Inference on factor graphs (finding the maximum a posteriori estimate) solves SLAM and sensor fusion problems. GTSAM and g2o implement efficient sparse factor graph optimization for real-time SLAM.