matlab路径规划

结合数学模型的构建，设计AGV小车的行驶路径规划应该怎么做？

那复杂了去了，算法还得自己先想好啊