基于OpenMV和Arduino的智能巡線機器人＊

李思熠，王少坤

基于OpenMV和Arduino的智能巡線機器人＊

李思熠，王少坤

（西北農林科技大學 水利與建筑工程學院，陜西 楊凌 712100）

巡線機器人作為一種能自動識別路徑行走的機器人，被廣泛用于快遞分揀、輸電線路巡檢等路徑規劃場合，有著良好的發展前景[1]。但如何提高其識別路徑的準確性、快速性仍是需要不斷突破的難點，針對以上問題，設計了一種基于OpenMV和Arduino的智能巡線機器人。在機器視覺方面，采用顏色識別算法、閾值二值化處理、權重計算和線性回歸算法進行圖像捕捉和路徑追蹤。在通信系統方面，采用以機器人舵機控制板為主、OpenMV和Arduino為輔的主從加分布式模塊化結構控制機器人行走模式和方向。在機械結構方面，采用了對稱機械結構設計、大扭力舵機替換等方法來解決自身重心偏移、承重能力等問題。實驗表明，在9 600波特率下，機器人可以十分穩定、快速地進行路徑識別巡線工作。

OpenMV；智能控制；Arduino；巡線機器人

1 引言

隨著人工智能技術的發展，機器人研究領域也變得越來越多元化，對機器人的要求也越來越高，機器人的智能化成為了當今研究熱點。而作為應用廣泛的巡線小車，其發展前景也是一片大好[2]。隨著類人機器人成為機器人的主要發展方向，許多模仿人的形態和動作的機器人被設計出來，雙足型仿人機器人也被用到了服務業、工業、軍業等多個領域，對仿人巡線機器人也開始有了研究[3]。傳統的仿人巡線機器人由舵機構成主要支架，外可加類人外形包裝，其控制系統則由舵機控制板以及各種形式的傳感器構成。例如可用安裝在腳板上的位置型灰度傳感器來判別機器人行走過程中是否偏離規定的線路，若設定線路為黑色，則傳感器識別到黑色就會傳遞“是”指令，機器人仍保持直線行駛；若某一特定位置傳感器檢測到其他顏色，傳感器就會傳遞“非”指令，機器人便按照傳感器所在位置進行左右轉判別，直到回歸正常軌道為止。此種方法動作緩慢，需要傳感器數量較大，傳感器受周圍光照環境等因素大，會出現“誤判”情況。為了改善這種傳統情況的不足，本文將OpenMV攝像頭當作機器人的“眼睛”，利用Arduino單片機聯結攝像頭與舵機控制板通信，使巡線機器人能保持高度的靈敏性，并可隨時調節由光線帶來的顏色閾值問題。

2 基于OpenMV的機器視覺識別算法

2.1 OpenMV簡介

OpenMV是一個以STM32F765VI ARM Cortex M7處理器為核心，集成了OV7725攝像頭芯片的機器視覺模塊，其搭載了Micro Python解釋器，可用Python語言高效地實現核心機器視覺算法。OpenMV機器視覺算法包括尋找色塊、人臉檢測、顏色跟蹤等功能，可以用來實現產品的殘次品篩選、非法入侵檢測、跟蹤固定的標記物等，具有穩定性高、傳輸效率高等特點[4]。

2.2 OpenMV路徑識別算法

圖像處理技術是OpenMV的核心功能，也是巡線機器人最重要的部分。OpenMV IDE作為調試軟件，可將圖像處理部分與攝像頭硬件連接起來，方便有效地操作。作為機器人的“眼睛”，OpenMV負責將道路狀況實時發送給機器人，判斷行走路線是否偏離既定的軌道。若偏離值在允許范圍內，則機器人繼續保持直行；若偏離值超過設定范圍，則根據其大小和方向旋轉相應的角度來控制機器人回歸到軌 道上。

