A computer-implemented method for representing environmental elements includes receiving scan data comprising at least a point cloud representing at least an environmental element from a sensor, segmenting the point cloud into point clusters, and partitioning the point clusters into hierarchical grids. The method also includes establishing a Gaussian distribution for points in each cell of each of the hierarchical grids, and constructing a Gaussian Mixture Model based on the Gaussian distribution for representing the environmental element.