具有力/位感知的仿人假手拇指機(jī)構(gòu)

王 偉，姜 力，王新慶，劉伊威，劉 宏，2

(1.哈爾濱工業(yè)大學(xué)，機(jī)器人技術(shù)與系統(tǒng)國(guó)家重點(diǎn)實(shí)驗(yàn)室，哈爾濱150086，kingwei82@163.com; 2.德國(guó)宇航中心，機(jī)器人及機(jī)電一體化研究所，慕尼黑82230)

近年來(lái)，國(guó)內(nèi)外對(duì)假手的研究都取得了一定成果，如意大利的RTR I［1－2］和RTRⅡ假手［3］，美國(guó)的IOWA－Hand［4］和Standford－Hand［5］，加拿大的TBM－Hand［6］，西班牙的MANUS－Hand［7］，哈工大的HIT－DLR手［8－9］等.現(xiàn)有大部分假手的傳感系統(tǒng)不夠完善，限制了假手的應(yīng)用，基于欠驅(qū)動(dòng)原理設(shè)計(jì)的上一代HIT/DLR假手，雖然其拇指包絡(luò)性較好，但由于其需要儲(chǔ)能元件(扭簧)，決定了拇指的尺寸比較大，且實(shí)驗(yàn)表明，由于儲(chǔ)能元件的存在，拇指在運(yùn)動(dòng)的起點(diǎn)和終點(diǎn)會(huì)發(fā)生震動(dòng)，這些都限制了欠驅(qū)動(dòng)技術(shù)在假手中的應(yīng)用.

本文在上一代假手的基礎(chǔ)上研制了一種基于耦合原理和空間四桿的具有力矩和位置感知的仿人拇指.該拇指能夠感知手指的絕對(duì)位置和指尖出力.采用了耦合驅(qū)動(dòng)，使得尺寸小于成人拇指，抓取速度快且在運(yùn)動(dòng)的起點(diǎn)和終點(diǎn)沒(méi)有震動(dòng).

1 仿人拇指的結(jié)構(gòu)設(shè)計(jì)

人手拇指有3個(gè)指節(jié)組成，即近指節(jié)、中指節(jié)和遠(yuǎn)指節(jié)(指尖).近指節(jié)被肌肉包裹，在手掌一側(cè)，故拇指一般只露出后2個(gè)指節(jié)，但近指節(jié)在抓握物體時(shí)參與運(yùn)動(dòng).另外，拇指在抓握運(yùn)動(dòng)時(shí)，通常是沿一錐面，即伸展/彎曲，外展/內(nèi)收兩個(gè)自由度的結(jié)合，而不是做單一方向的運(yùn)動(dòng).

本文設(shè)計(jì)的仿人假手拇指具有3個(gè)指節(jié)，考慮到假手外觀及佩戴手套需要，每個(gè)指節(jié)的尺寸均略小于成人拇指.電機(jī)經(jīng)減速箱和傘齒輪減速裝置減速增矩后驅(qū)動(dòng)近指節(jié)運(yùn)動(dòng)，中指節(jié)與近指節(jié)之間、遠(yuǎn)指節(jié)與中指節(jié)之間均采用耦合驅(qū)動(dòng)方式.為模仿人手拇指的運(yùn)動(dòng)特點(diǎn)，遠(yuǎn)指節(jié)與中指節(jié)之間為平面耦合驅(qū)動(dòng)，中指節(jié)與近指節(jié)之間采用了一平面四桿和一空間四桿結(jié)合的空間耦合驅(qū)動(dòng)方式，原理如圖1(a)和圖1(b)所示.

圖1 拇指近指節(jié)連桿機(jī)機(jī)構(gòu)簡(jiǎn)圖

其中:l1為拇指基座，l2為近指節(jié)側(cè)板，l6為中指節(jié)軸盤(pán)，s1，s2為球鉸.近指節(jié)側(cè)板l2的運(yùn)動(dòng)推動(dòng)連桿軸l3的運(yùn)動(dòng)，連桿軸通過(guò)球鉸連桿l5推動(dòng)中指節(jié)軸盤(pán)運(yùn)動(dòng)，從而實(shí)現(xiàn)與中指節(jié)軸盤(pán)l6連在一起的中指節(jié)運(yùn)動(dòng).對(duì)于圖1(b)所示的雙球鉸四桿機(jī)構(gòu)，由空間自由度計(jì)算公式可得該機(jī)構(gòu)的自由度F=2.

