色婷婷AⅤ一区二区三区|亚洲精品第一国产综合亚AV|久久精品官方网视频|日本28视频香蕉

          關(guān) 閉

          新聞中心

          EEPW首頁 > 工控自動化 > 設(shè)計應(yīng)用 > 基于MEMS慣性傳感器的兩輪自平衡小車設(shè)計

          基于MEMS慣性傳感器的兩輪自平衡小車設(shè)計

          作者:閆俊嶺 張郭 時間:2016-03-09 來源:電子產(chǎn)品世界 收藏
          編者按:著重分析了兩輪自平衡小車的設(shè)計原理與控制算法,采用卡爾曼濾波算法融合陀螺儀與加速度計信號,得到系統(tǒng)姿態(tài)傾角與角速度最優(yōu)估計值,通過雙閉環(huán)數(shù)字PID 算法實現(xiàn)系統(tǒng)的自平衡控制。設(shè)計了以MPU-6050傳感器為姿態(tài)感知的兩輪自平衡小車系統(tǒng),選用8位單片機HT66FU50A為控制核心處理器,完成對傳感器信號的采集處理、車身控制以及人機交互的設(shè)計,實現(xiàn)小車自主控制平衡狀態(tài)、運行速度以及轉(zhuǎn)向角度大小等功能。

          5 硬件設(shè)計

          本文引用地址:http://cafeforensic.com/article/201603/287501.htm

            系統(tǒng)硬件主要由以下幾個模塊組成:小車模型、HT66FU50單片機最小系統(tǒng)、模塊、電機驅(qū)動模塊、速度檢測電路、藍牙模塊和電源模塊。

          5.1 合泰HT66FU50芯片

            HT66FU50單片機[7]的增強型TM模塊具備兩路PWM輸出,分別是TP1A與TP1B,對應(yīng)復(fù)用管腳分別是PA1與PE4,作為兩路線圈驅(qū)動的PWM信號。

            具備串行接口模塊SIM(I2C通信僅從機模式)和一個獨立的SPIA串行接口模塊,用于SPI通信。與MPU-6050模塊連接,方案一,單片機模擬I2C通信主機模式連接,兩線制;方案二,采用獨立的SPIA串行接口模塊連接,四線制,僅限MPU-6000模塊。

            單片機內(nèi)部的串行接口模塊SIM+HT45B0F可以實現(xiàn)與藍牙模塊通信。外部中斷INT0與INT1可以用于光電編碼器的連接。

          5.2 模塊

            方案1:

            由加速度計MMA7260 /MMA7361、陀螺儀ENC-03及放大電路組成,輸出角度與角速度的模擬信號要通過ADC轉(zhuǎn)換為數(shù)字信號,參考文獻文獻[3]。

            方案2:

            MPU-6050[8]的角速度全格感測范圍為±250°/sec(dps)、±500°/sec(dps)、±1000°/sec(dps)與±2000°/sec (dps),可準確追蹤快速與慢速動作,并且用戶可程式控制的加速器全格感測范圍為±2g、±4g、±8g與±16g。產(chǎn)品傳輸可透過最高至400KHz的I2C。

            MPU6050輸出的位數(shù)為16位(65536)對應(yīng)滿量程,當量程為±8g時對應(yīng)靈敏度就為65536LSB/16g=4096LSB/g,選擇測量范圍越大,對應(yīng)精度就越低。

          5.3 電機驅(qū)動模塊

            本設(shè)計的采用兩塊半橋驅(qū)動IR2111芯片驅(qū)動4只場效應(yīng)管IRF1405,作為電機驅(qū)動模塊。CD4001BCN四2輸入或非門芯片,可實現(xiàn)單路輸出高低電平來控制我們電機的正反轉(zhuǎn),節(jié)省控制端口。JP3的另一路輸入為控制ENA使能端,隨時關(guān)閉任何一路驅(qū)動橋的輸入,這個使能端口用來輸入PWM信號。如圖7所示。

          5.4 電機速度檢測電路

            電機速度控制需要測量電機的轉(zhuǎn)速,系統(tǒng)的電機速度檢測主要是采用光電編碼器來完成,利用控制單片機的計數(shù)器測量在固定時間間隔內(nèi)速度脈沖信號的個數(shù)可以測量電機的轉(zhuǎn)速。光電編碼器輸出,如圖8所示。

          5.5 無線通信解決方案

            藍牙透傳模式非常方便,將普通串口變?yōu)闊o線串口。選用HC-06藍牙模塊作為與外部設(shè)備(PC或手機)連接的模塊,實現(xiàn)數(shù)據(jù)監(jiān)控與無線操控。

          6 軟件設(shè)計

            系統(tǒng)軟件設(shè)計框架主要包括:資源模塊初始化、姿態(tài)信息采集、、速度檢測、直流電機PID控制,系統(tǒng)軟件流程如圖9所示。

          7 組裝與調(diào)試

            本文采用液晶LCD1602輔助數(shù)據(jù)顯示。調(diào)試方法與測試方法依次如下:

            首先,藍牙收發(fā)串口調(diào)試;第二步,單片機串口收發(fā)測試;第三步,編碼器測速調(diào)試;第四步,I2C通信調(diào)試;第五步,MPU6050數(shù)據(jù)采集調(diào)試;第六步,PWM控制電機調(diào)試;最后,卡爾曼與PID算法調(diào)試??刂扑惴?、建模及PD調(diào)節(jié)的取值,參考文獻。

          8 總結(jié)

            本作品參考arduino開源平衡車與nBot平衡車[3],感謝全球默默無聞的平衡車愛好者無私奉獻,感謝參考文獻作者的付出。

            理論研究的仿真過程與實際控制過程算法、卡爾曼系數(shù)、PID調(diào)節(jié)系數(shù)相結(jié)合很難[10]。這也是作者在研發(fā)設(shè)計平衡車過程中最棘手的問題,也是多數(shù)論文幾乎不涉及的內(nèi)容。

          參考文獻:

            [1]陸軍.基于PID和LQR控制的小車研究[D].西安交通大學(xué). 2012(6)

            [2]姜良銀. 機器人控制關(guān)鍵技術(shù)的研究[D].上海大學(xué). 2011(4)

            [3]David P.Anderson .nBot Balancing Robot [EB/OL]. http://geology.heroy.smu.edu/~dpa-www/robo/nbot/ .2003(1)

            [4]李榮偉,李鑫,孫傳開,等.小車的設(shè)計[J].常熟理工學(xué)院學(xué)報(自然科學(xué)), 2012,26(10):70-75

            [5]“飛思卡爾”杯電磁組直立行車參考設(shè)計(版本2.0)[EB/OL]. http://www.smartcar.au.tsinghua.edu.cn/column/pxxz .2012(3)

            [6]魯云,趙亮,陳曉東,等. 基于磁導(dǎo)航的兩輪智能車系統(tǒng)設(shè)計[J].湖南師范大學(xué)自然科學(xué)學(xué)報. 2013,36(1):17-21

            [7]鐘啟仁. HT66Fxx Flash單片機原理與實踐[M].北京:北京航空航天大學(xué)出版杜. 2011

            [8]MPU-6050官方手冊. [EB/OL]. http://www.invensense.com/mems/gyro/mpu6050.html .2014-12

            [9]LEGO MINDSTORMS NXTway-GS Model-Based Design [EB/OL]

            http://www.mathworks.com/matlabcentral/fileexchange/19147-nxtway-gs-self-balancing-two-wheeled-robot-controller-design 2009-5

            [10]侯繼紅,馬聰承. 自平衡兩輪電動車控制系統(tǒng)設(shè)計與仿真[J]. 湖北大學(xué)學(xué)報(自然科學(xué)版),2014,36(4):307-312


          本文來源于中國科技期刊《電子產(chǎn)品世界》2016年第2期第51頁,歡迎您寫論文時引用,并注明出處。


          上一頁 1 2 下一頁

          評論


          相關(guān)推薦

          技術(shù)專區(qū)

          關(guān)閉