新手入門超聲自平衡小車最佳方案

　　1、項目概述

　　在網(wǎng)上看到各種制作自平衡小車的帖子，也跟著做了起來。因為第一次做，心里沒底，也就沒有投入過多的資金，一切按照最小配置進(jìn)行，所以選擇“TT馬達(dá)”，俗稱“香蕉電機”的小車底盤。

　　在等快遞送貨期間，才看到各種說用“香蕉電機”做自平衡小車的問題，最大的問題就是電機啟動對傳感器和單片機的干擾問題，還有就是平衡的穩(wěn)定性不好等問題。在我以Arduino + MPU6050 + L298N(＄2.3338)為核心做完后，閑得沒事干，就想做一款成本低，易上手，最小配置和最基本功能的自平衡小車，其目的就是給那些沒有什么經(jīng)驗的剛?cè)胄械男率謧兲峁┮粋€入門的解決方案。所以這個項目的目標(biāo)有以下幾點：

　　a、成本低；

　　b、目標(biāo)功能明確，就是實現(xiàn)小車的自平衡；

　　c、系統(tǒng)穩(wěn)定可靠；

　　d、調(diào)試、操作方便簡單。

　　2、項目方案

　　基于上述目標(biāo)，本方案采用超聲波測距模塊作為小車平衡狀態(tài)的檢測，免去了對加速度、陀螺儀傳感器的理解和復(fù)雜處理算法。小車的平衡控制仍然采用網(wǎng)絡(luò)上流行的Arduino開源硬件，再加上電機驅(qū)動模塊 L298N，電機仍然采用TT馬達(dá)（香蕉電機）。

　　該方案為了降低成本，采用電位器調(diào)整設(shè)定小車的平衡參數(shù)，不使用藍(lán)牙無線模塊或有線串口在線調(diào)整參數(shù)。

　　用超聲波測距的方式實現(xiàn)的自平衡小車，網(wǎng)絡(luò)上有人提出這種方案無法在坡度變化的斜坡上保持平衡，這種說法經(jīng)過我的實踐，是有解決方案的，這個問題我將在后面進(jìn)行闡述。

　　平衡控制的算法還是采用平衡車中經(jīng)典的PD算法。

　　3、硬件設(shè)計

　　硬件設(shè)計比較簡單，以Arduino Nano為核心控制模塊，采用HC-SR04超聲波測距模塊，L298N電機驅(qū)動模塊，供電采用7.4V/2200mAh(＄76.5000)鋰電池。圖中三個10K電位器分別用于平衡點設(shè)置、PD算法中Kp和Kd系數(shù)設(shè)置的調(diào)整。

　　電路原理圖如下所示：

　　圖中J1為HC-SR04超聲波測距模塊，J2、J3為L298N模塊，Arduino Nano為核心控制模塊，MG1、MG2分別為左右電機。

　　與之前用香蕉電機+MPU6050做的自平衡小車相比較要簡單很多，在MPU6050方案中，用了兩塊電池，其中一塊單獨用于電機供電，而且L298N必須用光耦隔離的。

　　而用超聲波做的自平衡小車，雖然用的是TT馬達(dá)（俗稱香蕉電機），但僅一塊電池供電，L298N電機驅(qū)動模塊也沒有光耦隔離，從最終調(diào)試后的效果上看，還比前者更穩(wěn)定。

　　成品照：

　　材料清單

　　這個材料清單比較完整，是帶遙控器的。在電商平臺可以收集齊全，大家可以i自行搜索。

　　4、程序設(shè)計

　　程序源代碼：http://www.52solution.com/auto-dl/7374

　　5、調(diào)試流程

　　最新版超聲平衡小車裝配完畢后如下圖所示。

　　串口調(diào)試助手程序：http://www.52solution.com/auto-dl/7375

　　a、準(zhǔn)備工作

　　將Kp與Kd調(diào)為0，調(diào)整方法是，旋轉(zhuǎn)電位器后，按下Arduino模塊上的復(fù)位鍵調(diào)整方可有效。調(diào)整后用串口調(diào)試助手（sscom42.exe）發(fā)送 “F”命令，讀取超聲自平衡小車參數(shù)的設(shè)定值。在使用串口調(diào)試助手前，首先選擇串口調(diào)試助手對應(yīng)的串口號，設(shè)置好波特率，方可發(fā)送上述命令讀取超聲自平衡小車參數(shù)的設(shè)定值，操作界面如下圖所示。

　　第一個數(shù)據(jù)為平衡點設(shè)定值，第二個數(shù)據(jù)為Kp，第三個數(shù)據(jù)為Kd。

　　b、超聲波測距測試

　　發(fā)送相應(yīng)“L”命令，讀取超聲波的測距值，注意，這里不是實際的mm或cm值，而是對應(yīng)距離來回的傳播時間值，是單片機內(nèi)部計時的輸出值。

