Optimize the sensor cone algorithm

Increased the speed on fetching neighbors by removing some duplicate
loops. The scanning speed is now limited by how quickly the scanned
cells could be updated.
Merge pull request #1 from txiao/feature-sensorcone-optimize

Optimize the sensor cone algorithm