fixed multiple points and GridCels are alligning on the grid in rviz