Или версия на похожем языке.Тот, который для всех типов карт, а не только 2d.
2d / 3d на самом деле не имеет значения, любой алгоритм кратчайшего маршрута должен основываться на простой сети узлов, а не на 2-м или 3-м представлении таковых. http://codezilla.com/projects/a-star/