對于尋跡軌道，根據現實要求，可分為單軌巡線和雙軌巡線。在這里，以單軌巡線為分析點。攝像頭將把路面信息以實時圖像呈現在IDE中，同時根據需要，設定圖像顯示形式，可采用GB565彩色顯示，也可采用GRAYSCALE黑白模式，同時可使用ROI命令來選擇自己所需要的圖像區域。以軌道顏色為黑線為例，設置捕捉色塊的閾值為黑色閾值，就可以抓捕到圖像中所有黑色的色塊并標記出來[5]。然后進行圖像的Otsu二值化處理，即將圖像轉化為只有黑白兩種閾值的圖像[6]。在對其進行閾值分割時，選定的分割閾值應使前景區域的平均灰度、背景區域的平均灰度與整幅圖像的平均灰度之間差別最大，這種差異用區域的方差來表示，其相互關系如下所示：

=0×0+1×1（1）

2=0×（0－）2+1×（1－）2（2）

式（1）（2）中：為圖像的總平均灰度；0為前景像素點總數占圖像總像素點數目比例；0為平均灰度；1為背景像素點總數占圖像總像素點數目比例；1為平均灰度；2為前景和背景圖象的方差。讓閾值在灰度范圍內依次取值，使2最大的閾值便是最佳區域分割閾值[7-8]。

經過色塊尋找和Otsu二值化處理后，可對黑線實行多段標記，經過權重加和算法或者線性回歸處理對黑線進行偏離值計算，這里的偏離值是指偏離圖像中心線的角度，根據程序算法完成。如此，便可實時顯現出機器人對于軌道的偏離程度。若想將偏離數據傳給機器人，就需要采用URT命令與Arduino進行串口通信傳值[9]。

3 基于Arduino的機器人控制系統設計

3.1 Arduino簡介

Arduino是一塊基于開放原始代碼的Simple i/o平臺，具有類似Java、C語言的開發環境，可以配合一些電子元件例如LED燈、蜂鳴器、光敏電阻等來開發出設計者想要的產品，效果驚人。此外，Arduino還可以在運行時和電腦中的程序如Flash、Processing、MaxMSP等進行通訊。其以高速的微處理控制器（Atmel Atmega328）、USB直供電或外部5～9 V直流電壓供電以及簡單、易理解的開放語言和環境等優點備受電子元件愛好者的推崇[10]。

3.2 Arduino控制算法設計

Arduino實際上由可編程電路板和Arduino IDE集成開發環境軟件組成。可使用IDE編寫計算機代碼，然后下載到實際電路板中，實現電路板單獨控制機器人的脫機運行。至于對電路板的大小要求比較嚴格的地方，可以采用Arduino Nano，它有著十分小巧的體積，且其他功能依然完善。Arduino Nano的引腳示如圖1所示。

Arduino既要接受由OpenMV傳遞過來的角度偏轉值，又要向舵機控制板輸出信號控制機器人行走，但因其本身只有一個串口，無法同時進行接收與發送，于是在與OpenMV進行通信時，需設置模擬串口（軟串口）進行信息交流[11]。串口通訊至少需要3根線，即TX、RX和GND，TX是發送端，RX是接收端，GND是地線。則在Arduino IDE軟件中，需編寫將數字串口設置成模擬串口的代碼，以D2、D3數字口為例，其設置成為軟串口的命令為：

其中，默認設置D2口為接收端RX，D3口為發送端TX。在硬件上，將Arduino Nano的D2、D3引腳分別與OpenMV的TX、RX引腳相連（實際為P4、P5引腳），就可以實現信號通訊。不同于傳統的巡線機器人，此種設計下的傳輸速度是可控的，可以設置兩者的通信傳輸速率為9 600波特率或者4 800波特率，具體數值可根據實際情況靈活選擇。在這里，基于對機器人的快速性要求，選擇9 600波特率。

圖1 Arduino Nano引腳圖

實際上，Arduino起著信號傳遞作用。OpenMV程序會將具體的偏轉值轉化成為左轉和右轉信號，若開始執行轉向信號的偏轉值為4°，則相關程序如下所示：

