理论知识
参考:1. kummar 2011年 论文 Minimum Snap Trajectory Generation and Control for Quadrotors.
2. 香港科技大沈邵劫老师的相关论文;
3. 深蓝学院 高飞老师课件。
微分平坦:系统状态可以被平坦空间的状态以及他们的导数所组成的代数组合所表示。
系统状态12维,首先可以看出 x,y,z 和 dot_x, dot_y, dot_z, 以及 \phi , \theta, \psi和 \omega_x \omega_y \omega_z之间的导数关系,所以整个系统可以先规划成6个,然后无人机的角度和\dot\dot_x相关,所以,最终可以缩减为4个输入,x,y,z和\psi
Minimum jerk: minimize angular velocity, good for visual tracking
Minimum snap: minimize differential thrust, save energy
注:如果是针对minimum jerk,则需要提供位置,速度,角速度3个状态量。如果只考虑起点和终点,则有23个状态。同时考虑多项式形式包含有x_{0}(也就是常数项),所以最终的N=5
同样的道理,如果minimum snap,则需要提供位置,速度,加速度,以及角速度,4个状态量。所以N = 24-1 = 7
注2: 如果考虑多段的情况,例如K段,则minimum jerk ,需要 (k-1) +3 +3= k+5 , 这里只要求能够连续的到达中间点,至