【正文】 的 模 糊 量 NB PB PB PM PS PM PB PB NM PB PB PM PS PM PB PB NS PB PM PS ZO PS PM PB ZO PB PM PS ZO PS PM PB PS PB PM PS ZO PS PM PB PM PB PB PM PS PM PB PB PB PB PB PM PS PM PB PB 表 34 Kd? 的模糊規(guī)則表 一般二維模糊控制器的推理機使用的最廣泛的 Marndani 模型，根據(jù)該模型可以將專家規(guī)則寫成如下所示的判斷條件語句的形式，即： If E=Ai then if EC=Bj then U=Cij 系統(tǒng)總的模糊關系 R 可以由控制系統(tǒng)的模糊控制規(guī)則來確定，一般可以表示成下面的形式： ijiiji CBAR ??? ,? （ 32） R 的隸屬度函數(shù)具體可以表示為： )()()(),( , 1,1 zCyBxAzyxR ijjimjni ji ???? ???? ?? ?? （ 33） 式中， ZzYyXx ??? , 。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設計 22 三個姿態(tài)角對應著三個 PID 控制環(huán) ,因此就有三個控制量的輸出 ,然而四旋翼控制 器需要調整的控制量是四個無刷電機的轉速 ,實質上就是四路 PWM 波的占空比 ,因此這三個輸出的控制量與四路PWM 波的占空比存在一個線性關系 ,具體表達式如公式 38 所示。 (a) (b) (c) 圖 36 ,Kp Ki Kd? ? ? 的控制曲面圖 圖 36(a)為 Kp 的控制曲面圖，從圖中可以看出在正半軸和負半軸 Kp 都隨著 e,ec 的增大而增大。簡介和模 糊 PID 控制器的設計方法并根據(jù)第二章推導的數(shù)學模型，利用 Matlab/simulink 對四旋翼飛行器控制系統(tǒng)進行了建模和仿真。 時，系統(tǒng)達到穩(wěn)定狀態(tài)，并且曲線穩(wěn)定后沒有出現(xiàn)震蕩。 采用三角形隸屬度函 數(shù)，本文設計的模糊 PID 控制器中 e 的基本論域為 {3， 2， 1， 0， 1， 2，基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設計 23 3}， ec 的基本論域為 {3， 2， 1， 0， 1， 2， 3}， Kp 的基本論域 {， ， ， 0， ， ， }，Ki 的基本論域 {,0,}， Kd 的基本論域 {3， 2， 1， 0， 1， 2， 3}如下圖35 所示。 綜上所述，控制量的實際輸出 1U 可表示為： KUU?1 （ 37） 由上面的建立模糊 PID 控制器的流程可以得出該控制算法的流程圖，如圖 33 所示。當偏差比較小時，應該盡量減小靜差，提高控制精度，因此應該使 Kp 的取值盡量小，Ki 的取值盡量大，增強積分作用來減小偏差， Kd 的取值與偏差的變化率呈負相關，變化率較大時，Kd 取值應該較小，反之則相反。 圖 32 輸入輸出信號的隸屬度函數(shù)圖 隸屬度 模 糊 等級 論域 3 2 1 0 1 2 3 NB 1 0 0 0 0 0 0 NM 0 1 0 0 0 0 0 NS 0 0 1 0 0 0 0 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設計 18 ZO 0 0 0 1 0 0 0 PS 0 0 0 0 1 0 0 PM 0 0 0 0 0 1 0 PB 0 0 0 0 0 0 1 表 31 隸屬度函數(shù)表 由于 PID 控制器的 Kp、 Ki、 Kd 三個參數(shù)不僅與 ? Kp、 ? Ki、 ? Kd 有關，還與初始量000 KdKiKp 、 有關，模糊控制器主要是用來調整變量 ? Kp、 ? Ki、 ? Kd，初始量 000 KdKiKp 、還需要在實驗中不斷調試，以得到合適的參數(shù)，使控制效果達到最佳狀態(tài)，其具體調整原則如下： 首先對比例增益系數(shù) Kp 進行調節(jié)。模糊控制器利用姿態(tài)角的偏差及偏差變化率，根據(jù)模糊規(guī)則、推理機以及反模糊化機制計算出 ? Kp、? Ki、 ? Kd，然后與控制器的初始參數(shù)值做運算，得出實際的 Kp、 Ki、 Kd，供 PID 控制器使用。本文研究的四旋翼飛行器是一個非線性的參數(shù)實時變化的系統(tǒng)，因此選擇模糊 PID 控制方法對系統(tǒng)進行控制。 控制過程容易實現(xiàn)，控制方式靈活，應用領域廣泛是 PID 控制器控制過程具有的特點。語言變量的概念現(xiàn)在被稱為模糊集合的概念。 PID 控制器具有算法成熟、原理簡單、控制參數(shù)相互獨立、性能穩(wěn)定等優(yōu)點，但它需要應用于一個精確模型的系統(tǒng)中，當系統(tǒng)內部結構或者外部環(huán)境發(fā)生變化時，控制對象和模型就會發(fā)生改變，而 PID 控制的控制參數(shù)固定，抗擾動性和適應性差，難以控制非線性、不確定的復雜系統(tǒng)。 第三章 四旋翼飛行器姿態(tài)控制算法研究 由于 PID 控制器具有其獨特的優(yōu)勢，雖然對于非線性控制系統(tǒng)控制效果不是很好，但是人們對PID 控制器的研究并沒有停步。 圖 27 四旋翼飛行器受力分析 設螺旋槳的轉速為 1? ，由前面的假設條件（ 5），則旋翼產(chǎn)生的升力為 1?b ，其屮 b 為升力系數(shù)。為了便于分析，在分析過程中，一般將四旋翼飛行器視為理想的剛體，其質量分布處處均勾，所以飛行器的重心就是其中心，原點則在中心處。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設計 11 圖 25 四旋翼飛行器的偏航角控制 四旋翼飛行器的數(shù)學模型 想要實現(xiàn)四旋翼飛行器平穩(wěn)的飛行，就需要采用合適的控制方法。同理， 1 號電機加速旋轉冋時 3 號電機減速，則四旋翼飛行器后傾（見圖 23b）。四旋翼飛行器飛行運動有六個自由度，因此對應這六個自由度，四旋翼飛行器共有六個運動方式。 四旋翼的機架呈“ X”字型對稱形狀，兩個橫梁互相垂直，材料是輕質合成金屬。調研了國內外的各個大學和研究機構對四旋翼飛行器的研究狀況。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設計 7 第 2 章介紹了四旋翼飛行器的結構和飛行原理。采用鋰電池作為能源供給不能滿足飛行器工作時間的要求，限制了飛行器的應用范圍。選擇控制算法要注意難易程度及控制算法實現(xiàn)的效果。在飛行中，控制器的性能會遇到各種各樣的干擾因素。 四旋翼飛行器的關鍵技術 從目前的研究狀況分析，四旋翼飛行器正朝著智能化和小型化的方向發(fā)展。 使用高性能鋰電池供電，且 功耗很低 ，具有較長的 續(xù)航 時間。 圖 DargnflyerX4 四旋翼飛行器 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設計 3 圖 四旋翼飛行器 在小型和微型四旋翼飛行器領域，許多相關的科研項目 在 許多高校和科研機構已經(jīng)開展，主要包括四旋翼飛行器 的 系統(tǒng)建模和控制策略的研究以及基于四旋翼飛行器實現(xiàn)任務的功能。 在此后的一段時間里 ， 許多科學家 先后 設計制造了許多改進的四旋翼飛行器，但都由于不能良好的控制其穩(wěn)定飛行而曇花一現(xiàn)。四旋翼飛行器是一個多學科融合的綜合體，涉及動力、慣性、控制、檢測等學科。它是一種電動的、能夠垂直起降的多旋翼式遙控自主飛行器，屬于非共軸式碟形飛行器。這些結構的改 變，大大提高了飛行器的性能，并使飛行器的應用范圍變得更加廣泛。為了實現(xiàn)這一夢想，很多人不懈的努力，為此，有的甚至用 自己寶貴的生命付出代價。 關鍵詞： 四旋翼飛行器；模糊 PID；姿態(tài)控制 目錄 Ⅱ Abstract Quadrotor UAV is a four propeller driven, vertical takeoff and landing aircraft, this structure is widely used in micro mini unmanned aerial vehicle design and can be applied to multiple areas of aerial, archaeology, border patrol, antiterrorism investigation, has important military and civil UAV is a plicated characteristic of the plicated characteristics such as the less drive, the multi variable, the strong coupling, the nonlinear and the uncertainty, and the difficulty and the hot topic in the control field. Research status of the design of small quadrotor UAV were detailed and extensive research, summarized the main classification, research areas, key technology and application prospect of and according to Dr. dot quadrotor actual object, the modeling method and control scheme were preliminary study. First, for the dynamic characteristics of quadrotor UAV, dynamic model of quadrotor UAV is established according to the theorem of Euler and Newton39。四旋翼飛行器同時也具有欠驅動、多變量、強耦合、非線性和不確定等復雜特性，對其建模和控制是當今控制領域的難點和熱點話題。 under the MATLAB environment built the nonlinear model of the quadrotor UAV Select the attitude of the quadrotor angle as the control object, with the help of matlab fuzzy toolbox to design the fuzzy PID controller and according to experience of experts to edit the corresponding fuzzy rules。不幸的是，萬戶操作失誤，火箭中途爆炸，萬戶為此付出了生命。當無人飛行器第一次出現(xiàn)時是針對防空火炮部隊進行打靶的靶機。與常規(guī)布局的直升機相比，四旋翼飛行器的機械結構簡單，易于維護，成本較低。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設計 2 四旋翼飛行器的研究現(xiàn)狀 四旋翼飛行器的研究 工作 可以追溯到 20 世紀初，在 1907 年 ， 法國科學家 Charles Richet 的指導下， Breguet 兄弟 生產(chǎn) 出了第一架旋翼式直升機，命名為 BreguetRichet Gyroplane 旋翼機 1 號。該系列四旋翼飛行器主要使用碳纖維材料制作，通過壓電晶體陀螺儀作為姿態(tài)穩(wěn)定傳感器， 具有自動平衡及定點懸浮功能。 圖 賓夕法尼亞大學的四旋翼編隊 麻省理工學院設計了一款 能夠 在室內進行定位、地圖繪制和壁障的四旋翼無人機系統(tǒng)，該系統(tǒng)通過激光雷達對周圍環(huán)境進行測量， 可以 自動生成室內 的 三維地圖數(shù)據(jù)，并根據(jù)周圍環(huán)境進行自主壁障和路徑規(guī)劃，可以用于危險環(huán)境的初步探測以及人員的搜救。 圖 MD4200 四旋翼飛行器 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設計 5 在微型四旋翼飛行器 研究 領域中具有代表性的是斯坦福大學的 Mesicopter 項目， 該 項目 是在國家航空航天局 (nasa)的支持下，為研究微型旋翼飛行器技術而設計的，斯坦福大學研究小組 為四旋翼飛行器的研究提供了一種獨特的 思維方式 。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設計 6 數(shù) 學模型 研究四旋翼飛行器是以四旋翼飛行器的動力學數(shù)學模型為基礎的。 基于實驗飛行中的無法預知外界的干擾。傳感器的測量精度，微處理器的處理速度，對飛行器的控制效果有非常大的影響，因此對電子元器件也有很高的要求。燃油驅動是保證四旋翼飛行器工作時間的一個很好的選擇。本文利用 Matlab/simulink 對控制算法進行仿真。 第二章 四旋翼飛行器的運動原理及數(shù)學模型 本章主要做的工作是對四