《電子技術應用》
您所在的位置:首頁 > 嵌入式技術 > 設計應用 > 基于雙STM32多旋翼無人機控制系統設計
基于雙STM32多旋翼無人機控制系統設計
來源:電子技術應用2013年第11期
袁安富, 徐金琦, 王 偉, 馬 浩
南京信息工程大學 信息與控制學院,江蘇 南京 210044
摘要: 提出一種基于雙STM32芯片的控制系統設計方法和具體實現方案。控制系統以2個STM32F107VCT6芯片作為主從控制器,通過高速SPI接口進行數據通信,以保證控制階段的實時性。介紹了系統的硬件布局,并且給出嵌入式系統的軟件設計流程。實驗結果證明,整個系統性能優良,為后續復雜的控制運算提供可靠的運作平臺。
中圖分類號: V249
文獻標識碼: A
文章編號: 0258-7998(2013)11-0136-03
Control system design for multi-rotor unmanned aerial vehicle based on dual STM32
Yuan Anfu, Xu Jinqi, Wang Wei, Ma Hao
School of Information and Control,Nanjing University of Information Science & Technology, Nanjing 210044,China
Abstract: A design method that based on double STM32 chips is proposed. The control system uses two STM32F107VCT6 chips to ensure the real-time performance, the communication between the two chips is completed by the high-speed SPI interface. Additionally, the introduction of the system hardware layout and the software design flowchart detail is discussed. The experimental results demonstrate that the high-performance of the system, and provide a reliable operation platform for subsequent complex control arithmetic.
Key words : multi-rotor unmanned aerial vehicle; autonomous flight; dual chip; system design

    隨著科學技術的進步和時代發展的需求,無人機無論在軍事還是民用領域都具有廣泛的應用前景。近年來,對無人機領域的研究已得到國內外各大研究機構的重視,特別是微小型多旋翼無人機的研究得到迅猛的發展。微小型多旋翼無人機可廣泛應用于軍事偵察、高空拍攝、交通監控及自然災害勘察等領域。因此,實現微小型多旋翼無人機的自主飛行具有重要的現實意義[1]。然而,實現無人機的自主飛行不可避免地要涉及到飛行器姿態、速度、位置這幾個大方面的控制運算,因此對于控制器的運算能力有很高的要求。

    現有的飛行控制系統一般采用ARM7、DSP等高速處理器作為控制芯片。對于這類單芯片飛控系統,一個控制周期內要完成數據采集、數據處理、控制運算及指令輸出,同時還需將數據輸出到監控系統,過重的負荷影響了系統的可靠性[2]。針對這一問題,本文設計了一種雙芯片飛行控制系統,采用2個STM32F107VCT6處理器同時分工協作的機制,完成對飛行控制的任務要求。該系統設計結構可靠,運算處理能力強,穩定性高。
1 系統硬件設計
1.1 系統功能劃分及硬件布局

    多旋翼無人機自主飛行控制系統較為復雜,一般需要設計3類控制器:位置控制器、速度控制器及姿態控制器。同時還有姿態角推算,導航數據融合等算法[3]。
    為了滿足以上控制和算法要求,機載部分的硬件布局就顯得尤為重要。若要得到很好的實時控制效果,控制頻率是一個重要的考慮因素。因此,為了完成高頻的控制運算,本文設計了一種雙芯片控制系統,2個處理器同時處理數據,協調工作, 達到自主飛行的目的[4]。協同任務的分配如表1所示。 其雙芯片系統結構如圖1所示。主控制器部分有IMU模塊、GPS模塊、遙控器無線接收機及XBEE無線傳輸模塊;從控制器有陀螺儀傳感器、三軸加速度傳感器、地磁傳感器、氣壓傳感器、PWM輸出模塊及SD卡數據存儲器[5]。

