基于STM32的兩輪自平衡遙控小車設計

1、    基于stm32的兩輪自平衡遙控小車設計    張建強楊標劉毅徐建【摘 要】兩輪自平衡小車作為一種新型的交通工具，其駕駛的方式新穎，深受年輕一族喜愛，且由于是采用的電力驅(qū)動，屬于清潔能源，對于緩解日益嚴重的大氣污染、能源危機和交通擁堵問題，是一種比較好的解決方式，同時由于兩輪自平衡小車的結(jié)構不穩(wěn)定性，給控制的算法提出了很大的挑戰(zhàn)，同時由于這個原因平衡車也成為了一種檢驗控制算法的良好平臺。本平衡車使用stm32單片機作為控制核心，通過電機編碼器與陀螺儀實時獲得小車速度與姿態(tài)數(shù)據(jù)，運用pid控制算法使得小車能夠保持平衡。【關鍵詞】兩輪平衡；stm32單

2、片機；pid【abstract】the two wheeled vehicle is a new type of vehicle，driving the novel，by young people love，and because it is the driving power，a kind of clean energy，to alleviate the increasingly serious air pollution，energy crisis and the problem of traffic congestion，is a relatively good solution at

3、the same time，due to the structure of self balancing the car two rounds of instability，is a great challenge to the control algorithm，and for this reason the balance of the car has become a good platform to test the control algorithm.using stm32 microcontroller as control core，real-time access to veh

4、icle speed and attitude data through the motor encoder and gyroscope using the pid control algorithm makes the car to maintain balance.【key words】two wheel balancing；stm32 single chip microcomputer；pid0 引言隨著我國工業(yè)化的不斷的推進，國民生產(chǎn)力不斷提升，同時自動化控制技術也在不斷發(fā)展，由于生活節(jié)奏也不斷的加快，人們急需一種能夠在小區(qū)，家中，室內(nèi)場館行駛的小型代步工具。同時又由于化石燃料大量消耗

5、導致是有緊缺的今天，人們也開始使用較為清潔的電能。因此在這種情況下，兩輪自平衡小車由于它時尚、小巧的外形，新穎的駕駛方式，全新的騎行體驗，受到青年的歡迎。兩輪平衡車具有較大的市場前景，因此研究兩輪自平衡小車也就有了它的必要性。1 系統(tǒng)總體設計本系統(tǒng)包括了電機驅(qū)動電路、電機編碼器模塊、供電模塊、陀螺儀模塊、單片機處理控制模塊等復雜模塊。系統(tǒng)總體框圖如下圖1所示。小車整體使用stm32f103zet6作為控制核心，使用mpu6050六軸陀螺儀作為姿態(tài)獲取傳感器，由于控制使用的是閉環(huán)算法，所以使用高精度磁編碼器作為小車兩輪速度采取傳感器，該編碼器具有較強的抗干擾能力。電機驅(qū)動選擇是使用東芝半導體生產(chǎn)

6、的直流電機驅(qū)動tn6612fng，相對于傳統(tǒng)的l298n電機驅(qū)動，tb6612fng具有外圍電路簡單，且支持的pwm調(diào)速頻率更高，同時也有利于減小系統(tǒng)的尺寸。2 系統(tǒng)硬件設計兩輪平衡車采用mpu-6050來獲取小車實時姿態(tài)信息，將信息上傳給單片機，由單片機處理數(shù)據(jù)，通過超聲波模塊可以讓小車與障礙物一直保持在一定的距離，以實現(xiàn)超聲波跟隨功能。通過藍牙接受遙控小車的運動。2.1 最小系統(tǒng)的設計本兩輪平衡車采用控制最小系統(tǒng)控制芯片是使用的stm32f103zet6單片機，芯片的所有引腳全部引出，有利于其他功能的擴展，下載程序采用了uart與sw調(diào)試接口，便于程序的調(diào)試。并且在制作的過程中預留了藍牙模

7、塊接口與超聲波接口，既方便安裝固定，也增加系統(tǒng)的重心的穩(wěn)定性，最小系統(tǒng)負責將電機編碼器和mpu-6050所傳來的數(shù)據(jù)進行處理，并根據(jù)得到的結(jié)果控制電機做出相應的動作。2.2 供電模塊的設計系統(tǒng)使用12v鋰電池供電，工作時的電流能夠滿足直流減速電機電流需求，由于單片機等其他的器件采用5v供電而且功耗較小，所以使用lm2596可調(diào)降壓模塊將12v電壓轉(zhuǎn)化為5v，供單片機、mpu-6050、藍牙模塊等傳感器使用。以保證系統(tǒng)的正常運行。3 系統(tǒng)軟件設計3.1 軟件設計流程軟件設計主要包含：電機編碼器與陀螺儀信號的采集與處理，調(diào)節(jié)pwm輸出改變電機狀態(tài)，使得小車達到平衡、行走、轉(zhuǎn)彎等功能。軟件主要是傾角

