基于環形紅外陣列的移動機器人自動跟隨系統

徐 勝，邢 強，王 浩

（1.南通大學機械工程學院，江蘇 南通 226019；2.南京航空航天大學機電學院，江蘇 南京 210026）

如今，機器人技術發展迅速。機器人已經應用到多個行業，朝著高度智能化的方向發展。具有跟隨功能的移動機器人是一種在復雜環境下自動捕捉移動目標物，并且能夠實時追蹤目標物的機器人［1-5］。其中快速獲取移動目標物的空間位置是關鍵［6-11］。

許多學者對智能跟隨移動機器人進行了研究。包加桐等［12］將里程計與視覺相機相結合，設計了具有自主定位和導航功能的跟隨機器人，實現了對目標的跟蹤。Srinivasa等［13］利用視覺相機成功實現了在不規則室內環境中對目標的精確識別和定位。目前，在很多復雜環境中可以通過視覺定位準確識別目標，但是在圖像處理時須用處理器將采集到的大量數據進行計算，這對微型控制器的處理速度提出了較高的要求。此外，謝德勝等［14］將GPS（global positioning system，全球定位系統）與RTK（realtime kinematic，實時動態）技術融合，設計了軌跡跟隨機器人。杜華臻等［15］將激光雷達作為環境感知傳感器，來捕捉人腿的圓弧形特征，實現了對人體目標的跟隨。上述研究主要依靠相機、激光雷達、慣性導航系統等來感知環境，從而實現對目標的定位和跟隨。然而，將這些硬件設備應用到智能車的成本十分高昂，這對智能車的普及帶來了阻礙。因此，研究低成本的傳感器方案并將其運用于智能車的跟隨勢在必行。

為此，本文設計了一種基于測距羅盤的移動機器人的目標跟隨系統。借鑒于復眼昆蟲具有接近360°的視角，設計了一種具有環形大視場的測距傳感器。利用單個紅外傳感器體積小、成本低的優點來模擬昆蟲小眼，對目標進行快速的距離測量和角度測量，以快速判斷目標的位置，實現對目標的精準定位。并依據目標的位置信息利用PD（proportion-differentiation，比例-微分）控制器控制跟隨機器人的移動，實現其對移動目標的自動跟蹤。

1 移動機器人自動跟隨系統的總體設計

針對室內空曠環境，提出一種具有主動式環形大視場的測距羅盤作為環境感知傳感器。通過該測距羅盤對移動機器人周圍的未知環境進行探測；其主控芯片將采集到的模擬信號轉換為數字信號，準確地計算出其與目標物之間的相對距離和相對角度，并運用PD算法將此空間位置關系與預設位置關系進行比較，通過控制跟隨車輛的差動驅動輪，實現移動機器人的前進、后退、轉動、轉彎，使得機器人與目標物保持在預定范圍；通過無線串口將測距羅盤采集到的數據傳輸給上位機，進行數據可視化分析。移動機器人自動跟隨系統的結構框圖如圖1所示。

圖1 移動機器人自動跟隨系統的結構框圖Fig.1 Structure block diagram of automatic following system of mobile robot

2 移動機器人自動跟隨系統的硬件設計

2.1 基于分布式傳感器陣列的大視場測距模塊

大視場測距模塊采用具有較強抗干擾能力的GP2Y0A21紅外測距傳感器。其有效探測距離為10～80 cm，主要由發射電路、接收電路和檢測電路三部分構成。檢測電路用來將從障礙物反射回來的光的強度信號轉換為模擬電信號，從而實現對傳感器與遮擋物體之間距離的測量［16-17］。為了實現接近360°的無死角視野，采用16個測距傳感器組成周向陣列。為了最大限度地降低傳感器之間的相互干擾，將16個同構傳感器分為4組，每組4個，各標記為1，2，3，4，周向均勻間隔排列在測距羅盤上，構成了基于傳感器陣列的測距模塊，如圖2所示。測量時，序號相同的4個傳感器在同一時刻工作，并設置序號不同的傳感器延遲一定時間測量，避免各組不同序號的傳感器相互干擾。這樣的設計可以使各傳感器在互不干擾的條件下完成對周圍環境的檢測。

圖2 基于傳感器陣列的測距模塊Fig.2 Ranging module based on sensor array