1.2 系統硬件選型
    (1)主從控制器:采用ST公司STM32F107VCT6型號的32位微處理器,時鐘頻率達到72 MHz,其豐富硬件接口資源及功能強大的DMA控制方式,充分保證無人機控制系統的穩定性與實時性。主從CPU之間采用高達18 MHz的SPI接口進行雙機通信[6]。針對實際應用, 對通信接口增加硬件握手,主機每次在傳輸數據前詢問從機狀態,如準備好,則開始發送數據。這樣可以避免主機發送數據時,而從機正處于中斷接收配置代碼區,無法接收數據,造成數據丟失,無法正確接收數據[7]。
    (2)模擬量傳感器:加速度傳感器(ADXL335)、陀螺儀傳感器(ADXRS610)。采用模擬量傳感器的優勢在于可以高頻率且精確地進行數據采集,滿足400 Hz姿態控制頻率的要求。
    (3)數字量傳感器:地磁計(MAG3110)、氣壓計(BMP0805)、GPS模塊。數字量傳感器使用相對簡單,且在控制位置和速度時的頻率相對較低,數字量傳感器可以滿足要求。
    (4)無線傳輸模塊:遙控器、遙控器接收機、XBEE無線傳輸模塊。
    (5)擴展模塊: IMU模塊。可以通過搭載高性能的IMU
模塊來驗證控制板上各種傳感器的性能及估算的姿態角的準確性[8]。
2 嵌入式系統軟件設計
    系統軟件的設計是基于IAR軟件平臺下開發,采用匯編語言和C語言混合編程實現。主要分為主控制器和從控制器兩部分的軟件設計。 
2.1 主控制器軟件設計
    主控制器軟件流程圖如圖2所示。遙控器的數據接收、上位機的數據接收、GPS數據讀取、高度計和地磁計的數據讀取、主循環控制頻率等利用中斷程序完成。為了減輕CPU負載,對地面站的數據輸出采用DMA功能,無需CPU干預。

2.2 從控制器軟件設計
    從控制器需要完成400 Hz的控制運算,同樣需要分別配置STM32的USART接口、SPI接口及定時器中斷。采集頻率設定為2 000 Hz,并對采集到的數據進行巴特沃斯數字低通濾波。巴特沃斯數字濾波器相比其他數字濾波器而言,通帶內具有最大平坦幅度、阻帶頻率響應逐漸下降為零的特點。濾波器的性能指標如下:通帶截止頻率20 Hz,阻帶截止頻率100 Hz,阻帶最小衰減20 dB,通帶最大衰減3 dB[9]。對于SD卡的數據寫入同樣采用SPI的DMA功能,實現數據的快速寫入,節約CPU時間。
    從控制軟件流程圖如圖3所示,接收與發送主機數據、主循環頻率都利用中斷程序完成[5]。同時為了節約CPU對外圍設備的讀寫的時間,采用ADC的DMA功能實現對模擬量傳感器的數據讀取,并將數據采集和存儲交由DMA控制器。
3 實驗結果
    為驗證系統方案的可行性,將含有速度控制和姿態控制的飛行控制系統搭載四旋翼飛行器進行室外飛行實驗[10],如圖4所示。

    圖5和圖6的實驗結果表明,控制器能夠很好地跟蹤速度目標值,實現飛行器按預定速度飛行。由此可知,整個系統具有良好的目標追蹤性及穩定性。

 

 

    本文提出了一種新型的采用雙芯片結構的多旋翼無人飛行器控制系統的設計方案。從硬件設計和軟件設計兩方面詳細介紹了設計與實現的過程,并在主機、從機上設計不同的控制器。實驗結果表明,該系統穩定性高,可以完成各種方式的數據傳輸,處理速度快,能夠有效地完成自主飛行所需各種運算要求,為實現該類無人機的自主飛行奠定了良好的基礎。
