Added the mapbuilder. Plane extraction is working