基于Robei EDA工具的多功能可重構機器人設計

鐘杭 孫浩 龔蓓蕾

摘 要：通過分析智能家居行業(yè)發(fā)現(xiàn)，機器人可分為家務功能型、娛樂家用型和助理管家型等，種類繁多但功能較為單一。市面上基于單片機的智能搬運機器人不具有可重構性和良好的實時性，不能夠滿足靈活多變的機器人需求。本團隊研究一款采用Robei？EDA設計的基于FPGA的多功能可重構機器人，具有人為遙控控制與語音控制、自動搬運物體、感測周圍環(huán)境、發(fā)射電磁炮等功能，可以實現(xiàn)環(huán)境檢測及火災預警、智能搬運及安保防御等作用，在提供便利服務的同時，有效保障居家安全。

關鍵詞：Robei；機器人；EDA；FPGA

*本項目獲得“2021全國大學生集成電路創(chuàng)新創(chuàng)業(yè)大賽”華東賽區(qū)一等獎，全國總決賽二等獎。

0 引言

隨著自動化技術以及計算機技術的發(fā)展，機器人技術正從傳統(tǒng)的工業(yè)制造領域向醫(yī)療服務、教育娛樂、勘探勘測等領域迅速擴展，適應不同領域需求的機器人系統(tǒng)不斷深入研究和開發(fā)。通過對智能家居的分析發(fā)現(xiàn)，市面上的機器人可分為代替人類完成家務的功能機器人、具有娛樂性的陪伴機器人和管理智能家電的助理機器人，種類繁多但是功能較為單一；多基于單片機或基于集成系統(tǒng)設計，不具有可重構性和良好的實時性，不能夠滿足靈活多樣的機器人需求且成本過高，而可重構機器人則可以根據(jù)任務需求更新其硬件構型[1]。

本團隊旨在通過一款機器人實現(xiàn)環(huán)境監(jiān)測及災難預警、安保防御及智能搬運等多種功能，有效保障居家安全，并提供便利服務。隨著中國老齡化的到來，獨居老人人數(shù)增多，以及當今社會獨居青年比例越來越高，對能保證基本生活環(huán)境的機器人的需求也會越來越多。相比上述市面上的功能型、娛樂型、助理型的非必需高檔奢侈類機器人，所設計的機器人有更高的市場潛力。

1 架構設計

本設計的架構基于Robei EDA工具設計（注：Robei EDA是一款可視化的跨平臺EDA設計工具[2]，能夠大大提高FPGA的開發(fā)效率），分為中心處理部分、傳感感知部分、電源電路部分、機械運動部分、網(wǎng)絡傳輸部分、上位機部分、顯示器部分及遙控控制部分。架構框圖如圖1所示。

邏輯流程圖如圖2所示，設計的機器人運行時可以進入兩種模式（自動和遙控）。進入系統(tǒng)前首先進行指紋識別，如果指紋正確則進入系統(tǒng)，如果指紋未錄入指紋傳感器的存儲器則無法進入系統(tǒng)，在進入系統(tǒng)后可以通過刷未錄入指紋的手指對系統(tǒng)上鎖，此時全機除顯示屏和指紋以外的模塊全部復位，待按上正確的指紋時才進行解鎖。

整機原理圖如圖2所示。

2 控制電路

2.1 遙控部分

遙控部分分為手柄遙控和語音控制兩個部分，分別通過手柄和語音對機器人進行實時控制。

2.1.1 手柄遙控

本模塊與外部指紋模塊與LCD HMI串口顯示屏模塊相連，當指紋輸入正確時，手柄遙控模塊復位解除，機器人所有傳感器均開始工作，同時顯示屏顯示開機動畫進入主程序。PS2手柄以SPI的通信協(xié)議與FPGA通信，使用者可以通過手柄按鍵和搖桿控制機器人移動、機械臂抓取運動以及對電磁炮超級電容進行充放電、放電發(fā)射金屬炮彈，其工作流程圖如圖3所示。

2.1.2 語音控制

語音控制部分包括串口模塊、電機驅動模塊、舵機驅動模塊和電磁炮驅動模塊；該部分的核心傳感器件是LD3320語音傳感器，通過SPI協(xié)議與FPGA通信。其工作流程如圖4所示。

2.2 自動部分

2.2.1 自主避障模塊

該模塊由4個超聲波傳感器控制和8路PWM波直流電機驅動控制組成，4個超聲波傳感器分別位于機器人的前后左右部分，通過測量判斷機器人各個方向障礙物相對于機器人的距離來控制電機運動，實現(xiàn)機器人的自主避障。

2.2.2 自動循跡模塊

該部分由FPGA對時序驅動CCD傳感器進行曝光采集賽道信息，經計算得到賽道中點相對于機器人的位置坐標，將該位置與像素中點相減得到賽道的偏移值，將偏移值代入PID模塊作為誤差進行運算，為機器人輸出PWM波，控制機器人的閉環(huán)循跡。

3 機械結構

本作品的機械結構主要由以下部分組成：機械臂部分、機器人運動部分、機器人輪胎和電磁炮部分。

3.1 機械臂部分

