基于電流環(huán)的可重構(gòu)機械臂碰撞辨識方法研究

鄧雁真，魏延輝，趙延峰，高葦杭，謝 聰

（哈爾濱工程大學 自動化學院，哈爾濱 150001）

0 引言

模塊化的可重構(gòu)機器人能夠以一套機器人模塊，根據(jù)實時任務(wù)和環(huán)境的需要，快速搭建并產(chǎn)生多種工作構(gòu)形，克服傳統(tǒng)固定結(jié)構(gòu)形式的工業(yè)機器人改裝費用高，不能一機多用等缺點，可滿足快速實時的生產(chǎn)生活需要，近年來成為國內(nèi)外機器人研究的熱點之一[1～4]，模塊化的可重構(gòu)機器人因此能夠在航天、制造業(yè)、核工業(yè)具有很大的發(fā)展前景和應(yīng)用潛力[5]。

模塊化的可重構(gòu)機器人是由許多相關(guān)的有一定自治能力和感知能力的模塊組成，各模塊間有統(tǒng)一的接口環(huán)境，可用于傳遞力、運動、能量和通信，通過模塊之間的連接斷開操作和相互運動來自動改變整體構(gòu)形，擴展運動形式，完成多種運動及操作任務(wù)[6]。

可重構(gòu)機器人在執(zhí)行任務(wù)的時候，要達到預期的目標點，很多機器人都是離線狀態(tài)下工作的，其中目標點、運動軌跡、運動速度、運動加速度、力矩、阻抗等內(nèi)容需要預先設(shè)定好，機器人在運動過程只要按照指定的數(shù)值走就可以。但是工業(yè)機器人的自由度多，運行功率大，工作環(huán)境復雜，所做的動作也較為復雜，在其工作空間中有著不可預料的狀況，機器人很可能與周圍的物件發(fā)生碰撞，導致物件或者機械手損壞[7]。更為嚴重的是與進入其工作空間的人發(fā)生碰撞，造成對工作人員的傷害，產(chǎn)生不可挽回的嚴重后果[8]。為此，有必要解決機器人的安全性問題。所以會給機器人添加各種各樣的傳感器，但是這又增加了機器人復雜性，對機器人的運算速度產(chǎn)生了很大影響，讓整個工作增加更多的中間反饋環(huán)節(jié)。沈自所王洪光[9]利用力矩方式判斷可重構(gòu)機器人構(gòu)形，為可重構(gòu)機械臂進行環(huán)境障礙物辨識提供借鑒。

本文借鑒已有的研究成果，利用人在未知環(huán)境下抓取物體操作，通過檢測關(guān)節(jié)驅(qū)動電流的變化分析所受到的關(guān)節(jié)力矩，判斷機械臂是否與障礙物碰撞和干涉，然后重新規(guī)劃軌跡。

1 可重構(gòu)機器人系統(tǒng)

可重構(gòu)機器人主要有六個模塊組成，分別為轉(zhuǎn)動模塊、腕部模塊、擺動模塊、連接模塊、輔助連接模塊和執(zhí)行模塊。通過六個模塊的互相不同順序拼接方式，快速建立一套實用性強的機器人。

轉(zhuǎn)動模塊是可重構(gòu)模塊的基本部分，兩端固定的連接模塊回轉(zhuǎn)首先做相對運動。根據(jù)構(gòu)型的需要設(shè)計了兩個轉(zhuǎn)動模塊（大的編號為模塊1，小的編號為模塊5），機構(gòu)如圖1(a)所示。

擺動模塊是一個雙方向的旋轉(zhuǎn)擺動，根據(jù)構(gòu)型的需要設(shè)計了兩個擺動模塊（大的編號為模塊2，小的編號為模塊4），如圖1(b)所示。

各個關(guān)節(jié)模塊中使用了統(tǒng)一的連接模塊，連接模塊1個是母頭，另一側(cè)是公頭，鏈接模塊統(tǒng)一，就可以互相快速組裝拼接（編號為模塊3），如圖1(c)所示。

圖1 可重構(gòu)機器人模塊

這款可重構(gòu)機器人的執(zhí)行部分就是夾持器，利用步進電機旋轉(zhuǎn)，通過齒輪閉合，可以控制夾持器的開關(guān)（編號為剛體7），結(jié)構(gòu)如圖1(d)所示。

連桿沒有運動單元，為了機器人某一部分在需要長距離使用的時候可以加入連桿部分，增加這部分長度，如圖1(e)所示。

腕部模塊有兩大部分：橫向的擺動部分和縱向的回轉(zhuǎn)部分（擺動部分編號為模塊6（擺），回轉(zhuǎn)部分編號為模塊6（轉(zhuǎn)）），其整體設(shè)計小巧靈活，如圖1(f)所示。