參考文獻
[1] 李科杰, 宋萍. 微小型無人系統技術在未來戰爭中的重要意義及發展動向[J]. 傳感器世界, 2004(1):6-11.
[2] 李偵, 田夢君, 趙菲菲. 基于 DSP 的無人飛行器飛行控制系統設計[J]. 微處理機, 2010,31(4):125-128.
[3] NONAMI K, KENDOULG F,SUZUKI S,et al. Autonomous  flying robots-unmanned aerial vehicles and micro aerial vehicles[M]. Springer,2010.
[4] 范衛剛, 袁冬莉, 王化會. 基于雙 DSP 的無人機導航系統設計[J].計算機測量與控制, 2011,19(1):152-154.
[5] 劉曉杰, 趙曉暉, 顧海軍,等.微小型四旋翼無人機實時嵌入式控制系統設計與實現[J]. 電子技術應用, 2009,35(5):35-38.
[6] 王志,王文廉,張志杰. SPI及USB雙通信接口的設計與實現[J].自動化儀表,2010(1):72-75.
[7] 高振,羅秋鳳. SPI 接口與 CRC算法在雙 DSP數據通信中的應用[J]. 電子產品世界, 2011(1):46-48.
[8] 陳杰, 陳超, 周建軍,等. 基于 RTOS 的小型無人機飛行控制系統[J]. 電子技術應用, 2009,35(4):27-29.
[9] 王志,王文廉,張志杰. SPI 及 USB 雙通信接口的設計實現[J]. 自動化儀表,2010,36(1):72-75.
[10] WANG W,SUZUKI S,NONAMI K,et al. Fully autonomous quad-rotor MAV and flying performance with complete embedded system[C].Proceedings of the 9th International Conference on Motion and Vibration Control, Japan, 2008.

