動態(tài)系統(tǒng)建模仿真試驗報告

本文格式為Word版，下載可任意編輯——動態(tài)系統(tǒng)建模仿真試驗報告動態(tài)系統(tǒng)建模仿真試驗報告

動態(tài)系統(tǒng)建模仿真試驗報告（2）

2023.12.15

1

四旋翼飛行器仿真

動態(tài)系統(tǒng)建模仿真試驗報告

1試驗內容

基于Simulink建立四旋翼飛行器的懸?？刂苹芈罚瑢崿F飛行器的懸?？刂?；建立UI界面，能夠輸入參數并繪制運動軌跡；

基于VRToolbox建立3D動畫場景，能夠模擬飛行器的運動軌跡。2試驗目的

通過在Matlab環(huán)境中對四旋翼飛行器進行系統(tǒng)建模，使把握以下內容：四旋翼飛行器的建模和控制方法

在Matlab下快速建立虛擬可視化環(huán)境的方法。3試驗器材

硬件：PC機。

工具軟件：操作系統(tǒng)：Windows系列；軟件工具：MATLAB及simulink。4試驗原理4.1四旋翼飛行器

四旋翼飛行器通過四個螺旋槳產生的升力實現飛行，原理與直升機類似。四個旋翼位于一個幾何對稱的十字支架前，后，左，右四端，如圖1所示。旋翼由電機控制；整個飛行器依靠改變每個電機的轉速來實現飛行神態(tài)控制。

圖1四旋翼飛行器旋轉方向示意圖

2

動態(tài)系統(tǒng)建模仿真試驗報告

在圖1中，前端旋翼1和后端旋翼3逆時針旋轉，而左端旋翼2和右端的旋翼4順時針旋轉，以平衡旋翼旋轉所產生的反扭轉矩。由此可知，懸停時，四只旋翼的轉速應當相等，以相互抵消反扭力矩；同時等量地增大或減小四只旋翼的轉速，會引起上升或下降運動；增大某一只旋翼的轉速，同時等量地減小同組另一只旋翼的轉速，則產生俯仰、橫滾運動；增大某一組旋翼的轉速，同時等量減小另一組旋翼的轉速，將產生偏航運動。

4.2建模分析

四旋翼飛行器受力分析,如圖2所示

圖2四旋翼飛行器受力分析示意圖

旋翼機體所受外力和力矩為：重力mg,機體受到重力沿-zw方向；

四個旋翼旋轉所產生的升力Fi(i=1,2,3,4)，旋翼升力沿zb方向；旋翼旋轉會產生扭轉力矩Mi(i=1,2,3,4)。Mi垂直于葉片的旋翼平面，與旋轉矢量相反。

k力模型為：Fi?kF?i2，旋翼通過螺旋槳產生升力。F是電機轉動力系數，

?82?6.11?10N/rpm可取，i為電機轉速。旋翼旋轉產生旋轉力矩Mi(i=1,2,3,4)，

3

動態(tài)系統(tǒng)建模仿真試驗報告

力矩Mi的旋向依據右手定則確定。力矩模型為Mi?kM?i2，其中kM是電機轉動力系數，可取1.5?10?9Nm/rpm2?i為電機轉速。當給定期望轉速后，電機的實際轉速需要經過一段時間才能達到。實際轉速與期望轉速之間的關系為一階延遲：

20?i?km(?ides??i)?響應延遲時間可取0.05s(即km?)。期望轉速?ides則需要限

s制在電機的最小轉速和最大轉速之間，范圍可分取[1200rpm，7800rpm]。

飛行器受到外界力和力矩的作用，形成線運動和角運動。線運動由合外力引起，符合牛頓其次定律：

?0??0???????mr??0??R?0??F????mg????i?r為飛機的位置矢量。

角運動由合力矩引起。四旋翼飛行器所受力矩來源于兩個方面：1）旋翼升力作用于質心產生的力矩；2）旋翼旋轉產生的扭轉力矩。角運動方程如下式所示。其中，L為旋翼中心建立飛行器質心的距離，I為慣量矩陣。

???L(F2-F4)??p??p??p???q??I?q???=?I?qL(F-F)31????????????r???r????r???M1?M2?M3?M4???4.3控制回路設計

控制回路包括內外兩層。外回路由PositionControl模塊實現。輸入為位置誤差，輸出為期望的滾轉、俯仰和偏航角(?des(t)、?des(t)、?des(t))。內回路由AttitudeControl模塊實現，輸入為期望神態(tài)角，輸出為期望轉速。MotorDynamics模塊模擬電機特性，輸入為期望轉速(???、???、???)，輸出為力和力矩。RigidBodyDynamics是被控對象，模擬四旋翼飛行器的運動特性。

4

動態(tài)系統(tǒng)建模仿真試驗報告

圖3包含內外兩個控制回路的控制結構

（1）內回路：神態(tài)控制回路

對四旋翼飛行器，我們唯一可用的控制手段就是四個旋翼的轉速。因此，這里首先對轉速?產生的作用進行分析。假設我們希望旋翼1的轉速達到?1，那么它的效果可分解成以下幾個分量：

des?h：使飛行器保持懸停的轉速分量；

??F：除懸停所需之外，產生沿ZB軸的凈力；???：使飛行器負向偏轉的轉速分量；???：使飛行器正向偏航的轉速分量；

因此，可以將期望轉速寫成幾個分量的線性組合：

?1des??h???F????????

其它幾個旋翼也可進行類似分析，最終得到：

??1des??1?des????2??1??des???1?3??des1???4???010-1-10111???h???F?????-1?????1?????????-1????????在懸浮狀態(tài)下，四個旋翼共同的升力應抵消重力，因此：