劉青松，袁 杰，錢建華

（中科華核電技術(shù)研究院有限公司，廣東 深圳 518124）

基于旋量理論的四自由度抓取機械手奇異位形分析

劉青松，袁 杰，錢建華

（中科華核電技術(shù)研究院有限公司，廣東 深圳 518124）

機構(gòu)奇異位形是影響機構(gòu)運動學性能的重要因素之一，機械手的奇異位形可導致機構(gòu)鎖死、控制復(fù)雜化、危害人員安全等問題．本文針對四自由度抓取機械手采用旋量理論對該機械手進行了運動學分析，并推導出了機械手奇異位形，采用隨機取點法驗證了旋量方法的可行性．在此基礎(chǔ)上，利用MATLAB Robotics對奇異位形進行了仿真分析．仿真結(jié)果表明，應(yīng)用旋量理論求解的奇異位形數(shù)據(jù)準確，可有效剔除機械手奇異位形，確保機械手高速準確完成抓取任務(wù)．

奇異位形；機械手；旋量理論；隨機取點法

機器人運動學是機器人性能分析、動力學分析以及精確控制的基礎(chǔ)，具有非常重要的地位[1-3]．機構(gòu)奇異位形是影響機構(gòu)運動學性能的重要因素之一．機械手的奇異位形可導致機構(gòu)鎖死、控制復(fù)雜化、危害人員安全等問題．目前，研究奇異位形的方法主要有Grassmann線幾何法、運動學法、代數(shù)法等[4]．其中，線幾何法需要對每根連桿軸的線矢進行分析，求取子問題過多；運動學法運用運動學上的基本定理，找到物體運動的速度關(guān)系，對于空間運動的物體，3點速度關(guān)系不易求?。淮鷶?shù)法運用DH法則對每個連桿建立局部坐標系，求取速度雅克比矩陣，其求取過程中采用局部參數(shù)，存在表示不足的問題．

本文分析了輪式移動四自由度機械手，該機械手需高速準確地完成地面異物抓取等復(fù)雜任務(wù)，考慮到輪式移動平臺不能實現(xiàn)全方位移動，因此，機械手的奇異位形不可避免，分析其奇異位形種類，對提高其作業(yè)性能具有重要意義．本文以旋量理論從整體上建立了機械手的運動學模型，求解了速度雅克比矩陣，通過旋量理論分析了操作空間中速度參數(shù)之間線性關(guān)系，推導出了機械手奇異位形[5]，并采用廣泛應(yīng)用的隨機取點法驗證了該方法可行性．在此基礎(chǔ)上，利用MATLABRobotics對奇異位形進行了仿真分析．

1 四自由度機械手運動學分析

本機械手是由4個轉(zhuǎn)動副連接，4個桿件組成的4軸串聯(lián)機器人，融合了腰部回轉(zhuǎn)、肩部內(nèi)旋/（外翻）、肘部內(nèi)旋/（外翻）、腕部回轉(zhuǎn)、手指屈/（伸）等各關(guān)節(jié)運動，如圖1所示．

圖1 4-DOF機械手坐標系Fig.1 4-DOFmanipulator coordinate system

1.1 運動方程的建立

如圖1所示，建立四自由度機械手基坐標系 {S}和工具坐標系 {T}，圖所示為初始位形時[6]．

各個關(guān)節(jié)的運動旋量：

于是，得到正運動學方程：

1.2 雅克比矩陣求取

機械手速度雅克比矩陣只需通過運動旋量的位置和方向確定：

式 (11)中各當前位形下各個關(guān)節(jié)對應(yīng)的運動副旋量坐標：

于是，得到四自由度機械手的速度雅克比矩陣：

2 奇異位形求取

2.1 旋量法求取奇異位形

上一小節(jié)已經(jīng)得到機械手的速度雅克比矩陣，當雅可比矩陣的秩比操作空間向量維數(shù)小時，機械手會出現(xiàn)奇異位形[7]．

本文采用旋量方法求取奇異位形，與代數(shù)方法相比，它無需對雅克比矩陣求逆，計算更簡便；其通過分析空間速度矢量與關(guān)節(jié)速度矢量的線性關(guān)系，剔除線性相關(guān)的速度矢量，從而得到飽含獨立速度矢量的雅克比矩陣．該方法適用于少自由度機械手（自由度少于6）的奇異位形求解．

