https://9lib.co/document/nq77jjvq-simultaneous-localization-mapping-and-moving-object-tracking.html