攝像頭傳遞給Arduino“L”“R”或者“S”的信息，Arduino又將信號傳遞給舵機控制板，并按照內部編程信息執行事先已儲存在控制板內的動作組，這樣機器人就可以在偏差可控范圍內沿著黑色直行走。

3.3 舵機控制系統設計

機器人控制系統是根據指令及傳感信息控制機器人完成一定的動作或任務的裝置，它是機器人的心臟，決定了機器人性能的優劣[12]。舵機控制板、Arduino與OpenMV三者相連的系統就是其控制系統，控制機器人的行走模式與方向。該控制系統采取模塊化設計控制結構，將主從控制與分布式控制方式相結合，促使形成一種主從加分布的控制方式，這不僅可以有效地減少主控制器的工作量又可以及時處理從控制器出現的一些緊急或單一控制的情況，有助于機器人的整體實時控制與工作效率提升。

在實際運行時，需將舵機控制板的信號線、地線與Arduino連接進行信號通信，即接通控制板上的二次開發串口通信接口，舵機控制板如圖2所示。該控制板同樣搭配調試軟件，在其內部程序中，可設定機器人每一個舵機運轉的時間，根據各種情況下的實際需要，調試出不同時間的動作組。而一般情況下，準確率高的機器人動作較慢，動作快的機器人平穩性較差，可采用不同的行走姿態來解決這個問題。

圖2 16路舵機控制板圖

在組裝機器人時，需將機器人舵機各個號位連接于舵機控制板中的特定接口，根據事先調試好的動作組執行相應程序。若想實現脫機運行，則需要為其安裝7.4 V左右的鋰電池，對舵機控制板和Arduino供電，并且將Arduino的5 V電源線與OpenMV的VIN接口相連，實現對攝像頭的供電運行。如此，三者就可僅用一塊電池實現三位控制器的脫機運行，具有良好的實際運用性。

4 系統整體結構設計

4.1 機器人結構設計

作為仿人機器人，其必須要有明顯的頭、手臂、軀干和雙足等部分，與人體的結構比例相協調。所以設計機器人頭部為1個自由度，手臂2個自由度，軀干設計自由度不等，但大體上可分為縱軸與橫軸自由度，并且要求機器人在行走過程中有明顯的、協調的擺頭和擺臂動作[13]。

對于機器人的軀干設計，需選擇兩種型號舵機。一種是RDS3115雙軸型舵機，這是一款專門為機器人設計的數字舵機，扭矩15 kg，運行噪聲低、平穩且線性度高，可控角度范圍為180°，斷電可360°旋轉，采用單片機MCU控制，特別適合機器人的各關節活動。在機器人的手臂、腰身以及大腿等位置安裝，可實現最基礎的行走、轉向以及立定等動作。另一種則是SG90小舵機，其質量僅為9 g，在4.8 V供電電源下，無負載速度為0.12 s/60°，堵轉扭矩為1.2～1.4 kg/cm，死區設定為7 μs左右。它則主要安裝在機器的頭部以及手腕處。因為頭部舵機會導致重心的上移、機器人下盤不穩等問題，需要質量比較小的舵機來控制，而大小舵機聯合組成機器人的手臂可使軀體在行進時更加協調與美觀。

金屬鋁件作為一種將舵機連接起來的中間元件，是機器人機械結構必不可少的一部分，如圖3所示。此僅為其中連接件的一種形式，機器人頭部與肩部、肩部與手臂、肩部與腿部以及腿部與腳板之間的連接件都不一樣，需要根據實際舵機位置而設計，具有靈活性。

圖3 金屬鋁件連接圖

機器人的腳板設計也需要與人類相仿，采用材質輕、強度高、機械性能好的有機塑料制作成為類似矩形的平行腳板，可有助于機器人的重心平穩。當要適用于摩擦力較小的環境時，可選擇在原腳板上貼上防滑墊，也可選擇其他摩擦力較大的腳板材料，以防機器人打滑。

4.2 系統調試