可見(jiàn)雙球鉸之間會(huì)引入一局部自由度，為消除此自由度，其中球鉸s2使用兩個(gè)轉(zhuǎn)動(dòng)副軸線垂直的球連桿代替，如圖1(c).這樣，球鉸s2的3個(gè)轉(zhuǎn)動(dòng)自由度轉(zhuǎn)變?yōu)閮蓚€(gè)轉(zhuǎn)動(dòng)自由度.新一代假手與上一代假手比較見(jiàn)圖2(a)，可以看出，新一代假手的拇指比上一代假手尺寸更小，外觀更加仿人化.拇指的結(jié)構(gòu)圖見(jiàn)圖2(b).

2 仿人假手拇指近指節(jié)連桿機(jī)構(gòu)運(yùn)動(dòng)學(xué)分析

如圖2(b)所示，近指節(jié)側(cè)板、基座、近指節(jié)連桿與連桿軸組成一平面四連桿機(jī)構(gòu)，近指節(jié)側(cè)板、連桿軸、球鉸套、球連桿與中關(guān)節(jié)軸盤(pán)組成一空間四桿機(jī)構(gòu).球鉸中心點(diǎn)B是此平面四桿機(jī)構(gòu)和空間四桿機(jī)構(gòu)的公共點(diǎn)，通過(guò)對(duì)這兩個(gè)機(jī)構(gòu)分別進(jìn)行分析，推出B點(diǎn)的坐標(biāo)值，建立方程，進(jìn)行運(yùn)動(dòng)學(xué)計(jì)算.

圖2 兩代假手比較及拇指結(jié)構(gòu)圖

2.1 拇指近指節(jié)平面四桿運(yùn)動(dòng)學(xué)分析

為空間四桿計(jì)算方便，坐標(biāo)原點(diǎn)O0設(shè)置在通過(guò)球鉸中心B且垂直于基關(guān)節(jié)軸的平面與基關(guān)節(jié)軸的交點(diǎn)處，z0軸與基關(guān)節(jié)軸重合，x0軸垂直于基關(guān)節(jié)轉(zhuǎn)動(dòng)軸線與中關(guān)節(jié)轉(zhuǎn)動(dòng)軸線所形成的平面，y0由右手定則確定.建立的坐標(biāo)系如圖3(a)所示.

對(duì)于△OAC，有

對(duì)于△ABC，有

對(duì)于該拇指機(jī)構(gòu)β2＜90°，可得

圖3 平面四桿運(yùn)動(dòng)學(xué)分析和空間四桿的連桿坐標(biāo)系

同理可得

其中，β=β1+β2.

其中，θ1為輸入角.

則球鉸中心B點(diǎn)的坐標(biāo)

2.2 拇指近指節(jié)空間四連桿運(yùn)動(dòng)學(xué)分析

對(duì)拇指空間四桿機(jī)構(gòu)建立坐標(biāo)系如圖3(b)所示，O0坐標(biāo)系與平面四桿坐標(biāo)系重合，連桿的Denavit-Hartenberg參數(shù)如表1所示.

表1 連桿的Denavit－Hartenberg參數(shù)表

在這里，0≤θ1≤45°，0≤θ2＜180°，0≤θ3＜90°，0≤θ4＜90°.

相鄰連桿坐標(biāo)系之間的齊次變換矩陣是:

其中:si=sin θi，ci=cos θi.

則空間四桿的坐標(biāo)變換矩陣

可得B點(diǎn)的坐標(biāo):

其中:cij=cicj－sisj，sij=cisj+sicj，d5為坐標(biāo)原點(diǎn)O4到B點(diǎn)沿z4軸的距離.

為模仿人手拇指的運(yùn)動(dòng)，取中關(guān)節(jié)轉(zhuǎn)動(dòng)角與基關(guān)節(jié)轉(zhuǎn)動(dòng)角θ2∶θ1=0.9∶1.0.根據(jù)人手拇指近指節(jié)的尺寸，可以確定l2，l3和di的值，則由(1)(2)聯(lián)立，并注意到θi的變化范圍即可求得中關(guān)節(jié)軸盤(pán)l1的值.

圖4(a)為通過(guò)Matlab得出的拇指中關(guān)節(jié)與基關(guān)節(jié)轉(zhuǎn)動(dòng)角度關(guān)系曲線.圖4(b)為通過(guò)ADAMS仿真得到的拇指各關(guān)節(jié)轉(zhuǎn)角與時(shí)間關(guān)系曲線.

