基于單片機的自動跟隨小車

張 偉，王 橋，李 莉，魏 虎，張慶新，姜 萍

（1.貴州師范學院 數學與計算機科學學院，貴州 貴陽 550018；2.貴州師范學院 大數據科學與智能工程研究院，貴州 貴陽 550018）

0 引 言

隨著科技的發展，小車自動化、智能化已成為重要的觀注點之一。然而，國內市場目前還未出現無軌自動跟隨載物的小車，而我國具有的跟隨性小車并沒有針對超市、旅館、飛機場、港口等大眾場合，或家庭、個人的智能無軌產品，主要是有軌跟隨，其中最具代表性的便是餐廳服務機器人及快件分運的跟隨產品。本文參考陀螺儀定位及STM32各種模塊的綜合運用，設計了一款能夠實時檢測并追蹤特定移動目標的自動跟隨小車。該車采用陀螺儀定位技術及PID算法技術，可根據不同場合的環境要求調整小車的跟隨距離和速度等參數，實現對目標的精準跟隨，物品托運。該設計可用于超市智能購物車，也可放在機場、旅館用做行李托運車。

1 系統總體設計

系統完成了基于單片機的智能無軌跟隨小車設計。采用陀螺儀定位模塊，藍牙無線通信模塊等，設計了可實時無線收發目標位置，定位自身位置的模塊，同時構建了PID算法控制小車移動，從而實現小車對目標的自動跟隨。小車系統的設計框圖如圖1所示。

1.1 系統原理

系統為了實現小車自動跟隨目標，首先向從機發送無線信號，從機接收到無線電信號后進行匹配。目標利用陀螺儀取得自身位置坐標，通過無線信號將坐標發送回主機，主機將接收到的坐標與自身位置坐標進行運算，從而判斷目標所在的方向及位置，并通過PID算法調控電機轉速實現小車跟隨目標。小車手持設備結構如圖2、圖3所示。

圖1 系統總體設計圖

圖2 小車（主機）

圖3 手持設備（從機）

1.2 硬件設計

由于小車需要對定位目標位置，并進行運動控制，故本設計采用陀螺儀定位采集距離信息，并將采集到的數據發送到控制系統，經過控制系統算法處理，可識別目標的方位。

基于陀螺儀的定位原理：在小車頂部設置一個陀螺儀，使系統獲得小車自身的坐標。蛇螺儀電路如圖4所示。

為了實現小車對目標的實時跟隨，在小車和目標上安裝無線通信裝置。無線通信為小車與目標構建通信通道，使小車得到目標的實時位置。藍牙HC-05是主從一體的串口模塊，可設置藍牙的主從屬性。當主機藍牙與從機藍牙配對連接后，可建立一個短距離通信通道，主從設備可共同使用該通道，發送或接受數據。

調節PWM波可調控電機的轉速，從而實現小車的跟隨需求。調節PWM波即調制脈沖的寬度，換言之，PWM波通過調節占空比控制電機轉速。對于控制電機可將高電平持續x%，低電平持續1-x%。電機驅動電路如圖5所示，可控制小車的前進、后退、差速轉向等。

圖4 陀螺儀電路

2 核心技術

系統主要有三大核心技術：定位技術、無線通信技術、PID控制技術。

2.1 定位技術

定位技術可通過主機和從機上的陀螺儀定位主機和從機的位置，將坐標值傳輸到主板進行算法計算，從而得到從機所在的角度方向和兩者之間的距離：

通過比值求出角A所占比例：

在計算PWM波控制電機轉動時用Y的值控制電機的占空比。小車及目標的定位原理如圖6所示。

圖6 小車及目標的定位原理

2.2 無線通信技術

為了實現無線通信，本設計采用藍牙模塊HC-05。HC-05是一款可用作短距離無線通信的主從一體的通信設備。這款藍牙通訊模塊有兩種工作模式：

（1）命令響應工作模式

（2）自動連接工作模式

圖5 電機驅動電路

a.主（Master）

b.從（Slave）

c.回環（Lookback）

當設備調節至自動連接工作模式時，可事先設定連接方式，連接后設備將會按照設定傳輸數據；設置模塊進入命令響應工作模式時，可以使用 AT命令。通過設置AT指令，可以設置其主從模式，做成主機（小車接收設備）、從機（手持發送設備）。同時可以設置其與指令地址匹配，從而實現一對一匹配，避免出現連接錯誤。

2.3 PID控制技術

在直流電機的開環控制中，電機的轉速總是隨著電機的負載變化而變化，無法穩定在一個給定的數值上。隨著負載的增大，電機的轉速隨之下降，當負載超過額定負載時，電機停止轉動，此時電機電流最大，容易損壞。而在PID控制系統中，由于有積分和微分環節，可使系統跟隨到給定值上，即雖然有誤差，也可迅速調節，使誤差在一段時間過后為零。PID調節即比例、積分、微分控制，這種調節器是將設定值與輸出值進行對比，通過對比得到的偏差來進行比例、積分和微分的控制。

基本PID控制器的理想算式：

PID參數調整主要確定三個參數，然后進行整體測試對參數微調至系統正常工作，需要確定的三個參數：

（1）比例系數Kp

（2）積分時間常數Ti

（3）微分時間常數Td

首先確定比例系數，然后是積分時間常數，最后是微分時間常數。首先令Ti，Td為0，將Kp由0逐漸增大至系統震蕩，然后又將Kp減小至震蕩消失，設定此值為比例系數Kp。同樣的方法求得Ti，Td。隨后對系統進行微調直至正常運行。

3 系統調試

硬件調試：

（1）測試電機的驅動，差速轉向等。

（2）測試藍牙連接，數據傳輸。

（3）測試陀螺儀定位，通過串口監視器打印出相應坐標。

主要技術指標：

（1）藍牙連接的距離在8 m內非常穩定。

（2）陀螺儀定位精準度在97%，波動范圍在2%～5%之間。（3）PID控制穩定性在85%。

4 結 語

針對智能無軌跟隨的特點，文中的系統結合了無線通信技術，定位技術，采集小車位置、目標位置等參數，對航偏角進行有效計算，從而由PID控制轉向、跟隨等。此系統還具有低功耗、操作方便、實時性好、低成本、穩定性高等特點。能夠滿足大多數貨物托運的需求。

[1]馬建偉.滿意PID控制設計理論與設計[M].北京：北京科學出版社，2007.

[2]譚浩強.C程序設計[M].北京：清華大學出版社，2007.

[3]陳錕，危立輝.基于單片機的直流電機調速器控制電路[J].中南民族大學學報（自然科學版），2003，22（3）：43-45.

[4]陳堂敏，劉煥平.單片機原理與應用[M].北京：北京理工大學出版社，2007.

[5]唐力華，崔新藝.基于DSP的無刷直流電機控制系統中串行通信的實現[J].電機電器技術，2003（4）：27-30.

[6]賀東梅.基于ZigBee協議的無線通信網關的設計[J].物聯網技術，2017，7（1）：45-47.

[7]王恒，李陳康.基于雙單片機的無刷直流電機調速系統的設計[J].物聯網技術，2015，5（12）：47-50.

[8]張文霞，張凱，喬良，等.基于單片機的智能跟隨小車的設計與實現[J].科技與企業，2015（12）：251.