基于MPU6050和PID的雙輪平衡小車控制器設(shè)計

1、    基于mpu6050和pid的雙輪平衡小車控制器設(shè)計    蔣永超摘 要：隨著物聯(lián)網(wǎng)時代的到來，科技的發(fā)展，使得雙輪平衡小車控制器無論在日常生活中還是在機械生產(chǎn)都得到了廣泛使用。本文提出了一種基于pid的雙輪小車控制器，包括mcu為stm32f103c8t6、nfr24l01無線收發(fā)、hc-sr04超聲波、lm2596s dc-dc、mpu6050中的三軸加速度計和內(nèi)置陀螺儀。本文對設(shè)計具有無線控制的雙輪平衡小車控制器的各個模塊做了詳細的硬件原理分析，以及規(guī)范的軟件編程調(diào)試，實現(xiàn)了當(dāng)有外力作用于小車讓小車失衡時，小車通過控制器實現(xiàn)自平衡靜止，當(dāng)小車

2、運行時遇到障礙物，小車通過控制器反向運動一段距離，并且可以通過無線控制小車。關(guān)鍵詞：pid;nfr24l01;mpu6050引  言隨著電子信息技術(shù)的發(fā)展，短距離無線通訊也有了很大的提升。兩輪自平衡車運動靈活、智能控制、操作簡便，適合單人使用且適用范圍廣。本文就是圍繞對兩輪平衡小車控制器進行研究，在自平衡控制中利用mpu6050內(nèi)置陀螺儀和三軸加速度計都可以通過算法得到傾斜角利用互補濾波得到穩(wěn)定的傾斜角度。再引入pid對小車運動狀態(tài)精準(zhǔn)控制使小車穩(wěn)定系數(shù)增加。通過將雙輪平衡車控制系統(tǒng)與短程無線技術(shù)的結(jié)合，設(shè)計出了一種自平衡穩(wěn)定，功耗較低，可以進行無線控制的平衡控制器。1. 雙輪小車平

3、衡控制系統(tǒng)總體設(shè)計方案總控制系統(tǒng)分為主機和從機兩部分，分機對平衡車進行控制，主機對分機進行無線控制。此無線傳輸屬于雙工通信，主機發(fā)送信息，從機應(yīng)答，主機接收到應(yīng)答。從機系統(tǒng)通過mcu讀取mpu6050產(chǎn)生的信息通過編程實現(xiàn)小車的自平衡和轉(zhuǎn)向。利用單片機產(chǎn)生pwm輸入電機驅(qū)動芯tb6612對電機進行速度控制不同的占空比速度不同，占空比與速度成正比。通過編碼器獲得脈沖，利用io口讀取脈沖程序單位時間內(nèi)對其上升沿和下降沿進行計數(shù)，這里用了四倍頻技術(shù)，從而得到精確的車輪的轉(zhuǎn)速。利用hc-sro4超聲波模塊和單片機端口讀取軟件編程對小車前方進行障礙物距離測量設(shè)定一定的距離，當(dāng)距離很近進行反向慢速運動。2

4、. 雙輪平衡車控制系統(tǒng)硬件電路設(shè)計硬件電路由以下幾個部分組成電源模塊，mpu6050陀螺儀6dof模塊，hc-sro4超聲波測距模塊，nfr24l01模塊，電機驅(qū)動模塊。mpu6050是全球首例9軸運動處理傳感器內(nèi)置3軸陀螺儀和3軸加速度計。其工作電壓2.5±5%，3.0±5%，3.3±5% ，我們采用3.3v供電，用spi傳輸數(shù)據(jù)。無線收發(fā)模塊是全球開放ism頻段免認(rèn)證可用，最高頻率2m，內(nèi)置硬件rcr檢錯和對點通訊地址控制低功耗，內(nèi)置2.4ghz天線體積小巧可以直接與所選mcuio口相連。無線收發(fā)模塊采用nfr24l01，它一款新型單片射頻收發(fā)器件，工作于2.

5、4 ghz2.5 ghz ism頻段。內(nèi)置頻率合成器、功率放大器、晶體振蕩器、調(diào)制器等功能模塊。發(fā)射數(shù)據(jù)時，首先將nfr24l01配置為發(fā)射模式：接著把地址tx_addr和數(shù)據(jù)tx_pld按照時序由spi口寫入nfr24l01緩存區(qū)，tx_pld必須在csn為低時連續(xù)寫入，而tx_addr在發(fā)射時寫入一次即可，然后ce置為高電平并保持至少10s，延遲130s后發(fā)射數(shù)據(jù);若自動應(yīng)答開啟，那么nfr24l01在發(fā)射數(shù)據(jù)后立即進入接收模式，接收應(yīng)答信號。如果收到應(yīng)答，則認(rèn)為此次通信成功，tx_ds置高，同時tx_pld從發(fā)送堆棧中清除;若未收到應(yīng)答，則自動重新發(fā)射該數(shù)據(jù)（自動重發(fā)已開啟），若重發(fā)次數(shù)

