六足仿生機器人的設(shè)計與實現(xiàn)

(湖北大學 物理與電子科學學院，武漢 430062)

0 引言

近年來，用機器人替代人類進入條件惡劣或者高度危險的區(qū)域工作已經(jīng)成為一種趨勢。例如機器人進行水下作業(yè)、無人機進行偵查勘測、機器人在廢墟中探測生命跡象等。然而許多在路面作業(yè)的輪式或履帶式機器人在遇到復雜地形時，因地形原因?qū)o法正常工作。其次大多數(shù)的機械臂無法像人手一般靈活，在特殊環(huán)境下增加了控制者的操作難度為解決以上問題，本項目基于SOC-FPGA平臺設(shè)計實現(xiàn)了一種可在復雜地形行動，機械臂可跟隨人手實時作業(yè)，可運用VR眼鏡實時觀察行徑中的全景圖像的六足仿生機器人。

1 系統(tǒng)框架設(shè)計

系統(tǒng)框圖如圖1所示，主要由視頻成像設(shè)備、仿生機器人主體、遠程控制設(shè)備三部分構(gòu)成。其中視頻成像設(shè)備是戴在操作者頭部的VR眼鏡，遠程控制設(shè)備是穿戴在操作者手上的數(shù)據(jù)采集手套。

圖1 系統(tǒng)整體框架

1.1 機器人主體設(shè)計

1.1.1 外部結(jié)構(gòu)設(shè)計

機器人主體實物如圖2所示，由六足底座、DE1-SOC開發(fā)板、仿生手臂、USB攝像頭、無線路由器及兩個藍牙模塊組成。DE1-SoC開發(fā)平臺作為機器人的信息處理中心，是基于臺灣友晶公司設(shè)計生產(chǎn)的Intel SoC FPGA硬件設(shè)計平臺，具備強大的雙核Cortex-A9處理器和行業(yè)領(lǐng)先的可編程邏輯器件[1]。高清USB攝像頭作為機器人的視頻輸入設(shè)備，同時配備兩個舵機控制其拍攝角度。無線路由器用于構(gòu)建局域網(wǎng)，實現(xiàn)機器人到視頻成像設(shè)備的視頻實時傳輸。藍牙A、藍牙B兩個藍牙傳輸模塊，分別用于操作者頭部運動信息和遠程控制設(shè)備信息的接收。

如圖3所示，機器人的運動部件為對稱的六腳蜘蛛結(jié)構(gòu)的底座，六足支撐狀態(tài)站立時，底座尺寸為長：48 cm；寬：43.5 cm；凈高：9 cm；包含開發(fā)平臺及攝像頭主體高度：48.7 cm。

圖2 機器人主體實物圖 圖3 六足底座模型

機器人單足尺寸為：寬5.5 cm；伸直狀態(tài)下，足長：23 cm。且第一關(guān)節(jié)長：14 cm；第二關(guān)節(jié)長：9 cm；第三關(guān)節(jié)長：5 cm。每只腳均裝配有三個舵機，如圖4所示，實現(xiàn)了三個自由度運動的控制。1號舵機控制“足”在XY平面的旋轉(zhuǎn)；2、3號舵機控制“足”的兩個不同關(guān)節(jié)在垂直于XY平面方向的伸縮。舵機主要參數(shù)如表1所示。

圖4 足部舵機分布圖

舵機型號重量尺寸LD-201560g40?20?40.5mm速度堵轉(zhuǎn)扭矩工作電壓0.16sec/60°15-17kg/cm6-7.4V

如圖5所示，仿生手臂及手指采用3D打印制作，手臂截面直徑最大為10.5 cm，手掌張開手臂全長為42.5 cm，內(nèi)部安裝有5個MG995型號舵機，具體參數(shù)如表2所示。用5條高強度編織繩將其與手指連接。通過舵機來牽扯編織繩，實現(xiàn)對手指彎曲程度的控制。

圖5 仿生手臂內(nèi)部結(jié)構(gòu)

