Factor graphs have gained a lot of success and popularity for SLAM problems [1]}, [2]} due to their efficiency.
Fist assume that there exist static landmarks that the robot can identify to localize itself.
