Centroid search implemented

Signed-off-by: Luiz Carlos Cavalcanti <cavalcanti.luiz@gmail.com>