Added the addNeighbors function

This allows us to use a* and adds all valid neighbors