【正文】 航控制算法，它需要外接 OV7725 攝像頭模塊； STM32 飛控器完成飛行控制算法，需要外接超聲波測(cè)距模塊和電機(jī)驅(qū)動(dòng)模塊，系統(tǒng)總體 工作 框圖如圖 41 所示。 電 機(jī) 模 塊新 西 達(dá) 電 機(jī)A 2 2 1 2 / 1 3 T電 機(jī) 模 塊新 西 達(dá) 電 機(jī)A 2 2 1 2 / 1 3 T電 機(jī) 驅(qū) 動(dòng) 模 塊無(wú) 刷 電 機(jī) 電 子調(diào) 速 器電 機(jī) 驅(qū) 動(dòng) 模 塊無(wú) 刷 電 機(jī) 電 子調(diào) 速 器2 2 0 0 毫 安 動(dòng) 力鋰 電 池2 2 0 0 毫 安 動(dòng) 力鋰 電 池S T M 3 2 飛 行控 制 模 塊S T M 3 2 飛 行控 制 模 塊 H C S R 0 4超 聲 波 測(cè) 距 模塊 H C S R 0 4超 聲 波 測(cè) 距 模塊F r e e s c a l e K i n i t e s 6 0 處 理 器 的 最 小 系 統(tǒng) 板F r e e s c a l e K i n i t e s 6 0 處 理 器 的 最 小 系 統(tǒng) 板循 跡 模 塊 C M O S 攝 像 頭 循 跡A S M 1 1 1 7 3 . 3 圖 41 系統(tǒng)總體框圖 4. 2 電機(jī)驅(qū)動(dòng) 模塊 電機(jī)驅(qū)動(dòng)模塊主要由 STM32 飛行控制模塊產(chǎn)生 PWM 波來(lái)控制，通過(guò)調(diào)節(jié)占空比的方式來(lái)控制無(wú)刷電機(jī)的轉(zhuǎn)速， 電機(jī)驅(qū)動(dòng)子系統(tǒng)框圖 如圖 42 所示 。 圖 42 電機(jī)驅(qū)動(dòng)子系統(tǒng)框圖 P W MP W M電 調(diào)電 調(diào)電 機(jī)電 機(jī)電 源電 源S T M 3 2 飛 行控 制 模 塊 基于攝像頭循跡的四旋翼飛行器設(shè)計(jì) 20 4. 3 電源模塊 電源子系統(tǒng)框圖 該系統(tǒng)中有飛 行 控 制 模塊、電調(diào)、攝像頭 模塊 、超聲波模塊 、無(wú)線(xiàn)通訊模塊 需要供電，其框圖如圖 43 所示 。 電 源 1 2 V電 源 1 2 V攝 像 頭 3 . 3 V攝 像 頭 3 . 3 V電 調(diào)電 調(diào)S T M 3 2 飛 行 控制 模 塊S T M 3 2 飛 行 控制 模 塊超 聲 波 模 塊3 . 3 V 穩(wěn) 壓 電 路無(wú) 線(xiàn) 通 訊 模 塊 圖 43 電源子系統(tǒng)框圖 穩(wěn)壓電路圖 AMS1117 穩(wěn)壓電路圖， 其中輸入電壓為 5V，輸出電壓為 ,使用 LED 燈作為電源指示燈，使用 10uF 的電解電容和 的陶瓷電容濾波。電路原理圖 如圖 44 所示 。 圖 44 AMS1117 穩(wěn)壓電路圖 HCSR04 超聲波模塊工作時(shí)序圖 HCSR04 超聲波模塊工作時(shí)序圖，如圖 45 所示 。 基于攝像頭循跡的四旋翼飛行器設(shè)計(jì) 21 圖 45 HCSR04 超聲波模塊工作時(shí)序圖 4. 4 小結(jié) 本章 首先簡(jiǎn)述了系統(tǒng)的硬件總體設(shè)計(jì)，接著講述了電機(jī)驅(qū)動(dòng)模塊 、 電源模塊的設(shè)計(jì)。 基于攝像頭循跡的四旋翼飛行器設(shè)計(jì) 22 5 系統(tǒng)設(shè)計(jì)軟件部分設(shè)計(jì) 5. 1 程序設(shè)計(jì) 總論 系統(tǒng)采用模塊化結(jié)構(gòu)設(shè)計(jì)， 使用 Keil MDKARM 開(kāi)發(fā)環(huán)境， 使得系統(tǒng)功能組態(tài)更加方便?；境绦蚰K有超聲波測(cè)距模塊、電機(jī)控制程序、攝像頭 采集圖像處理 程序、無(wú)線(xiàn)通訊 程序等，各個(gè)模塊能夠獨(dú)立地實(shí)現(xiàn)各部分功能。 5. 2 軟件開(kāi)發(fā)工具 簡(jiǎn)介 源程序的編寫(xiě)、編譯和鏈接都是在 Keil MDKARM 軟 件下進(jìn)行的，并最后生成可執(zhí)行文件。 Keil MDKARM（舊稱(chēng) RealView MDK）開(kāi)發(fā)工具源自德國(guó) Keil 公司，被全球上百萬(wàn)的嵌入式開(kāi)發(fā)工程師驗(yàn)證和使用，是 ARM 公司目前最新推出的針對(duì)各種嵌入式處理器的軟件開(kāi)發(fā)工具。 KEIL MDK 集成了業(yè)內(nèi)最領(lǐng)先的技術(shù)，包括 uVision uVision uVision5 集成開(kāi)發(fā)環(huán)境與 ARM 編譯器。支持 ARM ARM CortexM0、 CortexM0+、 CortexMCortexM CortexR4 內(nèi)核核處理器。 Keil MDK 可以自動(dòng)配置啟動(dòng)代碼，集成 Flash 燒寫(xiě)模塊，強(qiáng)大的 Simulation 設(shè)備模擬，性能分析等功能，與 ARM 之前的工具包 ADS 等相比， ARM 編譯器的最新版本可將性能改善超過(guò) 20％以上。 相比于之前的 Version4，新發(fā)布的 Version 版本的 MDK 有了 非 常大的架構(gòu)調(diào)整，增添 了許多新的特性。 Keil 將 MDK5 分成了 MDK 內(nèi)核和 Software Pack 兩部分，其內(nèi)核部分仍然是包括編輯器、編譯器、包安裝和調(diào)試跟蹤，而 Software Pack 則又包含 Device、CMSIS 和 MDK professional Midware。這種分層的結(jié)構(gòu)使得對(duì) MDK5 的更新和維護(hù)更簡(jiǎn)單，對(duì)我們開(kāi)發(fā)來(lái)說(shuō)效率也提高不少，因?yàn)樗峁┝撕艽筌浖┪覀冋{(diào)用。 基于攝像頭循跡的四旋翼飛行器設(shè)計(jì) 23 圖 51 MDK5 開(kāi)發(fā)環(huán)境主界面 5. 3 程序流程圖 主程序流程圖 下圖 52 為 主程序流程圖， 程序啟動(dòng)后進(jìn)行各部分模塊的初始化，對(duì) IO 引腳經(jīng)行配置，初始化完成后，傳感器傳輸?shù)臄?shù)據(jù)正常后，四旋翼飛行器開(kāi)始起飛，起飛過(guò)程中由 STM32 控制超聲波模塊檢測(cè)離地面高度，到達(dá)一定高度（可以人為設(shè)定）后，停止上升，飛行器保持相應(yīng)的高度飛行 。同時(shí) Freescale Kinites60 單片機(jī)控制 攝像頭模塊開(kāi)始采集圖像信息，將采集到的圖像經(jīng)過(guò)處理分析，實(shí)時(shí)計(jì)算出飛行器飛行的路徑信息，并把路徑信息傳輸給 STM32 構(gòu)成的飛行控制模塊，飛行控制模塊控制四旋翼飛行器的姿態(tài)以及飛行方向，以實(shí)現(xiàn)四旋翼飛行器的循跡飛行。 基于攝像頭循跡的四旋翼飛行器設(shè)計(jì) 24 圖 52 主程序流程圖 超聲波模塊子程序流程圖 如圖 52 為超聲波模塊子程序流程圖 ， 超聲波模塊主要是用定時(shí)器檢測(cè)超聲波模塊發(fā)出的波形 ， 再檢測(cè)收到的波形的時(shí)間 ， 再通過(guò)計(jì)算 ， 算出距離 。 開(kāi) 始開(kāi) 始初 始 化 定時(shí) 器初 始 化 定時(shí) 器啟 動(dòng) 定 時(shí)T 0啟 動(dòng) 定 時(shí)T 0發(fā) 射 超 聲 波發(fā) 射 超 聲 波延 時(shí)2 . 3 8 m s延 時(shí)2 . 3 8 m s開(kāi) 中 斷 開(kāi) 始接 收開(kāi) 中 斷 開(kāi) 始接 收是 否 收 到 回 聲是 否 收 到 回 聲關(guān) 閉 定 時(shí) 器關(guān) 閉 定 時(shí) 器是讀 取 所 記 數(shù) 值讀 取 所 記 數(shù) 值 圖 52 超聲波模塊子程序流程圖 開(kāi) 始開(kāi) 始各 模 塊 初 始 化各 模 塊 初 始 化飛 行 器 上 升飛 行 器 上 升超 聲 波 測(cè) 高超 聲 波 測(cè) 高 h = 3 0 c m h = 3 0 c m圖 像 采 集圖 像 采 集 圖 像 識(shí) 別 與 分 析 圖 像 識(shí) 別 與 分 析F r e e s c a l e K i n i t e s 6 0單 片 機(jī) F r e e s c a l e K i n i t e s 6 0單 片 機(jī) 飛 行 控 制 模 塊飛 行 控 制 模 塊N OY E S飛 行 器定 高 飛 行飛 行 器定 高 飛 行飛 行 器循 跡 飛 行飛 行 器循 跡 飛 行 基于攝像頭循跡的四旋翼飛行器設(shè)計(jì) 25 攝像頭模塊 程序流程圖 如圖 53 所示為攝像頭模塊程序流程圖 。主要的流程為 SCCB 協(xié)議初始化、采集圖像信息、圖像信息二值化、計(jì)算路徑信息和把路徑信息傳送給控制模塊。 圖 53 攝像頭模塊程序流程圖 5. 4 各模塊 初始化 各模塊初始化包括軟件 初始化 和硬件初始化 ， 具體如下： NVIC_PriorityGroupConfig(NVIC_GROUP)。 //中斷優(yōu)先級(jí)組別設(shè)置 SysTick_Configuration()。 //滴答時(shí)鐘 I2c_Soft_Init()。 //初始化模擬 I2C PWM_IN_Init()。 //初始化接收機(jī)采集功能 PWM_Out_Init(400)。 //初始化電調(diào)輸出功能 Delay_ms(400)。 //延時(shí) MPU6050_Init(20)。 //加速度計(jì) 、 陀螺儀初始化 ， 配置 20Hz 低通 LED_Init()。 //LED 功能初始化 Para_Init()。 //參數(shù)初始化 Delay_ms(100)。 //延時(shí) Ultrasonic_Init()。 //超聲波初始化 if(SCCB_Init(I2C0_SCL_PB00_SDA_PB01)) //攝像頭 OV7725 初始化 基于攝像頭循跡的四旋翼飛行器設(shè)計(jì) 26 { while(1)。 } DMA_Init(amp。DMA_InitStruct1)。 //DMA 初始化 5. 5 算法設(shè)計(jì) 四旋翼飛行器能否 按照指定的路線(xiàn) 飛 完全程除了穩(wěn)定的硬件設(shè)計(jì)外，還在于控制程序的算法是否準(zhǔn)確而合理。方向控制主要在于四旋翼飛行器在過(guò) 直角 彎道時(shí)能否根據(jù) 進(jìn)行飛行方向 的轉(zhuǎn)變， 高度 控制在于 超聲波模塊檢測(cè)到距地面高度的距離偏差有多大調(diào)整四個(gè)無(wú)刷電機(jī)旋轉(zhuǎn)的速度 ，速度控制主要是控制四旋翼飛行器飛行的速度， 攝像頭圖像信息 處理主要是通過(guò)算法將道路信息轉(zhuǎn)換為四旋翼飛行器飛行方向的控制信號(hào) ，下面逐一分析。 PID 算法 PID 算法簡(jiǎn)介： PID 算法是自動(dòng)控制領(lǐng)域和和自動(dòng)化生產(chǎn)實(shí)踐中應(yīng)用最廣泛的控制方法，其原理如圖 54 所示： ??(τ) ??(τ) ??(τ) ??(τ) — 圖 54 PID 算法 原理圖 誤差 ??(τ)代表理想輸入和實(shí)際輸入的差值將這個(gè)誤差信號(hào)送給控制器，控制器通過(guò)計(jì)算處理得出誤差信號(hào)的積分值和微分值，將這些值與某些信號(hào)進(jìn)行整合比較，得到輸出值，用公式表達(dá)如下： ??(??) = K?? [??(τ)+ 1????∫ ??(τ)???? + ??????0 ????(t)?? ] （ 51） 上式中， K??為比例系數(shù) , K??為積分時(shí)間常數(shù)， ????為微分時(shí)間常數(shù)。 ??(τ)為控制量；??(τ)為被控量與設(shè)定值 ??(τ)的偏差。此式是時(shí)域表達(dá)式，而單片機(jī)智能處理數(shù)字信號(hào)，即數(shù)字 PID 控制。將式 （ 51）離散化得： ??(??) = ????[e(n)+ ??????∑ ??(??)+ ????????=0 ??(n)???(???1)?? ] （ 52） 控制器將輸出量 ??(??)反饋到輸入，與輸入再一次進(jìn)行比較，得到新的輸入，這樣無(wú) ????= ??? 177。√??2 ?4????2?? ???? ???? controller 基于攝像頭循跡的四旋翼飛行器設(shè)計(jì)