Fix a bug with the GetNeighborhood function that occur when the distance is 0.
Merge pull request #2 from txiao/feature-sensorcone-bugfix

Fix a bug with the GetNeighborhood function