1.1.2 控制邏輯設(shè)計

控制邏輯分為三個部分，分別是陀螺儀的數(shù)據(jù)收集與

表2 手臂內(nèi)部舵機參數(shù)

處理；彎曲傳感器信號接收與處理；方向控制指令的接收與處理。

陀螺儀數(shù)據(jù)收集與處理模塊，細分為如下子模塊：藍牙連接指令存儲模塊，串口數(shù)據(jù)發(fā)送模塊，串口數(shù)據(jù)接收模塊，數(shù)據(jù)處理模塊，算法模塊，舵機控制模塊。藍牙信號傳輸工作波特率數(shù)值設(shè)置為1 200。其工作邏輯為，串口數(shù)據(jù)發(fā)送模塊發(fā)送連接指令，連接成功后串口接收模塊接收數(shù)據(jù)。數(shù)據(jù)經(jīng)數(shù)據(jù)處理模塊提取出有效數(shù)據(jù)，如陀螺儀的滾轉(zhuǎn)角、俯仰角、偏航角。有效數(shù)據(jù)輸出至算法模塊，轉(zhuǎn)換為攝像頭舵機的控制信號。最后將控制信息發(fā)送至舵機控制模塊，實現(xiàn)對攝像頭拍攝角度的控制。

在彎曲傳感器信號接收與處理模塊中，其藍牙信號傳輸部分波特率數(shù)值設(shè)置為9 600，原理與陀螺儀信號接收相同。在數(shù)據(jù)接收后傳入數(shù)據(jù)處理模塊進行解碼操作，輸出預置的控制信號給舵機控制模塊，實現(xiàn)對機械臂的控制。

方向控制指令的接收與處理模塊包含指令接收，指令發(fā)送以及解碼模塊。藍牙傳輸波特率數(shù)值設(shè)置為115 200，經(jīng)指令發(fā)送模塊發(fā)送握手信號，連接成功后，接收模塊接收藍牙數(shù)據(jù)。經(jīng)解碼模塊將其與預置數(shù)據(jù)進行比對。得出相應(yīng)的控制信號，將其發(fā)送至舵機控制模塊，從而驅(qū)動底座運動。

1.2 遠程控制設(shè)備設(shè)計

遠程控制設(shè)備為一個自制的數(shù)據(jù)手套，如圖6所示，由六片應(yīng)變傳感器、方向控制板以及藍牙模塊組成。應(yīng)變傳感器獲取操作者五個手指和手臂的彎曲程度[2]，轉(zhuǎn)換成數(shù)據(jù)信號后連同控制板輸出的方向信號一起通過藍牙模塊發(fā)送至仿生機器人主體，實現(xiàn)對六足底座和仿生手臂的控制。

圖6 遠程控制設(shè)備實物圖

1.3 視頻成像端設(shè)計

視頻成像端實物如圖7所示，主體為一個VR頭盔，內(nèi)部放置一部安卓手機，陀螺儀，鋰電池以及藍牙模塊。陀螺儀采集操作者頭部運動信息，通過藍牙模塊發(fā)送至仿生機器人主體，信號經(jīng)處理后用于控制機器人攝像頭的拍攝角度，將眼鏡盒中的智能手機連入由路由器所構(gòu)建的局域網(wǎng)中。打開我們自行編寫的APP，即可將機器人傳輸過來的圖像實時顯示在屏幕上，調(diào)焦旋鈕用于調(diào)整手機到VR目鏡的距離。

圖7 遠程控制端實物圖

2 功能實現(xiàn)方案

2.1 六足步態(tài)設(shè)計

機器人六足步態(tài)設(shè)計分為前進后退步態(tài)設(shè)計與旋轉(zhuǎn)步態(tài)設(shè)計。其中步態(tài)設(shè)計分為六足整體行進步態(tài)和單足擺動步態(tài)設(shè)計。并在仿生機器人行進過程中采用PID控制器以調(diào)整行走幅度[3]。

2.1.1 前后行走步態(tài)設(shè)計

