基于旋量理論的三指機器人靈巧手逆運動學(xué)分析

裴九芳 許德章 王 海

安徽工程大學(xué)機械與汽車工程學(xué)院，蕪湖，241000

基于旋量理論的三指機器人靈巧手逆運動學(xué)分析

裴九芳 許德章 王 海

安徽工程大學(xué)機械與汽車工程學(xué)院，蕪湖，241000

為提高三指機器人靈巧手逆運動學(xué)的求解效率，提出了基于旋量理論的逆運動學(xué)新的求解算法。以Shadow三指靈巧手為例，在無法直接利用單純的Paden-Kahan 子問題求解逆運動學(xué)的條件下，食指(無名指)的逆解采用Paden-Kahan子問題與代數(shù)解相結(jié)合的算法，拇指的逆解采用數(shù)值法與Paden-Kahan子問題相結(jié)合的算法。最后通過計算實例證明了算法的有效性和可行性。該算法在保證精度的前提下，幾何意義明顯，耗費時間短，效率高。

旋量理論；靈巧手；逆運動學(xué)；Paden-Kahan子問題

0 引言

機器人靈巧手的逆運動學(xué)分析是根據(jù)各手指末端的期望位置，求解出各手指關(guān)節(jié)的轉(zhuǎn)角。機器人靈巧手的運動學(xué)逆解是其控制和抓取規(guī)劃的前提和基礎(chǔ)，求解算法直接影響抓取效率和控制效果。

利用旋量理論建立的機器人運動學(xué)模型，其機器人的逆運動學(xué)問題可以轉(zhuǎn)化為幾類Paden-Kahan子問題進(jìn)行求解，所得逆解是解析解，沒有累計誤差，實時性高，具有明顯的幾何意義和數(shù)值穩(wěn)定性，簡化了機器人運動學(xué)的分析和計算。SARIYILDIZ等[5]基于螺旋理論，以四元數(shù)為螺旋運動算子，解決了常見結(jié)構(gòu)機器人的運動學(xué)逆解。TAN等[6]對Paden-Kahan子問題2進(jìn)行擴展，并將其用于某種特殊結(jié)構(gòu)的逆運動學(xué)求解。錢東海等[7]基于旋量理論，采用經(jīng)典消元理論和Paden-Kahan子問題相結(jié)合的方法對六自由度的機械臂進(jìn)行了逆運動學(xué)求解，該方法具有較強的通用性。陳慶誠等[8]針對具有特殊結(jié)構(gòu)的六自由度機械臂，提出了“繞3個不相交軸旋轉(zhuǎn)”的新的逆解子問題求解算法。孫恒輝等[9]針對一種后3個旋轉(zhuǎn)關(guān)節(jié)軸線相交于一點、前3個旋轉(zhuǎn)關(guān)節(jié)軸線均不相交的6R串聯(lián)機器人，提出了一種新的 Paden-Kahan 子問題并進(jìn)行了求解。呂世增等[10]基于吳方法的特征列思想，結(jié)合旋量法，對6R工業(yè)機器人進(jìn)行了高效的逆解求解運算。李盛前等[11]引入希爾維斯特結(jié)式法對6R工業(yè)機器人進(jìn)行逆運動學(xué)求解。

目前常見的Paden-Kahan子問題組合需要各關(guān)節(jié)軸線具有較多的交點，無法適用于所有多關(guān)節(jié)機器人結(jié)構(gòu)的逆解問題。本文以Shadow 三指靈巧手為例，食指(無名指)采用Paden-Kahan子問題與代數(shù)解相結(jié)合的算法求得逆解，拇指則采用Paden-Kahan子問題與數(shù)值解相結(jié)合的算法。最后通過實例證明了該算法的正確性。該算法在保證精度的前提下，計算量小、效率高。

1 基于旋量理論的運動學(xué)模型

當(dāng)一剛體既繞軸線ω(ω∈R3)轉(zhuǎn)動(轉(zhuǎn)動角度為θ)，又沿平行于ω軸方向移動(移動線速度為v)，如圖1所示，則剛體的變換可以用矩陣指數(shù)形式表示為

(1)

(2)

v=-ω×q

圖1 剛體的旋量運動Fig.1 Screw motion of a rigid body

ω=0時

ω≠0時

(3)

n自由度任意開鏈機器人的運動學(xué)正解映射可表示為gst:se(3)→SE(3)，其中，se(3)和SE(3)分別為李代數(shù)和李群，代表旋量的集合和剛體變換的集合，則機器人運動學(xué)正解的指數(shù)積公式為