2.2 紅外測量和采集模塊

紅外測量和采集模塊使用4組模擬開關對單片機上的模數轉換接口進行拓展，使得單片機4路模數轉換通道拓展為16路模數轉換通道。每組紅外測量電路包含一個收發一體式紅外測量探頭、紅外發射電路、紅外接收電路和濾波放大電路，且4組紅外測量電路共享STM32控制內核和nRF24L01無線通信模塊。nRF24L01無線通信模塊可以實現一對一、一對多、多對多設備間的數據傳輸。利用它可組成星形、樹形和蜂窩形網絡結構，并與上位機組成分布式測量控制系統。上位機用來接收和保存所測數據，以便后續分析。

移動機器人自動跟隨系統以STM32為控制核心，4組紅外測距回路并行執行。STM32同時選中4組電路的同一通道4052，紅外傳感器發射的紅外波遇到障礙物后返回，經過各自的4052通道進入放大濾波電路，然后進入STM32的ADC（analog-to-digital converter，模數轉換器）通道，數模轉換后經過計算得出距障礙物的距離，并同時保存傳感器所在的通路，即可獲得障礙物的方位。上述過程進行4次，即可完成16個傳感器的測距工作，獲得跟隨機器人與移動目標物之間的距離ρ和角度φ。

紅外測量和采集模塊的設計如圖3所示。

圖3 紅外測量和采集模塊設計示意Fig.3 Schematic of infrared measurement and acquisition module design

3 移動機器人自動跟隨系統的軟件設計

3.1 測距傳感器標定

GP2Y0A21紅外測距傳感器能夠根據物體的距離輸出模擬電壓。距離越遠，其輸出的模擬電壓值越小，且電壓值與距離之間存在非線性關系。因此，須對測距傳感器的輸入輸出關系進行參數標定。

在傳感器10～80 cm的量程范圍內，每隔5 cm取一個測量點，并在每一個測量點記錄其實際距離和傳感器輸出的模擬電壓值。為了減小在測量過程中產生的隨機誤差，進行10次測量，取測量的平均值，并將數據全部輸入MATLAB軟件。利用冪擬合的方法對數據點進行擬合，擬合曲線如圖4所示。擬合結果表明，擬合的確定系數為0.999 3，殘差平方和為0.002 3，可見擬合效果較好。

圖4 實測距離與電壓值的擬合曲線Fig.4 Fitting curve of measured distance and voltage value

該擬合曲線的表達式為：

式中：U（ρ）為紅外測距傳感器輸出的模擬電壓值。

3.2 定位模型

定位模型表示在跟隨機器人與移動目標物處于同一水平高度的條件下，移動目標物在測距羅盤坐標系下的位置，如圖5所示。第i個測距傳感器檢測到的數據為（ρi，φi）（i=1，2，…，16）。當跟隨機器人的周圍存在目標物時，其對應方向上傳感器檢測到的距離信號值會小于其他傳感器檢測到的值。因此，在t時刻取最小信號值作為跟隨機器人對目標物的定位結果（ρt，φt），即：

圖5 定位模型示意Fig.5 Schematic of positioning model

利用定位結果（ρt，φt）對車體兩側的差動驅動輪進行控制，以實現移動機器人的前進、后退、轉動、轉彎等運動，最終使跟隨機器人與移動目標物保持設定的距離ρw和偏航角φw。

3.3 跟隨機器人的數學模型

如圖5所示，假設兩輪差速驅動跟隨機器人的質心c位于跟隨機器人幾何中心位置，則機器人的質心坐標為（xc，yc），機器人的姿態向量P=（xc，yc，θ），其中θ為方向角。

根據剛體力學可得跟隨機器人的運動學方程為：

式中：v為跟隨機器人的線速度；ω為跟隨機器人的角速度；v1和vr分別為跟隨機器人左、右驅動輪的線速度；l為跟隨機器人兩驅動輪的輪距。

跟隨機器人的運動滿足如下約束：

則式（5）可改寫為：

將式（4）離散化，可得：

式中：T為采樣周期。

3.4 跟隨機制

為了實現對跟隨機器人的快速控制，同時考慮場景控制所需的較強實時性，選擇適應性強、控制簡單的PD控制律。跟隨機器人的PD控制原理如圖6所示。

