前言
本文将实现对无人机动力学以及运动学的公式推导完成建模,该模型以电机转速为输入,以无人机的状态量为输出。并在此基础上实现位置控制,以期望位置作为输入,使用串级pid结合无人机模型生成控制指令并对无人机进行控制。
无人机模型推导
对于任意刚体运动,均可分解为转动和平动,其中转动由动力学模型进行分析,平动可由运动学模型进行分析。对于无人机的糕体运动,如下示意

其中合力以及合力锯均由电机带动浆的转动产生
在忽略阻力、保证无人机小角度飞行的情况下,对无人机进行建模
在无人机机体系下,得到合力以及合力矩

动力学模型

带入并化简得

定义姿态角为机体系按ZYX旋转与惯性系平行时绕各轴的旋转角度