Finish grid index

Almost no difference with quad-tree