2 可重構(gòu)機器人電流環(huán)采樣系統(tǒng)

2.1 可重構(gòu)機器人模塊控制系統(tǒng)

可重構(gòu)機器人模塊控制系統(tǒng)以DSP2812作為主控芯片，通過EV管理器，進行PWM編程，將驅(qū)動信號發(fā)送到光耦器件進而輸出到驅(qū)動芯片，再利用內(nèi)部QEP電路確定機器人的轉(zhuǎn)動位置以及進行智能化控制，如圖2所示。

圖2 可重構(gòu)機器人模塊控制系統(tǒng)

2.2 電流采樣系統(tǒng)設(shè)計

電流采集方案使用的是基于霍爾傳感器原理的WCS2702單通道電流檢測傳感器，其具備寬電壓供電、測量精準、響應(yīng)時間快、靈敏度好、線性度1000mV/A、檢測電流范圍是-2A到2A之間的特性，在交直流電流檢測，電機電流檢測等領(lǐng)域都有非常好的應(yīng)用。

電流正方向流入時輸出電壓為：

電流負方向流入時輸出電壓為：

圖3 電流采樣系統(tǒng)

3 基于電流環(huán)的碰撞辨識

本文定義模塊1為剛體1、模塊2為剛體2、模塊3為剛體3、模塊4為剛體4、模塊5為剛體5、模塊6（擺）為剛體6（A）、模塊6（轉(zhuǎn)）為剛體6（B）、模塊7為剛體7。

由于ADAMS中更多的是剛體碰撞檢測，但是實際當中柔性碰撞的情況也非常多，所以下面通過在可重構(gòu)剛體上增加單點受力的情況下分析各關(guān)節(jié)所受力矩，如圖4所示，這樣可以模擬出碰撞的一個真實過程。

圖4 六自由度二碰撞約束

假設(shè)在運動過程中，分別在第3剛體，第5剛體和第七剛體3個位置方向上分別增加一個方向與運動方向相反的力（轉(zhuǎn)動方向或擺動方向），在1.001秒和1.002秒期間分別施加不同的力。

3.1 轉(zhuǎn)動關(guān)節(jié)添加運動約束的碰撞辨識

1） 剛體7添加水平單點力各關(guān)節(jié)力矩如下：

首先，對每一個轉(zhuǎn)動關(guān)節(jié)分別添加一個運動約束函數(shù)STEP(time，0，0，5，-9d)+STEP(time，0.5，0，4.5，0)+STEP(time，4.5，0，5，9d)函數(shù)，僅有在轉(zhuǎn)動方向運動，觀察各個關(guān)節(jié)的變化，在沒有單點力情況下個點力矩如圖5所示。

圖5 六自由度二無碰撞各關(guān)節(jié)力矩曲線

再添加一個STEP(time，0，0，1，0)+STEP(time，1，0，1.01，3)+STEP(time，1.01，0，1.02，-3)+ST EP(time，1.02，0，5，0)函數(shù)的瞬時力，可以看見有明顯的力度尖峰，如圖6所示。

圖6 僅轉(zhuǎn)動關(guān)節(jié)運動時刻剛體7碰撞點各關(guān)節(jié)力矩曲線

通過仿真可以發(fā)現(xiàn)關(guān)節(jié)1有巨大的力矩變化，關(guān)節(jié)5也有一定的變化，而其他關(guān)節(jié)變化并不是非常明顯。可以發(fā)現(xiàn)由于動力學的原因，剛體7突然增加的力矩使得幾個受力相關(guān)點的力矩突然增大，反映到電機上就是電流的急劇增加。

由于機器人的迭代性，從剛體7向剛體1進行迭代，每個關(guān)節(jié)都會產(chǎn)生一定的力矩。通過分析可以得出關(guān)節(jié)2、關(guān)節(jié)3、關(guān)節(jié)4是因為動力學迭代性產(chǎn)生的力矩，幅值并不大。剛體7是受力點產(chǎn)生了一定的力矩實際當中并不會有如此大。而關(guān)節(jié)1是轉(zhuǎn)動方向反向力會產(chǎn)生巨大作用力，通過力矩分析得到受力點為剛體7水平方向。

2）剛體5添加水平單點力各關(guān)節(jié)力矩如圖7所示：

圖7 僅轉(zhuǎn)動關(guān)節(jié)運動時刻剛體5碰撞點各關(guān)節(jié)力矩曲線

