四旋翼飛行器飛行控制系統(tǒng)研究與設(shè)計

劉巖 楊牧

摘 要：隨著社會科學(xué)技術(shù)的不斷發(fā)展，微控制器、傳感器及電力驅(qū)動技術(shù)的成熟，四旋翼飛行器已經(jīng)逐漸取代了傳統(tǒng)的螺旋翼直升機飛行器，由于四旋翼飛行器有十字架構(gòu)和四個螺旋翼，其屬于一個強耦合、非線性及欠驅(qū)動的六自由度系統(tǒng)，本文分析基于模糊控制的PID控制算法，以求持續(xù)提高四旋翼飛行器的控制效果。

關(guān)鍵詞：四旋翼飛行器；動力學(xué)模型；模糊控制；PID控制

DOI：10.16640/j.cnki.37-1222/t.2019.07.137

四旋翼飛行器由于其獨特的飛行方式使得其起飛和降落需要較少的空間，便于保持在較高的操縱性能飛行在障礙物密集的環(huán)境當(dāng)中，同時四旋翼飛行器可以保持穩(wěn)定的飛行姿態(tài)，因此在軍事和民用領(lǐng)域都有較好的應(yīng)用前景。四旋翼飛行器具有簡單的機械結(jié)構(gòu)，其主要由十字狀構(gòu)架和四個旋翼組成，在對四旋翼飛行器數(shù)學(xué)建模時其屬于強耦合、非線性及欠驅(qū)動六自由度系統(tǒng)，通過控制四個螺旋槳不同速度就可是實現(xiàn)不同的飛行姿態(tài)。對于非線性強耦合的系統(tǒng)的控制較為困難，因此要實現(xiàn)四旋翼飛行器從初始位置運行到既定位置并能保持當(dāng)前的運動狀態(tài)，就可以將非線性的四旋翼飛行器模型進行近似線性化的處理。在四旋翼飛行器控制過程中可以采用雙閉環(huán)結(jié)構(gòu)，將內(nèi)環(huán)角度環(huán)輸出作為外環(huán)速度環(huán)的控制輸入，從而實現(xiàn)對四旋翼飛行器運行姿態(tài)的控制。

1 四旋翼飛行器的控制原理

1.1 四旋翼飛行器的垂直飛行與俯仰飛行的控制原理

四旋翼飛行器在控制過程中通過調(diào)整電機轉(zhuǎn)動速度來改變合力實現(xiàn)飛行的多種姿態(tài)。在四旋翼飛行器垂直飛行過程中，首先需要處理好電機轉(zhuǎn)動過程中產(chǎn)生的反轉(zhuǎn)矩作用，在1號與3號電機逆時針運行的同時2號與4號電機順時針旋轉(zhuǎn)，當(dāng)兩者產(chǎn)生的合力能保持大小一致時，就會使他們產(chǎn)生的反扭矩互相完全抵消。當(dāng)各電機均產(chǎn)生向上拉力且拉力大于飛行器重力時就會使四旋翼飛行器上升，同時電機轉(zhuǎn)動速度增加會使拉力變大，當(dāng)拉力大于飛行器重力時就可以實現(xiàn)懸停狀態(tài)，為了保證四旋翼飛行器可以實現(xiàn)垂直飛行，就需要四個電機的轉(zhuǎn)動速度相同。當(dāng)四旋翼飛行器需要產(chǎn)生俯仰飛行時，可令2號和4號電機朝同一個方向旋轉(zhuǎn)并保持相同的旋轉(zhuǎn)速度，1號電機運行速度增加，3號電機運行速度降低，則會使四旋翼飛行器向X軸方向產(chǎn)生俯仰并進入不平衡狀態(tài)。

1.2 四旋翼飛行器的橫滾飛行、偏航飛行與前后飛行的控制原理

四旋翼飛行器的橫滾飛行與俯仰飛行的控制原理相似，令1號和3號電機轉(zhuǎn)速恒定，使2號電機轉(zhuǎn)速增大的同時改變4號電機轉(zhuǎn)速，就會使四旋翼飛行器左右兩側(cè)升力產(chǎn)生差異進而飛行器繞X軸旋轉(zhuǎn)實現(xiàn)橫滾運動。四旋翼飛行器需要進行前后運動時，2號與4號電機轉(zhuǎn)速不變，增大1號電機轉(zhuǎn)速的同時減少3號電機，此時飛行器的前側(cè)升力大于后側(cè)升力，會與Z軸正方向呈現(xiàn)銳角即有正的俯仰角，四旋翼飛行器產(chǎn)生一個向后的運動。在四旋翼飛行器前后運動時相同轉(zhuǎn)向的一組電機轉(zhuǎn)速增加，另一組電機轉(zhuǎn)速減小，此時會時飛行器產(chǎn)生偏航角，并且偏航方向與轉(zhuǎn)速增大的一組電機方向相反。

