Edited pathfinding just a bit.

- works for any sized nodes now.