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

    空間雙臂機(jī)器人抓捕非合作目標(biāo)后的協(xié)調(diào)穩(wěn)定控制

    2022-03-29 07:49:54夏鵬程羅建軍王明明譚龍玉
    航空學(xué)報(bào) 2022年2期
    關(guān)鍵詞:方法

    夏鵬程,羅建軍,王明明,*,譚龍玉

    1.西北工業(yè)大學(xué) 深圳研究院,深圳 518057

    2.西北工業(yè)大學(xué) 航天動(dòng)力學(xué)國(guó)家重點(diǎn)實(shí)驗(yàn)室,西安 710072 3.上海航天控制技術(shù)研究所,上海 201109

    近年來(lái),隨著空間技術(shù)與應(yīng)用的發(fā)展,利用空間機(jī)器人維修失效衛(wèi)星、操控非合作目標(biāo)等在軌服務(wù)任務(wù)日益引人關(guān)注??臻g多臂機(jī)器人相較于空間單臂機(jī)器人,具有更強(qiáng)的操作能力和更廣泛的應(yīng)用,但操作更為復(fù)雜。因此,空間多臂機(jī)器人捕獲非合作目標(biāo)的操控技術(shù)成為當(dāng)前研究的熱點(diǎn)和完成任務(wù)的關(guān)鍵??臻g多臂機(jī)器人捕獲非合作目標(biāo)的過(guò)程可分為抓捕前、抓捕中和抓捕后等三個(gè)階段。本文研究空間雙臂機(jī)器人抓捕非合作目標(biāo)后的安全協(xié)調(diào)穩(wěn)定控制問(wèn)題。

    針對(duì)空間機(jī)器人抓捕非合作目標(biāo)后的穩(wěn)定控制,相關(guān)研究一般將該階段的控制問(wèn)題拆分為兩個(gè)子問(wèn)題:期望軌跡規(guī)劃問(wèn)題和跟蹤控制問(wèn)題。為了規(guī)劃空間機(jī)器人穩(wěn)定目標(biāo)運(yùn)動(dòng)的期望軌跡,研究者們通常將抓捕后階段的穩(wěn)定軌跡規(guī)劃問(wèn)題轉(zhuǎn)化為優(yōu)化問(wèn)題進(jìn)行求解。對(duì)于慣性參數(shù)無(wú)法準(zhǔn)確獲得的非合作目標(biāo),通常利用其慣性參數(shù)的估計(jì)值規(guī)劃參考期望運(yùn)動(dòng)軌跡。Yoshida等從能量分配的角度規(guī)劃了空間機(jī)器人的運(yùn)動(dòng)軌跡。Zappa等則從動(dòng)量守恒的角度,規(guī)劃自由飛行機(jī)器人的期望運(yùn)動(dòng)軌跡。Wang等利用樣條曲線對(duì)空間機(jī)器人的關(guān)節(jié)運(yùn)動(dòng)進(jìn)行參數(shù)化處理,提出了針對(duì)冗余機(jī)械臂的軌跡規(guī)劃方法。Yu等利用機(jī)械臂的冗余度,提出了一種考慮優(yōu)先級(jí)的空間多臂機(jī)器人期望軌跡規(guī)劃方法。在抓捕后階段,由于目標(biāo)慣性參數(shù)無(wú)法準(zhǔn)確地獲得,因而無(wú)法有效地控制空間機(jī)器人跟蹤期望運(yùn)動(dòng)軌跡從而實(shí)現(xiàn)目標(biāo)的穩(wěn)定。為了避免目標(biāo)不確定性對(duì)基座運(yùn)動(dòng)控制的影響,Sharf等提出了基座無(wú)擾的穩(wěn)定控制策略。Abiko等則考慮目標(biāo)不確定性對(duì)期望軌跡跟蹤的影響,根據(jù)目標(biāo)的不確定性設(shè)計(jì)了自適應(yīng)穩(wěn)定控制器。由于非合作目標(biāo)的慣性參數(shù)具有不確定性,加之上述控制方法未考慮控制過(guò)程中機(jī)械臂末端受到的接觸力與力矩,空間機(jī)器人無(wú)法在規(guī)劃的接觸力范圍內(nèi)跟蹤參考期望運(yùn)動(dòng),無(wú)法保證空間機(jī)器人與目標(biāo)交互的安全。

    為了實(shí)現(xiàn)抓捕后階段機(jī)器人與目標(biāo)與交互的柔順和安全,降低機(jī)械臂末端與目標(biāo)之間的接觸力/力矩,研究者們將柔順控制方法引入到空間機(jī)器人抓捕目標(biāo)的相關(guān)研究中。柔順控制方法通過(guò)設(shè)計(jì)控制律,將機(jī)器人與目標(biāo)的交互過(guò)程等效為一個(gè)質(zhì)量-彈簧-阻尼系統(tǒng),繼而實(shí)現(xiàn)交互過(guò)程可控的柔順接觸。描述該質(zhì)量-彈簧-阻尼系統(tǒng)的等式被稱為柔順等式。為了保證機(jī)械臂末端的接觸安全,Yoshida等根據(jù)柔順等式提出了空間機(jī)器人的阻抗控制方法,設(shè)計(jì)了調(diào)整柔順等式參數(shù)的自適應(yīng)律,根據(jù)接觸力與力矩調(diào)整跟蹤控制律,實(shí)現(xiàn)交互過(guò)程中的柔順接觸。Wang等利用柔順等式提出了期望運(yùn)動(dòng)軌跡的調(diào)整方法,通過(guò)調(diào)整期望軌跡實(shí)現(xiàn)了目標(biāo)穩(wěn)定過(guò)程中的接觸柔順,使得跟蹤控制器的控制性能不受接觸力與力矩的影響。Stolfi等將一般的位置跟蹤控制與柔順控制相結(jié)合,提出了力/位混合控制方法,僅在需要實(shí)現(xiàn)柔順接觸的方向進(jìn)行柔順控制。然而上述研究?jī)H針對(duì)單臂空間機(jī)器人,而且只考慮了目標(biāo)慣性參數(shù)不確定性對(duì)接觸力與力矩的影響。當(dāng)雙臂同時(shí)操控被抓捕目標(biāo)時(shí),雙臂對(duì)目標(biāo)會(huì)產(chǎn)生拉扯/擠壓作用,可能對(duì)目標(biāo)會(huì)造成損傷,機(jī)械臂末端與目標(biāo)之間可能產(chǎn)生過(guò)大的接觸力與力矩,因此,利用空間雙臂機(jī)器人穩(wěn)定和操控非合作目標(biāo)時(shí),除了需要考慮目標(biāo)不確定性對(duì)接觸力與力矩的影響,還需要進(jìn)一步地考慮雙臂拉扯/擠壓目標(biāo)產(chǎn)生的接觸力與力矩影響。

    針對(duì)空間雙臂機(jī)器人抓捕非合作目標(biāo)后的安全穩(wěn)定問(wèn)題,同時(shí)考慮非合作目標(biāo)慣性參數(shù)的不確定性以及雙臂操控目標(biāo)的拉扯/擠壓作用,提出了一種協(xié)調(diào)穩(wěn)定控制方法,通過(guò)協(xié)調(diào)地控制雙臂的運(yùn)動(dòng)實(shí)現(xiàn)雙臂末端與目標(biāo)接觸柔順,降低穩(wěn)定過(guò)程中產(chǎn)生的接觸力與力矩。首先,利用目標(biāo)慣性參數(shù)的估值規(guī)劃穩(wěn)定目標(biāo)的運(yùn)動(dòng)軌跡。然后,針對(duì)目標(biāo)慣性參數(shù)不確定性,對(duì)規(guī)劃的目標(biāo)穩(wěn)定軌跡進(jìn)行調(diào)整;同時(shí),基于抓捕矩陣零空間內(nèi)存在不影響目標(biāo)運(yùn)動(dòng)的無(wú)效運(yùn)動(dòng)旋量反應(yīng)了雙臂對(duì)目標(biāo)的拉扯/擠壓,對(duì)雙臂末端的期望運(yùn)動(dòng)進(jìn)行調(diào)整;根據(jù)運(yùn)動(dòng)學(xué)約束求解逆運(yùn)動(dòng)學(xué)得到雙臂運(yùn)動(dòng)協(xié)調(diào)的安全穩(wěn)定運(yùn)動(dòng)軌跡;在設(shè)計(jì)的控制性能范圍內(nèi)對(duì)安全穩(wěn)定運(yùn)動(dòng)軌跡進(jìn)行有效跟蹤,協(xié)調(diào)地控制雙臂運(yùn)動(dòng)實(shí)現(xiàn)接觸柔順的安全穩(wěn)定控制。最后,通過(guò)仿真算例驗(yàn)證了本文協(xié)調(diào)穩(wěn)定控制方法的有效性。

    1 動(dòng)力學(xué)建模

    研究對(duì)象空間雙臂機(jī)器人如圖1所示。該空間機(jī)器人由兩個(gè)對(duì)稱安裝的七關(guān)節(jié)空間機(jī)械臂和可以六自由度運(yùn)動(dòng)的基座組成。在空間雙臂機(jī)器人捕獲非合作目標(biāo)的抓捕后階段,空間機(jī)械臂的末端與目標(biāo)固連形成組合體。

    圖1 空間雙臂機(jī)器人抓捕目標(biāo)示意圖Fig.1 Snapshot of a dual-arm space robot capturing a target

    用表示向量∈R對(duì)應(yīng)的反對(duì)稱矩陣。為了便于定義目標(biāo)的六自由度運(yùn)動(dòng),根據(jù)向量,∈R定義運(yùn)算:

    式中:為目標(biāo)的慣性矩陣;為目標(biāo)質(zhì)心到抓捕點(diǎn)的雅可比矩陣即抓捕矩陣。由于抓捕后階段目標(biāo)與空間機(jī)器人雙臂的末端在抓捕點(diǎn)處固定連接,因此目標(biāo)與空間機(jī)器人的運(yùn)動(dòng)滿足運(yùn)動(dòng)學(xué)約束:

    2 安全穩(wěn)定控制問(wèn)題分析

    當(dāng)空間機(jī)器人的雙臂同時(shí)作用于非合作目標(biāo)時(shí),描述末端接觸力與力矩的旋量和作用于目標(biāo)質(zhì)心的運(yùn)動(dòng)旋量滿足:

    式中:運(yùn)動(dòng)旋量∈R被稱為控制目標(biāo)運(yùn)動(dòng)的有效運(yùn)動(dòng)旋量。與空間單臂機(jī)器人不同,當(dāng)兩個(gè)機(jī)械臂同時(shí)作用于目標(biāo)時(shí),在雅可比矩陣的零空間內(nèi)會(huì)產(chǎn)生不影響目標(biāo)運(yùn)動(dòng)的無(wú)效運(yùn)動(dòng)旋量,其表達(dá)式為

    式中:?表示矩陣的廣義逆;∈R為單位矩陣;∈R為反應(yīng)拉扯、擠壓程度的旋量。無(wú)效運(yùn)動(dòng)旋量反映了兩個(gè)機(jī)械臂與目標(biāo)之間的拉扯/擠壓,會(huì)對(duì)機(jī)械臂末端的接觸力/力矩產(chǎn)生影響。因此,為了機(jī)械臂末端與目標(biāo)接觸的安全,需要在控制空間機(jī)器人的過(guò)程中考慮無(wú)效運(yùn)動(dòng)旋量的影響。

    除此之外,由于非合作目標(biāo)的慣性參數(shù)無(wú)法準(zhǔn)確獲得,通常利用目標(biāo)慣性參數(shù)的估值規(guī)劃穩(wěn)定其運(yùn)動(dòng)的參考期望軌跡。根據(jù)式(3)中的目標(biāo)動(dòng)力學(xué)方程可知,參考期望軌跡滿足動(dòng)力學(xué)約束為

    由此關(guān)系不難看出,因?yàn)閰?shù)估計(jì)值與真值之間存在誤差,跟蹤參考期望軌跡并不一定能夠滿足規(guī)劃的接觸力與力矩約束,因此跟蹤參考期望軌跡存在威脅機(jī)械臂末端接觸安全的風(fēng)險(xiǎn)。

    根據(jù)上述分析可知,為了保證空間雙臂機(jī)器人穩(wěn)定非合作目標(biāo)過(guò)程中的末端接觸安全,需要同時(shí)考慮無(wú)效運(yùn)動(dòng)旋量和目標(biāo)慣性參數(shù)不確定性對(duì)接觸力/力矩產(chǎn)生的影響,協(xié)調(diào)地控制雙臂的運(yùn)動(dòng),降低控制過(guò)程中產(chǎn)生的接觸力與力矩。

    3 安全協(xié)調(diào)穩(wěn)定控制

    為了同時(shí)處理無(wú)效運(yùn)動(dòng)旋量以及目標(biāo)不確定性對(duì)機(jī)械臂末端與目標(biāo)接觸的影響,基于柔順等式對(duì)規(guī)劃的期望穩(wěn)定運(yùn)動(dòng)軌跡進(jìn)行調(diào)整,求解能夠?qū)崿F(xiàn)目標(biāo)與雙臂末端接觸柔順的安全穩(wěn)定運(yùn)動(dòng)軌跡;通過(guò)在設(shè)計(jì)的控制性能約束范圍內(nèi)有效地跟蹤安全穩(wěn)定運(yùn)動(dòng)軌跡,保障控制的效率,協(xié)調(diào)地控制雙臂運(yùn)動(dòng)實(shí)現(xiàn)接觸的柔順,使得空間雙臂機(jī)器人能夠安全地穩(wěn)定非合作目標(biāo)的運(yùn)動(dòng)。

    3.1 目標(biāo)運(yùn)動(dòng)軌跡規(guī)劃

    為了實(shí)現(xiàn)空間雙臂機(jī)器人穩(wěn)定非合作目標(biāo)的運(yùn)動(dòng),首先,利用目標(biāo)慣性參數(shù)的估值規(guī)劃穩(wěn)定控制過(guò)程中目標(biāo)的參考期望運(yùn)動(dòng)軌跡。利用貝塞爾曲線對(duì)目標(biāo)的六自由度運(yùn)動(dòng)進(jìn)行參數(shù)化處理,并設(shè)計(jì)穩(wěn)定過(guò)程中目標(biāo)的優(yōu)化運(yùn)動(dòng)軌跡。

    選取貝塞爾曲線:

    式中:下標(biāo)代表運(yùn)動(dòng)的第個(gè)自由度;4為貝塞爾曲線的階數(shù);為構(gòu)造二項(xiàng)式系數(shù)的變量;P是構(gòu)建貝塞爾曲線的控制點(diǎn);是歸一化時(shí)間。根據(jù)目標(biāo)運(yùn)動(dòng)穩(wěn)定時(shí)間,時(shí)間可定義為??紤]到空間非合作目標(biāo)運(yùn)動(dòng)的不確定性、組合體操控的安全性和時(shí)效最優(yōu)性,本文在參考期望軌跡規(guī)劃的過(guò)程中采用了時(shí)間最優(yōu)與接觸力/力矩盡量小和安全的聯(lián)合優(yōu)化方式。根據(jù)式(3)中的目標(biāo)動(dòng)力學(xué)方程,可將穩(wěn)定目標(biāo)的運(yùn)動(dòng)規(guī)劃問(wèn)題轉(zhuǎn)化為優(yōu)化問(wèn)題:

    式中:和分別是最優(yōu)時(shí)間和接觸力與力矩的權(quán)重因子;和為目標(biāo)運(yùn)動(dòng)約束的下界與上界;為接觸力與力矩的安全約束。由于該優(yōu)化問(wèn)題同時(shí)考慮了最優(yōu)穩(wěn)定時(shí)間和接觸力/力矩,不會(huì)規(guī)劃過(guò)大的接觸力/力矩,且可以通過(guò)調(diào)節(jié)權(quán)重因子控制最優(yōu)穩(wěn)定時(shí)間的長(zhǎng)短,因此可以根據(jù)任務(wù)需求靈活地規(guī)劃參考期望運(yùn)動(dòng)軌跡。

    通過(guò)求解上述的優(yōu)化問(wèn)題,可以規(guī)劃穩(wěn)定過(guò)程中目標(biāo)的參考期望運(yùn)動(dòng)軌跡。

    3.2 安全穩(wěn)定運(yùn)動(dòng)軌跡求解

    鑒于目標(biāo)運(yùn)動(dòng)軌跡是利用目標(biāo)慣性參數(shù)估值規(guī)劃的,由3.1節(jié)的分析可知,直接跟蹤對(duì)應(yīng)的關(guān)節(jié)與基座運(yùn)動(dòng)軌跡具有一定的風(fēng)險(xiǎn)。提出一種根據(jù)接觸力與力矩調(diào)整穩(wěn)定運(yùn)動(dòng)軌跡的內(nèi)外雙環(huán)式結(jié)構(gòu),利用內(nèi)環(huán)與外環(huán)分別針對(duì)無(wú)效運(yùn)動(dòng)旋量和目標(biāo)不確定性對(duì)接觸力/力矩的影響,對(duì)目標(biāo)參考期望運(yùn)動(dòng)軌跡進(jìn)行柔順化調(diào)整。最終,求解得到安全穩(wěn)定目標(biāo)的空間機(jī)器人關(guān)節(jié)與基座期望運(yùn)動(dòng)軌跡。

    綜上,安全穩(wěn)定目標(biāo)的空間機(jī)器人關(guān)節(jié)與基座的期望運(yùn)動(dòng)軌跡生成框圖如圖2所示。經(jīng)過(guò)式(14)和式(16)中柔順等式的調(diào)整,最終得到的期望運(yùn)動(dòng)考慮了無(wú)效運(yùn)動(dòng)旋量和目標(biāo)不確定性對(duì)接觸力/力矩的影響。跟蹤時(shí),空間雙臂機(jī)器人能夠同時(shí)考慮無(wú)效運(yùn)動(dòng)旋量和目標(biāo)不確定性對(duì)機(jī)械臂末端與目標(biāo)接觸產(chǎn)生的影響,在機(jī)械臂末端與目標(biāo)交互過(guò)程中實(shí)現(xiàn)柔順接觸。

    圖2 安全穩(wěn)定運(yùn)動(dòng)軌跡求解框圖Fig.2 Schematic diagram of safe stabilization trajectory generation

    3.3 約束跟蹤控制器設(shè)計(jì)

    為了保證空間機(jī)器人能夠有效地跟蹤安全穩(wěn)定目標(biāo)運(yùn)動(dòng)的期望運(yùn)動(dòng),實(shí)現(xiàn)目標(biāo)與雙臂末端交互的柔順,基于障礙李雅普諾夫函數(shù)設(shè)計(jì)了控制性能可約束的跟蹤控制器。

    式中:∈R為由正數(shù)組成的控制性能約束向量。為了使得機(jī)器人跟蹤過(guò)程中滿足設(shè)計(jì)的性能約束,根據(jù)動(dòng)力學(xué)方程式(1),設(shè)計(jì)跟蹤控制律:

    其中,障礙李雅普諾夫函數(shù)為

    對(duì)式(25)中的求導(dǎo)可得

    障礙李雅普諾夫函數(shù)導(dǎo)數(shù)為

    利用不等式:

    將式(19)中的控制律代入李雅普諾夫函數(shù)的導(dǎo)數(shù)中,可以推得≤0。由此可以推導(dǎo)得到,在跟蹤控制的過(guò)程中,0時(shí)刻和后續(xù)時(shí)刻的李雅普諾夫函數(shù)滿足:

    對(duì)不等式兩邊進(jìn)行指數(shù)化處理,整理后可以推得,后續(xù)時(shí)刻的跟蹤誤差滿足約束關(guān)系:

    式中: 為誤差收斂時(shí)的約束下界與上界。根據(jù)跟蹤誤差的定義以及式(23)和式(24)可知,該跟蹤控制器能夠滿足式(18)中設(shè)計(jì)的控制性能。對(duì)式(30)求導(dǎo)可知,該約束跟蹤控制器能夠約束跟蹤誤差的收斂速率。利用此約束跟蹤控制器,空間雙臂機(jī)器人可以在控制性能約束范圍內(nèi)有效地跟蹤安全穩(wěn)定目標(biāo)的期望運(yùn)動(dòng)軌跡,實(shí)現(xiàn)空間雙臂機(jī)器人抓捕非合作目標(biāo)后的接觸柔順。

    綜上,空間雙臂機(jī)器人抓捕非合作目標(biāo)后的安全協(xié)調(diào)穩(wěn)定控制框圖如圖3所示。

    圖3 協(xié)調(diào)穩(wěn)定控制結(jié)構(gòu)圖Fig.3 Schematic diagram of coordinated stabilization control

    4 仿真校驗(yàn)

    設(shè)計(jì)了利用所提方法穩(wěn)定非合作目標(biāo)的仿真算例??臻g機(jī)器人的雙臂安裝位置對(duì)稱,空間機(jī)器人的運(yùn)動(dòng)學(xué)與動(dòng)力學(xué)參數(shù)如表1所示。目標(biāo)慣性參數(shù)的估值為真實(shí)值的80%。

    表1 空間機(jī)器人的運(yùn)動(dòng)學(xué)與動(dòng)力學(xué)參數(shù)Table 1 Kinematics and dynamics parameters of space robot

    非合作目標(biāo)被抓捕后的相對(duì)速度為零,角速度為[-0.174 5 0 0]rad/s,目標(biāo)上兩個(gè)抓捕點(diǎn)的位置分別為[0 0.5 0]m 和[0 -0.5 0]m。設(shè)定目標(biāo)運(yùn)動(dòng)軌跡的接觸力/力矩約束上界分別為20 N 與20 N·m,約束下界為-20 N與-20 N·m,目標(biāo)運(yùn)動(dòng)軌跡的時(shí)長(zhǎng)為3 s??臻g雙臂機(jī)器人穩(wěn)定非合作目標(biāo)時(shí),為了避免基座運(yùn)動(dòng)對(duì)機(jī)械臂末端與目標(biāo)接觸產(chǎn)生影響,令基座的位姿固定,期望運(yùn)動(dòng)速度為零。

    根據(jù)式(4)中的運(yùn)動(dòng)學(xué)約束與目標(biāo)運(yùn)動(dòng)軌跡,通過(guò)逆運(yùn)動(dòng)學(xué)計(jì)算可以得到未經(jīng)內(nèi)外雙環(huán)結(jié)構(gòu)調(diào)整的穩(wěn)定運(yùn)動(dòng)軌跡。對(duì)于控制性能可設(shè)計(jì)的跟蹤控制器,選擇控制參數(shù):

    為了展示所提協(xié)調(diào)穩(wěn)定控制方法的有效性,根據(jù)已有研究中的穩(wěn)定控制方法設(shè)計(jì)了兩個(gè)對(duì)照組。在對(duì)照組1中,穩(wěn)定過(guò)程中不考慮空間機(jī)器人與目標(biāo)交互的安全,利用PD 控制器直接跟蹤未經(jīng)調(diào)整的穩(wěn)定運(yùn)動(dòng)軌跡。由空間雙臂機(jī)器人的動(dòng)力學(xué)方程,可以設(shè)計(jì)PD 控制器:

    在對(duì)照組2中,穩(wěn)定過(guò)程中采取已有研究中的阻抗控制方法,根據(jù)接觸力與力矩對(duì)跟蹤控制律進(jìn)行調(diào)整實(shí)現(xiàn)接觸柔順。仿真中利用阻抗控制器跟蹤未經(jīng)調(diào)整的穩(wěn)定運(yùn)動(dòng)軌跡:

    式中:、和為對(duì)稱的正定矩陣。仿真過(guò)程中,對(duì)照組2中實(shí)現(xiàn)阻抗控制的柔順等式參數(shù)以及所提方法求解安全穩(wěn)定運(yùn)動(dòng)軌跡所需的柔順等式參數(shù)如表2所示。

    表2 柔順等式參數(shù)Table 2 Parameters of compliant equations

    圖4~圖6給出了所提方法與對(duì)照組方法在穩(wěn)定目標(biāo)過(guò)程時(shí),空間雙臂機(jī)器人末端的接觸力/力 矩情況。圖中、、、分別為和的 三 軸 分 量;、、分別為和的三軸分量。由于抓捕點(diǎn)處目標(biāo)的加速度與機(jī)械臂末端的加速度之間存在初始偏差,因此在抓捕后開(kāi)始階段,目標(biāo)的運(yùn)動(dòng)會(huì)受到初始接觸的沖擊影響,抓捕點(diǎn)處會(huì)產(chǎn)生較大的初始接觸力/力矩。

    圖4 協(xié)調(diào)穩(wěn)定控制機(jī)械臂末端的接觸力與力矩Fig.4 Contact wrenches of robot end-effector under coordinated stabilization control

    圖6 阻抗控制機(jī)械臂末端的接觸力與力矩Fig.6 Contact wrenches of robot end-effector under impedance control

    對(duì)比圖4與圖5、圖6可以發(fā)現(xiàn),由于未考慮目標(biāo)與機(jī)械臂末端交互的安全,PD 控制器跟蹤未經(jīng)調(diào)整的期望軌跡時(shí)產(chǎn)生了三組中最大的接觸力/力矩,無(wú)法保證目標(biāo)與機(jī)械臂末端的安全交互。相較于PD 控制,考慮了末端接觸力/力矩的阻抗控制方法與協(xié)調(diào)控制方法有效地降低抓捕后階段的接觸力。而協(xié)調(diào)控制方法同時(shí)考慮了目標(biāo)的不確定性與無(wú)效運(yùn)動(dòng)旋量對(duì)接觸力/力矩的影響,故相較于僅考慮接觸力/力矩大小的阻抗控制,協(xié)調(diào)控制進(jìn)一步地降低了機(jī)械臂末端的接觸力矩。鑒于協(xié)調(diào)控制需要根據(jù)接觸力/力矩生成安全運(yùn)動(dòng)軌跡,受到安全運(yùn)動(dòng)軌跡的影響,協(xié)調(diào)控制穩(wěn)定目標(biāo)時(shí)產(chǎn)生的接觸力/力矩收斂速度較PD控制慢;而與阻抗控制方法相比,接觸力/力矩能夠根據(jù)安全軌跡快速收斂,因而收斂速度較阻抗控制快。因此,所提方法通過(guò)協(xié)調(diào)雙臂期望運(yùn)動(dòng)和約束跟蹤控制性能,有效地控制了目標(biāo)不確定性與無(wú)效運(yùn)動(dòng)旋量對(duì)接觸力/力矩造成的影響,實(shí)現(xiàn)了雙臂末端與目標(biāo)接觸的柔順,降低了穩(wěn)定過(guò)程中產(chǎn)生的接觸力/力矩,保證了穩(wěn)定過(guò)程中雙臂末端與目標(biāo)交互的安全。

    圖5 PD 控制機(jī)械臂末端的接觸力與力矩Fig.5 Contact wrenches of robot end-effector under PD control

    圖7~圖9給出了利用所提協(xié)調(diào)控制方法穩(wěn)定目標(biāo)和使用對(duì)照方法跟蹤軌跡穩(wěn)定目標(biāo)時(shí)的跟蹤誤差。由仿真結(jié)果可知,所提協(xié)調(diào)控制與PD控制均可以快速地跟蹤上期望運(yùn)動(dòng)軌跡。從圖7的仿真結(jié)果可以看出,約束跟蹤控制器能夠在設(shè)計(jì)的跟蹤誤差約束范圍內(nèi)有效地跟蹤安全穩(wěn)定運(yùn)動(dòng)軌跡。對(duì)比圖7和圖8可知,由于安全穩(wěn)定運(yùn)動(dòng)軌跡受到接觸力/力矩的影響,協(xié)調(diào)控制的跟蹤誤差收斂速率低于PD 控制。此外,由于阻抗控制的控制性能受到接觸力/力矩的影響,阻抗控制的跟蹤誤差收斂速率為三組中最低。相較于阻抗控制,本文所提協(xié)調(diào)控制方法的跟蹤控制性能不受接觸力/力矩影響且可以設(shè)計(jì),能夠有效地跟蹤安全穩(wěn)定軌跡,保障穩(wěn)定控制的效率。

    圖7 協(xié)調(diào)穩(wěn)定控制關(guān)節(jié)運(yùn)動(dòng)跟蹤誤差Fig.7 Tracking errors of joints under coordinated stabilization control

    圖8 PD 控制關(guān)節(jié)運(yùn)動(dòng)跟蹤誤差Fig.8 Tracking errors of joints under PD control

    圖9 阻抗控制關(guān)節(jié)運(yùn)動(dòng)跟蹤誤差Fig.9 Tracking errors of joints under impedance control

    圖10~圖12給出了所提協(xié)調(diào)控制方法與兩種對(duì)照方法穩(wěn)定目標(biāo)運(yùn)動(dòng)時(shí)目標(biāo)的運(yùn)動(dòng)狀態(tài)。由于初始時(shí)刻的沖擊影響,目標(biāo)在初始時(shí)刻產(chǎn)生了速度。圖中 為的三軸分量; 、 為的三軸分量。從仿真結(jié)果可知,三種方法均可以有效地穩(wěn)定目標(biāo)運(yùn)動(dòng)。由于PD 控制未考慮接觸力/力矩的影響,目標(biāo)運(yùn)動(dòng)參照未經(jīng)調(diào)整的參考期望運(yùn)動(dòng)軌跡,因而PD 控制的穩(wěn)定速度最快。相較于PD 控制,由于協(xié)調(diào)控制的安全穩(wěn)定運(yùn)動(dòng)軌跡受到接觸力/力矩的影響,因而穩(wěn)定速率低于PD 控制。而阻抗控制的控制性能受到接觸力/力矩影響,當(dāng)控制律中的接觸力與力矩收斂時(shí)跟蹤誤差才能保證收斂,因此阻抗控制穩(wěn)定目標(biāo)運(yùn)動(dòng)的速率為三組中最低。

    圖10 協(xié)調(diào)穩(wěn)定控制目標(biāo)運(yùn)動(dòng)速度Fig.10 Velocities of target under coordinated stabilization control

    圖12 阻抗控制目標(biāo)運(yùn)動(dòng)速度Fig.12 Velocities of target under impedance control

    圖13~圖15給出了穩(wěn)定控制過(guò)程中,機(jī)械臂由于耦合作用對(duì)基座產(chǎn)生的反作用力/力矩。圖中 、 為的三軸分量; 為的三軸分量。由仿真結(jié)果可知,PD控制產(chǎn)生的反作用力/力矩最大;而阻抗控制與所提協(xié)調(diào)控制均有效地降低了穩(wěn)定過(guò)程中因耦合作用對(duì)基座產(chǎn)生的反作用力/力矩,保證了基座安全。由于阻抗控制根據(jù)接觸力/力矩調(diào)整了基座和機(jī)械臂關(guān)節(jié)的跟蹤控制律,相比協(xié)調(diào)控制方法基座受到的最大反作用力/力矩小,但跟蹤期望運(yùn)動(dòng)的時(shí)間較長(zhǎng)。而協(xié)調(diào)控制穩(wěn)定目標(biāo)運(yùn)動(dòng)時(shí),約束跟蹤控制器為了保障跟蹤控制性能基座受到的最大反作用力/力矩大于阻抗控制,但仍在安全范圍內(nèi),且穩(wěn)定控制的速率和反作用力/力矩的收斂速率比阻抗控制高,這說(shuō)明本方法在保證安全的前提下協(xié)調(diào)控制效率更高。

    圖11 PD 控制目標(biāo)運(yùn)動(dòng)速度Fig.11 Velocities of target under PD control

    圖13 協(xié)調(diào)穩(wěn)定控制對(duì)基座的反作用力與力矩Fig.13 Coupling wrenches for base under coordinated stabilization control

    圖15 阻抗控制對(duì)基座的反作用力與力矩Fig.15 Coupling wrenches for base under impedance control

    圖14 PD 控制對(duì)基座的反作用力與力矩Fig.14 Coupling wrenches for base under PD control

    為了方便對(duì)照,表3對(duì)3種方法穩(wěn)定目標(biāo)的時(shí)間、穩(wěn)定目標(biāo)過(guò)程中的最大接觸力/力矩、接觸力/力矩收斂時(shí)間、對(duì)基座產(chǎn)生的反作用力/力矩及其收斂時(shí)間等進(jìn)行了匯總和對(duì)比。相較于未考慮交互安全的PD 控制,所提協(xié)調(diào)控制方法實(shí)現(xiàn)穩(wěn)定控制過(guò)程中的最大接觸力降低了74.2%,最大接觸力矩降低了84.1%,基座受到的最大反作用力與力矩分別降低了66.7%和66.4%。由于接觸力/力矩對(duì)安全穩(wěn)定運(yùn)動(dòng)軌跡的影響,協(xié)調(diào)控制的穩(wěn)定時(shí)間相較PD 控制增加了21.6%,接觸力/力矩收斂至數(shù)量級(jí)10內(nèi)的時(shí)間增加了9.1%。此外,由于PD 控制并未根據(jù)接觸力/力矩協(xié)調(diào)雙臂的運(yùn)動(dòng),相較于協(xié)調(diào)控制,反作用力/力矩收斂至數(shù)量級(jí)10內(nèi)的時(shí)間短。與考慮了交互安全的阻抗控制相對(duì)比,由于本文方法同時(shí)考慮了目標(biāo)不確定性和無(wú)效運(yùn)動(dòng)旋量對(duì)接觸力/力矩的影響,雖然最大接觸力提高了10.9%,但是最大接觸力矩相較阻抗控制降低了81.2%,仍然保證了交互的安全。此外,由于所提方法的跟蹤控制性能不受接觸力/力矩影響,相較于阻抗控制方法,接觸力/力矩收斂至數(shù)量級(jí)10內(nèi)的時(shí)間減少了68.2%,反作用力/力矩收斂至數(shù)量級(jí)10內(nèi)的時(shí)間降低了69.6%,穩(wěn)定目標(biāo)運(yùn)動(dòng)的時(shí)間縮短了56.3%,所提方法在穩(wěn)定目標(biāo)的過(guò)程中更高效地實(shí)現(xiàn)了雙臂末端與非合作目標(biāo)的安全交互。

    表3 3種控制方法的性能結(jié)果對(duì)比Table 3 List of simulation results of three control methods

    綜上,相較于無(wú)法保證目標(biāo)與機(jī)械臂末端交互安全的PD 控制,本文所提協(xié)調(diào)控制能夠在實(shí)現(xiàn)交互安全的同時(shí)保障跟蹤控制性能,便于設(shè)計(jì)且安全性更高。與阻抗控制相比,協(xié)調(diào)控制進(jìn)一步地降低了機(jī)械臂末端的接觸力矩;跟蹤控制性能可設(shè)計(jì)且不受接觸力與力矩的影響,減弱了接觸力/力矩對(duì)穩(wěn)定速率的影響。所提方法通過(guò)協(xié)調(diào)雙臂運(yùn)動(dòng)實(shí)現(xiàn)了雙臂末端與目標(biāo)交互柔順的穩(wěn)定控制,降低了穩(wěn)定過(guò)程中產(chǎn)生的接觸力與力矩,保證了穩(wěn)定控制過(guò)程中目標(biāo)與機(jī)械臂末端交互的安全,提高了柔順交互時(shí)穩(wěn)定控制的效率。

    5 結(jié) 論

    1)所提方法通過(guò)跟蹤由內(nèi)外雙環(huán)求解的安全穩(wěn)定運(yùn)動(dòng)軌跡,協(xié)調(diào)地控制了雙臂的運(yùn)動(dòng),使得雙臂末端與目標(biāo)交互柔順,降低了穩(wěn)定過(guò)程中產(chǎn)生的接觸力/力矩,實(shí)現(xiàn)了機(jī)械臂末端與目標(biāo)交互柔順的安全穩(wěn)定控制。

    2)與已有的阻抗控制方法相比,所提方法同時(shí)考慮了雙臂末端對(duì)目標(biāo)拉扯/擠壓以及目標(biāo)不確定性對(duì)接觸力/力矩的影響,進(jìn)一步地降低了機(jī)械臂末端的接觸力矩;跟蹤控制性能可設(shè)計(jì),減弱了接觸力/力矩對(duì)穩(wěn)定速率的影響,提高了雙臂末端與目標(biāo)柔順交互時(shí)穩(wěn)定控制的效率。

    猜你喜歡
    方法
    中醫(yī)特有的急救方法
    中老年保健(2021年9期)2021-08-24 03:52:04
    高中數(shù)學(xué)教學(xué)改革的方法
    化學(xué)反應(yīng)多變幻 “虛擬”方法幫大忙
    變快的方法
    兒童繪本(2020年5期)2020-04-07 17:46:30
    學(xué)習(xí)方法
    可能是方法不對(duì)
    用對(duì)方法才能瘦
    Coco薇(2016年2期)2016-03-22 02:42:52
    最有效的簡(jiǎn)單方法
    山東青年(2016年1期)2016-02-28 14:25:23
    四大方法 教你不再“坐以待病”!
    Coco薇(2015年1期)2015-08-13 02:47:34
    賺錢(qián)方法
    高清午夜精品一区二区三区| 亚洲欧美清纯卡通| 成人亚洲精品av一区二区| 成人午夜精彩视频在线观看| 欧美三级亚洲精品| 亚洲精品色激情综合| 国产高清有码在线观看视频| 亚洲国产成人一精品久久久| 黄色日韩在线| 草草在线视频免费看| 久久精品久久精品一区二区三区| 欧美 日韩 精品 国产| 国产精品不卡视频一区二区| 久久久午夜欧美精品| 国产亚洲91精品色在线| 熟女人妻精品中文字幕| 免费看不卡的av| 午夜福利高清视频| 久久久精品94久久精品| 亚洲精品成人av观看孕妇| 国产欧美日韩精品一区二区| 一区二区三区高清视频在线| 亚洲精品国产成人久久av| 日韩亚洲欧美综合| 欧美潮喷喷水| 国产精品综合久久久久久久免费| 亚洲18禁久久av| 激情五月婷婷亚洲| 午夜爱爱视频在线播放| 久久久a久久爽久久v久久| 欧美最新免费一区二区三区| 97超视频在线观看视频| 国产片特级美女逼逼视频| av黄色大香蕉| .国产精品久久| 亚洲欧美成人综合另类久久久| 久久精品久久精品一区二区三区| 久久草成人影院| 国产伦一二天堂av在线观看| 亚洲熟女精品中文字幕| 性插视频无遮挡在线免费观看| 亚洲人成网站在线播| 少妇熟女aⅴ在线视频| 国产一区二区三区av在线| 青春草亚洲视频在线观看| 午夜激情福利司机影院| 亚洲在久久综合| 日本色播在线视频| 观看美女的网站| 国产亚洲一区二区精品| 久久久久久久久久久免费av| 最近最新中文字幕免费大全7| 午夜福利在线观看吧| av黄色大香蕉| 插逼视频在线观看| 日韩三级伦理在线观看| 日韩 亚洲 欧美在线| 欧美潮喷喷水| 国产午夜精品久久久久久一区二区三区| 国产精品日韩av在线免费观看| 在线免费十八禁| 精品一区二区三卡| 成人毛片a级毛片在线播放| 一边亲一边摸免费视频| 乱系列少妇在线播放| av专区在线播放| 天天躁夜夜躁狠狠久久av| 国产亚洲午夜精品一区二区久久 | 99热6这里只有精品| 午夜免费男女啪啪视频观看| av国产免费在线观看| 两个人视频免费观看高清| 蜜桃亚洲精品一区二区三区| 欧美日韩综合久久久久久| 免费电影在线观看免费观看| 精品欧美国产一区二区三| 免费观看精品视频网站| 久久99精品国语久久久| 深爱激情五月婷婷| 直男gayav资源| 亚洲成色77777| 日韩制服骚丝袜av| 好男人在线观看高清免费视频| 联通29元200g的流量卡| 亚洲成人精品中文字幕电影| 性插视频无遮挡在线免费观看| 日韩欧美国产在线观看| 亚洲电影在线观看av| 黑人高潮一二区| 久久久色成人| 久久久久免费精品人妻一区二区| 久久精品国产自在天天线| 69av精品久久久久久| 亚洲不卡免费看| 老司机影院毛片| 国产精品国产三级国产av玫瑰| 婷婷色综合www| 欧美97在线视频| 午夜福利高清视频| 两个人视频免费观看高清| 亚洲精品乱码久久久v下载方式| .国产精品久久| 爱豆传媒免费全集在线观看| 51国产日韩欧美| 久久亚洲国产成人精品v| 日本与韩国留学比较| 嫩草影院新地址| 成人亚洲精品av一区二区| av福利片在线观看| 一级毛片电影观看| 99久国产av精品| 国产精品一区二区在线观看99 | 成人亚洲精品av一区二区| 亚洲成色77777| 日韩三级伦理在线观看| 麻豆av噜噜一区二区三区| 成人高潮视频无遮挡免费网站| 热99在线观看视频| 婷婷色综合www| 成年女人在线观看亚洲视频 | 国产视频首页在线观看| 久热久热在线精品观看| 国产午夜福利久久久久久| 精品久久久久久久久av| 特大巨黑吊av在线直播| 大话2 男鬼变身卡| 观看美女的网站| 99久久人妻综合| av.在线天堂| 国产一区二区亚洲精品在线观看| 中文字幕亚洲精品专区| 1000部很黄的大片| 亚洲国产精品成人综合色| 在线观看人妻少妇| 2021天堂中文幕一二区在线观| 国精品久久久久久国模美| 精品亚洲乱码少妇综合久久| 中文字幕av成人在线电影| 深爱激情五月婷婷| 国产日韩欧美在线精品| 亚洲成人精品中文字幕电影| 国内精品宾馆在线| 亚洲欧美日韩东京热| 国产成人免费观看mmmm| 久久人人爽人人片av| 伊人久久精品亚洲午夜| 一级片'在线观看视频| 秋霞在线观看毛片| 插逼视频在线观看| 亚洲av电影在线观看一区二区三区 | 九九爱精品视频在线观看| 在线天堂最新版资源| 日本猛色少妇xxxxx猛交久久| 久久99热6这里只有精品| 免费大片黄手机在线观看| 国产成人免费观看mmmm| 啦啦啦啦在线视频资源| 亚洲电影在线观看av| or卡值多少钱| 国产大屁股一区二区在线视频| 久久热精品热| 好男人视频免费观看在线| 日韩视频在线欧美| 久久精品国产自在天天线| 亚洲最大成人手机在线| 欧美激情久久久久久爽电影| 精品久久国产蜜桃| 美女被艹到高潮喷水动态| av播播在线观看一区| 18禁在线无遮挡免费观看视频| 成人综合一区亚洲| 国产三级在线视频| 国内精品宾馆在线| 日韩,欧美,国产一区二区三区| 国产成人免费观看mmmm| 一级av片app| 美女脱内裤让男人舔精品视频| 色哟哟·www| 蜜桃亚洲精品一区二区三区| 日韩人妻高清精品专区| 成人无遮挡网站| av专区在线播放| 看非洲黑人一级黄片| 最近手机中文字幕大全| 日韩,欧美,国产一区二区三区| 国产一区亚洲一区在线观看| 亚洲av电影不卡..在线观看| 日韩精品青青久久久久久| 一二三四中文在线观看免费高清| 久久久欧美国产精品| 日韩精品有码人妻一区| 麻豆精品久久久久久蜜桃| 国产精品一区二区在线观看99 | 国产成人a区在线观看| 免费看a级黄色片| videossex国产| a级一级毛片免费在线观看| 国内揄拍国产精品人妻在线| 麻豆精品久久久久久蜜桃| 免费无遮挡裸体视频| 午夜激情久久久久久久| 三级国产精品片| 看黄色毛片网站| 搡女人真爽免费视频火全软件| 午夜亚洲福利在线播放| 精品人妻一区二区三区麻豆| 美女大奶头视频| 日韩亚洲欧美综合| 久久久久久久久久人人人人人人| 国产一区二区亚洲精品在线观看| av在线老鸭窝| 亚洲欧美成人综合另类久久久| 国产美女午夜福利| 国产黄片美女视频| 观看美女的网站| 黄色欧美视频在线观看| 又大又黄又爽视频免费| 成人鲁丝片一二三区免费| 国产黄片美女视频| 搡老妇女老女人老熟妇| 成人综合一区亚洲| 99久久中文字幕三级久久日本| 麻豆乱淫一区二区| av网站免费在线观看视频 | 高清视频免费观看一区二区 | 亚洲,欧美,日韩| 亚洲18禁久久av| 久久草成人影院| 纵有疾风起免费观看全集完整版 | 久久久久免费精品人妻一区二区| 麻豆国产97在线/欧美| 亚洲av电影不卡..在线观看| 国产午夜精品久久久久久一区二区三区| 免费观看的影片在线观看| 在线播放无遮挡| 亚洲一级一片aⅴ在线观看| 久久99热6这里只有精品| 精品熟女少妇av免费看| 一个人观看的视频www高清免费观看| 天堂av国产一区二区熟女人妻| 国产精品av视频在线免费观看| 亚洲精品第二区| 你懂的网址亚洲精品在线观看| 免费大片18禁| 看黄色毛片网站| 国产 亚洲一区二区三区 | 国产成人aa在线观看| 国产白丝娇喘喷水9色精品| 久久久久久国产a免费观看| 精品亚洲乱码少妇综合久久| 日韩伦理黄色片| 免费黄色在线免费观看| 中文天堂在线官网| 一本一本综合久久| 日本免费在线观看一区| 欧美成人a在线观看| 亚洲精品一二三| 免费电影在线观看免费观看| 高清毛片免费看| 亚洲精品,欧美精品| 成年人午夜在线观看视频 | 在线观看美女被高潮喷水网站| 成人美女网站在线观看视频| 国产成人91sexporn| 女人被狂操c到高潮| 身体一侧抽搐| 亚洲va在线va天堂va国产| 特级一级黄色大片| 国产精品精品国产色婷婷| 亚洲av成人精品一区久久| 精品国产三级普通话版| 蜜桃亚洲精品一区二区三区| 男女边摸边吃奶| 亚洲va在线va天堂va国产| 亚洲欧美日韩东京热| 综合色av麻豆| 成人一区二区视频在线观看| 久久久久久久久大av| 国产单亲对白刺激| 国产永久视频网站| 国产精品嫩草影院av在线观看| 国产黄片美女视频| 少妇猛男粗大的猛烈进出视频 | 亚洲精品成人久久久久久| 国产麻豆成人av免费视频| 全区人妻精品视频| 国模一区二区三区四区视频| 国产精品一区二区在线观看99 | 国产亚洲精品av在线| 天堂√8在线中文| 午夜久久久久精精品| 欧美日韩精品成人综合77777| 免费黄色在线免费观看| 三级经典国产精品| 99热网站在线观看| 日本欧美国产在线视频| 午夜视频国产福利| 国产真实伦视频高清在线观看| av在线播放精品| 中文字幕人妻熟人妻熟丝袜美| 汤姆久久久久久久影院中文字幕 | 精品一区二区三卡| 久久精品国产自在天天线| 午夜爱爱视频在线播放| 黄色配什么色好看| 欧美精品国产亚洲| 亚洲成人一二三区av| 三级男女做爰猛烈吃奶摸视频| 噜噜噜噜噜久久久久久91| 中文字幕亚洲精品专区| 熟妇人妻久久中文字幕3abv| 国产一区二区在线观看日韩| 毛片一级片免费看久久久久| 老师上课跳d突然被开到最大视频| 国产精品久久久久久久电影| 国产一区二区亚洲精品在线观看| 国产精品伦人一区二区| 国产白丝娇喘喷水9色精品| 国产成人精品婷婷| 亚洲成人一二三区av| 精品国产一区二区三区久久久樱花 | 美女cb高潮喷水在线观看| 小蜜桃在线观看免费完整版高清| 大话2 男鬼变身卡| 校园人妻丝袜中文字幕| 国产综合懂色| 2021天堂中文幕一二区在线观| 高清欧美精品videossex| 日韩国内少妇激情av| 中国国产av一级| a级一级毛片免费在线观看| 又粗又硬又长又爽又黄的视频| 日本一本二区三区精品| 国产一区亚洲一区在线观看| 国产高清三级在线| 色吧在线观看| 最近最新中文字幕大全电影3| 亚洲国产精品专区欧美| 日韩欧美国产在线观看| 97超视频在线观看视频| 成人美女网站在线观看视频| 国产国拍精品亚洲av在线观看| 99热这里只有是精品50| 亚洲av成人av| 秋霞伦理黄片| 激情五月婷婷亚洲| 尾随美女入室| 久久综合国产亚洲精品| 日韩国内少妇激情av| 午夜亚洲福利在线播放| 黄色配什么色好看| 欧美成人a在线观看| 白带黄色成豆腐渣| 嫩草影院入口| 精品国产露脸久久av麻豆 | 大香蕉久久网| 精品久久久久久久末码| 夜夜看夜夜爽夜夜摸| 亚洲综合精品二区| 免费观看在线日韩| 亚洲四区av| 亚洲欧美精品自产自拍| 欧美日韩国产mv在线观看视频 | 国产毛片a区久久久久| 午夜亚洲福利在线播放| 色综合色国产| 大片免费播放器 马上看| 网址你懂的国产日韩在线| 欧美激情在线99| 女人久久www免费人成看片| 91久久精品国产一区二区成人| 黄色一级大片看看| 男女视频在线观看网站免费| 精品国产露脸久久av麻豆 | 三级经典国产精品| 一级毛片我不卡| 成人亚洲精品一区在线观看 | 一级毛片 在线播放| 国产大屁股一区二区在线视频| 丰满人妻一区二区三区视频av| videos熟女内射| 国产精品国产三级国产av玫瑰| 真实男女啪啪啪动态图| 国产av不卡久久| 一级毛片aaaaaa免费看小| 亚洲内射少妇av| 久久久精品免费免费高清| 丰满乱子伦码专区| 国产亚洲精品av在线| 久久综合国产亚洲精品| 国产精品一区二区三区四区免费观看| 欧美xxxx黑人xx丫x性爽| 99视频精品全部免费 在线| 高清欧美精品videossex| 三级国产精品欧美在线观看| 中文乱码字字幕精品一区二区三区 | 精品久久久久久久末码| 精品熟女少妇av免费看| 国产黄色视频一区二区在线观看| 黄片无遮挡物在线观看| 中文字幕免费在线视频6| 搡女人真爽免费视频火全软件| 精品久久久久久久久久久久久| 久久久久久伊人网av| 国产精品麻豆人妻色哟哟久久 | 亚洲在久久综合| 亚洲欧美日韩卡通动漫| 亚洲成人av在线免费| 一本久久精品| 午夜福利网站1000一区二区三区| 99热全是精品| 大话2 男鬼变身卡| 18禁在线无遮挡免费观看视频| 国产单亲对白刺激| 国产精品麻豆人妻色哟哟久久 | av在线播放精品| 成年女人在线观看亚洲视频 | 中文精品一卡2卡3卡4更新| 熟妇人妻不卡中文字幕| av在线观看视频网站免费| 久99久视频精品免费| 久久鲁丝午夜福利片| 欧美性猛交╳xxx乱大交人| 夜夜爽夜夜爽视频| 成人国产麻豆网| 一级av片app| 午夜福利在线在线| 大片免费播放器 马上看| 国产探花极品一区二区| 97在线视频观看| 亚洲在线自拍视频| 亚洲av成人精品一二三区| 国产单亲对白刺激| 午夜福利在线在线| 在线免费十八禁| 一级毛片黄色毛片免费观看视频| 91久久精品国产一区二区成人| 欧美激情国产日韩精品一区| 最近视频中文字幕2019在线8| 欧美97在线视频| 天堂√8在线中文| 国产精品人妻久久久久久| 国产黄色小视频在线观看| www.av在线官网国产| 国产精品久久视频播放| 国产精品综合久久久久久久免费| 干丝袜人妻中文字幕| 五月伊人婷婷丁香| 十八禁国产超污无遮挡网站| 国产亚洲最大av| 少妇熟女aⅴ在线视频| 欧美日韩国产mv在线观看视频 | 国产精品久久久久久久电影| 国产激情偷乱视频一区二区| 乱人视频在线观看| 欧美激情久久久久久爽电影| 禁无遮挡网站| 亚洲av国产av综合av卡| 国产精品蜜桃在线观看| 亚洲一级一片aⅴ在线观看| 午夜免费观看性视频| 观看美女的网站| 波野结衣二区三区在线| 亚洲国产色片| 免费高清在线观看视频在线观看| 久久久久久久国产电影| 中文精品一卡2卡3卡4更新| 91精品一卡2卡3卡4卡| 日日摸夜夜添夜夜爱| 免费观看在线日韩| 青春草国产在线视频| 免费播放大片免费观看视频在线观看| 午夜精品一区二区三区免费看| 国产高清国产精品国产三级 | 搞女人的毛片| 午夜免费激情av| 日韩av在线免费看完整版不卡| 国产v大片淫在线免费观看| 免费电影在线观看免费观看| 亚洲精华国产精华液的使用体验| 一二三四中文在线观看免费高清| 我的老师免费观看完整版| 色视频www国产| 九九久久精品国产亚洲av麻豆| 免费观看精品视频网站| 嫩草影院新地址| 色网站视频免费| 亚洲人与动物交配视频| 成人国产麻豆网| 联通29元200g的流量卡| 日本爱情动作片www.在线观看| 欧美日韩综合久久久久久| 亚洲欧美一区二区三区国产| 久久精品夜夜夜夜夜久久蜜豆| 欧美97在线视频| 视频中文字幕在线观看| 精品国产露脸久久av麻豆 | 亚洲精品aⅴ在线观看| 干丝袜人妻中文字幕| 七月丁香在线播放| 欧美日本视频| 性色avwww在线观看| 成人毛片a级毛片在线播放| 91精品国产九色| 一区二区三区乱码不卡18| 成人毛片60女人毛片免费| 超碰97精品在线观看| 亚洲国产av新网站| 天堂av国产一区二区熟女人妻| 69人妻影院| 插逼视频在线观看| 国产乱来视频区| 精品一区二区免费观看| 国产激情偷乱视频一区二区| 丝袜美腿在线中文| 一区二区三区高清视频在线| 久久久久久久大尺度免费视频| 国产成年人精品一区二区| 国产又色又爽无遮挡免| 91精品伊人久久大香线蕉| 1000部很黄的大片| 成年免费大片在线观看| 精品人妻视频免费看| 亚洲精品456在线播放app| 日本wwww免费看| 国产淫语在线视频| 国产亚洲午夜精品一区二区久久 | 久久久久久九九精品二区国产| 久热久热在线精品观看| 欧美精品国产亚洲| 日韩,欧美,国产一区二区三区| 国产亚洲精品久久久com| 只有这里有精品99| 乱码一卡2卡4卡精品| 日韩强制内射视频| 欧美区成人在线视频| 国产中年淑女户外野战色| 精品国产三级普通话版| 中文字幕av在线有码专区| 亚洲精品影视一区二区三区av| 亚洲精品乱码久久久久久按摩| 99久久人妻综合| 搡老乐熟女国产| 精品不卡国产一区二区三区| 国产亚洲一区二区精品| 国产成年人精品一区二区| 免费看光身美女| 老司机影院成人| 亚洲精品成人久久久久久| 久久精品熟女亚洲av麻豆精品 | 色5月婷婷丁香| 国语对白做爰xxxⅹ性视频网站| 亚洲精品自拍成人| 老师上课跳d突然被开到最大视频| 偷拍熟女少妇极品色| 国产午夜福利久久久久久| 极品教师在线视频| 有码 亚洲区| 国产精品一区二区在线观看99 | 91久久精品电影网| 欧美成人午夜免费资源| 舔av片在线| 成年女人看的毛片在线观看| 特大巨黑吊av在线直播| 国产精品日韩av在线免费观看| 三级男女做爰猛烈吃奶摸视频| 建设人人有责人人尽责人人享有的 | 成人一区二区视频在线观看| av卡一久久| 久久久午夜欧美精品| 十八禁国产超污无遮挡网站| 日日干狠狠操夜夜爽| 1000部很黄的大片| 日本三级黄在线观看| 亚洲av电影在线观看一区二区三区 | freevideosex欧美| 男女那种视频在线观看| 国产高清有码在线观看视频| 日韩一本色道免费dvd| 午夜久久久久精精品| 天美传媒精品一区二区| 国产爱豆传媒在线观看| 亚洲国产精品国产精品| 午夜亚洲福利在线播放| 午夜福利高清视频| 中文字幕制服av| 在线免费观看的www视频| 蜜桃久久精品国产亚洲av| 国产黄片美女视频| 午夜福利视频1000在线观看| 午夜福利高清视频| 又爽又黄无遮挡网站| 国产不卡一卡二| 男女那种视频在线观看| 99九九线精品视频在线观看视频| 亚洲色图av天堂| 久久久色成人| 美女大奶头视频| 成人美女网站在线观看视频| 一级毛片久久久久久久久女| 一级毛片黄色毛片免费观看视频| a级毛色黄片| 久久久久久伊人网av| av在线老鸭窝| 免费看美女性在线毛片视频| 老司机影院毛片| 最近2019中文字幕mv第一页| 久久国产乱子免费精品| 亚洲图色成人| 亚洲内射少妇av| 成人高潮视频无遮挡免费网站| 国产在视频线精品| 久久久久久九九精品二区国产| 国产一级毛片在线| 我的女老师完整版在线观看|