8、pid與速度pid。軟件設計流程如圖2所示。首先是各個傳感器的初始化，初始化完成后，通過iic通信協(xié)議從mpu-6050讀取姿態(tài)數(shù)據(jù)，以10ms為一個周期讀取mpu-6050角速度寄存器中的值，同時對讀到的數(shù)據(jù)進行互補濾波，然后進一步進行姿態(tài)結(jié)算，從而得到小車實時的姿態(tài)信息。對于電機編碼器得到的脈沖使用stm32的輸入捕獲模式，捕獲周期為60ms，從而得到電機速度。通過pi，pd算法結(jié)合，對電機轉(zhuǎn)速進行脈寬調(diào)制，從而達到讓小車原地平衡、行走平衡的目的。并且當小車傾斜的角度大于30度時，由于角度太大小車難以平衡，這時會讓電機停止轉(zhuǎn)動。3.2 互補濾波算法 互補濾波就是通過不同的濾波器（高通或低通

9、），然后相加得到整個頻帶的信號。對于陀螺儀互補濾波就是在短時間內(nèi)采用陀螺儀得到的角度認為最準確，利用定時對加速度獲得的角度進行取平均值來校正陀螺儀的得到的角度。簡言之，短時間內(nèi)角度使用陀螺儀；長時間用加速度計比較準確，隨著時間的增多加大加速得到的數(shù)據(jù)的比重，這就是對于陀螺儀的互補濾波了。3.3 pid控制算法在本小車中控制pid控制算法分為角度環(huán)（pd）和速度環(huán)（pi）。程序設計中，控制pwm輸出的角度環(huán)的方程為：out_pwm1=angle_p×angle_q+angle_d×angle_s式中的out_pwm1為pd控制計算得到的控制pwm，angle_q為反饋得到的角

10、度值，angle_s為反饋角速度。angle_p與angle_d分別為比例系數(shù)與微分系數(shù)。程序設計中，控制pwm輸出的速度環(huán)的方程為：out_pwm2=speed_p×speed_s+speed_i×speed_e式中的out_pwm2為pi控制計算得到的控制pwm，speed_s為電機速度，speed_e為反饋速度誤差的累積值。speed_p與speed_i分別為比例系數(shù)與積分系數(shù)。最后通過pi與pd計算得到的便是電機需要的pwm值，其方程為：out_pwm=out_pwm1+ou_pwm23.4 pid參數(shù)調(diào)整在讓i，d輸出為0的情況下，去調(diào)節(jié)p，選擇適當?shù)膒值讓車體基

11、本保持平衡，保證沒有較大的晃動或。然后調(diào)整d，適當?shù)膁值，合適的d值能夠增加小車的穩(wěn)定性，d可以很小，如果d值較大會導致小車劇烈的抖動導致電機驅(qū)動燒毀。i參數(shù)的調(diào)節(jié)相當于是對p值很小誤差下的一個補償，若i值過大，補償過多會導致小車前后大幅度晃動，導致小車無法維持平衡。4 結(jié)語系統(tǒng)使用stm32f103zet6單片機作為控制芯片，使用mpu-6050為姿態(tài)獲取傳感器（iic通信協(xié)議），通過電機編碼器獲得小車速度（stm32輸入捕獲模式），通過單片機使用pid算法得到pwm值從而達到控制電機轉(zhuǎn)速的目的，使得小車達到平衡，并且使用藍牙模塊使得單片機能夠與手機通信，使用手機可以控制小車運動。在姿態(tài)獲取濾波方面沒有采用卡爾曼濾波而是采用較為簡單的互補濾波。由于使用了pid算法，擁有速度反饋，能夠使小車在一定的干擾下能夠保持平衡?！緟⒖嘉墨I】1季鵬飛.基于stm32的兩輪自平衡小車控制系統(tǒng)設計j.電子科技，2014，27（11）：96-1052徐升.全數(shù)字直流脈寬調(diào)速系統(tǒng)及其模糊控制算法j.華中科技大學，2006.3林忠海.基于單片機的兩輪自動平衡小車設計j.科技創(chuàng)新與生產(chǎn)力，2013（2）：90-92.4陳波.基于神經(jīng)網(wǎng)絡pid控制的兩輪自平衡小車研究d.西南交