高雪，劉永新，李藝文

(陸航學(xué)院航電和兵器工程系，北京，101123)

0 引言

雙輪平衡車是一種能夠穩(wěn)定保持直立，且在外力的作用下依然可以不倒的智能小車。平衡車的穩(wěn)定主要是通過兩個電機的運動來實現(xiàn)的，本設(shè)計兩輪平衡車保持小車直立和運動的動力由小車的車輪控制，車輪的轉(zhuǎn)動由兩個直流電機驅(qū)動。從自動控制入手，控制對象為平衡小車，兩個直流電機的轉(zhuǎn)速作為輸入量[1]。該平衡小車相對于過去的四輪移動式機器人而言有了很多的改進，一是在車體的結(jié)構(gòu)上面實現(xiàn)了優(yōu)化，體積減?。欢强梢詫崿F(xiàn)原地轉(zhuǎn)彎，轉(zhuǎn)向的半徑可以很小，移動軌跡也更加機動，可以實現(xiàn)在窄小空間內(nèi)運動；三是驅(qū)動小車運動所需要的功率相對教小，同等條件下電池可以實現(xiàn)對該小車較長時間的供電。

平衡車的概念自從被提出以來，其在外來擾動下依然能保持穩(wěn)定的特點使得它成為一個研究控制理論的很好的平臺[2]。近年來，雙輪自平衡類設(shè)備的研究在美國等相對發(fā)達的國家正在被研究，各實驗室提出了不同的平衡控制的解決方案，也組建出了一些原型機來進行試驗，對平衡小車的的運動特性與自動平衡性能方面進行研究和改進。

本文設(shè)計的雙輪平衡車是由共軸、獨立的驅(qū)動系統(tǒng)控制、車身中心在兩輪軸上方，的一種控制程序檢測平臺，可以實現(xiàn)其直立穩(wěn)定的行走，有相對靈活的運動特點，能夠在相對復(fù)雜的環(huán)境中倚仗其獨特的靈活性工作。

1 平衡小車的設(shè)計與實現(xiàn)

1.1 硬件設(shè)計

1.1.1 核心硬件的選擇

圖1 車輪控制小車平衡原理

如果想讓小車平衡，車輪予以的加速度必須與小車偏差移的方向相同，從而修正這種平衡偏差。

1.1.2 測速及其物理模型搭建

首先要盡量保持小車的物理模型穩(wěn)定，本文采用三個支架片與八組支架為小車構(gòu)建了一個相對穩(wěn)定的立方體模型。

雙輪平衡小車在靜態(tài)條件下通過直立控制很容易實現(xiàn)靜態(tài)平衡。但是因為組成部件的安裝誤差或者傳感器等元件的測量誤差等因素，小車與實際地面并不是絕對的數(shù)學(xué)意義的90度角，它會有個誤差角度的存在[3]。由于重力的分立存在，小車就會為了修正朝傾斜的方向的誤差從而加速前進。基于此原理，控制小車的動態(tài)平衡須要通過控制小車的傾角誤差來實現(xiàn)。具體需要解決三個問題：

圖2 小車外觀圖

（1）測量小車速度

對于平衡小車速度的測量，本設(shè)計是由在電機輸出軸上安裝的光碼盤測得。電機的轉(zhuǎn)速，通過控制單片機的計數(shù)器，來測量在固定的時間間隔內(nèi)速度脈沖信號的個數(shù)來實現(xiàn)。

（2）智能小車傾斜角的控制

社區(qū)家長教育缺乏主動性。社區(qū)教育功能一直是被忽略的一環(huán)，社區(qū)中成人教育一直更多存在于學(xué)位教育和學(xué)歷教育中，社區(qū)教育定位不夠清楚，對于社區(qū)家長教育的理解滯后，少數(shù)開展家長教育的社區(qū)也是借助其他的平臺或者機構(gòu)。同時，社會上對家長教育的概念更多來源于家長自我教育本身，家長的后續(xù)型學(xué)習(xí)被放置到家長個人自發(fā)和自覺學(xué)習(xí)的層次上，政府部門、社區(qū)本身和家長自我都沒有意識到這是一項需要長期堅持的常規(guī)工作，它直接導(dǎo)致的后果是能夠開展家長教育的社區(qū)很少。

