Ref. https://pythonrobotics.readthedocs.io/en/latest/modules/localization.html#extended-kalman-filter-localization