六足的編號以及分布位置如圖8所示，為使機器人可以克服復雜地形并平穩(wěn)行走，參考蜘蛛的行走方式，規(guī)劃出仿生機器人行走的步態(tài)。根據(jù)步態(tài)規(guī)劃得出一個機器人前進過程中六足分時擺動的動作順序圖，如圖9所示。為保證仿生機器人在運動過程中重心不會出現(xiàn)大幅度晃動，在機器人的行進步態(tài)中加入兩個六足支撐階段以穩(wěn)定重心。從圖中可以看出運動的一個周期中含有足擺動階段和六足支撐階段。第一階段與第五階段六足均不運動，六足全部觸地調(diào)整重心。在其他階段中足的運動順序為：6號足、4號足、2號足、5號足、3號足、1號足。此動作順序可有效避免機器人在前進的過程中重心后搖或者主體大幅度擺動[4]。該過程稱為一個運動周期，如此反復以實現(xiàn)仿生機器人的前進行駛。

圖8 六足編號與分布

控制單個足擺動的步驟分為垂直上升階段、向前擺動階段、垂直下降階段[5]。設(shè)置垂直上升階段和垂直下降階段的目的是為了避免足在運動的多個階段中多次碰到障礙物而影響步態(tài)節(jié)奏以及減小足在運動過程中的行進阻力，加快行進速度。設(shè)定上升階段與下降階段的高度均為25 cm，以克服常見的不平整路面。在水平擺動階段中，主要工作的設(shè)備是每只足的一號舵機，假設(shè)在一次水平擺動的過程中，足沒有觸碰任何障礙物，則足在XY平面水平轉(zhuǎn)動15°。如果有障礙物阻擋足的水平擺動，且此時舵機旋轉(zhuǎn)角度為θ1。足會順勢下落重新執(zhí)行垂直上升階段，二次水平旋轉(zhuǎn)的角度由第一次旋轉(zhuǎn)角度的大小決定。二次水平旋轉(zhuǎn)的角度θ2=15°-θ1，以彌補一次旋轉(zhuǎn)過程中所缺省的行進路程。

圖9 前進步態(tài)

對六足輸入PWM控制方波的過程中，如圖10所示采用PID控制器來對關(guān)節(jié)角度進行調(diào)整。以現(xiàn)態(tài)的關(guān)節(jié)輸出量作為系統(tǒng)反饋信號與期望的關(guān)節(jié)角度進行積分運算，輸入PID控制單元，將調(diào)整后的控制量再次輸入關(guān)節(jié)，形成一個閉環(huán)控制系統(tǒng)。一旦控制量進入飽和區(qū)，將削弱積分項的運算，從而減小次態(tài)中對關(guān)節(jié)的輸入量，起到飽和抑制的作用。

圖10 關(guān)節(jié)角度控制原理

機器人的后退過程與前進過程原理相同，后退步態(tài)順序變化為：2號足、4號足、6號足、1號足、3號足、5號足。單足擺動時，在XY平面的旋轉(zhuǎn)方向與前進過程相反，其余步驟無需修正。

2.1.2 旋轉(zhuǎn)步態(tài)設(shè)計

本設(shè)計中將旋轉(zhuǎn)步態(tài)設(shè)定為原地旋轉(zhuǎn)，即不改變仿生機器人的空間位置，其目的是改變仿生手臂的方向以及機器人前進方向。如圖11所示，旋轉(zhuǎn)過程中仿生機器人的步態(tài)設(shè)計中同樣分為六足支撐階段和單足擺動階段。其中第一階段與第五階段為六足支撐階段，用于平衡仿生機器人重心。單足擺動階段，采用相鄰足連續(xù)工作的方式，即1、2足協(xié)調(diào)運動，3、4足協(xié)調(diào)運動，5、6足協(xié)調(diào)運動。運動順序依次為：1號足、2號足、3號足、4號足、5號足、6號足。在單足擺動過程中，運動分為垂直上升階段、水平擺動階段、垂直下降階段。設(shè)置每足單次抬起高度為15 cm，單次旋轉(zhuǎn)角度為15°，1號足至6號足依次執(zhí)行步態(tài)完畢一個旋轉(zhuǎn)周期結(jié)束。

