Mapping2D can be used to map areas using blob/point maps and depth cameras. It is designed for 2.5D space, incorporating the X and Y axis.