Added initial size parameter to PQueue and pathfinding now takes advantage of it.