四軸航拍飛行器功能概述:
本設(shè)計(jì)是基于STM32F4的四軸航拍平臺。以STM32F407為控制核心,四軸飛行器為載體,輔以云臺的航拍系統(tǒng)。硬件上由飛控電路,電源管理,通信模塊,動(dòng)力系統(tǒng),機(jī)架,云臺伺服系統(tǒng)組成。算法上采用簡潔穩(wěn)定的四元數(shù)加互補(bǔ)濾波作為姿態(tài)解算算法,PID作為控制器,實(shí)現(xiàn)飛行,云臺增穩(wěn)等功能。具有靈活輕盈,延展性,適應(yīng)性強(qiáng)好等特點(diǎn)。
?
四軸航拍系統(tǒng)設(shè)計(jì)框圖:
?
航拍飛行器視頻演示:
?
系統(tǒng)硬件設(shè)計(jì)組成:
本設(shè)計(jì)采用?STM32F407 作為核心處理器,該處理器內(nèi)核架構(gòu)ARMCortex-M4,具有高性能、低成本、低功耗等特點(diǎn)。主控板包括傳感器MPU6050電路模塊、無線藍(lán)牙模塊、電機(jī)啟動(dòng)模塊,電源管理模塊等;遙控使用商品遙控及接收機(jī)。控制芯片捕獲接收機(jī)的PPM命令信號,傳感器與控制芯片之間采用IIC總線連接,MCU與電調(diào)之間用PWM傳遞控制信號。
?
四軸飛行器硬件清單:
器件 | ? ? ?型號 | 主要參數(shù) |
機(jī)架 | ? ? ?四軸650機(jī)架 | ? ?槳距650mm,碳纖維材料 |
電機(jī) | ? ? ?新西達(dá)2212 | ? ?1000KV |
螺旋槳 | ? ? ?1045 | ? ?直徑10英寸,槳葉角45° |
電子調(diào)速器 | ? ? ?好贏天行者20A | ? ?額定電流20A |
電池 | ? ? ?鋰聚合物電池 | ? ?11.1V,2200mah,30C |
MCU | ? ? ?STM32F407 | ? ?主頻168M |
陀螺儀 | ? ? ?MPU6050 | ? ?+-2000dps,16位分辨率 |
加速度計(jì) | ? ? ?MPU6050 | ? ?+-16g,13位分辨率 |
電源芯片 | ? ? ?LM2940,LM1117 | ? ?5V,3.3V |
遙控器 | ? ? ?Futaba | ? ?2.4M,6通道 |
舵機(jī) | ? ??Futaba3003 | ? ?標(biāo)準(zhǔn)舵機(jī) |
?
?
注:芯片的數(shù)據(jù)手冊等信息可以在集成電路查詢網(wǎng)站搜索 https://www.datasheet5.com/
芯片詢價(jià)和在線購買鏈接 https://www.bom2buy.com/
?
系統(tǒng)軟件設(shè)計(jì):
軟件設(shè)計(jì)上由控制核心STM32F4讀取傳感器信息,解算姿態(tài)角,以姿態(tài)角為被控制量融合遙控信息后,輸出到四個(gè)電機(jī)及兩個(gè)舵機(jī)以完成四軸飛行控制和云臺的穩(wěn)定補(bǔ)償。
軟件流程圖:
?
控制設(shè)計(jì)心得:
- 由于四軸飛行器獨(dú)特的機(jī)械結(jié)構(gòu),即結(jié)構(gòu)上的對稱設(shè)計(jì),使得四軸在俯仰角的控制欲橫滾角的控制上有這近乎相同的控制特性,且兩者相對獨(dú)立。四軸飛行器的俯仰,橫滾,偏航,升降可以通過四個(gè)輸入量來控制。通過設(shè)定一個(gè)期望角度,調(diào)整電機(jī)轉(zhuǎn)速,使得測得的姿態(tài)角穩(wěn)定在期望角。控制律的設(shè)計(jì)主要采用是閉環(huán)控制。以姿態(tài)角做為被控制量,采用經(jīng)典的PID控制算法。
- 四軸飛行器系統(tǒng)是一個(gè)時(shí)變且非線性的系統(tǒng),采用傳統(tǒng)PID算法的單一的反饋控制會使系統(tǒng)存在不同程度的超調(diào)和振蕩現(xiàn)象,無法得到理想的控制效果。本文將前饋控制引入到了四軸飛行器系統(tǒng)的控制中,有效地改善了系統(tǒng)的實(shí)時(shí)性,提高了系統(tǒng)的反應(yīng)速度;并且根據(jù)四軸飛行器系統(tǒng)的特點(diǎn),對數(shù)字PID算法進(jìn)行了改進(jìn),引入了微分先行環(huán)節(jié),改善了系統(tǒng)的動(dòng)態(tài)特性;使得控制器能夠更好地適應(yīng)四軸飛行器系統(tǒng)的實(shí)際情況。
?
飛行器實(shí)物展示:
?
飛行器試飛心得:
飛行試驗(yàn)是對控制系統(tǒng)的功能和技術(shù)指標(biāo)進(jìn)行驗(yàn)證的最終手段,也是衡量四軸設(shè)計(jì)是否成功的重要標(biāo)志。試飛前要確保系統(tǒng)各部分工作正常,穩(wěn)定。檢查各個(gè)接口連接是否正確,各部件安裝是否牢固,電池電量是否充足。打開電源前檢查遙控器油門是否在最低位置,起飛前先輕推油門確保電機(jī)工作正常。一切準(zhǔn)備就緒,即可進(jìn)行試飛。將四種飛行器放在水平地面上,開始啟動(dòng)姿態(tài)初始化程序,聽到電調(diào)提示音后,緩慢增加油門,螺旋槳轉(zhuǎn)速上升,將飛機(jī)拉離地面。由實(shí)際情況可看出當(dāng)姿態(tài)發(fā)生傾斜時(shí),姿態(tài)解算及PID控制能夠及時(shí)調(diào)整電機(jī)轉(zhuǎn)速,穩(wěn)定飛行姿態(tài)。
飛行器還能根據(jù)遙控指令的變化完成相應(yīng)的動(dòng)作。本此設(shè)計(jì)的四軸飛行器可實(shí)現(xiàn)垂直升降的要求,能保持姿態(tài)的穩(wěn)定,機(jī)體晃動(dòng)小,在微風(fēng)的干擾下能夠自動(dòng)調(diào)整姿態(tài),確保平穩(wěn)飛行,且系統(tǒng)響應(yīng)快,續(xù)航時(shí)間大概在8分鐘。因此本次的設(shè)計(jì)是有效的。
?
附件內(nèi)容包括: