参考文章: 四旋翼飞行器建模(一)— 动力学及运动学方程 - 知乎 (zhihu.com) 多旋翼无人机建模-牛顿欧拉法_无人机运动学模型-CSDN博客 四旋翼无人机吊挂飞行轨迹跟踪控制研究 - 中国知网 (cnki.net) minimum snap原理: 【附源码和详细的公式推导】Minimum Snap轨迹生成,闭式求解Minimum Snap问题,机器人轨迹优化,多项式轨迹路径生成与优化-CSDN博客 移动机器人运动规划 - 深蓝学院 - 专注人工智能与自动驾驶的学习平台 (shenlanxueyuan.com) 路径规划-Minimum snap轨迹优化_路径规划算法中如何提高路径的平滑度-CSDN博客