Nex а чем поиск пути в 3д отличается от 2д? поидее должна быть какая никая сетка занятости клеток карты , на квадраты разбей
я тут у себя подобное сделал - правда пока без диагональных направлений, но добавить 5 минут
http://www.games-maker.ru/26-volnovo...a_puti_na_c++/