圖11 旋轉(zhuǎn)步態(tài)

2.2 遠程控制設(shè)備設(shè)計

如圖12所示，遠程控制設(shè)備系統(tǒng)包括控制仿生手臂運動的數(shù)據(jù)采集手套、捆綁于操作者手臂上的單片機、藍牙模塊以及方向控制板面。單片機對來自數(shù)據(jù)采集手套和來自控制面板的這兩類信號進行采集、編碼等操作，并通過藍牙模塊將處理結(jié)果發(fā)送至仿生機器人主體，以實現(xiàn)遠程遙控。

圖12 遠程控制設(shè)備系統(tǒng)框圖

手部動作采集手套上對應(yīng)手指的部分有五條應(yīng)變式彎曲傳感器，手肘位置也貼有一條彎曲傳感器。由公式R=ρL/S可知金屬阻值與材料、長度以及橫截面積有關(guān)，取其微分形式可得dR=ρ/SdL+L/Sdρ-ρL/S^2dS。故彎曲傳感器在手指運動作用下產(chǎn)生的機械形變會導致其電阻阻值的變化，從而間接地影響流過金屬的電流大小。應(yīng)變式彎曲傳感器實物如圖13所示。

圖13 應(yīng)變傳感器實物圖

當測得彎曲傳感器電阻值變化量為ΔR時，經(jīng)過測量電路獲取電壓變化值ΔV，將ΔV的值與預先設(shè)置的參考值進行比對，來判斷手指的彎曲程度。ΔV經(jīng)AD轉(zhuǎn)換后傳入單片機進行編碼，最后通過藍牙模塊將編碼信息發(fā)送至DE1-SoC部分的藍牙接收端。

2.3 實時VR成像實現(xiàn)方法

系統(tǒng)實時VR成像的實現(xiàn)框圖如圖14所示[6]，USB攝像頭獲取圖像信息傳輸至DE1-SOC開發(fā)平臺的HPS部分，存入DDR內(nèi)存。FPGA部分通過AXI bridge訪問DDR內(nèi)存，調(diào)用圖像數(shù)據(jù)進行VR成像處理，并將處理結(jié)果寫回DDR內(nèi)存，ARM再從內(nèi)存中讀取處理完后得數(shù)據(jù)，發(fā)送到同一局域網(wǎng)內(nèi)的安卓手機。為加快圖像處理的速度，編寫OpenCL加速邏輯進行圖像處理操作。VR頭套內(nèi)部安裝有陀螺儀用于探測操作者頭部的動作變化，頭部的當前狀態(tài)信息通過藍牙模塊傳輸至DE1-SoC開發(fā)平臺，用于控制攝像頭的轉(zhuǎn)動。

圖14 實時VR成像系統(tǒng)圖

2.3.1 視頻數(shù)據(jù)采集及處理

加速系統(tǒng)的軟件設(shè)計主要是為加速內(nèi)核填充圖像數(shù)據(jù)，并進行雙目化處理。通過對ARM的Linux系統(tǒng)內(nèi)核重新編譯，加入USB攝像頭的驅(qū)動，然后編寫應(yīng)用程序，調(diào)用USB攝像頭，獲取實時圖像，每幀圖像的分辨率為640*480，將此圖像通過AXI bridge傳輸給FPGA，在FPGA中運行OpenCL加速子系統(tǒng)，對圖像進行處理。

在OpenCL加速子系統(tǒng)中，OpenCL編譯器將圖像雙目化處理內(nèi)核算法編譯為OpenCL加速邏輯連接到OpenCL接口上，并記錄在二進制OpenCL內(nèi)核文件中[7-8]。在加速處理圖像數(shù)據(jù)時，調(diào)用OpenCL二進制文件更新FPGA邏輯。處理之后的圖像通過AXI bridge存入ARM端的DDR內(nèi)存指定區(qū)間。ARM處理器再從此內(nèi)存區(qū)間內(nèi)讀取出圖像數(shù)據(jù)，圖像處理結(jié)果如圖15所示。

