The algorithm now cleans up all old and already processed data right before returning a call to run_slam. This should greatly improve speed of on-line SLAM, since it allows the algorithm to continue where it ended in previous calls.

IssueID #10