3、硬件設(shè)計

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

　　電路原理圖如下所示：

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

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

　　而用超聲波做的自平衡小車，雖然用的是TT馬達（俗稱香蕉電機），但僅一塊電池供電，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、準備工作

　　將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)的改變，距離近，測得的值變小，距離遠測得的值就增大。

　　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，使得小車能夠來回有點擺動即可進入調(diào)整Kd參數(shù)階段。

　　g、Kd參數(shù)整定

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

　　h、平衡點PB的進一步調(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馬達的情況下，如果系統(tǒng)使用同一組電池供電，電機一啟動Arduino與MPU6050立即死機，或者MPU6050的數(shù)據(jù)受干擾極為嚴重，不可使用。解決辦法是用另一組電池單獨給L298N供電，并且L298N要選擇帶光耦隔離的。但同樣的使用TT馬達的情況下，用超聲波測距方案，系統(tǒng)僅用一組電池即可，而且L298N也無需光耦隔離，系統(tǒng)很穩(wěn)定。

　　b、超聲波傳感器的選擇要選擇最小測量周期短的模塊，第一次我使用的是US-015 超聲波測距模塊，US-015是目前市場上分辨率最高，重復(fù)測量一致性最好的超聲波測距模塊，US-015的分辨率高于1mm，可達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