Fixed a bug with findEncampments

Locations are now checked to make sure they are inside the map. In
addition, fixed a bug where the search stopped when expanding the
first PathNode.