此內容為AET網站原創,未經授權禁止轉載。
亚洲一区二区欧美_亚洲丝袜一区_99re亚洲国产精品_日韩亚洲一区二区
欧美午夜一区二区三区免费大片 | 一区久久精品| 国产精品久久久一区麻豆最新章节| 免费久久精品视频| 久久精品国产亚洲高清剧情介绍| 亚洲综合丁香| 亚洲伊人久久综合| 亚洲小说欧美另类社区| 99一区二区| 99国产精品久久久久久久久久| 最新国产成人av网站网址麻豆| 久久精品国产亚洲高清剧情介绍| 性欧美video另类hd性玩具| 亚洲香蕉成视频在线观看| 这里只有精品电影| 一二美女精品欧洲| 99视频在线精品国自产拍免费观看| 亚洲国产精品福利| 亚洲国产精品成人一区二区| 亚洲国产精品一区| 亚洲欧洲日夜超级视频| 91久久极品少妇xxxxⅹ软件| 亚洲精品123区| 亚洲区一区二区三区| 亚洲国产女人aaa毛片在线| 亚洲精华国产欧美| 日韩午夜激情| 亚洲一区二区精品视频| 亚洲免费综合| 欧美在线视频一区二区三区| 欧美一区二区三区在线看| 欧美在线欧美在线| 亚洲欧洲日本在线| 一区二区91| 新67194成人永久网站| 欧美中在线观看| 久久人人97超碰精品888| 免费不卡在线视频| 欧美激情第三页| 国产精品va在线| 国产美女高潮久久白浆| 激情文学一区| 亚洲人成欧美中文字幕| 一区二区三区国产在线观看| 亚洲欧美一级二级三级| 亚洲成色777777在线观看影院| 亚洲伦伦在线| 午夜精品久久久久久久久久久久| 久久福利精品| 欧美高清视频在线| 国产精品久久亚洲7777| 国产亚洲精品一区二区| 亚洲国产女人aaa毛片在线| 一区二区三区视频在线看| 午夜久久美女| 日韩亚洲一区二区| 欧美一二三区精品| 欧美va天堂在线| 国产美女精品一区二区三区 | 日韩亚洲不卡在线| 亚洲欧美一区二区精品久久久| 久久亚洲影音av资源网| 欧美理论在线| 国产亚洲欧美一区二区三区| 亚洲理论在线| 久久精品一区二区三区不卡| 亚洲视频福利| 久久综合伊人77777蜜臀| 欧美色道久久88综合亚洲精品| 国产在线麻豆精品观看| 99精品免费视频| 久久精品国产69国产精品亚洲| 在线午夜精品自拍| 欧美专区日韩视频| 欧美日韩三级视频| 国产综合视频在线观看| 亚洲欧洲视频| 久久精品亚洲| 亚洲一区二区免费看| 久久精品首页| 欧美日韩国产在线播放| 国产精品综合| 国产日韩av在线播放| 99精品99| 久久岛国电影| 亚洲性视频网址| 蜜桃av一区二区三区| 欧美日韩在线精品| 国内精品视频在线观看| 夜夜嗨av一区二区三区网页 | 亚洲乱亚洲高清| 欧美一区二区三区久久精品| 亚洲精品一区二区三区婷婷月| 午夜国产欧美理论在线播放| 老司机免费视频久久| 国产精品高清在线| 在线观看日韩专区| 欧美国产欧美亚洲国产日韩mv天天看完整 | 欧美资源在线观看| 欧美精品久久久久久久| 国模私拍一区二区三区| 9i看片成人免费高清| 性感少妇一区| 99热在线精品观看| 久久精品国产综合精品| 欧美日韩国产美女| 国内精品美女在线观看| 亚洲一区二区三区在线看| 亚洲精品在线看| 久久久综合激的五月天| 欧美亚州韩日在线看免费版国语版| 在线精品视频在线观看高清| 亚洲在线播放电影| 99一区二区| 欧美国产欧美亚洲国产日韩mv天天看完整| 欧美日韩综合网| 欧美aⅴ一区二区三区视频| 国产精品欧美日韩一区二区| 亚洲国产综合视频在线观看 | 亚洲一区二区在线播放| 亚洲欧洲日韩在线| 欧美在线免费播放| 国产精品成av人在线视午夜片| 国语自产精品视频在线看抢先版结局 | 国产精品久久一卡二卡| 亚洲卡通欧美制服中文| 一区二区三区四区五区视频| 99re66热这里只有精品4| 久热精品在线| 国产综合亚洲精品一区二| 亚洲中午字幕| 亚洲一区二区成人| 欧美日韩国产区| 国模套图日韩精品一区二区| 亚洲欧美另类在线| 亚洲欧美成人| 欧美日韩一区综合| 国内精品久久久久久久影视蜜臀| 亚洲福利视频二区| 久久久一区二区| 国际精品欧美精品| 欧美一区午夜视频在线观看| 欧美一区二区黄色| 国产精品亚洲综合色区韩国| 亚洲日本va在线观看| 亚洲自拍偷拍视频| 国产精品igao视频网网址不卡日韩| 日韩小视频在线观看专区| 日韩一级精品| 欧美精品电影| 日韩一级在线观看| 亚洲综合不卡| 国产精品三级视频| 午夜精品剧场| 久久蜜桃精品| 黄色在线一区| 亚洲欧洲一区二区在线播放| 欧美一区三区三区高中清蜜桃| 久久香蕉国产线看观看av| 国内精品久久久久久久影视蜜臀| 在线一区观看| 亚洲欧美一区二区三区久久 | 先锋a资源在线看亚洲| 久久视频这里只有精品| 狠狠色狠狠色综合日日91app| 欧美一区二区在线视频| 久久亚洲精品中文字幕冲田杏梨| 国模叶桐国产精品一区| 亚洲国产成人在线播放| 欧美高清视频一区| 99精品国产在热久久| 亚洲专区免费| 国产日产欧美一区| 亚洲高清不卡在线| 欧美日本国产视频| 一本一本久久a久久精品综合麻豆| 亚洲永久视频| 国产欧美日韩综合精品二区| 欧美中文字幕在线| 女生裸体视频一区二区三区| 亚洲伦理在线免费看| 午夜精品久久久久久久蜜桃app | 国产一区 二区 三区一级| 亚洲成色www久久网站| 欧美激情乱人伦| 日韩视频免费大全中文字幕| 久久精品99国产精品| 伊人狠狠色j香婷婷综合| 99精品国产热久久91蜜凸| 国产精品swag| 亚洲高清不卡av| 欧美日韩一区二区三区免费| 亚洲视频中文字幕| 欧美成人一区二区三区| 艳女tv在线观看国产一区| 欧美在线视频全部完| 亚洲黄色成人久久久| 午夜在线一区二区| 亚洲电影免费观看高清完整版 | 亚洲一二三区精品|