基于PID算法的四旋翼姿態(tài)控制系統(tǒng)與研究
發(fā)布時間:2018-10-09 13:43
【摘要】:四旋翼飛行器是一個具有強耦合、不穩(wěn)定、非線性等特點的復雜控制對象,對其姿態(tài)控制的方法包括力學原理、傳感器通信、計算機處理以及無線通信等學科。本論文研究的工作重點在于傳感器的調試、動力學模型的建立及仿真,WIFI數據通道的建立及基于PID控制算法的設計。本文通過研究四旋翼飛行器結構特點、姿態(tài)解算方式及飛行控制技術,設計了以S3C2440的主控芯片為硬件開發(fā)平臺,在Linux環(huán)境下進行軟件開發(fā)。硬件平臺集成了MPU-6000及KS103為慣性測量單元的飛行姿態(tài)控制系統(tǒng)。軟件設計上以Linux系統(tǒng)作為運行平臺,在PC機上搭建交叉編譯環(huán)境并編寫應用層與控制算法層程序。在數據通道方面,以RS232及IIC協議實現了傳感器與主控芯片的數據解析并通過TCP下socket通信協議建立了與上位機的數據通道。通過加權法融合當前傳感器中加速度和陀螺儀的測量數據,估算出當前的運動姿態(tài)。將得出的姿態(tài)角度與穩(wěn)定姿態(tài)角做差值,并將該差值作為PID控制器的模糊輸入量,通過PID控制算法計算,得到當前角度快速向穩(wěn)態(tài)角度收斂對應的電機調節(jié)量,從而改變旋翼轉速以使得飛行器向平穩(wěn)姿態(tài)調整。本文對四旋翼飛行器自主飛行控制系統(tǒng)進行了整體方案設計并搭建出軟硬件平臺,并把重點放在了傳感器的調試與算法的設計。分別對俯仰角進行比例、積分和微分三種收斂算法進行說明,并設計出增量式PID軟件算法。論文最后對四旋翼俯仰軸姿態(tài)進行了建模仿真,測試結果表明本課所研究的關于四旋翼姿態(tài)角控制的PID算法是可行的,保證了四旋翼在起飛階段微小氣流擾動下姿態(tài)的穩(wěn)定性。
[Abstract]:Four-rotor aircraft is a complex control object with strong coupling, instability and nonlinearity. The methods of attitude control include mechanics principle, sensor communication, computer processing and wireless communication. The main work of this thesis is the debugging of sensor, the establishment of dynamic model, the establishment of simulation data channel of WiFi and the design of control algorithm based on PID. In this paper, the structure characteristics, attitude calculation method and flight control technology of four-rotor aircraft are studied, and a software development platform based on S3C2440 main control chip is designed under the Linux environment. The hardware platform integrates MPU-6000 and KS103 as the inertial measurement unit of the flight attitude control system. In the software design, the Linux system is used as the running platform, the cross-compiling environment is built on the PC computer, and the application layer and the control algorithm layer are programmed. In the aspect of data channel, the data analysis between sensor and master control chip is realized by RS232 and IIC protocol, and the data channel with host computer is established by socket communication protocol under TCP. The measurement data of acceleration and gyroscope in the current sensor are fused by weighted method, and the current motion attitude is estimated. The difference between the attitude angle obtained and the stable attitude angle is used as the fuzzy input of the PID controller. The motor regulation quantity corresponding to the fast convergence of the current angle to the steady state angle is obtained through the calculation of the PID control algorithm. Thus, the rotation speed of the rotor is changed to make the aircraft adjust to a steady attitude. In this paper, the overall scheme of autonomous flight control system of four-rotor aircraft is designed, and the hardware and software platform is built, and the emphasis is put on the sensor debugging and algorithm design. The three convergent algorithms of pitch angle such as proportion integral and differential are explained respectively and the incremental PID software algorithm is designed. Finally, the four rotor pitch axis attitude is modeled and simulated. The test results show that the PID algorithm for the attitude control of the four rotor is feasible, which ensures the stability of the four rotor attitude under the micro air disturbance in the takeoff stage.
【學位授予單位】:西安科技大學
【學位級別】:碩士
【學位授予年份】:2015
【分類號】:V249.1
本文編號:2259548
[Abstract]:Four-rotor aircraft is a complex control object with strong coupling, instability and nonlinearity. The methods of attitude control include mechanics principle, sensor communication, computer processing and wireless communication. The main work of this thesis is the debugging of sensor, the establishment of dynamic model, the establishment of simulation data channel of WiFi and the design of control algorithm based on PID. In this paper, the structure characteristics, attitude calculation method and flight control technology of four-rotor aircraft are studied, and a software development platform based on S3C2440 main control chip is designed under the Linux environment. The hardware platform integrates MPU-6000 and KS103 as the inertial measurement unit of the flight attitude control system. In the software design, the Linux system is used as the running platform, the cross-compiling environment is built on the PC computer, and the application layer and the control algorithm layer are programmed. In the aspect of data channel, the data analysis between sensor and master control chip is realized by RS232 and IIC protocol, and the data channel with host computer is established by socket communication protocol under TCP. The measurement data of acceleration and gyroscope in the current sensor are fused by weighted method, and the current motion attitude is estimated. The difference between the attitude angle obtained and the stable attitude angle is used as the fuzzy input of the PID controller. The motor regulation quantity corresponding to the fast convergence of the current angle to the steady state angle is obtained through the calculation of the PID control algorithm. Thus, the rotation speed of the rotor is changed to make the aircraft adjust to a steady attitude. In this paper, the overall scheme of autonomous flight control system of four-rotor aircraft is designed, and the hardware and software platform is built, and the emphasis is put on the sensor debugging and algorithm design. The three convergent algorithms of pitch angle such as proportion integral and differential are explained respectively and the incremental PID software algorithm is designed. Finally, the four rotor pitch axis attitude is modeled and simulated. The test results show that the PID algorithm for the attitude control of the four rotor is feasible, which ensures the stability of the four rotor attitude under the micro air disturbance in the takeoff stage.
【學位授予單位】:西安科技大學
【學位級別】:碩士
【學位授予年份】:2015
【分類號】:V249.1
【參考文獻】
相關期刊論文 前3條
1 谷永晟;楊建軍;朱宇虹;;四旋翼無人飛行器導航控制系統(tǒng)研究[J];遙測遙控;2012年03期
2 梁延德;程敏;何福本;李航;;基于互補濾波器的四旋翼飛行器姿態(tài)解算[J];傳感器與微系統(tǒng);2011年11期
3 高應杰;陳鼎新;李榮明;;小型四旋翼無人飛行器控制算法研究[J];計算機與現代化;2011年10期
相關博士學位論文 前1條
1 朱清華;自轉旋翼飛行器總體設計關鍵技術研究[D];南京航空航天大學;2007年
相關碩士學位論文 前2條
1 岳基隆;四旋翼無人機自適應控制方法研究[D];國防科學技術大學;2010年
2 姜印清;基于μC/OS-Ⅱ的小型無人機飛行控制系統(tǒng)軟件設計[D];南京航空航天大學;2009年
,本文編號:2259548
本文鏈接:http://sikaile.net/kejilunwen/hangkongsky/2259548.html