(4)

2 機器人靈巧手的運動學(xué)逆解算法

2.1 運動學(xué)逆解的3個Paden-Kahan子問題

Paden-Kahan子問題的主要思想是：將復(fù)雜的機器人運動學(xué)逆解分解為若干個具有明確幾何意義的逆解子問題，然后逐一解決，即將復(fù)雜的運動分解為幾個連續(xù)的簡單運動(都可采用運動旋量的指數(shù)積來表示)。 Paden-Kahan子問題主要有3種。

θ=arctan(ω·(u′×w′),u′·w′)

圖2 Paden-Kahan子問題1Fig.2 Paden-Kahan sub problem 1

圖3 Paden-Kahan子問題2Fig.3 Paden-Kahan sub problem 2

圖4 Paden-Kahan子問題3Fig.4 Paden-Kahan sub problem 3

2.2 Shadow 三指機器人靈巧手手指逆運動學(xué)解的實現(xiàn)

2.2.1 Shadow三指機器人靈巧手結(jié)構(gòu)

如圖5所示，Shadow三指機器人靈巧手包括拇指、食指、無名指、簡易手掌。拇指共5個自由度，分別為下指節(jié)的側(cè)擺和屈曲、中指節(jié)的側(cè)擺和屈曲，以及上指節(jié)的屈曲運動，其中，側(cè)擺軸與屈曲軸垂直，且與手掌相連。食指和無名指結(jié)構(gòu)相同(故下面逆運動學(xué)只分析食指)，分別為下指節(jié)的側(cè)擺和屈曲，以及中指節(jié)和上指節(jié)的屈曲運動，其中，中指節(jié)和上指節(jié)相互耦合，耦合系數(shù)為1。

圖5 Shadow靈巧手結(jié)構(gòu)簡圖Fig.5 Schematic diagram of Shadow dexterous hand

2.2.2食指逆運動學(xué)逆解算法的實現(xiàn)

圖6 食指的運動模型Fig.6 Motion model of the index finger

gst(θ)=

(5)

ci=cosθisi=sinθii=1,2,3,4

c23=cos(θ2+θ3)s23=sin(θ2+θ3)

c234=cos(θ2+θ3+θ4)s234=sin(θ2+θ3+θ4)

根據(jù)運動學(xué)正解結(jié)果，對食指逆解求解步驟如下：

(1)求θ1。令式(5)的第一行、第四列元素c1(a1+a2c2+a3c23+a4c234)=px，第二行、第四列元素s1(a1+a2c2+a3c23+a4c234)=py，則可得

θ1=arctan(py,px)

(6)

即

(7)

式(7)中僅有未知數(shù)θ3，利用子問題3可解出θ3。

(3)求θ4。θ4和θ3相互耦合，耦合系數(shù)為1，則

θ4=θ3

(8)

(9)

利用子問題1對式(9)進(jìn)行求解，即得θ2。

2.2.3拇指逆運動學(xué)解算法實現(xiàn)

由拇指的運動模型簡圖(圖7)可知，拇指的特點是關(guān)節(jié)1與關(guān)節(jié)2的軸線相交，a1=0，關(guān)節(jié)3與關(guān)節(jié)4軸線相交，關(guān)節(jié)1、關(guān)節(jié)4與關(guān)節(jié)5軸線平行，垂直紙面向外。這種結(jié)構(gòu)是無法利用已有的3個子問題直接求解而獲得逆解的。為了提高求解效率，應(yīng)盡量計算各關(guān)節(jié)的解析解；如果不能夠獲得解析解，以盡少采用數(shù)值解為宜。根據(jù)拇指的特點，設(shè)計的求解過程如下。

圖7 拇指的運動模型Fig.7 Motion model of the thumb

(10)

對式(10)兩邊右乘pw，則

(11)

(12)

式(12)中只有一個未知數(shù)θ5，利用數(shù)值解解得即可。

(3)求θ3和θ4。因θ1、θ2和θ5已知，將式(10)左邊的θ1、θ2移至等式右邊，則式(10)變?yōu)?/p>

(13)

3 逆解實例計算驗證

參照人手各個關(guān)節(jié)的轉(zhuǎn)動范圍，表1給出了Shadow靈巧手手指結(jié)構(gòu)參數(shù)和關(guān)節(jié)范圍。

