point_cloud: range_bearing_grid::index implemented; doing unit test...