SLAM in Python