Added a spacial grid to speed up the neighbor lookup. Still working out a few bugs.