【路径生成--基于运动学的A*图搜索方法】运动学/动力学Kinodynamic A*算法