表1 Shadow靈巧手手指結(jié)構(gòu)參數(shù)和關(guān)節(jié)范圍

根據(jù)食指和拇指的逆運動學(xué)算法，其驗證方法和步驟如下：

(1)給定手指各關(guān)節(jié)確定的角度。

(2)根據(jù)靈巧手手指的正運動學(xué)方程計算出手指指尖在此角度下的位姿。

(3)應(yīng)用本文提出的食指和拇指的逆運動學(xué)算法逐步求解各關(guān)節(jié)的角度。在多解的情況下，將所解關(guān)節(jié)角范圍外的角度剔除。

(4)比較步驟(1)中給定角度和步驟(3)中求解的角度，若二者誤差在允許范圍內(nèi)，則驗證本文算法正確；否則不正確。

根據(jù)此步驟，在關(guān)節(jié)取值范圍內(nèi)任意選取一組數(shù)據(jù)，則食指和拇指的求解結(jié)果如表2所示。 通過比較理論設(shè)定值和實際運行結(jié)果各對應(yīng)元素的數(shù)值，關(guān)節(jié)角運行誤差最大為食指的第三和第四關(guān)節(jié)，皆為0.0444°，最小運行誤差為食指的第一關(guān)節(jié)，數(shù)值為0°，可以看出，本文提出的手指逆解的算法具有較高的精度，同時在該算法中，食指(無名指)的逆解算法都為解析解，而拇指僅第五關(guān)節(jié)需要數(shù)值解，其余都為解析解，改進(jìn)了傳統(tǒng)的D -H逆解算法中食指(無名指)和拇指都需要數(shù)值解，計算量大、效率低的問題。對算法運行時間進(jìn)行統(tǒng)計，本文仿真軟件采用MATLAB2011，計算機CPU為i5-4590@3.3GHz，內(nèi)存為8G的64位Win7操作系統(tǒng)。表3是利用旋量理論與D -H方法所得逆解的各運行時間?？梢钥闯?，利用旋量理論效率較D -H方法高。說明利用旋量理論進(jìn)行求逆的算法耗費時間少，計算效率高，證明該算法是正確有效的。

表2 逆解求解結(jié)果

表3 旋量理論與D -H方法所得逆解

4 結(jié)語

應(yīng)用旋量理論建立了Shadow 三指(拇指、食指、無名指)靈巧手各指的運動學(xué)模型，針對各手指不同的結(jié)構(gòu)，提出采用Paden-Kahan子問題與代數(shù)解結(jié)合求解食指(無名指)的逆解，采用數(shù)值法與Paden-Kahan子問題相結(jié)合求解拇指逆解，這兩種求解算法，整體計算量小，提高了計算效率；拇指和食指求逆的過程利用了Paden-Kahan幾何算法，并利用了軸的交點、軸外點等幾何量進(jìn)行計算，幾何特征明顯；通過實例計算，驗證了該逆解算法的可行性與有效性。

[1] DENAVIT J，HARTENBERG R S. A Kinematics Notation for Lower Pair Mechanisms Based on Matrices [J].Journal of Applied Mechanics，1995，21(5):215-221.

[2] LEE R，YAN Honglin. Development of Universal Environment for Constructing 5-axis Virtual Machine Tool Based on Modified D-H Notation and OpenGL[J]. Robotics and Computer-Integrated Manufacturing，2010，26(3): 253-262.

[3] ROCHA C R，TONETTO C P，DIAS A. A Comparison between the Denavit-Hartenberg and the Screw-based Methods Used in Kinematic Modeling of Robot Manipulators[J]. Robotics and Computer-Integrated Manufacturing，2011，27(4):723-728.

[4] 張玉茹，李繼婷，李劍鋒. 機器人靈巧手—建模、規(guī)劃與仿真[M]. 北京：機械工業(yè)出版社， 2007.

ZHANG Yuru，LI Jiting，LI Jianfeng. Dexterous Robot Hand—model Planning and Simulation[M]. Beijing: China Machine Press，2007.

[5] SARIYILDIZ E，TEMELTAS H. Solution of Inverse Kinematic Problem for Serial Robot Using Quaternion[C]//Proceedings of the IEEE International Conference on Mechatronics and Automation. Changchun: IEEE，2009: 26-31.

[6] TAN Yuesheng，XIAO Aiping. Extension of the Second Paden-Kahan Sub-problem and Its’ Application Kinematics of a Manipulator[C]// Proceedings in the Inverse of the International Mechatronics Conference on Robotics Automation. Chengdu: IEEE，2008: 379-381.

