Might wanna give it an A* version, would add even more to the performance and make it ideal for huge maps, although the dijikstra method you do here works too ; A* just has the hueristic in it. Any chance you'll release the full source? it would be good grounds to develop more onto.

-Rhuarc