圖4 中關(guān)節(jié)與基關(guān)節(jié)轉(zhuǎn)動(dòng)角度關(guān)系曲線和拇指各關(guān)節(jié)轉(zhuǎn)角與時(shí)間關(guān)系曲線

3 仿人假手力矩和位置傳感裝置設(shè)計(jì)

3.1 力矩傳感裝置設(shè)計(jì)

設(shè)計(jì)了基于應(yīng)變片的一維力矩傳感器，安裝在手指的基關(guān)節(jié)上，用來(lái)測(cè)量手指的抓取力矩.傳感器和電機(jī)驅(qū)動(dòng)部分相連，把電機(jī)的扭矩傳遞給各個(gè)手指.基關(guān)節(jié)力矩傳感器的彈性體作為一個(gè)機(jī)械部件連接在基關(guān)節(jié)軸和驅(qū)動(dòng)連桿之間，由ANSYS對(duì)其進(jìn)行受力分析，找出其應(yīng)變最大處，貼應(yīng)變片.它反映了抓取過(guò)程中近指節(jié)、中指節(jié)和遠(yuǎn)指節(jié)與物體接觸的時(shí)間和力的大小.

根據(jù)各彈性體在手指中的實(shí)際受力情況，要求彈性體在電機(jī)額定力矩的驅(qū)動(dòng)下，中間應(yīng)變?yōu)?×10－3mm/mm左右，以此來(lái)確定彈性體的基本結(jié)構(gòu).對(duì)力矩傳感器進(jìn)行了靜態(tài)標(biāo)定實(shí)驗(yàn)，由標(biāo)定所得數(shù)據(jù)可知，在力矩傳感器末端加負(fù)載50 N時(shí)，力矩傳感器的應(yīng)變?yōu)?.74×10－3mm/mm.通過(guò)ANSYS分析，力矩傳感器末端加負(fù)載50 N時(shí)，平均應(yīng)變?yōu)?.81×10－3mm/mm，說(shuō)明力矩傳感器實(shí)驗(yàn)與理論相符.

3.2 位置傳感裝置設(shè)計(jì)

根據(jù)霍爾效應(yīng)原理，將磁鋼固定在減速箱輸出軸上的轉(zhuǎn)盤(pán)邊沿，轉(zhuǎn)軸轉(zhuǎn)動(dòng)時(shí)，轉(zhuǎn)盤(pán)隨轉(zhuǎn)軸旋轉(zhuǎn)，磁鋼也將跟著同步旋轉(zhuǎn)，磁鋼所產(chǎn)生的磁場(chǎng)也將隨著變化，安裝在轉(zhuǎn)盤(pán)上方的霍爾器件，受磁鋼所產(chǎn)生的磁場(chǎng)的影響，將產(chǎn)生與位置變化相關(guān)的正余弦電壓信號(hào).根據(jù)霍爾器件產(chǎn)生的電壓值可以計(jì)算出轉(zhuǎn)軸的絕對(duì)位置.圖5為手指在伸展/彎曲時(shí)位置傳感器輸出信號(hào).該位置傳感器能夠測(cè)得0°～360°的絕對(duì)位置，轉(zhuǎn)軸的轉(zhuǎn)動(dòng)范圍為108°，設(shè)計(jì)的位置傳感器能夠滿(mǎn)足需要.

圖5 手指在伸展/彎曲時(shí)位置感器信號(hào)圖

4 仿人假手的控制系統(tǒng)設(shè)計(jì)和抓取實(shí)驗(yàn)

假手的控制系統(tǒng)采用主、從雙DSP分布式控制結(jié)構(gòu)，由驅(qū)動(dòng)和傳感系統(tǒng)和上層主控制系統(tǒng)組成.

如圖6所示，主控制系統(tǒng)中的DSP2作為主控制器置于手臂筒內(nèi)，以減少手掌的體積，它負(fù)責(zé)整個(gè)電氣系統(tǒng)的處理與決策.DSP2將處理完的肌電(EMG)信號(hào)轉(zhuǎn)換為電機(jī)動(dòng)作指令后，通過(guò)CAN總線把命令發(fā)給驅(qū)動(dòng)和傳感系統(tǒng)控制器的DSP1.

