Check out AFAYE SLAM (@hum