calculate_centroids_normalized function

Searches modes with the AMS3D algorithm for a lidar point cloud of a forest