二輪自平衡小車原理

摘要：近些年來，隨著電子科學技術的發展與進步，智能化也越來越成為生活中必不可少的生活條件因素，伴隨著智能移動機器人的剛性需求與相關領域研究不斷深入，已成為新興科學技術的寵兒，以及應用研究領域最活躍和最產業化的科研研究領域之一，正因如此移動機器人越來越廣泛的被應用在各種生產生活范圍中。

關鍵詞：智能化；平衡；控制系統

二輪自平衡小車的概念就是在這樣一個需求背景下應運而出的科技產物，這種機器車區別于其他移動機器車的最明顯突出的特點就是：小車采用了二輪共軸、各自擁有獨立驅動的工作方式，小車自平衡可以借助輪子的前后轉動來保持車身的自身姿態的平衡狀態，因此來保證小車重心的穩定和平衡。

二輪自平衡小車的控制系統分為硬件電路系統和軟件設計系統兩種，控制對象就是自平衡小車的兩個獨立的驅動電機，由分析系統要求我們可知，之所以控制輸出量是轉速采集數據和數據分析很重要，數據分別來自于兩個獨立直流電機驅動車輪的，維持小車直立狀態和運動過程中的動力都來自于小車的兩個獨立驅動的車輪，隨之控制平衡小車達到各種運動狀態的效果，來使自平衡小車保持直立平衡的姿態。

平衡小車的狀態控制可以被分成以下三個部分：

1.二輪自平衡小車的平衡控制：

借助姿態檢測儀獲得的小車傾角為輸入量，通過直流電機對車輪的正反轉和加速度控制從而達到小車的直立平衡狀態。

2.二輪自平衡小車的速度控制：

在小車處于非平衡狀態的時候，通過單片機（STM32C8T6系列）調節直流電機轉速而達到控制小車速度的理想效果，并且在速度控制的過程中形成有效的負反饋環，從而保持二輪自平衡小車的穩定狀態。

3.二輪自平衡小車的方向控制：

對于二輪小車方向的控制，即是對小車車輪轉速的控制，通過控制車輪轉速的轉動差速來實現兩個車輪的轉向，從而來達到左轉和右轉的效果。也可以只控制其中一個車輪的轉動，另一個車輪不轉動因此來實現轉彎的效果，這種方法可以實現對轉彎角度的控制，使其轉過固定的角度。

關于二輪自平衡小車平衡系統的設計，我們所希望達到的效果最終都是在同一個控制對象（小車的電機）進行基礎控制，例如小車的數據采集、數據處理和各種控制變量，這就要三個子系統能夠各自獨立進行有效地控制，一種被叫做耦合關系的特殊結合系統控制。其電機是同軸相連的，但是電機卻又可以分別實現保持小車直立姿態，實現小車左右方向的轉動效果。然而二輪自平衡小車左右轉動是必須在小車保持直立狀態前提下實現的，就是小車保持平衡的情況下使自平衡小車實現左右轉動。二輪自平衡小車速度的控制完全是取決于自平衡小車車身的傾斜程度的大小。傾斜程度會給小車帶來加速和減速兩種不同的的平衡效果，所以小車自平衡控制是系統的最基本要求，也是整個控制系統的重點攻關的任務。

如圖2-1平衡小車示意圖所示，當小車車體垂直的時候，車輪是靜止的；當小車向前運動的時候，車身向后仰，而電機需要糾正后仰，即使得小車車輪向后產生一個加速度，也能使小車向后運動，把二輪自平衡小車的偏離角度作為偏差，通過負反饋讓這個產生的偏差接近于零，好比小車哪邊傾斜角度過大，則平衡小車需要通過獨立直流電機和控制系統隨之往相對應的那個方向運動，目的是達到消除傾斜狀態，從而來保持直立的姿態的效果。

二輪自平衡小車的系統是一種本質不穩定非線性系統，所以需要及時實時檢測自身傾角，再利用STM32系統算法不斷調整自身角度，以實現動態平衡效果。然后通過三個子系統進行合理有效的調整，就可以實現動態平衡，因而對于采集小車的傾斜角度和角速度和小車的姿態檢測成為控制小車直立平衡的關鍵之中的關鍵。在MCU獲得小車車身的姿態數據之后，利用慣性元件來測量運載體本身的加速度，借助傳統的PID控制算法控制單片機輸出PWM波來驅動獨立的直流電機運動。在小車的運行過程中需要單片機輸出的PWM控制電機的轉速控制，通過無線遙控裝置人為的對單片機下達指令，調節獨立電機的運轉速度和正反轉而達到對小車運行狀態系統的控制效果。

利用MPU_6050運動處理整合器件，把陀螺儀和加速度計集合到一起，使用時用了16位的ADC，并且內部自帶了DMP功能，使得效率上也得到了很大的提高，相對而言，成本較低。將傳感器測量的模擬量轉化為可以精確使用的數字量陀螺儀可測范圍：±250，±500，±1000，±2000。加速度計可測范圍：±2，±4，±8，±16。為了實現用戶的需求，可設置為精確快速和慢速跟蹤。片上 1024 字節的 FIFO，有助于減少系統功耗。

參考文獻

[1]楊莘，劉海濤. 基于STM32的兩輪自平衡遙控小車[J]. 數字技術與應用，2014，（5）：151-152.

[2]譚浩強. C語言程序設計. 清華大學出版社[M]. 2010年6月：

[3]季鵬飛. 基于STM32的兩輪自平衡小車控制系統設計[J].電子科技，2014，27（11）；

作者簡介：潘井華（1986.08-），男，漢族，內蒙赤峰人，科員，黨員，助理工程師，學士，主要從事醫療設備維修工作。

（作者單位：淄博萬杰腫瘤醫院設備科）