4 个圆表示马达,棒的长度与各马达的必要推力成正比。中央的箭头为偏航方向,机体的倾斜表示横滚和纵倾。
$$T_{total} = \frac{m\,(g + a_z)}{\cos\phi\cos\theta},\qquad [T_1, T_2, T_3, T_4]^T = A^{-1}\,[T, M_\phi, M_\theta, M_\psi]^T$$
A 为分配矩阵(4×4)。对于对称配置的四旋翼,A 的逆矩阵可解析求得,各马达的必要推力可代数方式获得。
$$M_\phi = I_{xx}\,\dot\omega_\phi,\quad M_\theta = I_{yy}\,\dot\omega_\theta,\quad M_\psi = I_{zz}\,\dot\omega_\psi,\qquad I_{xx}\!\approx\!I_{yy}\!\approx\!\tfrac{1}{2}mL^2,\ I_{zz}\!\approx\!mL^2$$
必要力矩为惯性矩 I 与角加速度 ω̇ 的乘积。本工具在简化模型中用横滚、纵倾增益 5 和偏航速率微分系数 0.05 来生成 ω̇。
$$T_i = k_T\,\omega_i^2,\qquad \tau_i = k_M\,\omega_i^2$$
螺旋桨推力 T_i 与转速 ω_i 的平方成正比,反作用力矩 τ_i 也与同一的 ω² 成正比。通过顺逆交替配置可以抵消 τ,在保持推力的同时仅保留偏航力矩。