Python sample code of 3D pose optimization SLAM - View it on GitHub