通過分析可以得出關(guān)節(jié)2、關(guān)節(jié)3、關(guān)節(jié)4是因為動力學迭代性產(chǎn)生的力矩，幅值并不大。而關(guān)節(jié)1是轉(zhuǎn)動方向直接反向力會產(chǎn)生巨大的反作用力，其他關(guān)節(jié)受力并不明顯。所以通過力矩可以分析出來受力點為剛體5水平方向。

3.2 擺動關(guān)節(jié)添加運動約束的碰撞辨識

1）剛體7添加豎直單點力各關(guān)節(jié)力矩如下：

下面是對剛體5添加一個障礙物，相當于在剛體7上施加一個瞬時豎直方向的力，現(xiàn)在對每一個擺動關(guān)節(jié)添加一個STEP(time，0，0，5，-9d)+STEP(time，0.5，0，4.5，0)+STEP(time，4.5，0，5，9d)函數(shù)，在擺動方向運動，觀察各個關(guān)節(jié)變化如圖8所示。

圖8 僅擺動關(guān)節(jié)運動方向運動約束

圖9 僅擺動關(guān)節(jié)運動方向剛體7碰撞點各關(guān)節(jié)力矩曲線

通過分析可以得出關(guān)節(jié)1、關(guān)節(jié)4是因為動力學迭代性產(chǎn)生的力矩，幅值并不大，如圖9所示。關(guān)節(jié)5由于是剛體7直接受力點產(chǎn)生了一定的力矩但是在實際當中并不會有如此大。而關(guān)節(jié)2，關(guān)節(jié)3，關(guān)節(jié)5是轉(zhuǎn)動方向直接反向力會產(chǎn)生巨大的反作用力，所以通過力矩可以分析出來受力點為剛體7豎直方向受力。

2）剛體5添加豎直單點力各關(guān)節(jié)力矩如圖10所示。

圖10 僅擺動關(guān)節(jié)運動方向剛體5碰撞點各關(guān)節(jié)力矩曲線

通過分析可以得出關(guān)節(jié)1、關(guān)節(jié)4、關(guān)節(jié)5是因為動力學迭代性產(chǎn)生的力矩，幅值并不大。而關(guān)節(jié)2、關(guān)節(jié)3是擺動方向直接反向力會產(chǎn)生巨大的反作用力，其他關(guān)節(jié)受力并不明顯。所以通過力矩可以分析出來受力點為剛體5豎直方向。

4 結(jié)論

通過仿真結(jié)果可知，基于電流環(huán)的機械臂避障方案是通過分析因受力變化的電流值，從而分析出機械臂所受力矩，判斷機械臂所受障礙物的位置，以此為基礎(chǔ)為機械臂提供避障方法。相較于以往通過視覺信息避障，此方案的優(yōu)點在于無視覺傳感器和力矩傳感器也能夠自我感知環(huán)境障礙物。水下機械臂工作在水下，環(huán)境未知，能見度低，本文技術(shù)方案為水下機械臂的軌跡規(guī)劃提供有效的解決途徑。

[1]高文斌,王洪光,姜勇,潘新安.模塊化可重構(gòu)機器人標定方法研究[J].機械工程學報,2013,49(17):92-100.

[2]吳文強,管貽生,朱海飛,蘇滿佳,李懷珠,周雪峰.面向任務(wù)的可重構(gòu)模塊化機器人構(gòu)型設(shè)計[J].哈爾濱工業(yè)大學學報,2014,46(03):93-98.

[3]王肖鋒,張明路,葛為民.可重構(gòu)機器人動力學自動建模研究[J].農(nóng)業(yè)機械學報,2015,46(12):355-361,377.

[4]PAREDIS C J J, KHOSLA P K. RMMS: reconfigurable modular manipulator system project[A].Proceedings of the 1997 IEEE International Conference on Robotics and Automation．Albuquerque.USA[C],1997:20-25.

[5]Chocron O,Bidaud P.Genetic design of 3D modular manipulators[A].Proceedings of the 1997 IEEE Inter-national Conference on Robotics and Automation[C].New Mexico,1997.223-228.

[6]魏延輝,趙杰,高延濱,蔡鶴皋.一種可重構(gòu)機器人運動學求解方法[J].哈爾濱工業(yè)大學學報,2010,42(01):133-137.

[7]吳國魁.工業(yè)機器人的碰撞辨識與安全控制[D].福州大學.2014,06.

[8]胡化.機器人安全性工程研究綜述[J].中國機械工程.2004,15(2):370-375.

[9]姜勇,王洪光,潘新安,余岑,何能.模塊化可重構(gòu)機器人的構(gòu)形在線自主辨識[J].機械工程學報,2011,47(15):17-24.