基于姿態(tài)庫的危險品檢測機械臂遠程控制

鄭育祥，許 旻，董二寶，李陽鴻

(中國科學技術(shù)大學工程科學學院精密機械與精密儀器系，安徽 合肥 230027)

0 引言

隨著近現(xiàn)代工業(yè)技術(shù)的高速發(fā)展，很多探索工作和高危作業(yè)環(huán)境，人力往往無法直接到達，需要機器人代替人力進行遠程作業(yè)。幾十年來，國內(nèi)外學者針對機器人的遠程控制進行了廣泛研究。

目前，主流的遠程控制技術(shù)分為3類：主從式遙操作機器人方案，操作者通過操作主端機器人來控制從端機器人進行探索和作業(yè)任務[1-3]；人機遙操作方案，通過環(huán)境感知設備感知人體姿態(tài)變化來控制機器人[4]；遠程上位機方案，上位機(遙控箱、遙控手柄、手機和平板等)在無線網(wǎng)絡下與機器人實時通信控制[5-6]。

然而針對恐怖事件現(xiàn)場的危險品檢測作業(yè)時，存在野外環(huán)境干擾以及遠程操作的便攜性，主從式遙操作和人機遙操作方案顯然不適用于該場景；而遠程上位機方案相比其他2種方案來說，其對于控制多自由度機械臂靈活性不高。而且在危險品檢測作業(yè)中，往往需要針對危險品的特殊性，采用專門的姿態(tài)去采樣，所以提出了一種基于姿態(tài)庫的遠程控制方法，壓縮了操作時間，能更高效地完成檢測作業(yè)。

1 機械臂遠程控制系統(tǒng)構(gòu)成

危險品檢測機器人機械臂遠程控制系統(tǒng)由六輪移動平臺、機械臂、控制系統(tǒng)和末端檢測裝置等組成，如圖1所示。

圖1 面向警用無人平臺的機械臂遠程控制系統(tǒng)

六輪移動平臺通過采用空心杯跨步驅(qū)動電機，集成扭桿懸架實現(xiàn)驅(qū)動懸架一體化，采用輪轂電機集成轉(zhuǎn)向電機和盤式制動器實現(xiàn)輪邊驅(qū)動、轉(zhuǎn)向與制動一體化，聯(lián)合輪步結(jié)合多自由度協(xié)調(diào)驅(qū)動控制方法，實現(xiàn)六輪驅(qū)動、全輪轉(zhuǎn)向和輪步行走等功能。

機械臂安裝在六輪移動平臺頂面。通過MATLAB仿真優(yōu)化設計連桿尺寸，采用機電一體化旋轉(zhuǎn)關(guān)節(jié)模組設計協(xié)作型機械臂，能滿足1.3 m的特殊作業(yè)工作空間需求及10 kg的負載需求。

如圖2所示，整個控制系統(tǒng)采用上位機和下位機實時監(jiān)控，上位機端采用的是PS2遙控手柄，應用2.4 GHz無線技術(shù)與下位機實時通信。下位機安裝在六輪移動平臺內(nèi)部，主要由STM32核心板、EtherCAT通信模塊、無線通信模塊和電源穩(wěn)壓模塊組成。其主要功能是解析上位機發(fā)送指令、機械臂正逆解運算、EtherCAT總線信息交互、姿態(tài)庫控制、控制末端檢測裝置的固體和液體采集以及相關(guān)功能指令。

圖2 下位機控制器模塊連接關(guān)系

末端檢測裝置采用的是安徽芯核防務公司的模塊化危險品檢測設備，能實現(xiàn)固體和液體采集功能，安裝于機械臂的末端工具法蘭上。

2 機械臂運動學建模

考慮到姿態(tài)庫控制中針對不同作業(yè)場景下的不同姿態(tài)，需要對其機械臂做正解和逆解控制。

首先，采用改進后D-H法建立機械臂模型，D-H參數(shù)如表1所示。

表1 機械臂D-H參數(shù)

2.1 運動學正解

應用改進的D-H模型可以得到機械臂連桿變換公式為

(1)

此模塊實現(xiàn)教師信息的管理功能，此模塊包括查詢、新增、更新教師信息等功能操作。教師信息包含教師編號、教師姓名、學歷、參加工作時間、職稱、職務、資格證書、所屬系部、專業(yè)領(lǐng)域、科研情況等相關(guān)信息。

(2)

2.2 運動學逆解

根據(jù)式(1)和式(2)，限定條件為機械臂各個關(guān)節(jié)的運動范圍為[-π,π]，通過解析法，可以依次推導出各個關(guān)節(jié)角度的解[7]：

θ1=arctan(0P5y,0P5x)±

(3)

(4)

(5)

(6)

(7)

(8)

由此可以發(fā)現(xiàn)，對于機械臂工作空間中某一位姿，可能存在的逆解個數(shù)為

