如何在VC++中实现三维A*算法

如何在VC++中建立MFC AppWizard工程基于基本对话框实现三维A*算法

我要做一个简单飞行器航迹规划(要考虑飞行器的性能最大拐弯角，爬升/俯冲角，最小航迹段)，通过vc++与matlab混合编程利用matlab引擎，在matlab生成的三维地形图中采用三维A*算法实现飞行航迹规划，求教代码/思路？？？