6、（arc_cnt）達到上限，max_rt置高，tx_pld不會被清除;max_rt或tx_ds置高時，使irq變低，以便通知mcu。最后發(fā)射成功時，若ce為低則nrf24l01進入空閑模式1;若發(fā)送堆棧中有數(shù)據(jù)且ce為高，則進入下一次發(fā)射;若發(fā)送堆棧中無數(shù)據(jù)且ce為高，則進入空閑模式2。超聲波距離測試模塊，使用rs232轉(zhuǎn)串口與mcu通信，利用壓電效應(yīng)可以監(jiān)測對障礙物的距離。電機驅(qū)動模塊采用驅(qū)動芯片增加負載能力使用tb6612fng直流電機驅(qū)動，其負載較強，這個芯片由東芝半導(dǎo)體公司生產(chǎn)可驅(qū)動2個電機，其熱耗低，對于pwm的頻率限制可以達到100khz，其內(nèi)置過熱保護和低壓檢測。3. 雙輪平衡車

7、控制系統(tǒng)（分機）軟件設(shè)計pid由3個單元組成，分別是比例（p）單元、積分（i）單元、微分（d）單位。在微處理器中，因為控制器要實現(xiàn)其控制算法必須通過軟件實現(xiàn)，因此要對模擬調(diào)節(jié)器進行離散化處理，如此它只需根據(jù)采樣時刻的偏差值來計算控制量。于是，我們需要使用離散的差分方程代替連續(xù)的微分方程。 常用一階差分代替一階微分;常用累加代替積分。根據(jù)位置式離散 pid 公式：e（k）為本次偏差，e（k-1）上一次的偏差，e（k）為e（k）以及之前的偏差的累積和;其中 k 為 常數(shù);pwm代表輸出。關(guān)于 p、i、d 三個參數(shù)的主要作用，p 用于提高響應(yīng)速度、i 用于減小靜差、d 用于抑制震蕩。對角速度進行測量

8、可以采用陀螺儀，我使用的mpu6050里面根據(jù)其英文手冊其內(nèi)部集成了三軸陀螺儀，所以我將繼續(xù)使用mpu6050測量角速度。我從陀螺儀得到的是角速度，角速度的測量不受小車運動的影響。角度得到之后可以通過積分得到2格努同時按內(nèi)的角度變化，用陀螺儀可以間接測量某段時間角度變化。通過在10ms的定時中斷服務(wù)函數(shù)里面執(zhí)行語句就可以得到10ms后的角度的變化有多大。陀螺儀測量傾斜角度理論是可以的，但在聯(lián)系實際情況進行分析角速度信號存在微小的偏差和漂移。傳感器靜止的情況下，輸出不為零時會產(chǎn)生誤差，經(jīng)過積分放大誤差，誤差的不斷疊加最終無法測得正確的角度。所以可以將角加速度計和線加速度計聯(lián)合使用，通過互補濾波實

9、現(xiàn)的自平衡控制系統(tǒng)更加穩(wěn)定。4. 結(jié)論本文介紹了雙輪平衡小車控制器系統(tǒng)的硬件電路和無線接收發(fā)模塊，按鍵控制模塊，超聲波探測距離模塊，mcu控制模塊等。實現(xiàn)了主機對從機的運動控制，而且對其控制是極其靈活，可以進行速度控制，運行方向控制，實現(xiàn)設(shè)定距離位移和設(shè)定角度旋轉(zhuǎn)。實現(xiàn)小車在操作不當(dāng)情況下，遇到障礙物后退的功能，可以反向行走。在keil開發(fā)環(huán)境中使用jlink在線仿真調(diào)試，使各個模塊協(xié)調(diào)運行。事實表明調(diào)試很成功。雙輪平衡車的控制器實現(xiàn)了基本功能，其使用價值較高。參考文獻：1戴偉，岳明，肖鵬程，張躍杰. 單軸雙輪自平衡小車的設(shè)計研究j物理實驗，2014（12）：19 23.2 葛文盡， pid 控制技術(shù)平衡動態(tài)倒立擺的探索j信息通信，2017（5）136-137.3馬傳翔，楊名利雙輪自平衡機器人的滑模變結(jié)構(gòu)控制研究j.微計算機信息，2011（1）：70 71 .4符秀輝，趙茂鑫.基于互補濾波算法的移動機器人姿態(tài)檢測j.測控技術(shù)，2015，36（6 ）：31 33.5阮曉鋼，劉江狄海江，等.兩輪自平衡機器人系統(tǒng)沒汁、建模及l(fā)q控制j.現(xiàn)代電子技術(shù)，2008，281（18）：5256.6盧海曦，王壽榮，周百令.微機械陀螺儀反饋控制器魯棒分析已經(jīng)閉環(huán)接檢測電路分析j.東南大學(xué)學(xué)報，2011，41（3）：526-532.（成都理工大學(xué)  四川 &#