四旋翼无人机Simulink建模与仿真：运动学、动力学模型研究及PD控制方式实现

四旋翼无人机，进行simulink建模与仿真，对它的运动学模型和动力学模型进行了必要且详细的研究和分析，运用牛顿-欧拉方程建立了四旋翼的运动学和动力学方程，最后推导出四个旋翼的角速度表达式。 采用了一种简单高效的比例微分串级（PD）控制方式，分别设计了四旋翼无人机的位置控制器和姿态控制器并利用Simulink实现了四旋翼无人机的仿真

四旋翼无人机的建模就像搭积木，只不过每一块积木都是微分方程。当我们打开Simulink开始搭这个"乐高城堡"时，首先要解决的是飞行器的运动学问题——说白了就是搞清楚它怎么在空间里动起来。

坐标系设定是第一步，地面坐标系X轴指东，Y轴向北，Z轴朝天。机体系则用x轴指向机头，y轴向右，z轴朝下。这俩坐标系之间的转换得靠旋转矩阵，这里咱们用ZYX顺序的欧拉角转换：

R = [cosθ*cosψ, sinφ*sinθ*cosψ - cosφ*sinψ, cosφ*sinθ*cosψ + sinφ*sinψ; cosθ*sinψ, sinφ*sinθ*sinψ + cosφ*cosψ, cosφ*sinθ*sinψ - sinφ*cosψ; -sinθ, sinφ*cosθ, cosφ*cosθ];

这个看起来像密码的矩阵，其实是姿态控制的核心。当我们在Simulink里用Rotation Matrix模块实现时，记得把三个姿态角φ/θ/ψ（滚转/俯仰/偏航）分别输入，矩阵乘法会自动处理坐标转换。

动力学部分更像在游乐场玩旋转木马。牛顿方程负责平动，欧拉方程处理转动。举个栗子，z轴方向的力平衡方程长这样：

m * ddot_z = (F1 + F2 + F3 + F4) * cosφ * cosθ - m * g

这里的F1~F4是四个旋翼的升力，Simulink里可以直接用Sum模块把四个PWM信号相加。不过要注意，实际建模时会用ω²*Kf来换算转速和升力，这时候就得在模型里插个Math Function模块做平方运算。

说到控制策略，PD串级控制就像骑自行车时的条件反射。外环位置控制器生成姿态指令，内环姿态控制器负责执行。举个位置环的代码片段：

function desired_angle = position_PD(current_pos, target_pos) Kp = 0.8; Kd = 0.3; error = target_pos - current_pos; desired_angle = Kp*error + Kd*derivative(error); end

这个函数在Simulink里会被封装成Embedded MATLAB Function模块。实际调试时会发现，Kp给大了无人机会像喝醉的水手一样摇晃，Kd过量则会像生锈的机器人动作迟缓。

姿态控制更刺激，以滚转通道为例：

torque_x = Ixx * (Kp_phi*(phi_des - phi) + Kd_phi*(p_des - p));

这里Ixx是转动惯量，Simulink建模时要用Parameter模块提前定义好。调试这个环节时，经常需要开着Simulation Data Inspector边跑边调，看着时域曲线像在玩音乐节奏游戏。

最后推导电机转速时，会发现四个电机的分配公式长得像魔方解法：

omega1 = sqrt( (U1/4) - (U2/2) - (U3/4) ) omega2 = sqrt( (U1/4) + (U2/2) - (U3/4) ) ...

在Simulink里实现时要注意开平方后的单位转换，最好加上饱和限制防止电机超转。跑仿真时会看到四个转速信号像合唱团的和声此起彼伏，共同维持着无人机的空中芭蕾。

当所有模块最终在Simulink里手拉手连成闭环时，点击运行按钮的瞬间，就像看着自己组装的火箭点火升空——虽然可能第一次会炸机，但调整几轮PID参数后，那个绿色的小方块终于能在三维空间里画出漂亮的轨迹了。