姜承昊　王子淳　燕向德

摘要：近年來，對非完整移動機器人的理論和應(yīng)用研究日益受到國內(nèi)外控制界的重視。此類動力學(xué)系統(tǒng)由于具有多變量、非線性、強耦合、時變、參數(shù)不確定性等特性，使傳統(tǒng)控制理論遇到極大困難。因此研究非完整輪式移動機器人具有十分重要的意義。本項目將傳統(tǒng)自平衡車與超聲波、遙控器相結(jié)合，利用距離傳感器感知躲避環(huán)境障礙和采用PID控制算法來維持車體平衡。

關(guān)鍵詞：移動機器人;自平衡;閉環(huán)控制;PID算法

基本內(nèi)容：

本項目基于ARM芯片，能夠自主適應(yīng)環(huán)境情況的智能二輪車系統(tǒng)。其核心部分是對車體的控制，智能性主要體現(xiàn)在它的功能上，在能夠穩(wěn)定運行的基礎(chǔ)上，同時檢測周圍環(huán)境障礙物以避障，另外添加遙控器以實現(xiàn)智能車加速、減速、旋轉(zhuǎn)等多功能的無線控制。因此，該系統(tǒng)的基本研究內(nèi)容主要分為以下三個部分：

（1）姿態(tài)及路況數(shù)據(jù)的準(zhǔn)確獲取

姿態(tài)數(shù)據(jù)的獲取在車體行駛時尤為重要，智能車的每一個動作都需要通過角度傳感器來獲取相應(yīng)數(shù)據(jù)，以反饋給控制芯片，進而迅速作出控制反應(yīng)。

（2）算法控制

算法控制主要分為對傳感器數(shù)據(jù)的處理以及主控芯片對整個系統(tǒng)運行的控制兩個方面。傳感器數(shù)據(jù)是通過一定取值算法獲取，用以保證數(shù)據(jù)來源準(zhǔn)確無誤。系統(tǒng)控制主要以經(jīng)典的PID算法為主體，根據(jù)不同的控制目的調(diào)整相應(yīng)PID參數(shù)，完成不同的操作動作。

（3）電機控制

通過上述算法把結(jié)果轉(zhuǎn)化成PWM波電信號，輸出給執(zhí)行機構(gòu)—直流電機，從而實現(xiàn)對電機的實時控制。

研究思路和方法：

智能車是一個集動態(tài)決策、環(huán)境感知、行為控制和執(zhí)行等多種功能于一體的綜合復(fù)雜系統(tǒng)，其關(guān)鍵是在解決自平衡的同時，還能夠適應(yīng)在各種環(huán)境下的控制任務(wù)。

技術(shù)關(guān)鍵：

（1）測量小車的空間姿態(tài)、角加速度等。

（2）讀取和處理姿態(tài)信息和速度信息。

（3）使用STM32F103RCT6主控芯片分析數(shù)據(jù)，用PID控制算法控制小車的平衡。

（4）在保證平衡的前提下，通過超聲波感知環(huán)境障礙用以避障前進。

（5）通過NRF24L01無線通信模塊實現(xiàn)對小車的實時控制。

主要技術(shù)指標(biāo)：在斷電狀態(tài)實現(xiàn)一鍵站立和自主平衡;在受到外界一定干擾下能自主恢復(fù)平衡;在保持平衡的同時實現(xiàn)旋轉(zhuǎn)、避障、遙控等多種功能。

（1）旋轉(zhuǎn)功能為遙控被動功能，采用航向角積分策略。在收到旋轉(zhuǎn)信號后，智能車按控制速度進行航向角積分，并設(shè)置航向角期望控制執(zhí)行機構(gòu)完成轉(zhuǎn)向。積分策略能實現(xiàn)智能車在360度任意方向上的角度旋轉(zhuǎn)。

（2）避障功能為系統(tǒng)的另一個主要功能，在車體0度平衡狀態(tài)下讀取超聲波數(shù)據(jù)，分析障礙物距離，再根據(jù)車體自身的旋轉(zhuǎn)半徑做出避障行為。超聲波的0度檢測方案保證了讀出的數(shù)據(jù)即為車體距障礙物的距離。

（3）遙控功能使用無線通信模組NRF24L01實現(xiàn)，獨立遙控器包括2維搖桿、油門搖桿和獨立按鍵，分別控制x，y軸轉(zhuǎn)向、速度和模式，經(jīng)過控制信號的整合通信模組會定時向智能車發(fā)出控制信號。

項目研究過程：

控制流程：