根據所選材料組裝好機器人并同時接通電源與控制系統后，便開始進行機器人調試。在這過程中，出現了機器人重心不穩、承重能力差等問題，但可采用大扭力舵機替換機器人的肩部與腳踝舵機的方案來解決這個問題，根據現場調試情況來看，有良好的效果。同時，在機器人行走過程中根據各種實際情況，需要相應地調整機器人各個動作組中舵機的旋轉角度以及運行時間，以適應行走的環境。一旦時間以及程序設定完成，其脫機運行獨自完成巡線任務的速度就是一定的，可用于不需要頻繁變更的場合，十分方便。

5 總結

總體來說，此次設計的仿人巡線機器人主要由機械結構和控制系統組成。仿人競速機器人要求其外形似人，若把機械結構看作人的骨架，那么控制系統就被認為是人的大腦，所以機器人的先進程度與功能強弱通常都直接與其控制系統的性能密切相關。仿人機器人作為當今科技發展的主要機器人類型之一，注定有著不可估量的未來。比如可利用機器人攜帶的攝像裝置，實現線路及其安全通道的檢測與巡視，將檢測到的數據和圖像信息經過無線傳輸系統發送到地面基站，通過地面基站接收、顯示發回的數據和圖像資料。而本文設計的巡線機器人可與其他硬件相搭配實現物流搬運、智能分揀、輸電線路巡檢等功能，將在農業、工業、民業以及醫學類等領域實現廣泛運用[14]。

［1］陳超，鄭彥寧，江鵬，等.基于兩自由度模塊化關節的巡線機器人設計［J］.儀器儀表學報，2014，35（12）：28-35．

［2］高峰，郭為忠.中國機器人的發展戰略思考［J］.機械工程學報，2016，52（7）：1-5．

［3］任大林，劉恒，劉琴.淺析仿人機器人專利發展狀況［J］.科技創新與應用，2016（18）：57.

［4］牛國臣.基于OpenMV的類人機器人教學實踐［J］.計算機教育，2019（10）：38-41.

［5］劉彩霞，楊春.基于機器視覺的食品碼垛機器人控制系統設計［J］.食品工業，2020，41（1）：231-233.

［6］OTSU N.A threshold selection method from gray－Level histograms［J］.IEEE Transactions on Systems Man and Cybernetics，1979，9（1）：62.

［7］雷建鋒，汪偉.基于OpenCV的圖像閾值分割研究與實現［J］.現代電子技術，2013，36（24）：73-76.

［8］牛國臣，許開魯.基于線性CCD的類人機器人循跡系統的設計［J］.現代電子技術，2018，41（2）：133-136，140.

［9］李占鵬，郭穎，韓濟陽，等.基于圖像識別的雙足循跡機器人設計［J］.國外電子測量技術，2019，38（4）：154-157.

［10］孫梅，張森林.基于Arduino模塊化機器人視覺系統的研究與設計［J］.華中師范大學學報（自然科學版），2014，48（4）：511-515.

［11］施敏虎，栗云鵬，莊曙東，等.基于OpenMV的智能搬運車型機器人的設計［J］.機械工程師，2020（4）：20-25.

［12］韓富寧.中國民航信息化系統現狀及發展展望［J］.硅谷，2013，6（17）：4，7.

［13］吳悅.仿人機器人的設計與競賽應用［J］.電子世界，2019（23）：136-137.

［14］王田苗，陶永.我國工業機器人技術現狀與產業化發展戰略［J］.機械工程學報，2014，50（9）：1-13．

TP242

A

10.15913/j.cnki.kjycx.2020.22.020

2095－6835（2020）22－0050－04

西北農林科技大學教學改革項目“大學生科技競賽與工科專業創新教學協同模式研究”（編號：JY1903095）；西北農林科技大學大學生創新創業訓練項目“多功能智能物流搬運機器人”（編號：X201910712285）

李思熠（1999—），女，重慶人，本科，主要從事機器人視覺方面與Arduino方面的研究。

王少坤（1979—），男，河北趙縣人，碩士，實驗師，主要從事智能控制技術與機器人技術、電力電子技術方面的研究。

〔編輯：嚴麗琴〕