本作品采用三自由度機械臂，由機械部件和三個舵機組成，舵機的選型是MG996R，它是一種180°的數(shù)字舵機。其特點是便宜、大扭力（最大扭力可達20千克力），工作電壓為4.8～6 V。

舵機的主要控制原理是：輸入1個周期為20 ms的矩形脈沖，根據(jù)其占空比的大小來決定舵機輸出的轉軸角。

3.2 機器人運動部分

該部分由直流電機、輪胎、電機驅動模塊組成，其中直流電機采用4個370直流減速電機，控制電壓為12 V。電機選取的轉速為中等的170轉/min。電機驅動部分由2個電機驅動模塊組成，其型號為L298N，是一種H橋MOS管驅動電路，輸出電流大、隔離性強、頻帶寬，能夠輸出4路信號控制2個電機。

3.3 機器人底盤部分

機器人輪胎選用麥克納姆輪。由于獨特的機械結構，4個麥克納姆輪通過矢量相加可實現(xiàn)機器人平移、原地旋轉等特殊運動。

3.4 電磁炮部分

該部分主要包含逆變升壓模塊、繼電器模塊、超級電容模塊和電磁線圈模塊。

首先從繼電器模塊中引出兩根信號線給FPGA，F(xiàn)PGA可根據(jù)手柄和語音控制繼電器模塊閉合張開以控制12 V電源，通過逆變升壓模塊給超級電容充電，然后控制繼電器將12 V電源斷開，此時電能被存儲在超級電容之中。然后再次由FPGA控制電磁線圈閉合，使電能從電容中釋放，此時變化的電流通過線圈生成磁場。根據(jù)法拉第電磁感應定律和楞次定律，線圈中將產生排斥方向的洛倫茲力帶動炮管中的金屬彈射出。為了保護電路和隔離，使用可控硅和續(xù)流二極管等器件。

4 算法系統(tǒng)

4.1 機器人運動算法

本作品設計的機器人運動部分采用4WD的麥克納姆輪，每個麥克納姆輪上有若干傾斜45°的小輪子，在轉動時產生相比機器人傾斜45°的摩擦力，4個輪胎轉動配合即可實現(xiàn)平移、原地旋轉等運動。其運動原理如圖5所示，其中紅色代表輪子向前轉，藍色代表輪子向后轉。

4.2 自主避障算法

該部分在機器人周圍設計4個超聲波傳感器，當一方檢測到障礙物的距離小于15 cm時，機器人向逆時針90°方向平移，即左手定則，如前方檢測到障礙就向左平移，左邊檢測到障礙向后平移，以此類推。

4.3 自主循跡算法

本作品使用128路線性CCD傳感器進行循跡，當標記線位置偏向任意一側，控制機器人向另一側偏轉，使標記線始終保持在小車的中線附近。本作品還設計了循跡PID算法，可實現(xiàn)平滑轉彎。

4.4 濾波算法

機器人傳感器進行數(shù)據(jù)采集可能發(fā)生意外的抖動，數(shù)據(jù)現(xiàn)在誤差，進而影響機器人的判斷。因此，采用均值濾波和中值濾波算法對部分傳感器，如超聲波傳感器、角度傳感器、溫度傳感器進行一定的濾波，以改善傳感器效果。

5 圖像處理

圖像處理功能由CCD基于FPGA實現(xiàn)，主要有兩種功能：軌跡識別及顯示、復雜循跡。以下將詳細介紹各個功能的實現(xiàn)。

5.1 軌跡識別及顯示

傳感系統(tǒng)中的CCD模塊使用FPGA實現(xiàn)，本功能基于FPGA驅動TS1401線性CCD采集軌跡信息二值化后輸出至上位機，以顯示軌跡。

5.1.1 灰度值采集

首先，F(xiàn)PGA驅動CCD輸出其感光元件采集的線性128個像素的模擬電壓，模擬電壓經過AD9226模塊轉換成12位數(shù)字信號給FPGA?？紤]到AD模塊采集信號時有一定的隨機誤差，因此在采集時對其進行均值濾波，即采集7次AD，然后對采集的值求平均。由于本作品的AD轉換頻率高達50 MHz，因此采集更多的次數(shù)也是可以實現(xiàn)的，通過多次試驗且考慮到毛刺的影響，設置7次AD轉換比較合理。

5.1.2 二值化

可知CCD采集的灰度值越大，F(xiàn)PGA收到的12位數(shù)字值就越小，因此軌跡越黑數(shù)字值越大。根據(jù)設置閾值則可將軌跡和軌跡外的灰度二值化為0或1。本作品將黑色軌跡設置為0，其中閾值的大小由當次灰度采樣值的平均值、場地光強和調試經驗共同決定[3]。

5.1.3 平滑濾波

隨后單次采樣的128位像素均變?yōu)?和1的二值化量?？紤]到在采集灰度時存在一定的毛刺，使采集的數(shù)據(jù)有0到1或1到0的錯誤跳變，本作品對采集的軌跡進行平滑濾波處理。由于軌跡的連續(xù)性灰度信號不存在突然的跳變，因此在圖像采集時采集的1個、2個或3個孤點都是毛刺產生的，該影響表現(xiàn)效果如圖6所示。

