【正文】 ........................................ 15 模糊 PID 控制原理 ......................................................................................................................... 15 姿態(tài)穩(wěn)定回路的模糊 PID 控制器設(shè)計 ........................................................................................ 16 構(gòu)建模糊 PID 控制器步驟 ................................................................................................. 17 基于 Matlab 的姿態(tài)角控制算法的仿真 ............................................................................ 22 本章小結(jié) ........................................................................................................................................ 25 第四章 四旋翼飛行器飛行控制系統(tǒng)軟件設(shè)計 .................................................................... 25 模糊 PID 控制算法流程圖 ............................................................................................................ 25 系統(tǒng)實驗及結(jié)果分析 ..................................................................................................................... 26 本章小結(jié) ........................................................................................................................................ 27 第五章 總結(jié)與展望 ................................................................................................................ 28 總結(jié) ................................................................................................................................................ 28 展望 ................................................................................................................................................ 28 參考文獻 .................................................................................................................................. 28 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 1 第一章 概述 有史以來，人類一直有一個夢想，那就是可以像藍天上自由翱翔的鳥兒一樣。為了實現(xiàn)這一夢想，很多人不懈的努力，為此，有的甚至用 自己寶貴的生命付出代價。據(jù)史料記載，歷史上第一個嘗試飛天的人，是我國明朝時期一位名叫萬戶的士大夫。萬戶的想法是，將火箭綁在椅子上提供推力，并且兩只手拉著風(fēng)箏，提供牽引力。不幸的是，萬戶操作失誤，火箭中途爆炸，萬戶為此付出了生命。萬戶雖然失敗了，但是他這大膽的舉動，極大的推動了人類對飛行的探索。 人類真正將飛天夢想變?yōu)楝F(xiàn)實是在 1904 年：美國的萊特兄弟發(fā)明了飛機。在這之后，隨著科學(xué)技術(shù)的日新月異，人類對于飛行器的研制開發(fā)工作更是得到了飛速進步。由之前的飛行員駕駛發(fā)展為無人駕駛，固定翼發(fā)展為旋翼式。這些結(jié)構(gòu)的改 變，大大提高了飛行器的性能，并使飛行器的應(yīng)用范圍變得更加廣泛。四旋翼飛行器作為無人機的一種，因其優(yōu)良的性能和廣泛的適用性，漸漸成為近幾年的熱門。 課題背景及意義 無人飛行器（ Unmanned Aerial Vehicle,UAV)是指無需駕駛員在機體內(nèi)操作，通過無線電遙控或自身控制程序，利用空氣動力承載飛行并可回收重復(fù)使用的飛行器。當(dāng)無人飛行器第一次出現(xiàn)時是針對防空火炮部隊進行打靶的靶機。海灣戰(zhàn)爭之后，由于無人機在戰(zhàn)爭中出色的表現(xiàn)，無人機的研發(fā)工作在世界各國都開始引起重視，先進的無人機可以攜帶 各種探測、檢測設(shè)備，以執(zhí)行偵察與監(jiān)視任務(wù)，甚至可以裝備攻擊型武器執(zhí)行打擊任務(wù)。 無人飛行器按旋翼形式分為兩種是固定翼和旋翼式，旋翼式無人機存在多方面的優(yōu)勢和固定翼無人機相比。本論文主要研究小型四旋翼式無人機。小型四旋翼無人飛行器是一種結(jié)構(gòu)簡單可靠的飛行器。它是一種電動的、能夠垂直起降的多旋翼式遙控自主飛行器，屬于非共軸式碟形飛行器。與固定翼飛行器相比，四旋翼飛行器在飛行過程中通過改變四個螺旋槳的轉(zhuǎn)速和轉(zhuǎn)向來改變飛行器的姿態(tài)，而不需要調(diào)整螺旋槳傾角，因此結(jié)構(gòu)緊湊，操控簡單。四旋翼飛行器的四只旋翼對稱分布，產(chǎn)生的反扭力矩相互抵消，因此不需要額外的反扭矩尾槳。與常規(guī)布局的直升機相比，四旋翼飛行器的機械結(jié)構(gòu)簡單，易于維護，成本較低。其四個螺旋槳對稱分布，使得四旋翼飛行器的機動能力更強，靜態(tài)盤旋的穩(wěn)定性更好，也更容易實現(xiàn)機型的微小型化。這些優(yōu)點決定了四旋翼無人飛行器可以用于執(zhí)行某些特殊任務(wù)。如航拍、考古、電力線檢測、資源勘探、大氣監(jiān)測、邊境巡邏、交通監(jiān)控、災(zāi)情監(jiān)視、反恐偵查、緝毒緝私等，具有良好的民用和軍事前景。 四旋翼飛行器是一個多輸入多輸出的非線性控制系統(tǒng)，由于不同于傳統(tǒng)的飛行器結(jié)構(gòu)，因此系統(tǒng)建模也相對復(fù)雜，由 于結(jié)構(gòu)的特殊性其對控制算法的要求也相對較高。四旋翼飛行器是一個多學(xué)科融合的綜合體，涉及動力、慣性、控制、檢測等學(xué)科。近幾年來，隨著材料學(xué)、微機電系統(tǒng)、高性能微型傳感器及飛行控制理論的不斷發(fā)展，四旋翼飛行器獲得了日新月異的進展，并且展現(xiàn)出了巨大的商業(yè)潛力。同時，由于四旋翼飛行器能夠在三維空間中運動，為機器人提供了良好的實現(xiàn)平臺，在路徑規(guī)劃、三維場景重構(gòu)等領(lǐng)域具有較高科研價值。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 2 四旋翼飛行器的研究現(xiàn)狀 四旋翼飛行器的研究 工作 可以追溯到 20 世紀(jì)初，在 1907 年 ， 法國科學(xué)家 Charles Richet 的指導(dǎo)下， Breguet 兄弟 生產(chǎn) 出了第一架旋翼式直升機，命名為 BreguetRichet Gyroplane 旋翼機 1 號。Breguet 兄弟制作出的這架飛機機身使用 鋼制的管子， 焊接 成對稱的十字交叉結(jié)構(gòu)作為支架， 在十字形結(jié)構(gòu)的四個端點 位置 分別安裝了四對 米長的正反旋轉(zhuǎn)螺旋槳，四對螺旋槳由一臺發(fā)動機驅(qū)動。螺旋槳采用共軸反旋式結(jié)構(gòu)， 從而很好的 相互抵消反扭矩。駕駛員坐在機身 的 中央 來 控制發(fā)動機油門，而旋翼需要地面人員輔助控制實現(xiàn)穩(wěn)定。旋翼機 1 號進行 了 多次的飛行試驗，而最終實驗結(jié)果卻并不理想，但是這種同時使用正 反旋翼的設(shè)計思想為后來飛行器的設(shè)計提供了新的設(shè)計思路，也為現(xiàn)代四旋翼飛行器的發(fā)展提供了基本雛形。 在此后的一段時間里 ， 許多科學(xué)家 先后 設(shè)計制造了許多改進的四旋翼飛行器，但都由于不能良好的控制其穩(wěn)定飛行而曇花一現(xiàn)。在 之后的很長 一段時間里，四旋翼飛行器 沒有做出顯著的進步 到了二十一世紀(jì)，隨著科學(xué)技術(shù)的不斷發(fā)展以及各種新型控制器、傳感器的出現(xiàn)， 四旋翼飛行器的研究再次進入人們的視野。目前，世界上的各大科研機構(gòu)和高校對四旋翼飛行器的研究主要可分為以下三類： 遙控航模四旋翼飛行器 小型四旋翼飛行器 微型 四旋翼飛行器 遙控航模四旋翼飛行器的研發(fā)具有標(biāo)志性的是美國 Dargnflyer 公司研制的 Dargnflyer 系列四旋翼飛行器，如圖 所示。該系列四旋翼飛行器主要使用碳纖維材料制作，通過壓電晶體陀螺儀作為姿態(tài)穩(wěn)定傳感器， 具有自動平衡及定點懸浮功能。還針對不同攝像設(shè)備設(shè)計了支架，是 航拍 界的不二選擇 。另外 Parrot 公司制作的 飛行器也是另一款非常 具 有代表性 的 遙控四旋翼飛行器。如圖 所示。 可 借助機載 wifi 系統(tǒng)，通過 iPhone、 iPod touch 或 iPad 遠(yuǎn)程控 制，使用 MEMS 加速度計 （微機電系統(tǒng)） 、陀螺儀傳感器和超聲波測距傳感器，并配備多個傳感器，多個捕獲器、廣角攝像頭、高速攝像頭和機載控制器相結(jié)合，使 可以簡單輕松地 進行飛行操縱。 圖 DargnflyerX4 四旋翼飛行器 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 3 圖 四旋翼飛行器 在小型和微型四旋翼飛行器領(lǐng)域，許多相關(guān)的科研項目 在 許多高校和科研機構(gòu)已經(jīng)開展，主要包括四旋翼飛行器 的 系統(tǒng)建模和控制策略的研究以及基于四旋翼飛行器實現(xiàn)任務(wù)的功能。美國賓夕法尼亞大學(xué) GRASP 實驗室設(shè)計了一種 可以 在室內(nèi)進行編 隊飛行的四旋翼無人飛行器， 在 這些飛行器上都安裝有光源，通過安裝在室內(nèi)的一組攝像頭進行拍攝，確定飛行器的位置并對其進行編隊控制 。如圖 所示。 圖 賓夕法尼亞大學(xué)的四旋翼編隊 麻省理工學(xué)院設(shè)計了一款 能夠 在室內(nèi)進行定位、地圖繪制和壁障的四旋翼無人機系統(tǒng)，該系統(tǒng)通過激光雷達對周圍環(huán)境進行測量， 可以 自動生成室內(nèi) 的 三維地圖數(shù)據(jù)，并根據(jù)周圍環(huán)境進行自主壁障和路徑規(guī)劃，可以用于危險環(huán)境的初步探測以及人員的搜救。 如圖 所示。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 4 圖 麻省理工大學(xué)的四旋翼飛行器 德國在四旋翼飛行器的研究 成果 也具 全球領(lǐng)先 的水平 ，德國的 MICRODRONES 公司推出了一款四旋翼飛行器 MD4200。這個飛行器 機體和云臺完全 采用 碳纖維材料制造，擁有更輕的重量和更高的強度。 使用獨特的盤式直流無刷 直驅(qū) 電機，具有非常高的工作效率 和非常小的噪音。 使用高性能鋰電池供電，且 功耗很低 ，具有較長的 續(xù)航 時間。飛行器安裝有 GPS 定位系統(tǒng)和攝像設(shè)備，能夠在室內(nèi)和室外執(zhí)行 自動駕駛、 航拍和定點觀測 等 任務(wù)。 如圖 所示。 圖 MD4200 四旋翼飛行器 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 5 在微型四旋翼飛行器 研究 領(lǐng)域中具有代表性的是斯坦福大學(xué)的 Mesicopter 項目， 該 項目 是在國家航空航天局 (nasa)的支持下，為研究微型旋翼飛行器技術(shù)而設(shè)計的，斯坦福大學(xué)研究小組 為四旋翼飛行器的研究提供了一種獨特的 思維方式 。該項目設(shè)計了一個微型四旋翼飛行器，如圖 所示，Mesicopter 是一個 機身尺寸僅為 1616mm 的飛行器， 它有四個螺旋槳， 使用 四個 直徑約 3mm 的電機驅(qū)動，每個螺旋槳直徑為 ，厚度僅為 。 圖 Mesicopter 的微型四旋翼飛行器 目前， 我國 對于四旋翼飛行器的研究還處于 初級 階段，國防科技大學(xué) ， 上海交通大學(xué)，南京航空航天大學(xué)，哈爾濱 工業(yè)大學(xué) ， 天津大學(xué)，中南大學(xué) ，北京航空航天大學(xué) 等幾所院校已經(jīng) 開始進行相關(guān)領(lǐng)域 的 研究工作，并且取得了一定成果。 提出了很多飛行器的控制算法，并且應(yīng)用到自主研制的飛行器中。同時，對于硬件系統(tǒng)的研究，對捷聯(lián)慣導(dǎo)系統(tǒng)的設(shè)計研究也取得了不錯的成績。 四旋翼飛行器的關(guān)鍵技術(shù) 從目前的研究狀況分析，四旋翼飛行器正朝著智能化和小型化的方向發(fā)展。雖然四旋翼飛行器的技術(shù)逐漸走向成熟，但要想要讓四旋翼飛行器從實驗室走到實際生活中，仍有一些技術(shù)難題需要解決。下面，本文簡單介紹四旋翼飛行器的的幾個關(guān)鍵技術(shù)。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 6 數(shù) 學(xué)模型 研究四旋翼飛行器是以四旋翼飛行器的動力學(xué)數(shù)學(xué)模型為基礎(chǔ)的。四旋翼飛行器是具有四個輸入六個輸出下的欠驅(qū)動系統(tǒng)（獨立控制變量的數(shù)量小于系統(tǒng)自由度數(shù)量的一類非線性系統(tǒng)）。由于飛行器系統(tǒng)的高度非線性，多目標(biāo)控制和控制量是有限的，且易受到自身原因和外界干擾等，這是難以建立準(zhǔn)確和可靠的數(shù)學(xué)模型的。因此，建立飛行器準(zhǔn)確的數(shù)學(xué)模型對控制工作特別重要。 控制算法 四旋翼飛行器的強耦合、不穩(wěn)定的動力特性是姿態(tài)控制方面困擾無數(shù)研究人員的難題。在飛行中，控制