2θ1×2θ5×1θ6×2θ3×1θ2×1θ4=8

(9)

考慮機械臂碰撞和角度限制問題，通常選取基關(guān)節(jié)[θ1θ2θ3]角度空間最近點作為最優(yōu)解，所以需要對求得的8組解比較角度空間距離，即

di=‖Φi-Φ0‖

(10)

Φ0=[θ10θ20θ30]為當前機械臂基關(guān)節(jié)角度向量；Φi=[θ1iθ2iθ3i]為第i組解基關(guān)節(jié)角度向量；di為第i組解的角度空間距離。

圖3 下位機控制器程序流程

3 姿態(tài)庫控制

針對危險品的特殊性，需要采用專門的姿態(tài)去采樣，依據(jù)機械臂在移動平臺的安裝位置選取了幾個常用的采樣姿態(tài)，組成姿態(tài)庫，如圖4所示。

圖4 姿態(tài)庫

圖4a為原點姿態(tài)：機械臂不工作時的姿態(tài)。保證其整體是收攏的，避免在移動平臺行走時與其他物體碰撞。在每次完成作業(yè)時，需要機械臂回到原點姿態(tài)，即復位動作。

圖4b為初始姿態(tài)：原點姿態(tài)與其他幾個常用姿態(tài)的中間過渡姿態(tài)。保證其各姿態(tài)切換時的軌跡的安全性。

圖4c ～圖4g為方位姿態(tài)(左側(cè)方、右側(cè)方、正前方、上前方和下前方姿態(tài))：針對采樣目標在移動平臺相應方位時設置的姿態(tài)。

預先示教好上述的各姿態(tài)，將多組姿態(tài)數(shù)據(jù)組成姿態(tài)庫存儲在下位機控制器里。在遠程上位機只需要相應按鍵即可調(diào)用姿態(tài)庫中相應姿態(tài)動作，當機械臂到達期望的方位姿態(tài)后，如果末端檢測裝置距離檢測目標還存在著一段距離，可以通過上位機操作基坐標方向微動動作指令，到達期望的目標位置。具體操作流程如圖5所示。

圖5 檢測操作流程

4 實驗

實驗分為無線通信實驗和有無姿態(tài)庫對比實驗。

4.1 無線通信實驗

在無線通信實驗中，無線通信的有效距離定義為：從六輪移動平臺的前端前進，當無線手柄和接收器的連接燈開始閃爍時，即表示通信斷開，記錄當前位置與下位機控制器之間的距離。

經(jīng)過多次測試發(fā)現(xiàn)，在室內(nèi)環(huán)境下當離下位機控制器10 m范圍內(nèi)，信號較強，通信實時性較高；而在室外環(huán)境下受干擾較多，在距離8 m范圍內(nèi)，能保持正常通信。無線遙控的距離取決于無線信號的覆蓋范圍，在實際應用中可采用遠距離無線網(wǎng)橋的方案增加遙控距離。

4.2 有無姿態(tài)庫對比實驗

隨機給定一個機械臂工作空間內(nèi)的指定目標，用常規(guī)關(guān)節(jié)控制和姿態(tài)庫控制2種方式控制機械臂到達指定目標位置，用電子秒表記錄每次從原點位置到檢測目標位置所用的時間。每組多次記錄，取平均值。

本實驗在空間中隨機選取了10個點進行對比實驗。實驗控制過程如圖6所示，在一塊固定板上貼合了一個圓柱狀紅色標記物，作為目標點，可通過移動固定板和調(diào)整其高度，重新選取目標點。其中，箭頭指向為指定目標點，每張圖右下角為開始記錄到當前的時間點。

圖6 第1組連續(xù)抓拍

本實驗的10組數(shù)據(jù)對比結(jié)果如圖7所示。根據(jù)10組記錄的時間結(jié)果對比發(fā)現(xiàn)，采用姿態(tài)庫控制所用時間遠小于常規(guī)關(guān)節(jié)控制所用的時間，可以驗證基于姿態(tài)庫的優(yōu)異性，能減少遠程控制機械臂到達目標的時間，提高效率。

圖7 10組隨機點2種控制所用時間對比

5 結(jié)束語

提出了一種基于姿態(tài)庫的危險品檢測機器人機械臂遠程控制方法，設計了機械臂遠程控制系統(tǒng)的整體架構(gòu)方案，通過分析機械臂運動學，在下位機控制器建立機械臂正逆解模型；分析采樣作業(yè)的幾種常用姿態(tài)，建立了姿態(tài)庫，實現(xiàn)了遠程一鍵調(diào)用。通過實驗發(fā)現(xiàn)，無線通信距離基本滿足作業(yè)要求，但受室外干擾，通信距離影響較大。增加姿態(tài)庫控制，可適用于危險品檢測作業(yè)場景，可以降低無線通信被干擾的影響，有效地減少作業(yè)時間，驗證本文方法的有效性。