首先進行硬件的初始化，之后開始數(shù)據(jù)的采集，如果車體處于歪倒?fàn)顟B(tài)則會觸發(fā)一鍵起立，起立完成后便維持平衡。如果在平衡過程中接收到遙控數(shù)據(jù)，則會根據(jù)接收到的數(shù)據(jù)觸發(fā)相應(yīng)準(zhǔn)備動作、啟動航向角積分和設(shè)置俯仰角期望。然后進行PID算法的控制完成動作。其中如果超聲波檢測到障礙，則會觸發(fā)車體主動轉(zhuǎn)彎避開障礙。

主控部分：

主控芯片采用STM32F103C8T6，這是一款基于ARM Cortex-M3 內(nèi)核的32位嵌入式微控制器，主頻能夠達(dá)到72MHz，用以滿足項目的計算使用。

電源部分：

本項目采用航模電池供電，電壓為12V，一級采用LM2576開關(guān)電源芯片使輸入直流12V穩(wěn)壓至5V給電機編碼器和超聲波供電，二級采用AMS1117線性穩(wěn)壓芯片使5V穩(wěn)壓至3.3V給單片機和其他模塊供電。

關(guān)鍵算法：

PID控制其實就是指比例，積分，微分控制。本項目采用并聯(lián)PID的控制算法：速度環(huán)與角度環(huán)并聯(lián)。期望的俯仰角為0度，目的是能讓智能車平穩(wěn)的直立;期望的速度為0，目的是能讓智能車趨于靜止。

P參數(shù)的給定增加了系統(tǒng)反應(yīng)的快速性，P參數(shù)越大反應(yīng)越迅速，但是P參數(shù)過大容易導(dǎo)致系統(tǒng)的震蕩;I參數(shù)的給定能調(diào)節(jié)系統(tǒng)的穩(wěn)態(tài)誤差，在該系統(tǒng)中I參數(shù)用于角度環(huán)，用于補救車體的傾斜，避免歪倒;D參數(shù)的給定主要用來克服系統(tǒng)的滯后，加快系統(tǒng)的動作速度，減少調(diào)節(jié)時間和系統(tǒng)的震蕩。

無線遙控算法：被控智能車在一次接收中接受6字節(jié)的數(shù)據(jù)，其中包含1字節(jié)的地址校驗位、4字節(jié)的數(shù)據(jù)位和1字節(jié)的和校驗位，其中4字節(jié)數(shù)據(jù)包含車體x，y兩個方向的控制數(shù)據(jù)、速度控制數(shù)據(jù)和模式控制數(shù)據(jù)。方向控制是被控智能車通過航向角積分和設(shè)置俯仰角期望完成的。

結(jié)束語：

本設(shè)計主要針對生活中較火熱的平衡單車進行研究設(shè)計，將經(jīng)典PID算法與環(huán)境檢測、遙控器相結(jié)合，利用角度和距離傳感器等獲取環(huán)境數(shù)據(jù)，然后將數(shù)據(jù)反饋到主控形成閉環(huán)控制。在調(diào)試小車直立時會遇到左右輕微搖擺的情況，經(jīng)過排查發(fā)現(xiàn)，直流電機的減速比對整個系統(tǒng)的控制精度有很大影響，應(yīng)該選擇減速比較小的直流電機，還應(yīng)注意減速齒輪間的空程引起的執(zhí)行誤差。此外小車機械結(jié)構(gòu)也很重要，需將小車重心保持穩(wěn)定，重心越低，車子越穩(wěn)定?，F(xiàn)階段項目已基本完成，后續(xù)階段會繼續(xù)開發(fā)，爭取使用更少的資源達(dá)到更高的性能！

參考文獻

[1]王蕾，宋文忠. PID控制[J]. 自動化儀表，2004，25（4）：1-6.

[2]楊智，朱海鋒，黃以華. PID控制器設(shè)計與參數(shù)整定方法綜述[J]. 化工自動化及儀表，2005，32（5）：1-7.

[3]吳宏鑫，沈少萍. PID控制的應(yīng)用與理論依據(jù)[J]. 控制工程，2003，10（1）：37-42.

[4]胡壽松.自動控制原理.北京：科學(xué)出版社，2013年：1-2

[5]楊巨慶，黃健，段麗華. PID控制技術(shù)與應(yīng)用[J]. 哈爾濱師范大學(xué)自然科學(xué)學(xué)報，2004，20（2）：76-79.

[6]秦勇，閆繼宏，王曉宇，等. 兩輪自平衡機器人運動控制研究[J]. 哈爾濱工業(yè)大學(xué)學(xué)報，2008，40（5）：721-726.

[7]李開生，宗光華. 機器人控制器體系結(jié)構(gòu)研究的現(xiàn)狀和發(fā)展[J]. 機器人，2000，22（3）：235-240.8、

[8]王國軍，陳松喬. 自動控制理論發(fā)展綜述[J]. 微型機與應(yīng)用，2000，19（6）：4-7.