基于模糊pid算法的小型四旋翼無人飛行器控制系統設計畢業設計論文(編輯修改稿)

　

【文章內容簡介】 絡控制和自適應控制等算法。 電子技術 四旋翼飛行器的控制算法，數據通信，姿態測量等過程都需要由電子元器件實現。傳感器的測量精度，微處理器的處理速度，對飛行器的控制效果有非常大的影響，因此對電子元器件也有很高的要求。希望微處理器的功能更強大，處理信號的速度更快；傳感器的可靠性，測量精度做出了一定的要求。由于電子技術的限制，使許多理論上可行的控制算法，不能在實際中落實，使四旋翼飛行器發展的步伐受到阻礙。因此電子技術的研究也是飛行器研究的重要組成部分。 動力與 能源問題 目前四旋翼飛行器的能源供應主要來源于機載鋰電池。采用鋰電池作為能源供給不能滿足飛行器工作時間的要求，限制了飛行器的應用范圍。有些科研人員將飛行器微型化，減小負載，雖然可以延長使用時間，但是并不能從根本上解決問題，反而導致了其它新的問題出現。因此尋找一個大容量的能源作為驅動力，是飛行器從實驗走向應用的必經之路。燃油驅動是保證四旋翼飛行器工作時間的一個很好的選擇。 本文主要內容 本文主要研究了四旋翼飛行器的控制系統。完成了四旋翼飛行器動力學模型的推導，采用模糊 PID 控制算法對系統進行 控制，并利用 Matlab 對控制算法進行仿真實驗。根據圓點博士小四軸飛行器提供的實物和控制平臺，設計了飛行器的控制系統；最后完成了軟件設計和調試。 第 1 章介紹了研究四旋翼飛行器的研究意義，國內外飛行器的研究現狀以及需要解決的難題。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統設計 7 第 2 章介紹了四旋翼飛行器的結構和飛行原理。首先介紹了四旋翼飛行器的組成及結構功能；接著分析四旋翼飛行器的運動原理，還對四旋翼飛行器的力學和動力學特性進行分析，推導其數學模型。 第 3 章介紹了四旋翼飛行器的控制算法，即模糊 PID 控制。本文利用 Matlab/simulink 對控制算法進行仿真。通過對仿真結果的分析，可知模糊 PID 控制能實現對四旋翼飛行器的控制，并且在響應時間、穩定性方面效果良好。 第 4 章主要完成了四旋翼飛行器的控制算法編寫，并在實物上進行飛行試驗，利用飛行試驗數據，進行不斷的調試，驗證了控制系統的性能。 第 5 章總結了自己所做的工作，并總結自己沒能完成的工作，和在對四旋翼飛行器的研究過程中的缺陷和不足，并規劃了下一步的工作。 本章小結 本章主要介紹了四旋翼飛行器的研究意義，及飛行器的發開制造歷史。調研了國內外的各個大學和研究 機構對四旋翼飛行器的研究狀況。分析了四旋翼飛行器發展過程中需要解決的問題。最后介紹了本文的寫作內容安排。 第 二 章 四旋翼飛行器的運動原理及數學模型 本章主要做的工作是對四旋翼飛行器進行簡單的介紹，分析四旋翼飛行器的運動原理，從運動學和空氣動力學的角度完成四旋翼飛行器的的數學建模。 四旋翼飛行器簡介 四旋翼飛行器，英文又名 Quadrotor 或 Fourrotor。它是一種具有四個螺旋槳的飛行器，通過改變四個螺旋槳的轉速、轉向來改變飛行器的運動狀態，如圖 21 所示。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統設計 8 圖 21 四旋翼飛行器的 外形圖 一個普通的四旋翼飛行器主要由螺旋槳、帶動螺旋槳轉動的電機、機架和飛行控制板組成。一些更加先進的四旋翼飛行器還可以 安裝 其他模塊，例如無線通信模塊、 GPS 模塊 、攝像設備 等，來實現更為復雜的其他功能。 四旋翼的機架呈“ X”字型對稱形狀，兩個橫梁互相垂直，材料是輕質合成金屬。在每個橫梁的頂點各有一個螺旋槳。位置相對的一組螺旋槳轉動方向相同，另外一組，轉動方向相反。無刷直流 電機安裝在螺旋槳下面，固定 在 機身桿上。機身中央是飛行器的核心部分區，安裝有：飛行控制板、電源和負載。飛行控制板由慣性單元和微處理器 組成。 四旋翼飛行器的運動原理 四旋翼飛行器在空中 的 飛行方向 和 飛行速度都是 由 飛行器的 傾斜角度 決定的，飛行器朝哪個方向傾斜 ， 飛行器就會向哪個方向飛行。通過調節 每 個螺旋槳的轉速，使得升力發生變化， 然后 使飛行器的受力改變，即可調節四旋翼飛行器的飛行姿態。四旋翼飛行器飛行運動有六個自由度，因此對應這六個自由度，四旋翼飛行器共有六個運動方式。分別是垂直升降運動、俯仰運動、滾轉運動、偏航運動、前后運動、側向運動。四旋翼飛行器飛行的姿態控制主要包括高度控制、俯仰角控制、橫滾角控制、偏航角控制。 四旋翼飛行器高度控制 首先將四旋翼飛行器看作質量處處均勻，形狀完全對稱的理想物體，螺旋槳產生的升力與其旋轉角速度的平方成正比，即 2?KF? 。如圖 22 所示，進行高度控制時：要保證四旋翼飛行器的四個螺旋槳轉速相同，當四個螺旋槳同時加速時，螺旋槳產生的升力變大，當四個螺旋槳產生的升力大于飛行器的重力時，四旋翼飛行器向上升高（見 a 圖）；當四個螺旋架同時減速時，螺旋獎產生的升力變小，當升力小于飛行器重力時，四旋冀飛行器在力的作用下，高 度下降（見 b 圖）；當四個螺旋槳產生的升力和與飛行器的重力相等時，飛行器保持懸停狀態。四個電機能否同步是四旋翼飛行器高度控制的關鍵。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統設計 9 圖 22 四旋翼飛行器高度控制 四旋翼飛行器俯仰角控制 俯仰運動是指四旋翼飛行器以 2 號和 4 號螺旋槳所在橫梁為軸，繞著此軸 進行 旋轉的運動， 如23 圖所示，俯仰角控制時，將 1 號和 3 號電機所在的坐標軸定義為 Y 軸， 2 號和 4 號電機所在的坐標軸定義為 X 軸，對俯仰角的控制就是控制 Y 軸繞 X 軸傾斜角。對俯仰角進行控制時 要 保持 2 號和4 號螺旋槳轉速不變， 3 號 電機 加速旋轉 ，即增 大 3 號螺旋槳的升力， 1 號 電機 減速 旋轉 ， 即減小 1號螺旋槳的升力， 這樣使得 3 號電機產生的力矩大于 1 號電機產生的力矩，這樣就會使得四旋翼飛行器沿著 2 號和 4 號螺旋槳所在橫梁旋轉，但應注意轉速增大和減小的幅度應該相同，這樣能保證扭矩總和不變，仍能和 2 號與 4 號螺旋槳產生的扭矩抵消 ，這樣 四旋翼飛行器 就會 前傾（見圖 23a） 。同理， 1 號 電機 加速旋轉冋時 3 號 電機 減速，則四旋翼飛行器后傾（見圖 23b） 。 1 號和 3 號螺旋獎轉速差越大，則四旋翼飛行器俯仰角越大。 圖 23 四旋翼飛行器的俯仰角控制 四旋翼飛行器橫滾 角控制 橫滾運動和俯仰運動的原理類似，俯仰運動是指四旋翼飛行器以 1 號和 3 號螺旋槳所在橫梁為軸，繞著此軸進行旋轉的運動， 如 24 圖所示， 橫滾 角控制時，將 1 號和 3 號電機所在的坐標軸定基于模糊 PID 算法的小型四旋翼無人飛行器控制系統設計 10 義為 Y 軸， 2 號和 4 號電機所在的坐標軸定義為 X 軸，對 橫滾 角的控制就是控制 X 軸繞 Y 軸傾斜角。對 橫滾 角進行控制時 要 保持 1 號和 3 號螺旋槳轉速不變， 2 號 電機 加速旋轉 ，即增大 2 號螺旋槳的升力， 4 號 電機 減速 旋轉 ， 即減小 4 號螺旋槳的升力， 這樣使得 2 號電機產生的力矩大于 4 號電機產生的力矩，這樣就會使得四旋翼飛行器沿著 1 號和 3 號螺旋槳所在橫梁旋轉， 但應注意轉速增大和減小的幅度應該相同，這樣能保證扭矩總和不變，仍能和 1 號與 3 號螺旋槳產生的扭矩抵消 ，這樣 四旋翼飛行器 就會左 傾（見圖 24a） 。 同理， 4 號 電機 加速旋轉 同 時 2 號 電機 減速，則四旋翼飛行器 右 傾（見圖 24b） 。 2 號和 4 號螺旋獎轉速差越大，則四旋翼飛行器俯仰角越大。 圖 24 四旋翼飛行器的俯仰角控制 四旋翼飛行器 偏航 角控制 偏航運動是指四旋翼飛行器繞著與四個螺旋 槳 所在平面垂直的軸旋轉的運動 ，如圖 25 所示，對偏航角控制時 ,2 號和 4 號電機同時加速，產生的升力與反扭矩增加， 1 號和 3 號 電機轉速變小，產生的升力和反扭矩減小，但是要保證增大和減小的幅度相等，這樣能夠保證四旋翼飛行器受到的升力總和不變，仍等于重力，從而不會產生垂直升降運動，二者升力一增一減，因此能保持總量上的升力不變，由于向左的反扭矩大于向右的反扭矩，四旋翼飛行器左旋（見 ,25a） 。同理， 1 號和 3號螺旋槳同時加速 ,2 號和 4 號螺旋槳轉速變小，則四旋翼飛行器右旋（見圖 25b） 。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統設計 11 圖 25 四旋翼飛行器的偏航角控制 四旋翼飛行器的數學模型 想要實現四旋翼飛行器平穩的飛行，就需要采用合適的控制方法。為了選擇適當的控 制方法，需要對四旋翼飛行器進行力學和動力學上的分析并建立相應的數學模型，以挑選合適的控制算法基于最后的數學模型。 四旋翼飛行器是一個非線性、多變量、欠驅動、高度耦合的系統。針對這種非線性系統，對整個系統進行動力學建模比較復雜，為了簡化模型，我們對四旋翼飛行器建模的假設條件為： （ 1） 機體坐標系的原點為飛行器的質心，并且與飛行器幾何中心重合； （ 2） 除了由于螺旋槳的旋轉而產生的氣流外，空氣流的速度為零； （ 3） 四旋翼飛行器機體與螺旋槳都是剛體結構，并且機體是幾何與質量對稱的； （ 3） 忽略機體所受的空氣阻力 ，不考慮地效效應的影響； （ 4） 螺旋槳產生的升力與螺旋槳轉速的平方成比，螺旋槳旋轉時產生的反扭矩與螺旋槳轉速的平方成正比。 坐標系建立 四旋翼飛行器對應于六個自由度有六種運動方式，不難發現，這六種運動方式可以大致分為兩類：一類是沿著軸進行的平行運動，簡稱平動，包括垂直運動、左右運動和側向運動三種；另一類是繞著某個軸進行的旋轉運動，簡稱轉動。為了能夠更好的分析這兩種運動方式，且為了方便建立數學模型，本文引入了兩種坐標系，即地面坐標系和機體坐標系。 地面坐標系即 Earth(OXYZ)，簡寫為 E(OXYZ)，該坐標系以地面上某一固定點為坐標原點， X軸、 Y 軸、 Z 軸兩兩垂直，且規定 Z 軸以豎直向上為正方向，坐標軸方向符合右手定則。 載體坐標系即 Supporter(OXYZ)，簡寫為 S(OXYZ)，該坐標系以四旋翼飛行器的重心為原點， 1號和 3 號螺旋槳所在的橫梁代表的軸為 Y 軸， 2 號和 4 號螺旋槳所在的橫梁代表的軸為 X 軸，規定由 4 號螺旋槳指向 2 號螺旋槳的方向為 X 軸的正方向，由 3 號螺旋槳指向 1 號螺旋槳的方向為 Y 軸的正方向， Z 軸以豎直向上為正方向。為了便于分析，在分析過程中，一般將四旋翼飛行器視為理想的剛體，其 質量分布處處均勾，所以飛行器的重心就是其中心，原點則在中心處。在初始狀態下，機體坐標系和地面坐標系的 3 個軸是對應著平行的。兩個坐標系的關系如圖 26 所示。 基于模糊 PID 算法的小型四旋翼無人飛行器控制系統設計 12 圖 26 地面坐標系與載體坐標系 在地面坐標系中對飛行器的位置和姿態進行定義，而四旋翼飛行器的自身的傳感器數據是在載體坐標系獲得的。這兩個坐標系之間的向量轉換需要通過旋轉矩陣實現，假設在地面坐標系 E 下，載體坐標系原點的坐標為 ? ?zyxE ?? ，傾角為 ? ??????E ,其中 ? 是俯仰角， ? 是橫滾角，? 是偏航角。定義在機體坐標系下的向量： ? ?BBBab zyxa ? （ ） 則 轉換到地面坐標系下為： ? ?EEEBE zyxaRa ?? *39。 （ ） 其中 R 為 旋 轉 矩 陣 ：?????????????????????????????????????????????c o sc o ss i nc o ss i ns i nc o sc o ss i ns i nc o sc o ss i ns i ns i nc o ss i ns i ns i nc o ss i nc o sc o ss i ns i ns i nc o sc o sc o sR （ ） 基于牛頓 歐拉公式的四旋翼飛行器動力學模型 對四旋翼飛行器構建動力學模型，需要考慮兩種運動：平移運動與旋轉運動，對這兩 種運動方式建模的理論依據是牛頓 歐拉方程： ????? ?? HM VmF ?? （ ） 其中 F 為四旋翼飛行器受到的外力和， m 為四旋翼飛行器質量， V 是四旋翼飛行器的飛行速度， M是四旋翼飛行器所受的力矩之和， H 是四旋翼飛行器相對于地面坐標系的相對動量矩。 VmF ?? 是基于模糊 PID 算法的小型四旋翼無人飛行器控制系統設計 13 牛頓第二定律構建的，針對四旋翼飛行器平移運動的平移方程， HM ?? 是歐拉方程，是描述剛體旋轉運動的旋轉方程。 圖 27 四旋翼飛行器受力分析 設螺旋槳的轉速為 1? ，由前面的假設條件（ 5），則旋翼產生的升力為 1?b ，其屮 b 為升力系數。則四旋翼飛行器在空中所受到