在程序中，小車通電后會有較短的感受時間給陀螺儀一個給定的中立值，給定小車直立控制的初始設(shè)定值，通過角度控制，小車將會自動保持在這個初始角度（即上電時給到的控制值）。在兩輪平衡車直立控制算法中小車的傾角是跟蹤重力的分力加速度在Z軸的角度。為了修正這個誤差，我將小車的傾角初始值與重力加速度Z軸角度做差，這樣可以最終確定小車的傾角，該傾角一般以小車上電的后陀螺儀的自定義基準，來給定傾角。

（3）根據(jù)速度誤差控制小車傾角

小車傾角存在的主要原因是在靜態(tài)平衡的小車速度與小車傾角之間傳遞函數(shù)存在非小相位特性[3]，這使得在反饋控制下容易造成系統(tǒng)的不穩(wěn)定性，本文利用了共軛點與比例控制和積分環(huán)節(jié)來調(diào)節(jié)，使小車在由歸干擾的情況下依然能保持穩(wěn)定。

這三個問題的解決控制算法再由單片機來實現(xiàn)，這樣雙輪平衡小車的角度控制和方向控制就可以直接將輸出電壓調(diào)制后輸出PWM波，從而控制電機轉(zhuǎn)速。

該雙輪平衡小車是一個非最小相位系統(tǒng)，其速度的控制在本質(zhì)上是通過調(diào)節(jié)模型的傾斜角實現(xiàn)。所以對于小車的控制須精準，速度調(diào)節(jié)式幅度不可過大且要緩慢變化，因為如果比例和積分系數(shù)過大，可能使系統(tǒng)成正反饋，此時小車出現(xiàn)過調(diào)系統(tǒng)不穩(wěn)定。

1.2 系統(tǒng)設(shè)計

電機驅(qū)動模塊采用TB6612，該模塊可以對兩個電機進行驅(qū)動，通過該模塊來控制兩電機的輸入口，該模塊的STBY口接單片機的IO口使得清零電機全部停止，置1通過AIN1 AIN2，BIN1，BIN2 來控制正反轉(zhuǎn)。邏輯真值表設(shè)置如下。

表1 電機操作模塊邏輯真值表

采用MPU6050陀螺儀采集小車俯仰角，可以將陀螺儀和加速度計二者結(jié)合在一起，精度較高而且減少了占用PCB板的空間。同時，在該模塊上內(nèi)置了一個溫度傳感器和在工作調(diào)節(jié)誤差在±1%內(nèi)的振蕩器（振蕩器可以穩(wěn)定送給單片機的小車姿態(tài)信號）。MPU-6050還有一個VLOGIC引腳，而平衡小車的操控是耦合橫軸和縱軸夾角實現(xiàn)小車平衡。

開關(guān)電壓調(diào)節(jié)模塊采用LM2596，該模塊式一個小的集成電路，可以實現(xiàn)降壓電源管理，并且其本身比較輕量化也是非常符合本設(shè)計的需求不會對小車的中心有太大影響，雖然可調(diào)至的電壓比較少但是足夠小車使用，能夠輸出3A的驅(qū)動電流，同時具有很好的線性和負載調(diào)節(jié)特性。

測速碼盤模組采用L15D11測速模塊，具有高精度高速光電門，同時它具有448個光柵片，在AB雙相輸出的作用下，小車車輪轉(zhuǎn)動一圈時脈沖數(shù)可達三千多，單向可可以達到一千多，精度足夠高，使得小車保持非常好的平衡空置狀態(tài)。

直流減速電機采用GB37 3530，直流減速電機是一款微型減速電機，我使用的是一款雙相高精度帶光電門測速碼盤的款式，其減速比為1:30。

圖3 超聲波時序圖

超聲波模塊的設(shè)置為控制口發(fā)出一個高電平，那么輸出口會有一個高電平。當(dāng)開始有輸出值時，定時器打開，當(dāng)輸出為低電平時，定時器顯示輸出值，這樣便可以得到一次測距的時間,同時計算出距離。通過不斷反復(fù)的周期測量,即可得出移動的距離值。(1)采用IO觸發(fā)測距，給至少10us的高電平信號;(2)通過該超聲波模塊自動發(fā)送8個40khz 的方波，自動的建出有無信號返回；(3)當(dāng)信號返回時，會在IO輸出高電平，根據(jù)該電平的持續(xù)時間可以得出測試距離，測試距離等于高電平的時間乘以聲速除以2。