2 四旋翼飛行器的動力學(xué)建模

建立準(zhǔn)確的四旋翼飛行器動力學(xué)模型對于研究合適的控制算法并提高控制精度有重要作用，在進行四旋翼飛行器數(shù)學(xué)建模時需要先對飛行條件進行理想化假設(shè)，并建立系統(tǒng)的參考坐標(biāo)系，再對四旋翼飛行器進行受力分析和力矩分析。假設(shè)四旋翼飛行器在低空空域飛行，且飛行速度小于40km/h，飛行范圍不超過10km，則可視四旋翼飛行器的維度和飛行高度保持恒定。空間中的四旋翼飛行器有俯仰、滾動、偏航、垂直、橫向及縱向六種運行狀態(tài)，因此根據(jù)機體運行規(guī)律建立六自由度動力學(xué)模型，其不僅要確認(rèn)機體每刻的空間位置，還需要描述機體的機械運動狀態(tài)，根據(jù)兩種相對變化建立兩種不同參考坐標(biāo)系，再通過轉(zhuǎn)換矩陣將四旋翼飛行器質(zhì)心運動規(guī)律統(tǒng)一到一個參考坐標(biāo)系中。四旋翼飛行器的運動較為復(fù)雜，在進行受力分析過程中需要將這些運動簡化為簡單直線運動，將機體運動看作是俯仰運動、滾轉(zhuǎn)運動及偏航運動的按照平行四邊形法則的合運動，在進行力矩分析過程中由于四旋翼飛行器屬于“+”型對稱結(jié)構(gòu)，當(dāng)俯仰角或橫滾角發(fā)生改變時，會產(chǎn)生一機體質(zhì)心為中心的并且垂直于機體平面的力矩即為機體的旋翼臂，進而可以求出機體的俯仰力矩式和滾轉(zhuǎn)力矩式。

3 四旋翼飛行器的姿態(tài)控制算法研究

對于四旋翼飛行器姿態(tài)控制算法最為常用的就是PID控制，其在處理線性系統(tǒng)的控制具有穩(wěn)定性強、可靠性高及設(shè)計簡單的優(yōu)點，但由于四旋翼飛行器屬于非線性系統(tǒng)因此不能直接使用PID算法。基于PID算法設(shè)計基于模糊控制的PID算法可以根據(jù)系統(tǒng)狀態(tài)的不間斷特性實現(xiàn)對控制參數(shù)的實時優(yōu)化，從而滿足對四旋翼飛行的姿態(tài)控制。PID算法主要包括比例、積分及微分三個部分，其中比例部分直接決定機體控制力的大小，當(dāng)比例部分越大時系統(tǒng)的超調(diào)量越大，則系統(tǒng)的振蕩幅度越大，系統(tǒng)動態(tài)性能越差，調(diào)整系統(tǒng)狀態(tài)的調(diào)節(jié)時間就越小。積分部分可以消除系統(tǒng)的控制偏差，積分作用可以累積控制偏差。微分部分可以影響控制系統(tǒng)的動態(tài)性能，設(shè)定合適的微分參數(shù)值，可以有效減少系統(tǒng)的超調(diào)量并提高系統(tǒng)姿態(tài)運行的穩(wěn)定性。

4 結(jié)束語

四旋翼飛行器具有體積小、隱蔽性強、功耗低、機械機構(gòu)簡單及容錯能力強的特點，因此在民用及軍用領(lǐng)域均有廣泛的應(yīng)用，但同時四旋翼飛行器模型具有非線性、強耦合和欠驅(qū)動的特點，因此控制四旋翼飛行器的姿態(tài)狀態(tài)具有一定難度，本文中設(shè)計基于模糊PID控制策略實現(xiàn)對四旋翼飛行器的有效控制。

參考文獻(xiàn)：

[1]國倩倩.微型四旋翼飛行器控制系統(tǒng)設(shè)計及控制方法研究[D].長春：吉林大學(xué)，2013.

[2]張鐳，李浩.四旋翼飛行器模糊自整定PID姿態(tài)控制[J].計算機仿真，2014，31（08）：73-77.

[3]胡錦添.基于PID神經(jīng)網(wǎng)絡(luò)的四旋翼飛行器控制系統(tǒng)研究[D].廣州：廣州大學(xué)，2013.