圖15 原圖與處理后圖像對比

2.3.2 VR頭套設(shè)計

本設(shè)計利用I2C總線協(xié)議驅(qū)動的MPU-6050陀螺儀可以通過測量加速度或者角速度來測量x、y、z軸三個方向的旋轉(zhuǎn)角度。如圖16所示，以x軸正方向作為人眼的觀察方向，三個旋轉(zhuǎn)角度分別為繞x軸旋轉(zhuǎn)的滾轉(zhuǎn)角Roll、繞y軸旋轉(zhuǎn)的俯仰角Pitch以及繞z軸旋轉(zhuǎn)的偏航角Yaw[9]。

測量Roll角、Pitch角、Yaw角時，首先從相應(yīng)寄存器地址讀取出繞三個方向旋轉(zhuǎn)角速度GYT_X 、GYT_Y、GYR_Z，均以“度/秒”作為單位。以初始位置作為基準，分別對時間進行積分，從而求出在三個方向上與前一位置的相對旋轉(zhuǎn)角度。陀螺儀滾轉(zhuǎn)角、俯仰角、偏航角計算方法如下：

Roll=((RollH<<8)|RollL)/32768*180°

(1)

Pitch=((PitchH<<8)|PitchL)/32768*180°

(2)

Yaw=((YawH<<8)|YawL)/32768*180°(3)

式中，RollH，RollL，PitchH，PitchL，YawH，YawL均可從相應(yīng)寄存器讀取。

圖16 俯仰角、滾轉(zhuǎn)角、偏航角分布圖

DE1-SoC的ARM部分通過有線網(wǎng)口連接到路由器，安卓手機則通過無線熱點連接路由器，使兩者同處一個局域網(wǎng)。ARM端獲取到安卓手機的IP后，將實時獲取到的經(jīng)OpenCL加速系統(tǒng)處理之后的攝像頭數(shù)據(jù)發(fā)送至此IP。同時安卓手機端需安裝自行開發(fā)用于接收DE1-SoC數(shù)據(jù)的APP，此APP的功能即是將通過局域獲取的圖像信號通過安卓手機對其進行數(shù)字圖像處理，生成兩幅相同的圖像，并呈現(xiàn)在同一副畫面中。當人眼通過目鏡同時對兩幅圖片進行觀察時，會產(chǎn)生立體視差角，從而使人眼感受到立體的效果，實現(xiàn)VR圖像的成像。

3 實驗結(jié)果與分析

3.1 六足底座步態(tài)測試

機器人步態(tài)的穩(wěn)定性測試內(nèi)容分為前進步態(tài)測試和旋轉(zhuǎn)步態(tài)測試，在機器人六足底座表面固定一個玻璃燒杯，在其中加入250 mL自來水，前進步態(tài)測試中控制機器人在平地上行走10米距離，旋轉(zhuǎn)步態(tài)測試中控制機器人原地旋轉(zhuǎn)10圈。完成規(guī)定操作，記錄燒杯中液體的剩余量。液體剩余量越多，表征該步態(tài)穩(wěn)定性越高。如表3、4所示，一共有六種前進步態(tài)，六種旋轉(zhuǎn)步態(tài)，每種步態(tài)進行10次測試取平均值，記錄測試結(jié)果如表5所示。

表3 前進步態(tài)方案

表5 機器人步態(tài)測試結(jié)果

測試結(jié)果可得出，前進步態(tài)的方案一與旋轉(zhuǎn)步態(tài)的方案一穩(wěn)定性均相對其他步態(tài)穩(wěn)定性有所提高。故在實際設(shè)計中前進與旋轉(zhuǎn)的步態(tài)均采用方案一，來對步態(tài)進行規(guī)劃。