圖6 跟隨機器人PD控制原理示意Fig.6 Schematic of PD control principle of following robot

式中：kp為比例系數；kd為微分系數。

以一階后向差分近似代替微分，則PD控制律的離散化方程為：

3.5 數據處理

數據采集程序主要在LabVIEW軟件中編寫完成。利用串口技術［18-21］實現對測距羅盤數據和隨動機器人路徑的可視化采集。下位機接收到測距羅盤的數據后，會將實時距離信號編碼成帶有校驗碼的字符串傳送回上位機；用于定位跟隨機器人的室內定位系統［15］將實時記錄機器人的二維坐標，并通過串口上傳至上位機。上位機循環接收上述傳感器信號，在其操作界面可以顯示在極坐標和平面直角坐標系下測距羅盤數據和機器人跟隨路徑，如圖7所示。

圖7 測距羅盤數據和機器人跟隨路徑的顯示界面Fig.7 Display interface of ranging compass data and robot following path

4 移動機器人自動跟隨實驗

跟隨機器人如圖8所示。其采用差速輪，差速電機選用MG513BP30直流減速電機，電機額定功率為7 W，空載轉速可達500 r/min。該型號電機自帶高精度AB雙相光電編碼器，尾部500線AB雙相輸出；減速比為1∶30的電機減速器的輸出軸旋轉1周，可以輸出15 000個完整脈沖。下位機中，選用基于ARM32位Cortex-M3內核的STM32F103單片機作為整個系統的控制中心，協調和控制各個模塊的工作。下位機的主要任務是采集測距羅盤的模擬信號并將它轉換為距離信號以控制跟隨機器人的運動，通過無線串口將數據傳輸給上位機中，通過LabVIEW軟件進行可視化分析。

圖8 跟隨機器人Fig.8 Following robot

為觀察搭載測距羅盤的跟隨機器人在小范圍無障礙環境中的自動跟隨效果，進行移動機器人自動跟隨實驗。

先將目標物放置于跟隨機器人前方某處不動，引入全局平面坐標系，用于描述機器人跟隨運動的軌跡。在初始時刻，全局平面坐標系與測距羅盤初始坐標系重合。設定相關參數：ρw=0.2 m，φw=0 rad，l=0.4 m，跟隨機器人最大速度vmax=0.5 m/s。實驗在平地上進行，因此不考慮跟隨機器人和目標物在垂直方向的位置變化。啟動移動機器人的自動跟隨系統，通過上位機實時記錄實驗過程中測距羅盤的數據和跟隨機器人的運動軌跡。

讓目標物以恒定線速度v=0.4 m/s進行“8”字形運動和方形運動，移動機器人自動跟隨效果如圖9所示。由圖可知，機器人跟隨軌跡連續，在跟隨過程中未出現跟丟目標物的情況。說明跟隨機器人能夠執行預期動作，準確跟隨目標物，跟蹤效果穩定。實驗結果證實了測距羅盤和自動跟隨系統的有效性和可靠性。

圖9 移動機器人自動跟隨效果Fig.9 Automatic following effect of following robot

5 結 論

本文設計了一種基于環形紅外陣列的移動機器人自動跟隨系統。受復眼昆蟲具有無死角視野的啟發，利用具有主動式環形大視場的測距羅盤作為環境感知傳感器。測距羅盤由數個紅外測距傳感器組成周向陣列。對紅外傳感器進行參數標定，使測距羅盤可以準確、快速地確定其與移動目標物之間的距離和偏航角。依據目標物的位置信息并利用PD控制器控制跟隨機器人的移動，使跟隨機器人保持與移動目標物的相對距離和相對角度，實現對目標物的自動跟隨。在上位機操作界面可以實時顯示跟隨機器人的運動軌跡及其對周圍未知環境的探測情況，方便實驗結果的觀察與分析。進行了跟隨機器人“8”字形和方形兩種軌跡的跟隨實驗，實驗結果表明，機器人跟隨軌跡連續，在跟隨過程中未出現跟丟目標物的情況，跟蹤效果穩定，證實了測距羅盤和自動跟隨系統的有效性和可靠性。后續可以通過提高周向陣列傳感器的密度來實現更高分辨率的環境探測，使移動機器人的應用更為廣泛。