測試發(fā)現(xiàn)，控制一定的曝光時間基本上可以將CCD產生的毛刺信號控制在3個以內。通過平滑濾波和調整曝光時間，CCD的采集得到較為完美的圖像，測試結果如圖7所示。

5.2 復雜循跡

基礎紅外光電傳感器有很大的缺點，如由于線路較少，其偏移值過于離散且數(shù)量?。▋H左右2個），其測量的偏差范圍是（-2～2）。該數(shù)據(jù)基本無法進行PID閉環(huán)控制，由于開環(huán)操作使得機器人循跡時抖動很大，效果不好，而且由于線路少，一路出故障就會對整個系統(tǒng)功能產生很大的影響。為了確保機器人的性能和穩(wěn)定性，按上一節(jié)采用圖像處理方法實現(xiàn)機器人的復雜循跡，包含基礎連續(xù)軌跡、間斷軌跡和交叉環(huán)島，基于CCD圖像識別完成機器人對其復雜循跡。

5.2.1連續(xù)軌跡

首先是實現(xiàn)機器人的連續(xù)循跡，由上一節(jié)CCD識別軌跡可以發(fā)現(xiàn)，黑色的軌跡在FPGA上表現(xiàn)為0，通過1次采集的128個像素所構成的二值化數(shù)組，即可得到軌跡兩邊的邊緣坐標，根據(jù)邊緣坐標即可計算出軌跡中點坐標，然后將中心坐標與128的1/2（取整數(shù)63）做差，即可得到機器人相對軌跡的偏差。如CCD得到黑線左邊坐標為68，右邊坐標為97，經計算得到黑線的中心坐標為82，說明此時黑線中點位于小車右邊19個坐標位置，小車則需要左移19個坐標才能實現(xiàn)軌跡的跟蹤即循跡。為了實現(xiàn)這一點，基于Verilog實現(xiàn)的PID制器將軌跡中點和小車的偏差作為輸入，輸出為小車左邊電機和右邊電機的PWM波占空比之差，以此閉環(huán)實現(xiàn)機器人的循跡功能。

5.2.2 間斷軌跡

對于間斷的軌跡而言，機器人若采取連續(xù)循跡方案很容易沖出賽道，因此在需要一定的判斷，在CCD采樣前首先存儲一次機器人上一次采樣的數(shù)據(jù)，如果判斷到錯誤的軌跡，如左邊坐標等于最小值、右邊坐標等于最大值以及左邊坐標大于右邊坐標的情況，即讓上一次正確的采樣值完全替代這次的采樣值。該方法相當于一種特殊的卡爾曼濾波法。

5.2.3 交叉環(huán)島

在（2）所提到的算法既可以修正CCD采集到全0或者是全1的情況，其中全1代表間斷軌跡，全0則代表環(huán)島的交叉點，顯然在此算法下機器人將根據(jù)之前的采樣正確地通過環(huán)島。

6 系統(tǒng)整合與調試

6.1 串口模塊

本部分采用UART協(xié)議結合藍牙模塊形成無線串口，實現(xiàn)機器人與PC端的上位機的無線通信，波特率為9 600 bit/s。

6.2 上位機設計

該部分基于PyQt設計和機器人配套的上位機軟件，在實現(xiàn)串口收發(fā)的基礎上，針對機器人的移動和機械臂的抓取設計了獨立按鍵，用戶可以通過點擊鼠標按鍵或者綁定的鍵盤來控制機器人運動和抓取，該部分主要用于調試機器人。

6.3 HMI串口屏設計

本部分基于FPGA結合觸摸電阻屏和串口設計一款機器人顯示端，具有豐富的按鍵和人性化的GUI。用戶需要解鎖才能使用，可以通過點擊按鍵來獲取各類信息，當觸發(fā)災難事件時會預警。本部分是機器人主要的人機交互模塊，傳感器的測試均可在顯示屏的顯示中得到驗證。

7 結束語

目前市面上少有純粹基于FPGA設計的機器人，本設計的機器人完全采用FPGA實現(xiàn)控制，由于其現(xiàn)場可編程特性以及并列運行指令結構，具有很好的可重構性和實時性。因此，基于FPGA的多功能可重構機器人能夠很好地彌補市場缺口，具有更低的成本。除此以外，隨著FPGA性能的提升以及集成電路產業(yè)與自動控制、計算機產業(yè)的互相促進融合，基于FPGA實現(xiàn)的機器人不僅能夠作為市場產品的替代，而且能夠實現(xiàn)更為復雜的算法和功能。

參考文獻：

[1]李斌，吳鎮(zhèn)煒，談大龍，等.可重構機器人技術的探討[J].信息與控制，2001，30（0S1）：684-688.

[2]吳國盛.7天搞定FPGA：Robei與Xilinx實戰(zhàn)[M].北京：電子工業(yè)出版社，2016.

[3]趙萬欣，陳思屹.基于TSL1401線性CCD的智能巡線小車[J].工業(yè)控制計算機，2014，27（2）：121-122.

2943500783333