Если стратегия реального времени, то волновой метод не прокатит по быстродействию. Тогда лучевой метод или его разновидности:
http://zx.pk.ru/showpost.php?p=348579&postcount=63
http://zx.pk.ru/showpost.php?p=372558&postcount=99