• <tr id="yyy80"></tr>
  • <sup id="yyy80"></sup>
  • <tfoot id="yyy80"><noscript id="yyy80"></noscript></tfoot>
  • 99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看 ?

    一種六自由度機(jī)械手奇異回避算法

    2017-06-15 17:01:56崔洪新李煥良韓金華
    中國機(jī)械工程 2017年11期
    關(guān)鍵詞:位形腕部倒數(shù)

    崔洪新 李煥良 韓金華 李 沛

    解放軍理工大學(xué)野戰(zhàn)工程學(xué)院,南京,210007

    ?

    一種六自由度機(jī)械手奇異回避算法

    崔洪新 李煥良 韓金華 李 沛

    解放軍理工大學(xué)野戰(zhàn)工程學(xué)院,南京,210007

    針對傳統(tǒng)機(jī)械手奇異回避算法存在的計(jì)算量大、實(shí)時(shí)性差的問題,提出了基于“奇異分離+指數(shù)級阻尼倒數(shù)”的奇異回避算法。首先,在對機(jī)械手運(yùn)動(dòng)學(xué)建模分析的基礎(chǔ)上,通過Jacobian矩陣計(jì)算將導(dǎo)致奇異的參數(shù)分離出來;然后,介紹了指數(shù)級阻尼倒數(shù)算法的原理,并對采用指數(shù)級阻尼倒數(shù)進(jìn)行奇異回避導(dǎo)致的誤差進(jìn)行了研究。仿真與實(shí)驗(yàn)結(jié)果表明,該算法可實(shí)現(xiàn)關(guān)節(jié)角速度在奇異域的平穩(wěn)光滑過渡,且僅犧牲了機(jī)械臂末端在部分方向上的精度,由此算法的有效性和實(shí)用性得到驗(yàn)證。

    六自由度機(jī)械手;奇異回避;奇異分離;指數(shù)級阻尼倒數(shù)

    0 引言

    奇異性是關(guān)節(jié)型機(jī)器人的固有特性,當(dāng)機(jī)械臂運(yùn)動(dòng)到奇異位形附近時(shí),雅可比矩陣的逆是病態(tài)的且趨于無窮大,從而需要無窮大的關(guān)節(jié)角速度和角加速度,這會(huì)導(dǎo)致機(jī)械臂在運(yùn)動(dòng)過程中出現(xiàn)振動(dòng),嚴(yán)重影響機(jī)器人的軌跡跟蹤精度。因此,回避奇異的軌跡規(guī)劃和控制策略研究一直是機(jī)器人研究的熱點(diǎn)[1]。

    常用的奇異回避算法是阻尼最小方差法[2-3],雖然該算法保證了關(guān)節(jié)角速度在奇異位形附近的連續(xù)性和有限性,但存在機(jī)械臂末端在各個(gè)方向上的跟蹤精度較差的問題;文獻(xiàn)[4]通過將阻尼系數(shù)只加在最小奇異值上,對阻尼最小方差法的軌跡跟蹤性能進(jìn)行了改進(jìn)。文獻(xiàn)[5]針對研磨機(jī)器人的特點(diǎn),提出了以可操作性為準(zhǔn)則[6]的奇異回避方法,提高了機(jī)器人的研磨精度。文獻(xiàn)[7-8]針對PUMA類型機(jī)械臂的結(jié)構(gòu)特點(diǎn),分別提出了“奇異分離+緊密二次型規(guī)劃”法和“奇異分離+阻尼倒數(shù)法”的PUMA機(jī)器人奇異回避算法。其他的奇異回避方法還有約束平面法[9]、幾何代數(shù)法[10]、虛擬驅(qū)動(dòng)法[11]和變速度控制法[12]等。但采用上述方法進(jìn)行奇異回避計(jì)算時(shí),需要對Jacobian矩陣進(jìn)行實(shí)時(shí)的奇異值分解,或者需要實(shí)時(shí)估計(jì)Jacobian矩陣的最小奇異值,運(yùn)算量較大。

    本文針對六自由度機(jī)械手有三個(gè)關(guān)節(jié)的軸線相交于一點(diǎn)的特點(diǎn),將機(jī)械臂分成前臂和腕部兩個(gè)部分。首先建立了機(jī)械臂的運(yùn)動(dòng)學(xué)模型,進(jìn)而推導(dǎo)出了以腕部為參考點(diǎn)的雅可比矩陣,并將六自由度的奇異回避問題分解為兩個(gè)三自由度的奇異回避子問題;然后,將機(jī)械臂的奇異分成內(nèi)部奇異、邊界奇異和腕部奇異,并計(jì)算出相應(yīng)的奇異影響因子,采用指數(shù)級阻尼倒數(shù)代替一般倒數(shù)的方法進(jìn)行奇異回避;最后,通過數(shù)值仿真和實(shí)驗(yàn)對提出的“奇異分離+指數(shù)級阻尼倒數(shù)”的奇異回避算法進(jìn)行了驗(yàn)證。

    1 運(yùn)動(dòng)學(xué)與雅可比矩陣建模

    1.1 運(yùn)動(dòng)學(xué)正解

    采用D-H坐標(biāo)系法建立的六自由度機(jī)械手各連桿坐標(biāo)系如圖1所示,相應(yīng)的連桿結(jié)構(gòu)參數(shù)如表1所示。其中,ai為沿Xi軸從Zi軸移動(dòng)到Zi+1軸的距離;αi為繞Xi軸從Zi軸旋轉(zhuǎn)到Zi+1軸的角度;di為沿Zi軸從Xi-1軸移動(dòng)到Xi軸的距離;θi為繞Zi軸從Xi-1軸旋轉(zhuǎn)到Xi軸的角度。

    圖1 機(jī)械手D-H坐標(biāo)系及參數(shù)Fig.1 D-H coordinate system and parameters

    表1 機(jī)械手D-H參數(shù)表

    (1)

    將表1中的參數(shù)代入式(1),并逐次相乘得到機(jī)械臂末端到全局坐標(biāo)系的齊次變換矩陣為

    (2)

    r11=s1(c4s6+s4c5c6)-c1[c6s23s5+

    c23(s4s6-c4c5c6)]

    r12=s1(c4c6-s4c5s6)+c1[s23s5s6-

    c23(s4c6+c4c5s6)]

    r13=-s1s4s5-c1(s23c5+c23c4s5)

    r21=s1[c23(c4c5c6-s4s6)-s23s5c6]-

    c1(c4s6+s4c5c6)

    r22=s1[s23s5s6-c23(c4c5s6+s4c6)]-

    c1(c4c6-s4c5s6)

    r23=-s1(s23c5+c23c4s5)+c1s4s5

    r31=s23(s4s6-c4c5c6)-c23s5c6

    r32=s23(s4c6+c4c5s6)+c23s5s6

    r33=s23c4s5-c23c5

    si=sinθisij=sin (θi+θj)

    cj=cosθjcij=cos (θi+θj)

    機(jī)械臂末端在全局坐標(biāo)系中的坐標(biāo)分量為

    (3)

    機(jī)械臂末端的姿態(tài)角為

    (4)

    1.2 運(yùn)動(dòng)學(xué)逆解

    根據(jù)六自由度機(jī)械手運(yùn)動(dòng)學(xué)逆解的存在性判斷條件,即機(jī)械臂后3個(gè)關(guān)節(jié)的軸線相交于一點(diǎn)則必存在逆運(yùn)動(dòng)學(xué)解,可得運(yùn)動(dòng)學(xué)逆解計(jì)算公式為

    (5)

    L2=(a2s3-d4)(c1Px+s1Py-a1)-(a3+a2c3)Pz

    L3=(a2c3-a3)(c1Px+s1Py-a1)-(d4-a2s3)Pz

    s5=-r13(c1c23c4+s1s4)-r23(s1c23c4-c1s4)+r33s23c4

    c5=-r13c1s23-r23s1s23-r33c23s6=-r11(c1c23s4-s1c4)-r21(s1c23s4+c1c4)+r31s23s4

    c6=r11[(c1c23c4+s1s4)c5-c1s23s5]-r31(s23c4c5+c23s5)+r21[(s1c23c4-c1s4)c5-s1s23s5]

    六自由度機(jī)械手運(yùn)動(dòng)學(xué)逆解計(jì)算方程組有多個(gè)解,在實(shí)際運(yùn)動(dòng)規(guī)劃過程中基于各關(guān)節(jié)的運(yùn)動(dòng)范圍約束和角度變化量最小的原則取出最優(yōu)解。

    1.3 雅可比矩陣建模

    (6)

    其中,Jli和Jai分別表示第i關(guān)節(jié)的線速度和角速度傳遞比。機(jī)械手的雅可比矩陣為

    J1x=-(c4s6+s4c5c6)(a1+a2c2+a3c23-d4s23)

    J1y=-(c4c6-s4c5s6)(a1+a2c2+a3c23-d4s23)

    J1z=s4s5(a1+a2c2+a3c23-d4s23)

    J2x=a2[s3(c4c5c6-s4s6)+c3s5c6]+a3s5c6-d4(c4c5c6-s4s6)

    J2y=-a2[s3(c4c5s6+s4c6)+c3s5s6]-a3s5s6+d4(c4c5s6+s4c6)

    J2z=a2(c3c5-s3c4s5)+a3c5+c4s5d4

    J3x=d4(s4s6-c4c5c6)+a3s5c6

    J3y=d4(c4c5s6+s4c6)-a3s5s6

    J3z=a3c5+d4c4s5

    2 奇異位形分析

    由于機(jī)械臂后三個(gè)關(guān)節(jié)的軸線相交于一點(diǎn),因此將機(jī)械臂分成前臂和腕部,采用奇異分離法進(jìn)行奇異位形分析。

    2.1 奇異位形分析

    由于機(jī)械臂末端和腕部的位置相對固定,因此建立以腕部為參考點(diǎn)的雅可比矩陣Jw,其計(jì)算公式為

    (7)

    其中,zi是繞關(guān)節(jié)i轉(zhuǎn)動(dòng)的單位向量在基坐標(biāo)系中的表示,其計(jì)算公式為

    zi=0R1…i-1Riz0

    (8)

    Pi表示基坐標(biāo)系相對于{i}坐標(biāo)原點(diǎn)的位置矢量,其計(jì)算公式為

    (9)

    Pw表示腕部在基坐標(biāo)系中的位置矢量,即Pw=P4。

    由于機(jī)械臂后三個(gè)關(guān)節(jié)的軸線相交,所以Pw=Pn-1=Pn-2=Pn-3。因此Jnw、J(n-1)w和J(n-2)w全為零矢量。

    最終,可得機(jī)械臂腕部雅可比矩陣為

    (10)

    其中,J11、J21、J22為腕部雅可比矩陣的分塊矩陣,其計(jì)算公式如下:

    M=a1+a2c2+a3c23-d4s23

    N=a2s2+a3s23+d4c23

    G=a3s23+d4c23

    (11)

    因此,腕部線速度和角速度可分別表達(dá)為

    (12)

    進(jìn)而將運(yùn)動(dòng)學(xué)逆問題分解為兩個(gè)問題:

    (13)

    由腕部雅可比矩陣表達(dá)式計(jì)算可得

    (14)

    (1)當(dāng)a3s3+d4c3=0,即θ3=arctan(-d4/a3)時(shí)奇異位形稱為邊界奇異;

    (2)當(dāng)a1+a2c2+a3c23-d4s23=0時(shí),奇異位形稱為內(nèi)部奇異;

    (3)當(dāng)s5=0,即θ5=0時(shí)奇異位形稱為腕部奇異,此時(shí)Z4軸和Z6軸共線。

    2.2 前臂奇異分離

    由于機(jī)械臂末端的線速度與腕部的線速度相同,為便于分析將腕部在全局坐標(biāo)系中的線速度轉(zhuǎn)換為坐標(biāo)系{3}中的線速度:

    (15)

    將J11轉(zhuǎn)換到坐標(biāo)系{3}中表示的計(jì)算公式為3J11=(0R3)-1J11,因而可得

    (16)

    (17)

    (18)

    當(dāng)k1=0時(shí),關(guān)節(jié)1的角速度為無窮大;當(dāng)k2=0時(shí),關(guān)節(jié)2和關(guān)節(jié)3的角速度為無窮大。k1、k2分別為內(nèi)部奇異因子和邊界奇異因子。

    2.3 腕部奇異分離

    同理,將J22轉(zhuǎn)換到坐標(biāo)系{5}中表示的計(jì)算公式為5J22=(0R5)-1J22,可得

    (19)

    (20)

    k3=sinθ5

    式中,k3為腕部奇異因子。

    將機(jī)械臂末端的角速度轉(zhuǎn)換到坐標(biāo)系{5}中的計(jì)算公式為

    (21)

    當(dāng)k3=0時(shí),關(guān)節(jié)4和關(guān)節(jié)6的角速度將為無窮大,此時(shí)稱為腕部奇異。

    3 奇異回避算法

    前文中通過奇異分離將機(jī)械手的奇異位形分成內(nèi)部奇異、邊界奇異和腕部奇異三種,并分別計(jì)算了相應(yīng)的奇異影響因子k1、k2和k3。本節(jié)引入指數(shù)級阻尼倒數(shù)算法進(jìn)行奇異回避分析。

    3.1 指數(shù)級阻尼倒數(shù)算法原理

    可得以下關(guān)系式:

    (22)

    從式(22)可以看出,當(dāng)奇異因子的絕對值|ki|遠(yuǎn)大于阻尼系數(shù)λi時(shí),阻尼系數(shù)產(chǎn)生的影響可忽略不計(jì);當(dāng)奇異因子的絕對值|ki|遠(yuǎn)小于阻尼系數(shù)λi時(shí),在奇異位形中阻尼系數(shù)起主要作用,保證關(guān)節(jié)角速度的連續(xù)光滑。

    在實(shí)際的機(jī)械手軌跡規(guī)劃中,奇異并不僅發(fā)生在奇異因子等于0的點(diǎn),而是奇異位形附近的一定區(qū)域,因此,設(shè)定閾值εi作為判斷奇異的條件,即當(dāng)|ki|≤εi時(shí)機(jī)械臂處于奇異域,阻尼系數(shù)開始作用,而在奇異域外阻尼系數(shù)不起作用。因而得到阻尼系數(shù)的計(jì)算公式為

    (23)

    式中,λ0為標(biāo)準(zhǔn)阻尼系數(shù)。

    根據(jù)式(15)、式(17)、式(20)和式(21)可得各關(guān)節(jié)的角速度計(jì)算公式為

    (24)

    3.2 奇異誤差分析

    (25)

    相應(yīng)的速度誤差為

    (26)

    4 仿真與實(shí)驗(yàn)

    在對機(jī)械手奇異位形和指數(shù)級阻尼倒數(shù)算法分析的基礎(chǔ)上,通過數(shù)值仿真與實(shí)驗(yàn)對提出的算法進(jìn)行驗(yàn)證。

    4.1 數(shù)值仿真

    圖2 誤差系數(shù)變化曲線Fig.2 Curve of error coefficient

    設(shè)x={α,β,γ,Px,Py,Pz}表示機(jī)械臂末端在位姿空間的坐標(biāo),其中{α,β,γ}表示末端姿態(tài)的Z-Y-X歐拉角,單位為弧度;{Px,Py,Pz}表示末端的位置,單位為mm。設(shè)機(jī)械臂末端直線插補(bǔ)的起點(diǎn)x0和終點(diǎn)xe分別為

    采用梯形法規(guī)劃機(jī)械臂末端的運(yùn)動(dòng)速度,并設(shè)運(yùn)動(dòng)總時(shí)間tf=20 s,加速和減速時(shí)間相等且ts=2 s。計(jì)算得到前臂奇異因子和腕部奇異因子隨時(shí)間變化曲線如圖3所示。從圖3中可以看出:當(dāng)t1=3.3 s時(shí),k2=0;當(dāng)t2=15.4 s時(shí),k3=0,因此機(jī)械臂在運(yùn)動(dòng)過程中發(fā)生邊界奇異和腕部奇異。

    指數(shù)級阻尼倒數(shù)相關(guān)參數(shù)分別設(shè)為:λ0=0.5,ε2=1.5,ε3=0.05。分別利用直接求逆法、阻尼倒數(shù)法和本文提出的指數(shù)級阻尼倒數(shù)法計(jì)算各關(guān)節(jié)的角速度。其中第i關(guān)節(jié)用直接求逆法計(jì)算的角速度表示為ωij,用阻尼倒數(shù)法計(jì)算的角速度表示為ωid,用指數(shù)級阻尼倒數(shù)法計(jì)算的角速度表示為ωie。各關(guān)節(jié)角速度變化曲線如圖4所示。圖中,“ωid+0.1”表示ωid曲線向上平移0.1個(gè)單位,其他類此。

    (a)前臂奇異因子變化曲線

    (b)腕部奇異因子變化曲線圖3 奇異因子值隨時(shí)間變化曲線Fig.3 Time-varying curves of singularity factors

    從圖4中可以看出:在奇異域外三條曲線重合,角速度值相同;在奇異域,采用直接求逆法計(jì)算的部分關(guān)節(jié)角速度發(fā)生奇異突變,即關(guān)節(jié)2、3、5的角速度在邊界奇異域發(fā)生突變,關(guān)節(jié)4和6的角速度在邊界奇異和腕部奇異域均發(fā)生突變;采用阻尼倒數(shù)法和指數(shù)級阻尼倒數(shù)法計(jì)算的各關(guān)節(jié)角速度變化曲線均能平穩(wěn)光滑地通過奇異域,計(jì)算結(jié)果與式(24)計(jì)算結(jié)果一致,說明這兩種方法均能很好地抑制由奇異導(dǎo)致的速度突變。

    4.2 實(shí)驗(yàn)驗(yàn)證

    實(shí)驗(yàn)系統(tǒng)是一個(gè)六自由度PUMA型機(jī)械手,通過視覺傳感系統(tǒng)對機(jī)械手末端的運(yùn)動(dòng)進(jìn)行測量以實(shí)現(xiàn)閉環(huán)控制,實(shí)驗(yàn)系統(tǒng)如圖5所示。

    (a)關(guān)節(jié)1 (b)關(guān)節(jié)2 (c)關(guān)節(jié)3

    (d)關(guān)節(jié)4 (e)關(guān)節(jié)5 (f)關(guān)節(jié)6圖4 機(jī)械臂各關(guān)節(jié)角速度變化曲線Fig.4 Angular velocity curves of manipulator joints

    圖5 實(shí)驗(yàn)系統(tǒng)圖Fig.5 Experimental schematic diagram

    利用該實(shí)驗(yàn)系統(tǒng)對本文提出的奇異回避方法進(jìn)行驗(yàn)證,機(jī)械臂運(yùn)動(dòng)的初始位姿和期望位姿分別設(shè)為

    末端運(yùn)動(dòng)速度按照梯形規(guī)劃法進(jìn)行規(guī)劃,運(yùn)動(dòng)過程中發(fā)生前臂奇異和腕部奇異。實(shí)驗(yàn)結(jié)果如圖6和圖7所示,其中,圖6為機(jī)械臂各關(guān)節(jié)的實(shí)際角速度變化曲線,圖7為機(jī)械臂末端的位置和姿態(tài)誤差曲線。

    (a)前臂

    (b)腕部圖6 各關(guān)節(jié)實(shí)際運(yùn)動(dòng)角速度Fig.6 Actual angular velocities of manipulator’s joints

    (a)位置誤差

    (b)姿態(tài)誤差圖7 機(jī)械臂末端跟蹤誤差Fig.7 Tracking errors of end-effector

    從圖6中可以看出,各關(guān)節(jié)角速度變化曲線平穩(wěn)光滑,在奇異位形關(guān)節(jié)角速度沒有發(fā)生突變。從圖7中可以看出機(jī)械臂末端的位置和姿態(tài)誤差均較小,滿足工程應(yīng)用的要求。因而,該實(shí)驗(yàn)結(jié)果證明了本文提出的“奇異分離+指數(shù)級阻尼倒數(shù)法”的有效性和實(shí)用性,能夠回避奇異位形對速度和加速度帶來的影響,高精度地跟蹤預(yù)定軌跡完成任務(wù)。

    5 結(jié)語

    本文研究了六自由度機(jī)械手的運(yùn)動(dòng)學(xué)奇異問題。針對機(jī)械臂后三個(gè)關(guān)節(jié)的軸線相交于一點(diǎn)的特點(diǎn),將六自由度的奇異問題分解成2個(gè)三自由度的奇異問題,并計(jì)算了相應(yīng)的奇異因子;提出了“奇異分離+指數(shù)級阻尼倒數(shù)”的奇異域回避算法。該算法不需要對Jacobian矩陣進(jìn)行奇異值分解,也不需要實(shí)時(shí)估算其最小奇異值;只需將奇異域內(nèi)的奇異因子倒數(shù)換成指數(shù)級阻尼倒數(shù)即可實(shí)現(xiàn)奇異回避。因而運(yùn)算量小、實(shí)時(shí)性好,且只犧牲了末端在部分方向上的速度精度。誤差分析結(jié)果表明,指數(shù)級阻尼倒數(shù)產(chǎn)生的誤差與實(shí)際值成比例,當(dāng)相應(yīng)的關(guān)節(jié)速度在奇異域內(nèi)接近于0時(shí),可進(jìn)一步減小運(yùn)動(dòng)誤差。數(shù)值仿真和實(shí)驗(yàn)結(jié)果證明了本文所提出的奇異回避算法的可行性和有效性。本文的研究方法也可應(yīng)用于其他類型機(jī)械臂的奇異回避研究中。

    [1] 劉海濤. 工業(yè)機(jī)器人的高速高精度控制方法研究[D]. 廣州:華南理工大學(xué),2012. LIU Haitao. Research on High-speed and High-precision Control of Industrial Robots [D]. Guangzhou: South China University of Technology,2012.

    [2] CHIAVERINI S, SICILIANO B,EGELAND O. Review of Damped Least-squares Inverse Kinematics with Experiments on an Industrial Robot Manipulator[J]. IEEE Transactions on Control Systems Technology,1994,2(2):123-134.

    [3] CHENOWETH S K M, SORIA J, OOI A. A Singularity-avoiding Moving Least Squares Scheme for Two-dimensional Unstructured Meshes[J]. Journal of Computational Physics,2009,228(15):5592-5619.

    [4] CHIAVERINI S. Singularity-robust Task-priority Redundancy Resolution for Real-time Kinematic Control of Robot Manipulators[J]. IEEE Transactions on Robotics and Automation,1997,13(3):398-410.

    [5] XIAO Wenlei, JI Huan. Redundancy and Optimization of a 6R Robot for Five-axis Milling Applications: Singularity, Joint Limits and Collision[J]. Production Engineering,2012,6(3):287-296.

    [6] 劉瑋, 常思勤. 一種新型并聯(lián)機(jī)器人的奇異性與工作空間研究[J]. 中國機(jī)械工程, 2012, 23(7): 786-789. LIU Wei, CHANG Siqin. Study on Singularity and Workspace of a Novel Parallel Manipulator[J]. China Mechanical Engineering,2012,23(7):786-789.

    [7] CHENG F T, HOUR T L, SUN Y Y, et al. Study and Resolution of Singularities for a 6-DOF PUMA Manipulator[J]. IEEE Transactions on System, Man and Cybernetics, Part B: Cybernetics,1997,27(2):332-343.

    [8] 徐文福,梁斌,劉宇,等. 一種新的PUMA類型機(jī)器人奇異回避算法[J]. 自動(dòng)化學(xué)報(bào), 2008,34(6): 670-675. XU Wenfu, LIANG Bin, LIU Yu, et al. A Novel Approach to Avoid Singularities of PUMA-type Manipulators[J]. Acta Automatica Sinica,2008,34(6):670-675.

    [9] PENDAR H, MAHNAMA M, ZOHOOR H. Singularity Analysis of Parallel Manipulators Using Constraint Plane Method[J]. Mechanism and Machine Theory,2011,46(1):33-43.

    [10] LI Qinchuan, XIANG J, CHAI X, et al. Singularity Analysis of a 3-RPS Parallel Manipulator Using Geometric Algebra[J]. Chinese Journal of Mechanical Engineering,2015,28(6):1204-1212.

    [11] PARK J O, IM Y D. Singularity Avoidance of CMGs by Virtual Actuators[J]. International Journal of Control Automation and Systems,2010,8(4):891-895.

    [12] MCMAHON J, SCHAUB H. Simplified Singularity Avoidance Using Variable-speed Control Moment Gyroscope Null Motion[J]. Journal of Guidance Control and Dynamics, 2009,32(6):1938-1943.

    (編輯 王艷麗)

    A Novel Avoid Singularity Algorithm for 6-DOF Manipulators

    CUI Hongxin LI Huanliang HAN Jinhua LI Pei

    College of Field Engineering,PLA University of Science and Technology,Nanjing,210007

    Aiming at the problems of the heavier calculation burden and worse real-time of traditional singularity avoidance algorithms, a novel approach (named “singularity separation plus exponential order damped reciprocal” algorithm) was proposed for 6-DOF manipulators. Firstly, the singularity configurations were analyzed and the singularity parameters were separated based on the kinematics calculation. Then, the principle of exponential order damped reciprocal algorithm was introduced and error coefficient caused by the exponential order damped reciprocal algorithm was analyzed. The simulation and experimental results show that the proposed algorithm may achieve smooth transition of joint angular velocities and only part velocities accuracy of the end-effector are sacrificed, the effectiveness and practicability of the proposed algorithm are proved.

    6-DOF manipulator; singularity avoidance; singularity separation; exponential order damped reciprocal

    2016-07-15

    全軍軍事類研究生資助課題(2015JY138)

    TP242.2

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

    崔洪新,男,1987年生。解放軍理工大學(xué)野戰(zhàn)工程學(xué)院博士研究生。主要研究方向?yàn)楣こ萄b備無人化。發(fā)表論文10余篇。E-mail:chx503207@163.com。李煥良,男,1977年生。解放軍理工大學(xué)野戰(zhàn)工程學(xué)院副教授。韓金華,男,1989年生。解放軍理工大學(xué)野戰(zhàn)工程學(xué)院博士研究生。李 沛,男,1991年生。解放軍理工大學(xué)野戰(zhàn)工程學(xué)院博士研究生。

    猜你喜歡
    位形腕部倒數(shù)
    中間支撐剛度對雙跨梁屈曲穩(wěn)定性的影響
    居家運(yùn)動(dòng)——手和腕部練習(xí)(初級篇)
    中老年保健(2021年5期)2021-08-24 07:07:36
    居家運(yùn)動(dòng)——手和腕部練習(xí)(中級篇)
    中老年保健(2021年6期)2021-08-24 06:55:28
    居家運(yùn)動(dòng)——手和腕部練習(xí)(高級篇)
    中老年保健(2021年7期)2021-08-22 07:42:30
    驚喜倒數(shù)日歷
    大學(xué)生腕管綜合征發(fā)病危險(xiǎn)因素的調(diào)查統(tǒng)計(jì)及其與電子產(chǎn)品使用的相關(guān)性分析
    基于旋量理論的四自由度抓取機(jī)械手奇異位形分析
    基于可操作度的機(jī)器人最優(yōu)初始位形研究
    大眾科技(2015年11期)2015-11-24 01:57:16
    巧用倒數(shù) 求異創(chuàng)新
    讀寫算(下)(2015年11期)2015-11-07 07:21:13
    基于最優(yōu)初始位形的冗余度機(jī)器人可操作度優(yōu)化*
    久久久久视频综合| 青春草亚洲视频在线观看| 99热网站在线观看| 一本色道久久久久久精品综合| 亚洲av男天堂| 国产成人免费观看mmmm| 老司机午夜福利在线观看视频 | 久久久精品国产亚洲av高清涩受| 91精品伊人久久大香线蕉| 亚洲专区国产一区二区| 久热这里只有精品99| 国产精品 国内视频| 美女主播在线视频| xxxhd国产人妻xxx| 12—13女人毛片做爰片一| 国产一卡二卡三卡精品| 嫁个100分男人电影在线观看| 十八禁人妻一区二区| 国产国语露脸激情在线看| 婷婷丁香在线五月| 黄色怎么调成土黄色| 黄色怎么调成土黄色| netflix在线观看网站| 成年人午夜在线观看视频| 精品亚洲成a人片在线观看| 成人免费观看视频高清| 色婷婷av一区二区三区视频| 99久久99久久久精品蜜桃| 亚洲国产成人一精品久久久| 99re6热这里在线精品视频| 这个男人来自地球电影免费观看| 欧美久久黑人一区二区| 悠悠久久av| 高清视频免费观看一区二区| 别揉我奶头~嗯~啊~动态视频 | 五月开心婷婷网| 欧美人与性动交α欧美精品济南到| 久久影院123| 国产精品99久久99久久久不卡| 亚洲欧美色中文字幕在线| 99国产综合亚洲精品| 少妇人妻久久综合中文| 国产亚洲精品一区二区www | 国产精品影院久久| 免费女性裸体啪啪无遮挡网站| 操美女的视频在线观看| 免费在线观看视频国产中文字幕亚洲 | 99re6热这里在线精品视频| 91国产中文字幕| 青春草亚洲视频在线观看| 亚洲三区欧美一区| 日韩三级视频一区二区三区| 一进一出抽搐动态| 国产99久久九九免费精品| 亚洲精品国产区一区二| 美女高潮到喷水免费观看| av福利片在线| 中文字幕av电影在线播放| 在线观看www视频免费| 一本一本久久a久久精品综合妖精| 久久精品成人免费网站| 精品少妇久久久久久888优播| 不卡一级毛片| 日本精品一区二区三区蜜桃| 午夜老司机福利片| 老司机影院成人| 巨乳人妻的诱惑在线观看| 久久精品国产亚洲av高清一级| 午夜激情久久久久久久| 国产视频一区二区在线看| 国产又色又爽无遮挡免| 久久香蕉激情| 99久久综合免费| 乱人伦中国视频| 午夜福利在线免费观看网站| 2018国产大陆天天弄谢| 午夜两性在线视频| 国产精品.久久久| bbb黄色大片| 午夜日韩欧美国产| 欧美av亚洲av综合av国产av| 视频在线观看一区二区三区| 丰满迷人的少妇在线观看| 国产亚洲一区二区精品| 亚洲成av片中文字幕在线观看| 如日韩欧美国产精品一区二区三区| 人人妻人人添人人爽欧美一区卜| www.自偷自拍.com| 亚洲七黄色美女视频| 成人三级做爰电影| 国产精品一二三区在线看| 人妻一区二区av| 欧美日韩视频精品一区| 一区二区三区乱码不卡18| 国产亚洲av片在线观看秒播厂| 国产免费福利视频在线观看| 久久久久精品国产欧美久久久 | 高清黄色对白视频在线免费看| 高清av免费在线| av免费在线观看网站| 国产又色又爽无遮挡免| 精品熟女少妇八av免费久了| 亚洲专区字幕在线| 久久毛片免费看一区二区三区| 欧美亚洲 丝袜 人妻 在线| 9色porny在线观看| 午夜免费成人在线视频| 永久免费av网站大全| 一级毛片电影观看| 狠狠精品人妻久久久久久综合| 91成年电影在线观看| 夜夜夜夜夜久久久久| av不卡在线播放| 亚洲精品久久成人aⅴ小说| 中国美女看黄片| 人人澡人人妻人| 久久久久久人人人人人| 欧美激情高清一区二区三区| 国产精品欧美亚洲77777| 久久人人爽人人片av| 亚洲久久久国产精品| 日本一区二区免费在线视频| 一本大道久久a久久精品| 精品一品国产午夜福利视频| 久久香蕉激情| 我要看黄色一级片免费的| 欧美黑人精品巨大| 欧美日韩一级在线毛片| 亚洲一区中文字幕在线| 人妻一区二区av| 黄色片一级片一级黄色片| 日韩免费高清中文字幕av| 国产淫语在线视频| 一区在线观看完整版| 91精品伊人久久大香线蕉| 丝袜喷水一区| 色精品久久人妻99蜜桃| 国产成人免费无遮挡视频| 波多野结衣av一区二区av| av网站免费在线观看视频| 丰满迷人的少妇在线观看| 狠狠精品人妻久久久久久综合| 香蕉丝袜av| 午夜久久久在线观看| 亚洲成人免费电影在线观看| 中亚洲国语对白在线视频| 亚洲情色 制服丝袜| 纯流量卡能插随身wifi吗| 叶爱在线成人免费视频播放| 久久国产精品人妻蜜桃| 国产亚洲av片在线观看秒播厂| 91av网站免费观看| 精品一区在线观看国产| 亚洲国产欧美日韩在线播放| 欧美在线一区亚洲| 中文字幕av电影在线播放| av在线老鸭窝| tocl精华| 岛国在线观看网站| 国产一区二区三区综合在线观看| 中文精品一卡2卡3卡4更新| 欧美成人午夜精品| 免费高清在线观看日韩| www.熟女人妻精品国产| 男女午夜视频在线观看| 久久性视频一级片| 色老头精品视频在线观看| 久久中文看片网| 99热国产这里只有精品6| 亚洲专区字幕在线| 人人妻人人爽人人添夜夜欢视频| 国产精品亚洲av一区麻豆| 国产精品免费视频内射| 国产有黄有色有爽视频| 青青草视频在线视频观看| 久久精品国产a三级三级三级| 纵有疾风起免费观看全集完整版| 精品少妇内射三级| a级片在线免费高清观看视频| 国产欧美日韩综合在线一区二区| 午夜激情av网站| 99国产精品免费福利视频| 女人精品久久久久毛片| 国产日韩欧美视频二区| 亚洲九九香蕉| 看免费av毛片| 亚洲国产看品久久| 视频区图区小说| a 毛片基地| 一二三四社区在线视频社区8| 亚洲免费av在线视频| 黑人巨大精品欧美一区二区mp4| 亚洲中文av在线| 久久久国产一区二区| 国产精品久久久久久精品古装| 成在线人永久免费视频| 黄色a级毛片大全视频| 丝袜喷水一区| 18禁黄网站禁片午夜丰满| 手机成人av网站| 日韩,欧美,国产一区二区三区| 欧美一级毛片孕妇| 国产深夜福利视频在线观看| 又大又爽又粗| 国产精品熟女久久久久浪| 老汉色av国产亚洲站长工具| 国产片内射在线| 成人国产一区最新在线观看| 久久久久久久久久久久大奶| 看免费av毛片| 欧美在线黄色| 欧美日韩福利视频一区二区| 免费日韩欧美在线观看| 亚洲精品国产精品久久久不卡| 日本vs欧美在线观看视频| 下体分泌物呈黄色| 午夜福利在线免费观看网站| 亚洲av电影在线观看一区二区三区| 亚洲国产成人一精品久久久| 色精品久久人妻99蜜桃| 91精品国产国语对白视频| 欧美精品高潮呻吟av久久| 国产黄色免费在线视频| 日日爽夜夜爽网站| 久久狼人影院| 一进一出抽搐动态| 99热全是精品| 中文字幕人妻丝袜制服| av在线播放精品| tube8黄色片| a在线观看视频网站| 久久 成人 亚洲| 精品一区二区三卡| 亚洲欧美成人综合另类久久久| 男人爽女人下面视频在线观看| 欧美激情 高清一区二区三区| 99热国产这里只有精品6| 国产精品熟女久久久久浪| 深夜精品福利| 多毛熟女@视频| 三上悠亚av全集在线观看| cao死你这个sao货| 9191精品国产免费久久| 日本精品一区二区三区蜜桃| 美女扒开内裤让男人捅视频| 嫩草影视91久久| 美女大奶头黄色视频| 啦啦啦视频在线资源免费观看| 在线观看一区二区三区激情| 中文字幕人妻熟女乱码| 99热全是精品| 国产精品av久久久久免费| 正在播放国产对白刺激| 在线观看一区二区三区激情| 一进一出抽搐动态| 亚洲成人免费电影在线观看| 久久人妻福利社区极品人妻图片| 午夜免费鲁丝| 亚洲欧美色中文字幕在线| 两性夫妻黄色片| 国产精品久久久久成人av| 老汉色av国产亚洲站长工具| 亚洲情色 制服丝袜| 美女中出高潮动态图| 黄色片一级片一级黄色片| 日韩中文字幕欧美一区二区| 久久精品成人免费网站| 国产精品一区二区精品视频观看| 国内毛片毛片毛片毛片毛片| 亚洲av片天天在线观看| 国产精品.久久久| 国产一区二区 视频在线| 青春草视频在线免费观看| 日本wwww免费看| 热re99久久精品国产66热6| 亚洲av日韩在线播放| 午夜日韩欧美国产| 欧美日韩中文字幕国产精品一区二区三区 | 国产97色在线日韩免费| 日韩制服丝袜自拍偷拍| 在线观看免费午夜福利视频| 欧美 日韩 精品 国产| 亚洲一区二区三区欧美精品| 99国产精品一区二区三区| 欧美日韩中文字幕国产精品一区二区三区 | 高清av免费在线| 乱人伦中国视频| 男人操女人黄网站| 动漫黄色视频在线观看| 欧美日韩成人在线一区二区| 精品少妇一区二区三区视频日本电影| 亚洲一码二码三码区别大吗| 欧美国产精品va在线观看不卡| 久久精品人人爽人人爽视色| 日日夜夜操网爽| 久久中文看片网| 免费久久久久久久精品成人欧美视频| 少妇精品久久久久久久| 国产精品亚洲av一区麻豆| 自线自在国产av| 91国产中文字幕| 国产精品免费视频内射| 最近最新免费中文字幕在线| 国产精品99久久99久久久不卡| 亚洲欧洲精品一区二区精品久久久| 老熟女久久久| 久久九九热精品免费| 国产精品99久久99久久久不卡| 黄频高清免费视频| 两性午夜刺激爽爽歪歪视频在线观看 | 精品熟女少妇八av免费久了| 婷婷成人精品国产| 亚洲色图 男人天堂 中文字幕| 少妇 在线观看| 久久99一区二区三区| 王馨瑶露胸无遮挡在线观看| 亚洲av日韩精品久久久久久密| 成人影院久久| 蜜桃在线观看..| 高清av免费在线| 无遮挡黄片免费观看| 亚洲国产av新网站| 久久精品国产a三级三级三级| 99精品久久久久人妻精品| 亚洲中文字幕日韩| a在线观看视频网站| av免费在线观看网站| 高清黄色对白视频在线免费看| 人妻人人澡人人爽人人| 国产精品一区二区在线观看99| 中文字幕av电影在线播放| www.999成人在线观看| 国产高清国产精品国产三级| 1024香蕉在线观看| 亚洲情色 制服丝袜| 国产不卡av网站在线观看| 欧美另类亚洲清纯唯美| 欧美黑人精品巨大| 国产片内射在线| 两个人免费观看高清视频| 婷婷丁香在线五月| 在线观看免费视频网站a站| 成人三级做爰电影| 久久精品aⅴ一区二区三区四区| 国产男人的电影天堂91| 在线观看免费视频网站a站| 老司机福利观看| 免费少妇av软件| 久久久久久亚洲精品国产蜜桃av| 十八禁高潮呻吟视频| 精品一区二区三区四区五区乱码| 新久久久久国产一级毛片| 久久久精品国产亚洲av高清涩受| 女人高潮潮喷娇喘18禁视频| 国产成人欧美在线观看 | 91字幕亚洲| 操出白浆在线播放| 91字幕亚洲| 黄色片一级片一级黄色片| 18禁观看日本| 色婷婷av一区二区三区视频| 欧美av亚洲av综合av国产av| 高清av免费在线| 国产淫语在线视频| www.熟女人妻精品国产| 久久av网站| 亚洲国产精品一区三区| 久久中文看片网| 国产一区二区 视频在线| 午夜福利,免费看| 黑人欧美特级aaaaaa片| 老汉色av国产亚洲站长工具| 少妇猛男粗大的猛烈进出视频| 国产精品九九99| 国精品久久久久久国模美| 亚洲精品国产精品久久久不卡| 亚洲精品av麻豆狂野| 女人久久www免费人成看片| av在线播放精品| 国产三级黄色录像| 咕卡用的链子| 黄频高清免费视频| 黄色视频在线播放观看不卡| 亚洲一区二区三区欧美精品| 亚洲中文字幕日韩| 午夜精品久久久久久毛片777| 12—13女人毛片做爰片一| av福利片在线| 精品人妻一区二区三区麻豆| 91麻豆av在线| 日韩欧美一区二区三区在线观看 | 久久性视频一级片| 久久久久久久大尺度免费视频| 日韩有码中文字幕| 91成人精品电影| 国产成人欧美在线观看 | 在线观看人妻少妇| 成人三级做爰电影| 蜜桃在线观看..| 国产一区二区 视频在线| 国产精品二区激情视频| 国产1区2区3区精品| 午夜福利免费观看在线| 免费在线观看视频国产中文字幕亚洲 | 黄色毛片三级朝国网站| 大陆偷拍与自拍| 亚洲自偷自拍图片 自拍| 国产成人精品久久二区二区91| 777久久人妻少妇嫩草av网站| 国产精品 国内视频| 久久人人爽人人片av| 国产精品偷伦视频观看了| 老司机靠b影院| 18禁黄网站禁片午夜丰满| 午夜免费成人在线视频| 国产亚洲欧美精品永久| 欧美老熟妇乱子伦牲交| 国精品久久久久久国模美| 亚洲人成77777在线视频| 欧美乱码精品一区二区三区| cao死你这个sao货| 韩国高清视频一区二区三区| 一进一出抽搐动态| 午夜影院在线不卡| 免费av中文字幕在线| 成年动漫av网址| 搡老乐熟女国产| 捣出白浆h1v1| 在线观看舔阴道视频| 亚洲精品中文字幕一二三四区 | 国产免费av片在线观看野外av| 搡老乐熟女国产| 精品人妻熟女毛片av久久网站| 91精品伊人久久大香线蕉| 香蕉丝袜av| a 毛片基地| 大香蕉久久成人网| www.自偷自拍.com| av网站在线播放免费| 久久天堂一区二区三区四区| 亚洲精品av麻豆狂野| 国产av精品麻豆| 一边摸一边抽搐一进一出视频| 久久久久国内视频| 色视频在线一区二区三区| 亚洲成av片中文字幕在线观看| 久久国产亚洲av麻豆专区| 叶爱在线成人免费视频播放| 国产精品一区二区精品视频观看| 国产欧美日韩一区二区精品| 精品亚洲成a人片在线观看| 欧美日韩亚洲国产一区二区在线观看 | 国产99久久九九免费精品| 午夜福利在线免费观看网站| 一边摸一边抽搐一进一出视频| 欧美亚洲 丝袜 人妻 在线| 在线亚洲精品国产二区图片欧美| 菩萨蛮人人尽说江南好唐韦庄| 欧美97在线视频| 91大片在线观看| www.av在线官网国产| 欧美日韩国产mv在线观看视频| 日本a在线网址| 99热全是精品| 午夜老司机福利片| 男人添女人高潮全过程视频| 国产片内射在线| 国产欧美亚洲国产| 夜夜骑夜夜射夜夜干| 日韩人妻精品一区2区三区| 动漫黄色视频在线观看| 99久久精品国产亚洲精品| 日韩视频在线欧美| 黄色a级毛片大全视频| 日韩视频一区二区在线观看| 国产精品1区2区在线观看. | 免费高清在线观看日韩| 老司机在亚洲福利影院| 99精品久久久久人妻精品| 一个人免费看片子| 伦理电影免费视频| 亚洲 欧美一区二区三区| 一个人免费在线观看的高清视频 | 精品人妻熟女毛片av久久网站| netflix在线观看网站| 啪啪无遮挡十八禁网站| 亚洲国产欧美日韩在线播放| 可以免费在线观看a视频的电影网站| 久久久欧美国产精品| 黄色毛片三级朝国网站| 高清黄色对白视频在线免费看| 激情视频va一区二区三区| 精品久久久久久电影网| 国产免费av片在线观看野外av| 亚洲色图综合在线观看| 性色av乱码一区二区三区2| 黑人巨大精品欧美一区二区mp4| 久久精品久久久久久噜噜老黄| 久久国产精品男人的天堂亚洲| 亚洲国产精品一区三区| 成人免费观看视频高清| 欧美日韩精品网址| 日本一区二区免费在线视频| 日韩精品免费视频一区二区三区| av在线播放精品| 日本a在线网址| 激情视频va一区二区三区| 亚洲av男天堂| 久久亚洲国产成人精品v| 精品国产国语对白av| 一级,二级,三级黄色视频| 成人av一区二区三区在线看 | 亚洲av美国av| 91九色精品人成在线观看| 视频在线观看一区二区三区| 99久久人妻综合| 国产男女内射视频| 国产三级黄色录像| 97人妻天天添夜夜摸| 国产极品粉嫩免费观看在线| 午夜福利乱码中文字幕| 中文字幕av电影在线播放| 欧美在线一区亚洲| 狠狠精品人妻久久久久久综合| 午夜激情久久久久久久| 日韩三级视频一区二区三区| 亚洲国产精品成人久久小说| 精品国产乱码久久久久久小说| 日韩电影二区| 真人做人爱边吃奶动态| 一级,二级,三级黄色视频| 国产深夜福利视频在线观看| 久久久久精品国产欧美久久久 | 亚洲 欧美一区二区三区| 亚洲av日韩在线播放| 免费在线观看影片大全网站| 精品欧美一区二区三区在线| 欧美日本中文国产一区发布| 美女国产高潮福利片在线看| 精品熟女少妇八av免费久了| 欧美黑人精品巨大| 色播在线永久视频| 超色免费av| 男女午夜视频在线观看| 国产精品一区二区免费欧美 | 日韩一区二区三区影片| 成人国产av品久久久| 免费观看人在逋| 午夜两性在线视频| 国产成人欧美在线观看 | 久久天堂一区二区三区四区| 91九色精品人成在线观看| 大香蕉久久成人网| 国产精品久久久av美女十八| 黄色a级毛片大全视频| 狠狠狠狠99中文字幕| 久久久久久久大尺度免费视频| 亚洲国产中文字幕在线视频| 午夜福利免费观看在线| 麻豆乱淫一区二区| 爱豆传媒免费全集在线观看| 亚洲精品美女久久av网站| 手机成人av网站| 午夜老司机福利片| 久久亚洲国产成人精品v| 夜夜骑夜夜射夜夜干| 成人黄色视频免费在线看| 啦啦啦免费观看视频1| 中文字幕av电影在线播放| 中亚洲国语对白在线视频| 亚洲少妇的诱惑av| 亚洲情色 制服丝袜| 狠狠狠狠99中文字幕| 午夜精品国产一区二区电影| 久久久久精品国产欧美久久久 | 国产成人a∨麻豆精品| 国产黄色免费在线视频| 少妇精品久久久久久久| 啦啦啦在线免费观看视频4| 久久免费观看电影| videos熟女内射| 天堂8中文在线网| 亚洲一码二码三码区别大吗| 黑人巨大精品欧美一区二区蜜桃| 久久影院123| 亚洲国产精品一区二区三区在线| 天天躁夜夜躁狠狠躁躁| 久久午夜综合久久蜜桃| 男女免费视频国产| 成人国产一区最新在线观看| 成人18禁高潮啪啪吃奶动态图| 精品免费久久久久久久清纯 | 一区二区三区激情视频| 中文字幕色久视频| 国产欧美亚洲国产| 黑人巨大精品欧美一区二区mp4| 国产成人欧美在线观看 | 男女床上黄色一级片免费看| 一边摸一边抽搐一进一出视频| 国产一区二区在线观看av| 精品乱码久久久久久99久播| 99国产精品一区二区三区| 一进一出抽搐动态| 亚洲,欧美精品.| 美女国产高潮福利片在线看| 日本vs欧美在线观看视频| 一二三四社区在线视频社区8| 777久久人妻少妇嫩草av网站| e午夜精品久久久久久久| 久久久水蜜桃国产精品网| 欧美精品亚洲一区二区| 99热网站在线观看| 成年人免费黄色播放视频| 一级黄色大片毛片| 成年女人毛片免费观看观看9 |