Он работает! Смог написать а* алгоритм в Unity!