A method for navigation of a vehicle using point cloud decimation includes generating, by a processor circuit, a ground plane point cloud and an object point cloud. Generating the ground plane point cloud and the object point cloud includes performing point cloud decimation of a 3-D point cloud using ground plane segmentation. The further includes navigating, by the processor circuit, the vehicle using at least the object point cloud.