　　操作界面如下圖所示。

　　第一個數(shù)為超聲波測距模塊的直接輸出值，第二個數(shù)為一階濾波后的值。改變超聲波測距模塊與被測界面的距離，這兩個值會發(fā)生相應(yīng)的改變，距離近，測得的值變小，距離遠(yuǎn)測得的值就增大。

　　c、尋找物理平衡點

　　在Kp、Kd為0時，用手尋找自平衡小車的物理平衡點，同時用“L”命令（500ms定時發(fā)送）讀取超聲波測量的返回值，確定平衡點的返回值，并記錄下來。

　　d、平衡點PB的設(shè)定

　　調(diào)整PB電位器，并在Arduino復(fù)位后，用“F”命令讀取超聲自平衡小車參數(shù)的設(shè)定值，使得第一個返回的數(shù)據(jù)與上述確定的物理平衡點相一致。

　　e、判斷電機運轉(zhuǎn)方向是否正確

　　在完成上述調(diào)整后，逐漸增大Kp（請記住，每次調(diào)整后，都必須復(fù)位Arduino模塊，調(diào)整才能生效），看到電機能夠動作時，停止調(diào)整Kp。這時將超聲波模塊一端稍稍下壓（也就是使超聲波探頭與地面距離縮短），觀察兩個電機的轉(zhuǎn)動方向，往前（超聲波測距模塊一端為前）轉(zhuǎn)測試正確的，往后轉(zhuǎn)則說明相應(yīng)的電機兩根線接反了，將接反的線調(diào)換過來即可。

　　f、Kp參數(shù)整定

　　在電機接線正確后，再逐漸增大Kp，使得小車能夠來回有點擺動即可進(jìn)入調(diào)整Kd參數(shù)階段。

　　g、Kd參數(shù)整定

　　在調(diào)整完Kp后，逐漸增大Kd，使得擺動消失，如果繼續(xù)增大Kd，小車會出現(xiàn)明顯的抖動，此時將Kd往回調(diào)整，使得抖動消失即可。

　　h、平衡點PB的進(jìn)一步調(diào)整

　　在上述參數(shù)調(diào)整完畢后，小車一般就能保持平衡了，如果出現(xiàn)小車往一邊跑的現(xiàn)象，可通過調(diào)整PB電位器加以修正。如果小車往前跑（超聲波模塊一端為前），調(diào)整PB使得平衡點設(shè)定值增大；如果小車往后跑，調(diào)整PB使得平衡點設(shè)定值減小，直到小車能夠長時間穩(wěn)定為止。

　　6、總結(jié)與展望

　　超聲自平衡小車的基本版已經(jīng)完成，在制作過程中與我之前用MPU6050制作的小平衡車相比有以下幾點體會：

　　a、在用TT馬達(dá)的情況下，如果系統(tǒng)使用同一組電池供電，電機一啟動Arduino與MPU6050立即死機，或者M(jìn)PU6050的數(shù)據(jù)受干擾極為嚴(yán)重，不可使用。解決辦法是用另一組電池單獨給L298N供電，并且L298N要選擇帶光耦隔離的。但同樣的使用TT馬達(dá)的情況下，用超聲波測距方案，系統(tǒng)僅用一組電池即可，而且L298N也無需光耦隔離，系統(tǒng)很穩(wěn)定。

　　b、超聲波傳感器的選擇要選擇最小測量周期短的模塊，第一次我使用的是US-015 超聲波測距模塊，US-015是目前市場上分辨率最高，重復(fù)測量一致性最好的超聲波測距模塊，US-015的分辨率高于1mm，可達(dá)0.5mm，測距精度高，重復(fù)測量一致性好，測距穩(wěn)定可靠。但他的最小測量周期大于10ms，而且對輸出數(shù)據(jù)經(jīng)常有跳動（這是由于它的靈敏度很高，在近距離時超聲波在模塊與地面之間的來回反射的二次信號都能被檢測到），為此在地面墊上一個地毯吸收了部分能量的超聲波，才能穩(wěn)定工作。在第二版中更換了HC-SR04超聲波模塊，這個模塊的測距精度雖然只有3mm，但它的最小測量周期僅略大于3ms。但這種模塊市場上有兩種，一種沒有晶體，一種是帶晶體的，帶晶體的很不穩(wěn)定，建議大家不要選擇。

　　c、小車的平衡穩(wěn)定性與多種因素有關(guān)，建議在結(jié)構(gòu)上，重心越低越好。

　　d、另外，我還做了一個對比測試，數(shù)據(jù)見下表：

　　誤差絕對值是指小車在一段時間內(nèi)，實測距離與設(shè)定平衡點距離誤差絕對值的平均值；濾波是指程序中對超聲波測量的距離濾波或不濾波直接使用；循環(huán)周期是程序中的延時時間，超聲波測量需要大約704us，一個周期大約為3.84ms，程序處理時間大約為136us