3.2 機械臂控制功能測試

為測試機械手臂的控制功能，操作者穿戴遠程控制手套，在10秒鐘內(nèi)連續(xù)做出10個不同的表示數(shù)字的手勢。觀察機械手臂是否可以同步跟隨操作者的手勢。進行的10次測試結(jié)果如表6所示。

表6 機械臂控制測試結(jié)果

由測試數(shù)據(jù)可以得出，機械手臂跟隨操作者的成功比例高達95%，實現(xiàn)了對機械臂的基本控制與操作。

3.3 視頻傳輸功能測試

機器人視頻傳輸測試方案為，在測試房間的地板以及墻面上粘貼10個醒目的數(shù)字標識。操作者佩戴視頻數(shù)據(jù)采集頭套，站立于房間中心位置。操作者需從數(shù)字1開始依次尋找目標，當操作者通過視頻采集頭套觀察到標記時，取下頭套觀察實際情景是否與VR成像相同。若基本一致記錄成功，若兩者差距較大則視為失敗。記錄觀察結(jié)果后，開始尋找下一個數(shù)字標記。每10個數(shù)字標記為一輪測試，共進行10輪測試，測試結(jié)果如表7所示。

由測試結(jié)果可知，在視頻傳輸測試中VR成像的平均正確率高達96%，基本實現(xiàn)機器人的視頻傳輸功能。

3.4 復雜地形作業(yè)測試與分析

為判定機器人在復雜地形中是否可以穩(wěn)定行走并準確抓取物品，選取室內(nèi)樓梯作為測試場地。樓梯標準為，踏步高度：150 mm，每級臺階寬度：250 mm，級數(shù)：10級。

表7 視頻傳輸測試結(jié)果

測試內(nèi)容設(shè)置為，操作者佩戴VR頭套與遠程控制設(shè)備，從開始操縱六足仿生機器人開始計時。機器人從樓梯底部出發(fā)，攀爬過程中，需準確抓取置于樓梯中部的水瓶，并將其運送至樓梯頂部平穩(wěn)放置，期間若水瓶滑落則視為測試失敗。進行50次重復試驗，并記錄完成時間。測試結(jié)果如圖17所示。

圖17 樓梯任務(wù)完成時間分布圖

從測試結(jié)果可得出，機器人50次完成任務(wù)的用時絕大多數(shù)分布在45～60 s區(qū)間，從45 s開始，時間越長所分布的次數(shù)越少。在第26次試驗過程中，因機器人重心不穩(wěn)，導致主體大幅度晃動，致使水瓶摔落。故仍需優(yōu)化機器人在攀爬高傾斜度地形時的步態(tài)設(shè)計。綜上所述，測試結(jié)果已滿足項目所設(shè)計的測試指標。機器人具備了在復雜地形中作業(yè)的能力與較高的操作穩(wěn)定性。

4 結(jié)束語

本文充分利用FPGA與ARM各自的優(yōu)勢，基于SoC FPGA平臺實現(xiàn)了一套集實時圖像傳輸、行進路線遙控、仿生手臂跟隨人手實時運動等多功能于一體的機器人。參考蜘蛛模型構(gòu)造六足底座，并對其行駛過程中的步態(tài)進行仿生設(shè)計，能夠在大多數(shù)復雜地形中暢通行駛。同時，參照人類手臂與手掌構(gòu)造機械手模型，可以靈活抓取物品。將方向控制面板與應(yīng)變式傳感器進行結(jié)合，制作出一個可感知手部動作和發(fā)送行進指令的操作手套，實現(xiàn)了對機器人行徑路線的遠程控制和機械手臂的跟隨運動。OpenCL加速子系統(tǒng)的運用，使得VR顯示成為可能，讓操作者可以身臨其境般地操控機器人?？偟膩碚f，綜合運用各項技術(shù)，實現(xiàn)了六足仿生機器人的全部設(shè)計功能，但離真正應(yīng)用于實際，尚有很多方面需要努力，我們后續(xù)將不斷完善。