驅(qū)動(dòng)和傳感系統(tǒng)采用DSP加CPLD的基本設(shè)計(jì)思路.根據(jù)就近原則DSP1與CPLD置于手掌內(nèi)，電機(jī)編碼器把信號(hào)返還給CPLD進(jìn)行處理，獲得手指的速度信息并發(fā)給DSP1.在功能上，實(shí)現(xiàn)力矩傳感器、位置傳感器信號(hào)的計(jì)算，從而獲知手指的力矩和絕對(duì)位置信息.驅(qū)動(dòng)和傳感系統(tǒng)由自己的系統(tǒng)電源轉(zhuǎn)換模塊為DSP供電，但和主控制系統(tǒng)共用一對(duì)電池.此部分通過(guò)CAN總線通訊，接受DSP2主控制系統(tǒng)的指令，并根據(jù)相應(yīng)的指令驅(qū)動(dòng)電機(jī)工作，另外它還可以通過(guò)DSP1的SCI口經(jīng)由MAX3221轉(zhuǎn)為RS232串口與PC機(jī)進(jìn)行通信.

人手抓握物體一般包括精確抓取、力量抓取、捏拿等抓握方式，在抓取物體時(shí)，拇指起到了很重要的作用，沒(méi)有拇指施加力，其他手指只能完成很小直徑的柱狀物體的抓握.圖7為假手分別進(jìn)行抓取U盤(pán)(手指正向捏取)、抓取乒乓球(三指捏取)、抓取水瓶(柱狀抓握)和握拳圖.實(shí)驗(yàn)證明，假手能夠完成人手大部分抓取功能，且運(yùn)動(dòng)速度快，抓取力大且穩(wěn)定，運(yùn)動(dòng)軌跡仿人化，能夠滿(mǎn)足殘疾人基本生活需要.

圖6 假手的控制系統(tǒng)

圖7 假手抓取實(shí)驗(yàn)和假手握拳圖

5 結(jié)語(yǔ)

1)基于耦合驅(qū)動(dòng)原理對(duì)拇指機(jī)構(gòu)進(jìn)行了設(shè)計(jì)和實(shí)驗(yàn)，并集成了力矩和位置感知功能.

2)拇指的特點(diǎn)是:能夠感知拇指的絕對(duì)位置和指尖出力，運(yùn)動(dòng)速度快且在運(yùn)動(dòng)的起點(diǎn)和終點(diǎn)沒(méi)有震動(dòng)，尺寸略小于正常人的拇指，運(yùn)動(dòng)軌跡仿人化，能夠滿(mǎn)足殘疾人基本生活需要.

3)與上一代假手相比，手指的出力更大，運(yùn)動(dòng)更穩(wěn)定，抓取速度更快.

［1］CARROZZA M C，MASSA B，MICERA S，et al.The development of a novel biomechatronic hand——ongoing research and preliminary results［J］.IEEE/ASME Transactions on Mechatronics，2002，7(2):108－114.

［2］CARROZZA M C，MASSA B，DARIO P，et al.A two DOF finger for a biomechatronic artificial hand［J］.Journal Technology and Health Care，2002，10(2):77－89.

［3］MASSA B，ROSELLA S，CARRIZOZO M C，et al.Design and Development of an Underactuated Prosthetic Hand［C］//Proceedings of the 2002 IEEE International Conference on Robotics and Automation.Washington DC:［s.n.］，2002:28－36.

［4］YANG Jingzhou，PITARCH E P，ABDEL-MALEK K，et al.A Multi-Fingered Hand Prosthesis［J］.Mechanism and machine theory，2004，39:555－581.

［5］DOSHI R，YEHC C.The design and development of a gloveless endoskeletal prosthetic hand［J］.Journal of Rehabilitation Research and Development，1998，35 (4):388－395.

［6］DECHEV N，NAUMANN S.Multiple Finger，Passive adaptive grasp prosthetic hand［J］.Mechanism and Machine theory，2004，36:1157－1173.

［7］PONS J L，ROCON E，CERES R.The MANUS-HAND dextrous robotics upper limb prosthesis:Mechanical and manipulation aspects［J］.Autonomous Robots，2004，16:143－163.

［8］HUANG Hai，JIANG Li，ZHAO Da-wei，et al.The Development on a New Biomechatronic Prosthetic Hand Based on Under-actuated Mechanism［C］//IEEE/RSJ International Conference on Intelligent Robots and Systems.Beijing，China:IEEE，2006:3791－3796.

［9］HUANG Hai，JIANG Li，LIU Yi-wei，et al.The Mechanical Design and Experiments of HIT/DLR Prosthetic Hand［C］//2006 IEEE International Conference on ROBOTICS and BIOMIMETICS.Kunming，China:IEEE，2006:896－901.