旋量理論中有一種重要運算，稱為互易積．它表示運動旋量和力旋量的約束關(guān)系．運動旋量用來表示剛體的運動，力旋量表示剛體受到的力，兩者的互易積表示力旋量對運動旋量所作的功．當互易積為0時，即力旋量對運動旋量的瞬時功率為0，無論旋量中力或力矩多大，不會對剛體做功，不改變該約束作用下剛體的運動狀態(tài)，將此時的力旋量記作與運動旋量所對應(yīng)的反旋量[8]．通過反旋量對雅克比矩陣中的運動旋量進行互易積運算，可以構(gòu)造操作空間6個速度矢量 wxwywzvxvyvzT的線性方程組，由于自由度小于6，必然存在自由變量，可以找到最大線性無關(guān)向量組，即對應(yīng)飽含獨立速度矢量的雅克比矩陣[9]．

已知雅克比矩陣，通過反旋量構(gòu)造線性方程組：

由于vx，vy為自由變量，剔除這2個元素所對應(yīng)的雅克比矩陣行向量，得到飽含獨立速度矢量的雅克比矩陣為

當det Jst=0或det Jst= 時，機械手出現(xiàn)奇異位形．

根據(jù)關(guān)節(jié)角運動范圍，得到奇異位形為：2= 90°，3=90°．

2.2 隨機取點法求取奇異位形

旋量方法已經(jīng)推導出了機械手的奇異位形，為了驗證該方法的可行性，本文采用基于代數(shù)法的的隨機取點法對求解結(jié)果進行了驗證求取．隨機取點法是利用概率統(tǒng)計的原理，首先建立1個概率模型或隨機過程，使其參數(shù)等于問題的解；然后通過觀察模型或進行抽樣試驗來計算所求參數(shù)的統(tǒng)計學特征；最后得到所求問題的近似解．建立數(shù)學模型：．imin為關(guān)節(jié)轉(zhuǎn)角最小值，imax為關(guān)節(jié)轉(zhuǎn)角最大值，rand 1為隨機數(shù)．

本文利用隨機取點法分析了各關(guān)節(jié)變量運動范圍內(nèi)，各關(guān)節(jié)轉(zhuǎn)角與雅克比矩陣分解出的最小奇異值的關(guān)系，如圖2所示．當最小奇異值為0時，即出現(xiàn)奇異位形[7]．

從圖中不難發(fā)現(xiàn)，關(guān)節(jié)角1和關(guān)節(jié)角4不存在奇異位形，關(guān)節(jié)角2和關(guān)節(jié)角3存在奇異位形．關(guān)節(jié)角2的奇異位形出現(xiàn)在圖中第50個點．結(jié)合圖中公式計算得2= 90°；關(guān)節(jié)角3的奇異位形出現(xiàn)在圖中第250個點和第750個點，結(jié)合圖中公式計算得2=90°，3= 90°．由于時與車體發(fā)生干涉，因此，機械手的奇異位形為2= 90°，3=90°，與應(yīng)用旋量方法求得的結(jié)果一致．

圖2 關(guān)節(jié)角1與最小奇異值的關(guān)系Fig.2 JointAngle1withminimum singular value

圖3 關(guān)節(jié)角2與最小奇異值的關(guān)系Fig.3 JointAngle2withm inimum singular value

圖4 關(guān)節(jié)角3與最小奇異值的關(guān)系Fig.4 JointAngle3withminimum singular value

圖5 關(guān)節(jié)角4與最小奇異值的關(guān)系Fig.5 JointAngle4withminimum singular value

3 奇異位形分析

廣義上講，奇異位形主要分為邊界奇異位形和內(nèi)部奇異位形[10]．機械手只要遠離工作空間邊界即可避免邊界奇異位形；但機械手處于內(nèi)部奇異位形時，會使工作空間變小，靈活性變差，可達區(qū)域變得“崎嶇”，引起實際操作自由度的瞬時減少，無法實現(xiàn)沿著某些方向的運動，造成機構(gòu)鎖死，從而無法實現(xiàn)作業(yè)任務(wù)；與此同時某些關(guān)節(jié)角速度會趨向無窮大，引起控制復(fù)雜化，甚至有失控的危險[11]．從求取過程中可知，奇異位形的出現(xiàn)與各關(guān)節(jié)角的變化組合密切相關(guān)，只要出現(xiàn)奇異位形，四自由度機械手運動性能就無法保證．

采用仿真軟件MATLAB Robotics對奇異位形進行仿真，四自由度機械手出現(xiàn)奇異位形時，其位置和姿態(tài)如圖6所示．

圖6 機械手奇異位形Fig.6 Manipulator singular configuration