根據(jù)總體設(shè)計的思想及本系統(tǒng)實現(xiàn)的功能，將平衡小車的軟件設(shè)計與實現(xiàn)分為主程序、平衡程序、各子模塊程序。使其能配合硬件完成二輪自平衡，移動避障。

圖4 主程序流程圖

圖5 小車工作室具體受力狀態(tài)圖

1.2.1 角度分析與算法

上圖為平衡小車在工作時的具體受力狀態(tài)圖，即小車在受到輪子加速的作用后會產(chǎn)生額外的慣性回復(fù)力使其保持原平衡狀態(tài)，由上圖可知回復(fù)力為：

但是由于小車的物理模型原因，一般θ都非常的小，所以對其進行線性化。因其為負反饋，所以其控制量是車輪加速度a與θ成正比例變化，定義比例系數(shù)為k1[4].若比例系數(shù)k1>g，則回復(fù)力的方向會與位移方向相反。同時為考慮其穩(wěn)定狀態(tài)還需要增加阻尼力（即考慮各種摩擦）則將回復(fù)力改寫為：

有了該式便可將加速關(guān)于比例k1、k2的方程列出：

圖6 小車受力模型與公式推導(dǎo)圖

根據(jù)上述結(jié)論我們可以依據(jù)控制理論得出小車的閉環(huán)系統(tǒng)在收到干擾加速度，即不平衡因素x（t）影響時的受力分析[5]，并取得小車剛體與車輪運動加速及其干擾加速度a（t）x（t）的運動方程式。

k1比例控制參數(shù)，k2微分控制參數(shù)（因為角速度是角度的微分），而微分控制參數(shù)提供的作用相當(dāng)于小車受到的阻尼力，該阻尼力可以均衡小車的震蕩現(xiàn)象（即一直處于頻繁修正的過調(diào)狀態(tài)）。

1.3 整合表現(xiàn)

雙輪平衡車的信號總體傳遞圖，如圖7所示。

圖7 小車信號總體傳遞圖

1.4 平衡程序

首先是對小車的各項平衡參數(shù)進行初始化:

2 調(diào)試與功能檢測

平衡小車在實現(xiàn)軟硬件結(jié)合后，需對系統(tǒng)進行集成調(diào)試與功能檢測。集成調(diào)試分為目測、萬用表測試、加電檢查、聯(lián)機檢查四步進行[6]，并對調(diào)試過程中發(fā)現(xiàn)的問題進行分析解決；功能檢測就是對平衡小車的平衡及附加功能進行實際測試，并對測試結(jié)果予以分析總結(jié)。

用500g重物在一片平整的場地里進行功能檢測。測試方法：考慮小車兩種失衡情況，一是通過用手推動小車，使其出現(xiàn)輕微傾斜；二是在小車上添加重物使其重心偏移，發(fā)生較大傾斜。觀察小車在兩種傾斜情況下的平衡調(diào)節(jié)。為了便捷可用肢體比如手來充當(dāng)障礙物，遮擋超聲波模塊，觀察小車避障是否靈活。

小車在兩種失衡情況，均可通過自身的速度調(diào)整實現(xiàn)平衡。當(dāng)用手去遮擋超聲波模塊營造障礙時，小車會向障礙物反方向移動一段距離，再實現(xiàn)平衡。根據(jù)測試結(jié)果知該平衡小車可以很好的完成自動平衡移動和避障，動作響應(yīng)迅速、準確，能很好的完成任務(wù)要求。

3 結(jié)束語

本文主要是通過陀螺儀對雙輪平衡小車的狀態(tài)進行檢查，再將信號傳送到單片機內(nèi)部，單片機的系統(tǒng)通過程序調(diào)用再將信號送到電機，從而控制電機的轉(zhuǎn)動方向和速度，以實現(xiàn)雙輪小車的直立平衡。測試結(jié)果表明，該平衡小車在負重情況下可以很好的完成自動平衡移動和避障，動作響應(yīng)迅速、準確。同時，該平衡小車的設(shè)計與研究，對于自動控制機器人的研究具有一定的參考意義。