Source: https://lucidar.me/en/kalman-filters/files/introduction-to-slam.pdf