Online SLAM update

Added a method to remove old positions from SLAM matrix making it an
optionally 'online' module where only the most recent positions are
monitored.