從圖中可知，該機械手并無出現(xiàn)2個以上關(guān)節(jié)軸線的平行或垂直，即無內(nèi)部奇異位形的出現(xiàn)；此位形只是機械手達到工作空間邊界，屬于邊界奇異位形，遠離工作空間邊界或在奇異點附近對奇異位形進行處理，就可以避免．通過對求得的奇異位形進行分析，了解了四自由度機械手運動性能，為示教和軌跡規(guī)劃提供可靠的依據(jù)[11]．

4 結(jié)論

1）通過應(yīng)用旋量理論對四自由度機械手的運動學建模和速度雅克比矩陣求解，體現(xiàn)了旋量理論簡潔、準確的特點．

2）結(jié)合互易積及反旋量相關(guān)理論，將求解逆雅克比矩陣問題轉(zhuǎn)化為操作空間速度參數(shù)的線性關(guān)系問題，應(yīng)用該方法對四自由度抓取機械手的奇異位形進行求解，經(jīng)隨機取點法驗證表明，該方法準確可靠．

3）總結(jié)了奇異位形種類及危害，對四自由度機械手奇異位形進行分析，為控制系統(tǒng)避開這些奇異位形提供了重要的數(shù)據(jù)．

[1]CuiGenqun，LiChunshu，ZhangMinglu．Kinematic AnalysisofMobileManipulator forMeasurementand Maintenance in DangerousEnvironment [J]．JournalofWuhan University of Technology，2006，28（1）：983-988．

[2]RuggiuM．Kinematicsanalysisof the CUR translationalmanipulatormachine[J]．Mechanism and Machine Theory，2008，43（9）：1087-1098．

[3]Kanaan D，Wenger P，Chablat D．Kinematic analysisof a serial-parallelmachine to the VERNEmachine[J]．Mechanism and Machine Theory，2009，44（2）：487-498．

[4]張鵬程，張鐵．基于矢量積法的六自由度工業(yè)機器人雅可比矩陣求解及奇異位形的分析 [J]．機械設(shè)計與制造，2011（8）：152-154．

[5]HU Zhun-qing，F(xiàn)ANGHai-rong，F(xiàn)ANG Yue-fa．Simulation Analysisof Low-DOFSerialManipulators[J]．Journalof System Simulation．2003，15（5）：693-695．

[6]李君．基于旋量理論的Stanford臂的運動學分析 [J]．天津科技大學學報，2010，25（4）：72-78．

[7]萬海波．五自由度機械手運動性能及動力學分析與仿真 [D]．天津：河北工業(yè)大學，2007．

[8]路立軍．旋量理論概述 [J]．機械工程師，2012（4）：39-42．

[9]楊揚．基于特種工件的大工作空間噴涂機器人設(shè)計與分析 [D]．北京：北京交通大學，2012．

[10]有倫．機器人技術(shù)基礎(chǔ) [M]．武漢：華中科技大學出版社，1996：78-81．

[11]李誠，謝志江，倪衛(wèi)，等．六自由度裝校機器人雅可比矩陣的建立及奇異性分析 [J]．中國機械工程，2012（23）：1165-1174．

[責任編輯 田 豐 夏紅梅]

Analysison the singular configuration of 4-DOFholding manipulatorbased on the Screw Theory

LIU Qingsong，YUAN Jie，QIAN Jianhua

(China Nuclear Power Technology Research Institute,Guangdong Shenzhen 518124,China)

Thesingularconfigurationisoneofthemostsignificantfactorsthatinfluencesthekinematicsperformances ofmechanism.Itmay cause problems likemechanism lockup,control complicated,and the safety of staff endangered, etc.Thisarticleanalyzes4-DOFholdingmanipulator in kinematics referring to the Screw Theory and derives the singular configuration of themanipulator aswellas the feasibility of screw theory tested with the random pick-up-pointmethod. Based on this,itdoesa furthersimulation analysisabout the singular configuration using Matlab Robotics.The resultof the simulation analysis shows that the data drawn from Applicable Screw Theory is reliable and the data can effectively elim inate singularconfiguration phenomenon tomakesure themechanismmanipulatorcan complete capturing task quickly and accurately.

singularconfiguration;manipulator;ScrewTheory;randompick-up-pointmethods

TP242

A

1007-2373(2016)06-0031-05

10.14081/j.cnki.hgdxb.2016.01.006

2014-08-23

國家863計劃（2011AA040201）

劉青松（1972-），男（漢族），高級工程師．

數(shù)字出版日期：2016-02-27數(shù)字出版網(wǎng)址：http：//www.cnki.net/kcms/detail/13.1208.T.20160227.1611.006.htm l