[7] 錢東海，王新峰，趙偉，等.基于旋量理論和Paden-Kahan子問題的6自由度機器人逆解算法[J]. 機械工程學(xué)報，2009，45(9):72-76.

QIAN Donghai， WANG Xinfeng，ZHAO Wei，et al. Algorithm for the Inverse Kinematics Calculation of 6-DOF Robots Based on Screw Theory and Paden-Kahan Sub-problems[J]. Journal of Mechanical Engineering，2009，45(9):72-76.

[8] 陳慶誠，朱世強，王宣銀，等. 基于旋量理論的串聯(lián)機器人逆解子問題求解算法[J]. 浙江大學(xué)學(xué)報:(工學(xué)版)，2014，48(1):8-14.

CHEN Qingcheng，ZHU Shiqiang，Wand Xuanyin，et al. Inverse Kinematics Sub-problem Solution Algorithm for Serial Robot Based on Screw Theory[J]. Journal of Zhejiang University(Engineering Science)，2014， 48(1): 8-14.

[9] 孫恒輝，趙愛武，李達(dá)，等. 基于新旋量子問題改進(jìn)一類6R串聯(lián)機器人逆解算法[J]. 機械工程學(xué)報， 2016，52(1):79-86.

SUN Henghui，ZHAO Aiwu，LI Da， et al. Improvement of the Algorithm of the Inverse Kinematics Calculation for 6R Series Robots Based on One Novel Paden-Kahan Sub-problem[J]. Journal of Mechanical Engineering，2016，52(1):79-86.

[10] 呂世增，張大衛(wèi)，劉海年. 基于吳方法的6R機器人逆運動學(xué)旋量方程求解[J]. 機械工程學(xué)報，2010，46(17): 35-41.

LYU Shizeng，ZHANG Dawei，LIU Hainian. Solution of Screw Equation for Inverse Kinematics of 6R Robot Based on Wu’s Method[J]. Journal of Mechanical Engineering，2010，46(17):35-41.

[11] 李盛前，謝小鵬. 基于旋量理論和Sylvester結(jié)式法的6自由度機器人逆運動學(xué)求解分析[J]. 農(nóng)業(yè)工程學(xué)報，2015，31(20):48-54.

LI Shengqian，XIE Xiaopeng. Analysis of Inverse Kinematic Solution for 6R Robot Based on Screw Theory and Sylvester Resultant[J]. Transactions of the Chinese Society of Agricultural Engineering，2015， 31(20):48-54.

[12] HUNT K H. Kinematic Geometry of Mechanisms [M]. New York: Oxford University Press，1978.

InverseKinematicsAnalysesof3-fingerRobotDexterousHandBasedonScrewTheory

PEI Jiufang XU Dezhang WANG Hai

School of Mechanical and Automotive Engineering,Anhui Polytechnic University,Wuhu,Anhui,241000

A novel inverse kinematics algorithm was proposed based on screw theory in order to improve operation efficiency of inverse kinematics for 3-finger robot dexterous hand. Taking Shadow 3-finger robot dexterous hand as an example, because inverse kinematics might not be solved directly by Paden-Kahan sub problem, an inverse solution of index finger(ring finger) was combined with algebraic solution and Paden-Kahan sub problem. The inverse solution of thumb was combined with numerical method and Paden-Kahan sub problem. Finally, validity and feasibility of the algorithms were proved by an example. Under the premise of ensuring accuracy, the algorithms have obvious geometric meaning, less computation, and high efficiency.

screw theory; dexterous hand; inverse kinematics; Paden-Kahan sub problem

TP242

10.3969/j.issn.1004-132X.2017.24.013

2016-11-22

國家自然科學(xué)基金資助項目(51175001)；安徽工程大學(xué)優(yōu)秀青年人才基金資助重點項目(2013RZR001zd)

(編輯張洋)

裴九芳，女，1980年生。安徽工程大學(xué)機械與汽車工程學(xué)院副教授。主要研究方向為機器人靈巧手的抓取規(guī)劃、機器人控制等。發(fā)表論文15篇。E-mail :jfpei@ahpu.edu.cn。許德章，男， 1964年生。安徽工程大學(xué)機械與汽車工程學(xué)院教授。王海，男，1976年生。安徽工程大學(xué)機械與汽車工程學(xué)院教授。