建模目的

无人机动力系统包括:螺旋桨、电机、电调及电池。建模流程图如下(图片来源《多旋翼飞行器设计与控制》.[M].全权):
请添加图片描述
经过误差结算后,将误差信息转换为螺旋桨的升力与转矩,以便实现对电机的控制。而动力系统建模就是描述了该控制的过程。

1 螺旋桨建模

得到姿态误差后,可将角度误差转化为升力(T)及扭矩(M)的控制量,有了T和M就可以根据螺旋桨参数结算出需要的转速(N)。对应公式如下:
"

T = CT∗p∗(N/60)2∗Dp4C_T*p*(N/60)^2*D_p^4CTp(N/60)2Dp4
M = CM∗p∗(N/60)2∗Dp5C_M*p*(N/60)^2*D_p^5CMp(N/60)2Dp5

其中,CTC_TCTCMC_MCM为无量纲系数,由螺旋桨物理参数决定;p为空气密度,一般设为常熟;DpD_pDp为螺旋桨直径。

2 电机建模

根据求得的 M 及 N 求解出电机的等效电流 ImI_mImUmU_mUm 。表达式如下:
"

Um=fU(Θm,M,N)U_m = f_U(\Theta_m ,M, N )Um=fU(Θm,M,N)
Im=fI(Θm,M,N)I_m = f_I(\Theta_m ,M, N )Im=fI(Θm,M,N)

其中,Θm\Theta_mΘm为电机参数集合。

3 电调(ESC)建模

根据电机模型的 ImI_mImUmU_mUm ,电调参数集合 Θe\Theta_eΘe 及 电池参数集合Θb\Theta_bΘb,求出油门指令 σ\sigmaσ 、电调的输入电流 IeI_eIe 及 输入电压UeU_eUe。表达式如下:
"

σ=fσ(Θb,Um,Im,Ub)≈(Um+Im∗Re)/Ub\sigma = f_\sigma(\Theta_b ,U_m, I_m, U_b )\approx(U_m + I_m*R_e)/U_bσ=fσ(Θb,Um,Im,Ub)Um+ImRe/Ub
Ue=fU(Θb,Ie)≈(Ub−Ib∗Rb)U_e = f_U(\Theta_b , I_e )\approx(U_b-I_b*R_b)Ue=fU(Θb,Ie)(UbIbRb)
Ie=fI(σ,Im)≈(Im∗σ)I_e = f_I(\sigma , I_m )\approx(I_m*\sigma)Ie=fI(σ,Im)(Imσ)
Ib=nr∗Ie+IoI_b = n_r*I_e+I_oIb=nrIe+Io

其中nrn_rnr为螺旋桨数,IoI_oIo为其他硬件的分流

4 电池建模

根据电调求出的电流 IbI_bIb 及电池参数集合 Θb\Theta_bΘb ,求出电池的续航时间。表达式如下:
"

Tb=fT(Θb,Ib)≈(Cb−Cm)∗60/(Ib∗1000)T_b = f_T(\Theta_b , I_b )\approx(C_b-C_m)*60/(I_b*1000)Tb=fT(Θb,Ib)(CbCm)60/(Ib1000)

其中,CbC_bCb为电池总容量,CmC_mCm为限定的最小容量

综上,当我们根据期望姿态获取到姿态误差时,我们便可输出对应的螺旋桨转速转矩,电机的电压及电流,电调的电压电流及油门开度,并结算出可飞行的时间。

本文所有知识点、图片及公式均来源于北航全权教授所著的《多旋翼飞行器设计与控制》图书。

Logo

有“AI”的1024 = 2048,欢迎大家加入2048 AI社区

更多推荐