目录 程序和控制流程 源码解读 总结 程序和控制流程 个人简单的总结了一下整个程序的流程如下: 整个的控制流程图可以在官网中找到: 源码解读 在解读源码之前,需要提几个公式,第一个就是协调转弯中的偏航控制,也就是流程图中为什么输入是空速: ⎧⎩⎨⎪⎪⎪⎪⎪⎪⎪⎪p=ϕ˙−ψ˙sinθq=θ˙cosϕ+ψ˙cosθ