• 固定翼飞机数学建模入门(姿态角篇)


    本文主要简单介绍固定翼飞机的数学建模的一般形式与原理,读者姥爷们可以跟着在草稿纸上手动推导一次,理解会更加深刻!

    1. 固定翼飞机的飞行原理

    一般地,多旋翼飞机的飞行原理简单而易懂:通过机身装备的螺旋桨的转动产生升力,进而获得 z z z轴上的上下垂直移动。通过调整某个/某几个螺旋桨的转速,就能够实现俯仰、滚转、偏航的姿态调整。从力学基础角度看,螺旋桨同时增大/降低转速可以实现多旋翼的上升/下降,不同螺旋桨之间的转速差引起的转矩则能够实现姿态机动。

    另一方面,由于多旋翼的控制通道往往是解耦的,因而其飞控算法容易实现,调参难度低,控制律设计也相对容易,经常作为专业相关学生的入门接触对象。

    与旋翼机相比,固定翼飞机历史悠久,飞行难度高,飞行条件苛刻,力学方程更加复杂,控制律更难设计。其飞行以流体力学为基础,通过飞行过程中机翼上下表面的压差提供升力,因而“无速度就无升力”。固定翼的俯仰、滚转、偏航均通过机翼和尾翼的舵面来控制。

    同时,固定翼飞机的数学模型往往相互耦合,难以设计控制律,且实际工业中往往通过控制左/右副翼、水平稳定翼、垂直稳定翼、方向舵、升降舵、推力等等参数以达到控制的目的,因而工业上固定翼飞机的控制律设计更加复杂。

    本文以简化后的固定翼数学建模为基础,在牛顿–欧拉方程基础上建立固定翼的数学模型。

    2. 姿态角设置

    根据目前最默认的设置,滚转、俯仰、偏航分别为欧拉角 φ \varphi φ θ \theta θ ψ \psi ψ(机体坐标系),而在地球坐标系下,三个通道的速度分别表示为 p p p q q q r r r。二者之间通过坐标系转换矩阵进行转换:
    [ p q r ] = R e b [ φ ˙ θ ˙ ψ ˙ ] = [ 1 0 − sin ⁡ θ 0 cos ⁡ φ sin ⁡ φ cos ⁡ θ 0 − sin ⁡ φ cos ⁡ φ cos ⁡ θ ] [ φ ˙ θ ˙ ψ ˙ ] \left[

    pqr" role="presentation" style="position: relative;">pqr
    \right] = R_e^b \left[
    φ˙θ˙ψ˙" role="presentation" style="position: relative;">φ˙θ˙ψ˙
    \right] = \left[
    10sinθ0cosφsinφcosθ0sinφcosφcosθ" role="presentation" style="position: relative;">10sinθ0cosφsinφcosθ0sinφcosφcosθ
    \right] \left[
    φ˙θ˙ψ˙" role="presentation" style="position: relative;">φ˙θ˙ψ˙
    \right] pqr =Reb φ˙θ˙ψ˙ = 1000cosφsinφsinθsinφcosθcosφcosθ φ˙θ˙ψ˙

    3. 牛顿–欧拉方程

    牛顿–欧拉方程如下:
    Ω ˙ b = ( J b ) − 1 ( M b − Ω b × ( J b ⋅ Ω b ) ) (1) \dot \Omega^b = \left( J^b \right) ^ {-1} \left( M^b - \Omega^b \times \left( J^b \cdot \Omega^b \right) \right) \tag{1} Ω˙b=(Jb)1(MbΩb×(JbΩb))(1)其中 Ω = [ p q r ] T \Omega = \left[

    pqr" role="presentation" style="position: relative;">pqr
    \right]^T Ω=[pqr]T姿态角矩阵 J b J^b Jb为机体坐标系下固定翼的转动惯量矩阵
    J b = [ J x 0 J x z 0 J y 0 J z x 0 J z ] (2) J^b = \left[
    Jx0Jxz0Jy0Jzx0Jz" role="presentation" style="position: relative;">Jx0Jxz0Jy0Jzx0Jz
    \right] \tag{2}
    Jb= Jx0Jzx0Jy0Jxz0Jz (2)
    M b M^b Mb为外力在俯仰、滚转、偏航三通道上的力矩
    M b = [ q ˉ S b E L q ˉ S c ˉ E M q ˉ S b E N ] (3) M^b = \left[
    q¯SbELq¯Sc¯EMq¯SbEN" role="presentation" style="position: relative;">q¯SbELq¯Sc¯EMq¯SbEN
    \right] \tag{3}
    Mb= qˉSbELqˉScˉEMqˉSbEN (3)
    其中 q ˉ = 1 2 ρ V T 2 \bar q = \frac{1}{2} \rho V_T^2 qˉ=21ρVT2空气动压 b b b翼展 c ˉ \bar c cˉ机翼平均弦长 E M , E L , E N E_M, E_L, E_N EM,EL,EN分别为滚转、俯仰、偏航力矩系数,各自表达式如下:
    E L = C L ˉ β ⋅ β + C L δ r ⋅ δ r + C L δ a ⋅ δ a + C L p ˉ ( p b 2 V T ) + C L r ˉ ( r b 2 V T ) E M = C M 0 + C M α ⋅ α + C M δ e ⋅ δ e + C M α ˙ ( α ˙ c ˉ 2 V T ) + C M q ˉ ( q c ˉ 2 V T ) E N = C N β ⋅ β + C N δ a ⋅ δ a + C N δ r ⋅ δ r + C N p ˉ ( p b 2 V T ) + C N r ˉ ( r b 2 V T ) (4)
    EL=CL¯ββ+CLδrδr+CLδaδa+CLp¯(pb2VT)+CLr¯(rb2VT)EM=CM0+CMαα+CMδeδe+CMα˙(α˙c¯2VT)+CMq¯(qc¯2VT)EN=CNββ+CNδaδa+CNδrδr+CNp¯(pb2VT)+CNr¯(rb2VT)" role="presentation" style="position: relative;">EL=CL¯ββ+CLδrδr+CLδaδa+CLp¯(pb2VT)+CLr¯(rb2VT)EM=CM0+CMαα+CMδeδe+CMα˙(α˙c¯2VT)+CMq¯(qc¯2VT)EN=CNββ+CNδaδa+CNδrδr+CNp¯(pb2VT)+CNr¯(rb2VT)
    \tag{4}
    ELEMEN=CLˉββ+CLδrδr+CLδaδa+CLpˉ(2VTpb)+CLrˉ(2VTrb)=CM0+CMαα+CMδeδe+CMα˙(2VTα˙cˉ)+CMqˉ(2VTqcˉ)=Cβ+CNδaδa+CNδrδr+CNpˉ(2VTpb)+CNrˉ(2VTrb)(4)
    其中 δ r , δ a , δ e \delta_r, \delta_a, \delta_e δr,δa,δe分别为尾翼方向舵左右副翼尾翼升降舵的控制量。

    将(1)(2)(3)(4)联立,(1)式可以化为
    Ω ˙ b = ( J b ) − 1 ( M b − Ω b × ( J b ⋅ Ω b ) ) ⟹ [ p ˙ q ˙ r ˙ ] = Λ [ q ˉ S b E L − J z x p q − J z q r + J y q r q ˉ S c ˉ E M − J x p r − J x z r 2 + J z x p 2 + J z p r q ˉ S b E N − J y p q + J x p q + J x z q r ] (5) \dot \Omega^b = \left( J^b \right) ^ {-1} \left( M^b - \Omega^b \times \left( J^b \cdot \Omega^b \right) \right) \Longrightarrow \\ \left[

    p˙q˙r˙" role="presentation" style="position: relative;">p˙q˙r˙
    \right] = \Lambda \left[
    q¯SbELJzxpqJzqr+Jyqrq¯Sc¯EMJxprJxzr2+Jzxp2+Jzprq¯SbENJypq+Jxpq+Jxzqr" role="presentation" style="position: relative;">q¯SbELJzxpqJzqr+Jyqrq¯Sc¯EMJxprJxzr2+Jzxp2+Jzprq¯SbENJypq+Jxpq+Jxzqr
    \right] \tag{5} Ω˙b=(Jb)1(MbΩb×(JbΩb)) p˙q˙r˙ =Λ qˉSbELJzxpqJzqr+JyqrqˉScˉEMJxprJxzr2+Jzxp2+JzprqˉSbENJypq+Jxpq+Jxzqr (5)其中 Λ = ( J b ) − 1 = [ J z J x J z − J x z J z x 0 J x z J x z J z x − J x J z 0 1 J y 0 J z x J x z J z x − J x J z 0 J x J x J z − J x z J z x ] \Lambda = \left( J^b \right) ^{-1} = \left[
    JzJxJzJxzJzx0JxzJxzJzxJxJz01Jy0JzxJxzJzxJxJz0JxJxJzJxzJzx" role="presentation" style="position: relative;">JzJxJzJxzJzx0JxzJxzJzxJxJz01Jy0JzxJxzJzxJxJz0JxJxJzJxzJzx
    \right]
    Λ=(Jb)1= JxJzJxzJzxJz0JxzJzxJxJzJzx0Jy10JxzJzxJxJzJxz0JxJzJxzJzxJx
    另一方面,由于 E L , E M , E N E_L, E_M, E_N EL,EM,EN表达式显含控制量 δ i \delta_i δi,因而(5)式还可以简化为
    { p ˙ = f 1 ( δ r , δ a , p , q , r ) q ˙ = f 2 ( δ e , p , q , r ) r ˙ = f 3 ( δ r , δ a , p , q , r ) (6)
    {p˙=f1(δr,δa,p,q,r)q˙=f2(δe,p,q,r)r˙=f3(δr,δa,p,q,r)" role="presentation" style="position: relative;">{p˙=f1(δr,δa,p,q,r)q˙=f2(δe,p,q,r)r˙=f3(δr,δa,p,q,r)
    \tag{6}
    p˙=f1(δr,δa,p,q,r)q˙=f2(δe,p,q,r)r˙=f3(δr,δa,p,q,r)(6)

    4. 备注

    本文只对固定翼的姿态角做出了数学建模,对于其位移、气流角等的进一步探讨将在后续给出。
    下一节将会给出固定翼姿态角的控制算法与实例。

  • 相关阅读:
    Python学习基础笔记七——元组
    基于压电陶瓷传感器的智能枕头非侵入式生命体征监测
    Android Fragment详解(一)——生命周期
    Oracle 表连接(内连接、外连接(左连接、右连接)、隐式连接、表并集、表交集、表补集)
    大端字节序存储 | 小端字节序存储介绍
    【Python】【OpenCV】关于cv2.findContours()轮廓索引(编号)解析(RETR_TREE)
    STM32智能健康监测系统教程
    2023宁夏大学计算机考研信息汇总
    力扣每日一题 6/20 数学+数组
    在PyCharm快速加载第三方模块的设置方法
  • 原文地址:https://blog.csdn.net/weixin_58399148/article/details/126456624