Experimental graphslam engine