An implementation of AVP_SLAM and some new contributions - View it on GitHub