point_cloud/spherical_grid: bearing_index and elevation_index: quick and dirty implementation added