【正文】 其中 F 為四旋翼飛行器受到的外力和， m 為四旋翼飛行器質(zhì)量， V 是四旋翼飛行器的飛行速度， M是四旋翼飛行器所受的力矩之和， H 是四旋翼飛行器相對于地面坐標系的相對動量矩。這兩個坐標系之間的向量轉(zhuǎn)換需要通過旋轉(zhuǎn)矩陣實現(xiàn)，假設(shè)在地面坐標系 E 下，載體坐標系原點的坐標為 ? ?zyxE ?? ，傾角為 ? ??????E ,其中 ? 是俯仰角， ? 是橫滾角，? 是偏航角。兩個坐標系的關(guān)系如圖 26 所示。為了便于分析，在分析過程中，一般將四旋翼飛行器視為理想的剛體，其質(zhì)量分布處處均勾，所以飛行器的重心就是其中心，原點則在中心處。 地面坐標系即 Earth(OXYZ)，簡寫為 E(OXYZ)，該坐標系以地面上某一固定點為坐標原點， X軸、 Y 軸、 Z 軸兩兩垂直，且規(guī)定 Z 軸以豎直向上為正方向，坐標軸方向符合右手定則。 坐標系建立 四旋翼飛行器對應(yīng)于六個自由度有六種運動方式，不難發(fā)現(xiàn)，這六種運動方式可以大致分為兩類：一類是沿著軸進行的平行運動 ，簡稱平動，包括垂直運動、左右運動和側(cè)向運動三種；另一類是繞著某個軸進行的旋轉(zhuǎn)運動，簡稱轉(zhuǎn)動。 四旋翼飛行器是一個非線性、多變量、欠驅(qū)動、高度耦合的系統(tǒng)。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 11 圖 25 四旋翼飛行器的偏航角控制 四旋翼飛行器的數(shù)學(xué)模型 想要實現(xiàn)四旋翼飛行器平穩(wěn)的飛行，就需要采用合適的控制方法。 圖 24 四旋翼飛行器的俯仰角控制 四旋翼飛行器偏航角控制 偏航運動是指四旋翼飛行器繞著與四個螺旋槳所在平面垂直的軸旋轉(zhuǎn)的運動，如圖 25 所示，對偏航角控制時 ,2 號和 4 號電機同時加速，產(chǎn)生的升力與反扭矩增加， 1 號和 3 號電機轉(zhuǎn)速變小，產(chǎn)生的升力和反扭矩減小，但是要保證增大和減小的幅度相等，這樣能夠保證四旋翼飛行器受到的升力總和不變，仍等于重力，從而不會產(chǎn)生垂直升降運動，二者升力一增一減，因此能保持總量上的升力不變，由于向左的反扭矩大于向右的反扭矩，四旋翼飛行器左旋（見 ,25a）。同理， 4 號電機加速旋轉(zhuǎn)同時 2 號電機減速，則四旋翼飛行器右傾（見圖 24b）。 圖 23 四旋翼飛行器的俯仰角控制 四旋翼飛行器橫滾角控制 橫滾運動和俯仰運動的原理類似，俯仰運動是指四旋翼飛行器以 1 號和 3 號螺旋槳所在橫梁為軸，繞著此軸進行旋轉(zhuǎn)的運動，如 24 圖所示，橫滾角控制時，將 1 號和 3 號電機所在的坐標軸定基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 10 義為 Y 軸， 2 號和 4號電機所在的坐標軸定義為 X 軸，對橫滾角的控制就是控制 X軸繞 Y軸 傾斜角。同理， 1 號電機加速旋轉(zhuǎn)冋時 3 號電機減速，則四旋翼飛行器后傾（見圖 23b）。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 9 圖 22 四旋翼飛行器高度控制 四旋翼飛行器俯仰角控制 俯仰運動是指四旋翼飛行器以 2 號和 4 號螺旋槳所在橫梁 為軸，繞著此軸進行旋轉(zhuǎn)的運動，如23 圖所示，俯仰角控制時，將 1號和 3 號電機所在的坐標軸定義為 Y軸， 2號和 4 號電機所在的坐標軸定義為 X軸，對俯仰角的控制就是控制 Y軸繞 X軸傾斜角。如圖 22 所示，進行高度控制時：要保證四 旋翼飛行器的四個螺旋槳轉(zhuǎn)速相同，當四個螺旋槳同時加速時，螺旋槳產(chǎn)生的升力變大，當四個螺旋槳產(chǎn)生的升力大于飛行器的重力時，四旋翼飛行器向上升高（見 a 圖）；當四個螺旋架同時減速時，螺旋獎產(chǎn)生的升力變小，當升力小于飛行器重力時，四旋冀飛行器在力的作用下，高度下降（見 b 圖）；當四個螺旋槳產(chǎn)生的升力和與飛行器的重力相等時，飛行器保持懸停狀態(tài)。四旋翼飛行器飛行的姿態(tài)控制主要包括高度控制、俯仰角控制、橫滾角控制、偏航角控制。四旋翼飛行器飛行運動有六個自由度，因此對應(yīng)這六個自由度，四旋翼飛行器共有六個運動方式。 四旋翼飛行器的運動原理 四旋翼飛行器在空中的飛行方向和飛行速度都是由飛行器的傾斜角度決定的，飛行器朝哪個方向傾斜，飛行器就會向哪個方向飛行。機身中央是飛行器的核心部分區(qū)，安裝有：飛行控制板、電源和負載。位置相對的一組螺旋槳轉(zhuǎn)動方向相同，另外一組，轉(zhuǎn)動方向相反。 四旋翼的機架呈“ X”字型對稱形狀，兩個橫梁互相垂直 ，材料是輕質(zhì)合成金屬。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 8 圖 21 四旋翼飛行器的外形圖 一個普通的四旋翼飛行器主要由螺旋槳、帶動螺旋槳轉(zhuǎn)動的電機、機架和飛行控制板組成。 四旋翼飛行器簡介 四旋翼飛行器，英文又名 Quadrotor 或 Fourrotor。最后介紹了本文的寫作內(nèi)容安排。調(diào)研了國內(nèi)外的各個大學(xué)和研究機構(gòu)對四旋翼飛行器的研究狀況。 第 5 章總結(jié)了自己所做的工作，并總結(jié)自己沒能完成的工作，和在對四旋翼飛行器的研究過程中的缺陷和不足，并規(guī)劃了下一步的工作。通過對仿真結(jié)果的分析，可知模糊 PID 控制能實現(xiàn)對四旋翼飛行器的控制，并且在響應(yīng)時間、穩(wěn)定性方面效果良好。 第 3 章介紹了四旋翼飛行器的控制算法，即模糊 PID 控制。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 7 第 2 章介紹了四旋 翼飛行器的結(jié)構(gòu)和飛行原理。根據(jù)圓點博士小四軸飛行器提供的實物和控制平臺，設(shè)計了飛行器的控制系統(tǒng)；最后完成了軟件設(shè)計和調(diào)試。 本文主要內(nèi)容 本文主要研究了四旋翼飛行器的控制系統(tǒng)。因此尋找 一個大容量的能源作為驅(qū)動力，是飛行器從實驗走向應(yīng)用的必經(jīng)之路。采用鋰電池作為能源供給不能滿足飛行器工作時間的要求，限制了飛行器的應(yīng)用范圍。因此電子技術(shù)的研究也是飛行器研究的重要組成部分。希望微 處理器的功能更強大，處理信號的速度更快；傳感器的可靠性，測量精度做出了一定的要求。 電子技術(shù) 四旋翼飛行器的控制算法，數(shù)據(jù)通信，姿態(tài)測量等過程都需要由電子元器件實現(xiàn)。選擇控制算法要注意難易程度及控制算法實現(xiàn)的效果。一些算法較易，但是控制效果較差，一些控制算法控制效果好，但是不易實現(xiàn)。因此飛行器控制系統(tǒng)的設(shè)計變得非常困難?；趯嶒炂脚_的電子元器件精度的影響。在飛行中，控制器的性能會遇到各種各樣的干擾因素。因此，建立飛行器準確的數(shù)學(xué)模型對控制工作特別重要。四旋翼飛行器是具有四個輸入六個輸出下的欠驅(qū)動系統(tǒng)（獨立控制變量的數(shù)量小于系統(tǒng)自由度數(shù)量的一類非線性系統(tǒng)）。下面，本文簡單介紹四旋翼飛行器的的幾個關(guān)鍵技術(shù)。 四旋翼飛行器的關(guān)鍵技術(shù) 從目前的研究狀況分析，四旋翼飛行器正朝著智能化和小型化的方向發(fā)展。 提出了很多飛行器的控制算法，并且應(yīng)用到自主研制的飛行器中。該項目設(shè)計了一個微型四旋翼飛行器，如圖 ，Mesicopter 是一 個 機身尺寸僅為 1616mm 的飛行器， 它有四個螺旋槳， 使用 四個 直徑約 3mm 的電機驅(qū)動，每個螺旋槳直徑為 ，厚度僅為 。 如圖 所示。 使用高性能鋰電池供電，且 功耗很低 ，具有較長的 續(xù)航 時間。這個飛行器 機體和云臺完全 采用 碳纖維材料制造，擁有更輕的重量和更高的強度。 如圖 所示。如圖 所示。 圖 DargnflyerX4 四旋翼飛行器 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統(tǒng)設(shè)計 3 圖 四旋翼飛行器 在小型和微型四旋翼飛行器領(lǐng)域，許多相關(guān)的科研項目 在 許多高校和科研機構(gòu)已經(jīng)開展，主要包括四旋翼飛行器 的 系統(tǒng)建模和控制策略的研究以及基于四旋翼飛行器實現(xiàn)任務(wù)的功能。如圖 所示。還針對不同攝像設(shè)備設(shè)計了支架，是 航拍 界的不二選擇 。目前，世界上的各大科研機構(gòu)和高校對四旋翼飛行器的研究主要可分為以下三類： 遙控航模四旋翼飛行器 小型四旋翼飛行器 微型四旋翼飛行器 遙控航模四旋翼飛行器的研發(fā)具有標志性的是美國 Dargnflyer 公司研制的 Dargnflyer 系列四旋翼飛行器，如圖 所示。 在此后的一段時間里 ， 許多科學(xué)家 先后 設(shè)計制造了許多改進的四旋翼飛行器，但都由于不能良好的控制其穩(wěn)定飛行而曇花一現(xiàn)。駕駛員坐在機身 的 中央 來 控制發(fā)動機油門，而旋翼需要地面人員輔助控制實現(xiàn)穩(wěn)定。Breguet 兄弟制作出的這架飛機機身使用 鋼制的管子， 焊接 成對稱的十字交叉結(jié)構(gòu)作為支架， 在 十字形結(jié)構(gòu)的四個端點 位置 分別安裝了四對 ，四對螺旋槳由一臺發(fā)動機驅(qū)動。同時，由于四旋翼飛行器能夠在三維空間中運動，為機器人提供了良好的實現(xiàn)平臺，在路徑規(guī)劃、三維場景重構(gòu)等領(lǐng)域具有較高科研價值。四旋翼飛行器是一個多學(xué)科融合的綜合體，涉及動力、慣性、控制、檢測等學(xué)科。如航拍、考古、電力線檢測、資源勘探、大氣監(jiān)測、邊境巡邏、交通監(jiān)控、災(zāi)情監(jiān)視、反恐偵查、緝毒緝私等，具有良好的民用和軍事前景。其四個螺旋槳對稱分布，使得四旋翼飛行器的機動能力更強，靜態(tài)盤旋的穩(wěn)定性更好，也更容易實現(xiàn)機型 的微小型化。四旋翼飛行器的四只旋翼對稱分布，產(chǎn)生的反扭力矩相互抵消，因此不需要額外的反扭矩尾槳。它是一種電動的、能夠垂直起降的多旋翼式遙控自主飛行器，屬于非共軸式碟形飛行器。本論文主要研究小型四旋翼式無人機。海灣戰(zhàn)爭之后，由于無人機在戰(zhàn)爭中出色的表現(xiàn)，無人機的研發(fā)工作在世界各國都開始引起重視，先進的無人機可以攜帶各種探測、檢測設(shè)備，以執(zhí)行偵察與監(jiān)視任務(wù)，甚至可以裝備攻擊型武器執(zhí)行打擊任務(wù)。 課題背景及意義 無人飛行器（ Unmanned Aerial Vehicle,UAV)是指無需駕駛員在機體內(nèi)操作，通過無線電遙控或自身控制程序，利用空氣動力承載飛行并可回收重復(fù)使用的飛行器。這些結(jié)構(gòu)的改變，大大提高了飛行器的性能，并使飛行器的應(yīng)用范圍變得更加廣泛。在這之后，隨著科學(xué)技術(shù)的日新月異，人類對于飛行器的研制開發(fā)工作更是得到了飛速進步。萬戶雖然失敗了，但是他這大膽的舉動，極大的推動了人類對飛行的探索。萬戶的想法是，將火箭綁在椅子上提供推力，并且兩只手拉著風(fēng)箏，提供牽引力。為了實現(xiàn)這一夢想，很多人不懈的努力，為此，有的甚至用自己寶貴的生命付出代價。Fuzzy PID。 through the simulation and realtime control verify the effectiveness of the control scheme, and this control scheme under the collection to the data input and output。 root according to experimental data and repeated calculation, the establishment of system simulation equation of state。 關(guā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