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

    變長(zhǎng)度柔性雙足機(jī)器人行走控制及穩(wěn)定性分析

    2023-02-03 03:02:44廖發(fā)康周亞麗張奇志
    計(jì)算機(jī)應(yīng)用 2023年1期
    關(guān)鍵詞:龐加萊步態(tài)擾動(dòng)

    廖發(fā)康,周亞麗,張奇志

    (北京信息科技大學(xué) 自動(dòng)化學(xué)院,北京 100192)

    0 引言

    1990 年,McGeer[1]提出了被動(dòng)動(dòng)態(tài)行走(Passive Dynamic Walking,PDW)模型,在雙足機(jī)器人領(lǐng)域取得了里程碑意義的研究成果。與主動(dòng)控制系統(tǒng)[2]相比,基于PDW原理設(shè)計(jì)的機(jī)器人效率要高得多,因?yàn)榇祟?lèi)機(jī)器人的運(yùn)動(dòng)是通過(guò)腿的自然擺動(dòng)來(lái)維持的,而不是通過(guò)安裝在每個(gè)關(guān)節(jié)上的電機(jī)來(lái)驅(qū)動(dòng)的。但是被動(dòng)行走步態(tài)單一,抗擾性能較差,容易出現(xiàn)混沌特性,進(jìn)入不穩(wěn)定狀態(tài)[3];而且由于擺動(dòng)腿落地瞬間,與地面之間的沖擊存在能量損失,采用剛性腿的被動(dòng)行走機(jī)器人不能在水平面上持續(xù)行走,且剛性腿太僵硬,不具有擬人性。1989 年,Blickhan[4]首次提出了彈簧-質(zhì)點(diǎn)模型,用以描述人類(lèi)的奔跑和跳躍。研究表明觸地時(shí)間和跳躍頻率不是簡(jiǎn)單地由彈簧-質(zhì)量系統(tǒng)的固有頻率決定的,而是很大程度上受著陸速度矢量的影響。雖然人類(lèi)的腿具有復(fù)雜的神經(jīng)控制系統(tǒng),但在跑步階段,腿會(huì)表現(xiàn)出簡(jiǎn)單的彈簧狀行為,可以用彈簧-質(zhì)點(diǎn)模型來(lái)描述。2006 年,Geyer 等[5]對(duì)彈簧-質(zhì)點(diǎn)模型進(jìn)行擴(kuò)展,該模型將雙支撐作為行走過(guò)程中的重要組成部分,用簡(jiǎn)單的彈簧負(fù)載倒立擺(Spring-Loaded Inverted Pendulum,SLIP)模型模擬了人類(lèi)在平面上的運(yùn)動(dòng)。Geyer 的研究表明:帶彈簧的柔性腿可以準(zhǔn)確地再現(xiàn)人體行走過(guò)程中髖關(guān)節(jié)運(yùn)動(dòng)軌跡和站立時(shí)的動(dòng)力學(xué)特性。雙足機(jī)器人采用柔性腿代替剛性腿,借助于彈簧的彈性勢(shì)能,可以實(shí)現(xiàn)平地上的類(lèi)人行走。2010 年,Rummel 等[6]通過(guò)對(duì)機(jī)器人行走時(shí)腿部剛度與魯棒性之間的關(guān)系研究,得出了可變腿剛度能有效地抑制外部干擾的結(jié)論。2012 年,Visser等[7]把SLIP 擴(kuò)展為變腿剛度模型(Variable leg stiffness-SLIP,V-SLIP),顯著提高了雙足機(jī)器人對(duì)外界干擾的魯棒性。2013 年,Visser 等[8]將V-SLIP 模型擴(kuò)展為考慮擺動(dòng)腿動(dòng)力學(xué)的V-SLIP 模型(V-SLIP model with Swing Leg dynamics,V-SLIP-SL),即在每條腿的末端增加了一個(gè)腳質(zhì)量。仿真結(jié)果表明,在控制器的作用下,機(jī)器人具有足夠的魯棒性,能夠抑制由擺動(dòng)腿動(dòng)態(tài)所引起的擾動(dòng)。2020 年,Pelit 等[9]以被動(dòng)SLIP-SL 模型作為模板,為5 連桿全驅(qū)動(dòng)雙足機(jī)器人的質(zhì)心和擺動(dòng)腳提供所需的軌跡。仿真結(jié)果表明,該控制器可以跟蹤由SLIP-SL 模型獲得的軌跡,并且簡(jiǎn)單的SLIP-SL 模型比高自由度模型在計(jì)算方面更有優(yōu)勢(shì)。

    盡管雙足機(jī)器人的擴(kuò)展及變剛度控制能使機(jī)器人擁有良好的魯棒性能,但變剛度實(shí)驗(yàn)裝置的設(shè)計(jì)和制造[10-11]都比較復(fù)雜,而變長(zhǎng)度的實(shí)驗(yàn)裝置要簡(jiǎn)單得多[12]。2008 年,Asano 等[13]針對(duì)平面伸縮腿雙足機(jī)器人模型,提出了一種簡(jiǎn)單的控制律,在不考慮零力矩點(diǎn)(Zero Moment Point,ZMP)條件的情況下,通過(guò)伸縮擺動(dòng)腿即可輕松實(shí)現(xiàn)水平步態(tài)生成。2012 年,Asano[14]引入了一個(gè)由8 個(gè)伸縮腿組成的平面無(wú)緣輪模型,并將該方法推廣到帶有制動(dòng)彈簧的平面伸縮腿雙足機(jī)器人,通過(guò)數(shù)值仿真驗(yàn)證了該方法的有效性。2018年,Harata 等[15]研究了包含伸縮腿的欠驅(qū)動(dòng)雙足機(jī)器人的穩(wěn)定性。將輸出跟隨控制律應(yīng)用于機(jī)器人的線性化運(yùn)動(dòng)方程中,將被控機(jī)器人的運(yùn)動(dòng)方程指定為一個(gè)線性時(shí)變系統(tǒng),建立了誤差轉(zhuǎn)移方程來(lái)評(píng)估穩(wěn)定性,通過(guò)數(shù)值計(jì)算說(shuō)明了腿部伸縮運(yùn)動(dòng)對(duì)穩(wěn)定性的影響。

    上述文獻(xiàn)的變長(zhǎng)度伸縮腿控制基本采用的都是剛性腿,本課題組在此基礎(chǔ)上,對(duì)雙足機(jī)器人變長(zhǎng)度的柔性伸縮腿控制展開(kāi)研究。2019 年,張奇志等[16]研究半被動(dòng)伸縮腿雙足機(jī)器人行走控制和周期解的全局穩(wěn)定性問(wèn)題,設(shè)計(jì)了腿伸縮長(zhǎng)度的支撐腿角度反饋控制率,證明了伸縮腿雙足機(jī)器人行走過(guò)程不動(dòng)點(diǎn)的全局穩(wěn)定性;同年,宋嘉琦等[17]采用變長(zhǎng)度柔性伸縮腿結(jié)構(gòu),研究了半被動(dòng)雙足機(jī)器人的平面穩(wěn)定行走的控制問(wèn)題,結(jié)果表明變長(zhǎng)度控制算法可以實(shí)現(xiàn)機(jī)器人的穩(wěn)定行走,并具有較強(qiáng)的抗干擾性。2022 年,張瑞等[18]用半被動(dòng)變長(zhǎng)度彈性伸縮腿雙足機(jī)器人模型,提出了一種基于能量的仿人控制方法。結(jié)果表明,所提出的控制策略可使雙足機(jī)器人在水平面上實(shí)現(xiàn)起步行走過(guò)程,并對(duì)外部的擾動(dòng)具有一定的抗擾性。

    本文在上述研究成果的基礎(chǔ)上,提出了考慮軀干影響和擺動(dòng)腿動(dòng)力學(xué)的變腿長(zhǎng)度柔性雙足機(jī)器人(Variable Leg length SLIP with Torso and Swing Legs dynamics,VL-TSLIPSL)模型。首先,建立柔性雙足機(jī)器人的動(dòng)力學(xué)模型,仿真求解出雙足機(jī)器人被動(dòng)行走的自然步態(tài),將其作為期望步態(tài);其次,采用反饋線性化控制方法,通過(guò)對(duì)雙足機(jī)器人腿長(zhǎng)度變量和髖關(guān)節(jié)力矩的控制,實(shí)現(xiàn)機(jī)器人的穩(wěn)定周期行走;最后,采用Newton-Raphson 迭代法和龐加萊映射相結(jié)合,求解不動(dòng)點(diǎn)并分析系統(tǒng)的穩(wěn)定性。

    1 雙足機(jī)器人動(dòng)力學(xué)模型

    1.1 機(jī)器人模型描述

    雙足機(jī)器人的模型如圖1 所示。由質(zhì)量為M的髖關(guān)節(jié)質(zhì)點(diǎn)、中心質(zhì)量為m的剛性桿及兩條長(zhǎng)度可變的柔性腿組成,每條腿的末端各有一個(gè)腳質(zhì)量mf。髖關(guān)節(jié)質(zhì)點(diǎn)坐標(biāo)為[x,y]=:qh∈Qh,其中Qh表示二維的實(shí)數(shù)域。軀干長(zhǎng)度為l,轉(zhuǎn)動(dòng)慣量為I;腿長(zhǎng)度為L(zhǎng)0+ui,L0為原長(zhǎng)度,ui(i=1,2)為可控的長(zhǎng)度增量。兩腿各有一個(gè)彈性系數(shù)為k0的單向彈簧。髖關(guān)節(jié)力矩τ1和τ2用來(lái)控制軀干姿態(tài)角α和擺動(dòng)腿與法線夾角β。

    圖1 VL-TSLIP-SL模型Fig.1 VL-TSLIP-SL model

    圖2 為機(jī)器人的運(yùn)動(dòng)過(guò)程。其初始狀態(tài)是左腿作支撐腿,右腿作擺動(dòng)腿,呈垂直站立(Vertical Leg Orientation,VLO)狀態(tài),擺動(dòng)腿不與地面接觸,此時(shí)為單支撐(Single Support,SS)階段。當(dāng)髖關(guān)節(jié)下降到高度S時(shí),此時(shí)的S=L0sinθ稱(chēng)為切換高度,擺動(dòng)腿以原始長(zhǎng)度L0和角度θ接觸地面,然后機(jī)器人進(jìn)入雙支撐(Double Support,DS)階段。當(dāng)髖關(guān)節(jié)升高到高度S時(shí),系統(tǒng)再次進(jìn)入SS 階段,左腿變?yōu)閿[動(dòng)腿,右腿變?yōu)橹瓮龋紤]到雙腿的對(duì)稱(chēng)性,圖2 中所表示的從左腿作支撐腿到右腿作支撐腿的過(guò)程稱(chēng)為機(jī)器人的一個(gè)步態(tài)周期,如此循環(huán)反復(fù)。

    圖2 雙足機(jī)器人的運(yùn)動(dòng)過(guò)程Fig.2 Moving process of biped robot

    由此可得,從SS 過(guò)渡到DS 的條件是:

    DS 切換為SS 的條件為:

    其中Li是后支撐腿的長(zhǎng)度。

    1.2 系統(tǒng)動(dòng)力學(xué)模型

    在圖1 中,以支撐腿與地面的接觸點(diǎn)為坐標(biāo)原點(diǎn)O,建立圖中所示直角坐標(biāo)系,利用拉格朗日方程建立系統(tǒng)的動(dòng)力學(xué)方程。定義拉格朗日函數(shù)為:

    其中:K為系統(tǒng)的動(dòng)能,P為系統(tǒng)的勢(shì)能。

    系統(tǒng)動(dòng)力學(xué)方程為:

    其中:n為系統(tǒng)的自由度,qi為系統(tǒng)的變量,F(xiàn)i為作用于系統(tǒng)的廣義力。

    1.2.1 單支撐階段的動(dòng)力學(xué)方程

    SS 階段的簡(jiǎn)化模型如圖3 所示。右腿是擺動(dòng)腿,長(zhǎng)度為L(zhǎng)0,與法線夾角為β,因?yàn)樵诖穗A段不需要對(duì)右腿進(jìn)行變長(zhǎng)度控制,所以假設(shè)為剛性腿。在這個(gè)階段,左腿長(zhǎng)度增量為u1,力矩τ1和τ2是控制髖關(guān)節(jié)質(zhì)點(diǎn)運(yùn)動(dòng),軀干姿態(tài)角和擺動(dòng)腿夾角的控制輸入,系統(tǒng)狀態(tài)變量為[x,y,α,β]T=:qSS∈QSS(QSS={qSS∈QSS|L0sinθ<y<L0})。

    圖3 SS階段的簡(jiǎn)化模型Fig.3 Simplified model of SS phase

    分別計(jì)算系統(tǒng)的動(dòng)能K和勢(shì)能P,可得拉格朗日函數(shù)的表達(dá)式為:

    1.2.2 雙支撐階段的動(dòng)力學(xué)方程

    DS 階段的簡(jiǎn)化模型如圖4 所示。此時(shí)雙腿接觸地面,由于右腿與法線的夾角β可以通過(guò)髖關(guān)節(jié)位置和腳觸地點(diǎn)計(jì)算得到,因此系統(tǒng)的狀態(tài)變量為[x,y,α]T=:qDS∈QDS。在這個(gè)階段中,雙腿長(zhǎng)度增量u1、u2和力矩τ1是控制髖關(guān)節(jié)運(yùn)動(dòng)和軀干姿態(tài)角的控制輸入,其中QDS為QDS={qDS∈QDS| 0 <y≤L0sinθ}。

    圖4 DS階段的簡(jiǎn)化模型Fig.4 Simplified model of DS phase

    采用與SS 階段相同的推導(dǎo)方法,得到DS 階段的動(dòng)力學(xué)方程:

    由式(9)~(10)可知,系統(tǒng)在SS 階段為欠驅(qū)動(dòng)模型,在DS 階段為全驅(qū)動(dòng)模型,但總的來(lái)說(shuō),系統(tǒng)是欠驅(qū)動(dòng)系統(tǒng)。

    1.3 狀態(tài)空間表達(dá)式

    為了便于后續(xù)的反饋線性化控制器的設(shè)計(jì),在這里將動(dòng)力學(xué)方程轉(zhuǎn)換為標(biāo)準(zhǔn)的狀態(tài)空間表達(dá)式。在SS 階段,令:

    2 控制器設(shè)計(jì)

    2.1 控制目標(biāo)

    對(duì)于文中所要研究的雙足機(jī)器人,設(shè)定的控制目標(biāo)是:在保證軀干直立的情況下,使髖關(guān)節(jié)質(zhì)點(diǎn)跟蹤期望高度y*(x)和期望水平速度,并使擺動(dòng)腿按期望軌跡β*(x)擺動(dòng)。由于機(jī)器人在穩(wěn)定行走過(guò)程中,水平位置x在時(shí)間上是嚴(yán)格單調(diào)遞增的,因此本文采用x替代時(shí)間t作為自變量,即采用空間軌跡方法。

    為了避免符號(hào)混亂,省略函數(shù)參數(shù)z1。定義控制目標(biāo)的誤差函數(shù)為:

    控制目標(biāo)是使誤差盡可能收斂到0 的鄰域。

    2.2 反饋線性化控制

    本文通過(guò)反饋線性化方法設(shè)計(jì)控制器,來(lái)控制腿的伸縮長(zhǎng)度和髖關(guān)節(jié)力矩,使機(jī)器人的行走能夠逐漸逼近期望的步態(tài),軀干傾角和擺動(dòng)腿夾角收斂到期望角度。需要說(shuō)明的是:由于系統(tǒng)在SS 階段有4 個(gè)自由度,但是只有3 個(gè)控制輸入,屬于欠驅(qū)動(dòng)狀態(tài),因此采用部分反饋線性化(Partial Feedback Linearization,PFL)的控制方式[19],水平方向速度誤差ev在SS 階段不受控制。在DS 階段,兩腳都與地面接觸,不需要對(duì)誤差eβ的動(dòng)態(tài)控制,屬于全驅(qū)動(dòng)狀態(tài),因此采用標(biāo)準(zhǔn)反饋線性化的控制方式??紤]到在單支撐階段,不是用3個(gè)控制輸入控制4 個(gè)被控變量;而是用3 個(gè)控制輸入控制3個(gè)被控變量,另一個(gè)被控量不控制,所以單支撐欠驅(qū)動(dòng)和雙支撐全驅(qū)動(dòng)的反饋線性化控制器的設(shè)計(jì)是一樣的。

    2.2.1 單支撐階段

    在SS 階段,控制變量為髖關(guān)節(jié)高度軌跡y、軀干姿態(tài)角α和擺動(dòng)腿夾角β,則系統(tǒng)的狀態(tài)空間表達(dá)式為:

    為了將該非線性系統(tǒng)轉(zhuǎn)換為線性標(biāo)準(zhǔn)型,首先需要確定誤差的關(guān)系度γSS={γp,γα,γβ}。

    對(duì)于位置誤差ep:

    所以關(guān)系度γp=2,同理可得γα和γβ的關(guān)系度也為2。因此,在SS 階段中,誤差的關(guān)系度γSS={γp,γα,γβ}={2,2,2}。

    根據(jù)反饋線性化原理,可得誤差動(dòng)力學(xué)方程為:

    2.2.2 雙支撐階段

    在DS 階段,控制變量為髖關(guān)節(jié)高度y、軀干姿態(tài)角α和前進(jìn)速度x˙。采用與SS 階段相同的方法,可以得到關(guān)系度γDS={γp,γα,γv}={2,2,1},則誤差動(dòng)力學(xué)方程為:

    3 軌道穩(wěn)定性分析

    被動(dòng)行走周期步態(tài)的特點(diǎn)是系統(tǒng)的狀態(tài)變量每隔一個(gè)周期重復(fù)取值一次,在狀態(tài)空間中表現(xiàn)為周期軌道,又稱(chēng)極限環(huán),因此被動(dòng)行走周期步態(tài)的局部穩(wěn)定性采用軌道穩(wěn)定性來(lái)定義。從直觀上講,周期步態(tài)是軌道穩(wěn)定的是指周期軌道對(duì)應(yīng)的某個(gè)狀態(tài)受到有限擾動(dòng)后偏離了原有的周期軌道,但系統(tǒng)的狀態(tài)最終運(yùn)動(dòng)到其附近的一條周期軌道上。如果狀態(tài)受到擾動(dòng)后,系統(tǒng)在自身的作用下仍能回到原來(lái)所在的周期軌道上則稱(chēng)周期步態(tài)是軌道漸近穩(wěn)定的。

    分析周期軌道穩(wěn)定性的常用辦法是通過(guò)龐加萊映射(Poincaré map)將周期軌道穩(wěn)定性問(wèn)題轉(zhuǎn)化為不動(dòng)點(diǎn)的穩(wěn)定性問(wèn)題[20-21]。本文將擺動(dòng)腿觸地瞬間所在的超平面取為龐加萊截面Σ,兩個(gè)連續(xù)觸地事件之間的關(guān)系可以用龐加萊映射表示為P:Σ→Σ,即

    其中:P代表龐加萊映射,為龐加萊截面上的6 維狀態(tài)變量。狀態(tài)變量不包含髖關(guān)節(jié)位置(x,y),這是因?yàn)樗轿恢脁為自變量,垂直位置y可由y=L0sinθ計(jì)算得到。因此,選擇合適的龐加萊節(jié)截面及采用空間軌跡的分析方法,可以將狀態(tài)變量維數(shù)由8 維降低到6 維,可以有效降低算法的復(fù)雜性及運(yùn)算量。

    對(duì)于周期相位軌跡,龐加萊截面上的狀態(tài)變量為常數(shù),即

    其中:φ*為龐加萊映射的不動(dòng)點(diǎn)。因此,通過(guò)龐加萊映射,雙足機(jī)器人的穩(wěn)定性問(wèn)題轉(zhuǎn)換為龐加萊映射不動(dòng)點(diǎn)的穩(wěn)定性問(wèn)題。

    3.1 求解不動(dòng)點(diǎn)

    求解龐加萊映射不動(dòng)點(diǎn)的常用方法是Newton-Raphson迭代法。用φk表示軌道第k次穿過(guò)龐加萊截面的點(diǎn),由式(19)可知φk+1=P(φk),設(shè)φk+1=φk+Δφk,利用一階泰勒公式對(duì)龐加萊映射函數(shù)P(x)進(jìn)行局部線性化,可以得到如下關(guān)系:

    使用φk+1=φk+Δφk進(jìn)行迭代,直到Δφk小于給定的閾值誤差,便求得不動(dòng)點(diǎn)φ*。

    3.2 軌道穩(wěn)定性判據(jù)

    對(duì)于不動(dòng)點(diǎn)φ*附近的小擾動(dòng)Δφ*,采用泰勒級(jí)數(shù)展開(kāi),龐加萊映射函數(shù)可以表示為:

    其中:?P為龐加萊映射函數(shù)相對(duì)于系統(tǒng)狀態(tài)的梯度,稱(chēng)為雅可比矩陣。?P其表達(dá)式為:

    該矩陣的特征值λ稱(chēng)為被動(dòng)行走系統(tǒng)的Floquet 乘子。由于Δφk+1=(?P)Δφk,所以,當(dāng)雅可比矩陣的所有特征值滿足|λ| <1 時(shí),必有<1,即隨著k的增加,Δφk→0,誤差會(huì)隨著步長(zhǎng)的增加而逐漸減小,極限環(huán)將逐漸收斂到原周期軌道,由軌道穩(wěn)定性定義可知系統(tǒng)的周期步態(tài)是軌道穩(wěn)定的。

    4 仿真分析

    表1 系統(tǒng)參數(shù)和初始條件Tab.1 System parameters and initial conditions

    4.1 步態(tài)分析

    圖5 給出的是髖關(guān)節(jié)軌跡、軀干姿態(tài)角α和擺動(dòng)腿夾角β的軌跡圖。可以看出,所提出的控制器能夠維持穩(wěn)定的周期步態(tài),并保持軀干直立。從圖6 中可以看出,得到的誤差曲線收斂于零的鄰域。在DS 階段,因?yàn)閿[動(dòng)腿角度β在此階段沒(méi)有定義,所以eβ≡0。此外,如前所述,系統(tǒng)在SS 階段處于欠驅(qū)動(dòng)狀態(tài),采用的是部分反饋線性化的控制方式。即僅在DS 階段控制髖關(guān)節(jié)質(zhì)點(diǎn)的水平速度。從圖6(d)中可以看出:誤差ev在DS 階段趨于零,而在單支撐階段,存在一定的誤差。

    圖5 髖關(guān)節(jié)軌跡、軀干傾角軌跡和擺動(dòng)腿夾角軌跡Fig.5 Hip trajectories,torso attitude angle trajectory,and swing leg included angle trajectory

    圖6 穩(wěn)態(tài)誤差變化曲線(灰色區(qū)域?yàn)镈S階段)Fig.6 Error change curves in steady state(the areas printed in grey are DS phases)

    圖7 給出了穩(wěn)定狀態(tài)下的控制輸入變化曲線,黑色虛線對(duì)應(yīng)腿原長(zhǎng)度(L0=1 m)。理想的SLIP 參考模型可以在沒(méi)有任何控制輸入的情況下(即u1=u2=0)維持穩(wěn)定的步態(tài)。本文提出的VL-TSLIP-SL 模型包括軀干姿態(tài)和擺動(dòng)腿控制,這些非理想動(dòng)態(tài)都被認(rèn)為是系統(tǒng)的外部擾動(dòng),因此需要較大的控制輸入來(lái)抑制這些擾動(dòng)。在圖7 中可以清楚地看到控制輸入隨著機(jī)器人的行走作出的變化,由于擺動(dòng)腿夾角β在DS 階段沒(méi)有定義,所以在DS 階段τ2≡0。此外,由于在行走的過(guò)程中,左右腿交替作為擺動(dòng)腿,所以在SS 階段,控制輸入u1和u2交替為零。

    圖7 穩(wěn)態(tài)控制輸入變化曲線Fig.7 Control input change curves in steady state

    系統(tǒng)的能量曲線如圖8 所示,其中虛線為理想SLIP 模型的能量水平。可以看出,總能量在SLIP 模型的能量水平上波動(dòng)。一方面原因是控制器作用在軀干和擺動(dòng)腿上,需要消耗能量;另一方面原因是期望軌跡由傅里葉級(jí)數(shù)擬合而來(lái),存在著一定的偏差。因此,實(shí)際上能量水平不是恒值,存在一定的波動(dòng)。

    圖8 系統(tǒng)的能量曲線Fig.8 Energy curves of system

    4.2 穩(wěn)定性驗(yàn)證

    4.2.1 特征值分布

    對(duì)于雅可比矩陣,由于無(wú)法得到解析解,在實(shí)際的機(jī)器人系統(tǒng)中,通常采用數(shù)值方法進(jìn)行求解。數(shù)值解法的步驟如下:

    步驟1 用Newton-Raphson 迭代法得到不動(dòng)點(diǎn)φ*=

    步驟2 每次對(duì)一個(gè)狀態(tài)變量施加擾動(dòng),其他狀態(tài)變量保持不變。

    步驟3 觀察龐加萊映射的首次返回值。

    步驟4 計(jì)算式(25)中對(duì)應(yīng)列的元素值。

    步驟5 重復(fù)6 次,即每個(gè)狀態(tài)變量各1 次。

    步驟6 計(jì)算雅可比矩陣的特征值,判斷系統(tǒng)是否穩(wěn)定。

    對(duì)于本文提出的雙足機(jī)器人系統(tǒng),存在一個(gè)不動(dòng)φ*=(0.000 3,1.090 8,1.147 6,-1.058 8,0.000 6,0.010 5)T,對(duì)不動(dòng)點(diǎn)施加一個(gè)大小為1 × 10-3的小擾動(dòng),則雅可比矩陣為:

    計(jì)算特征值為:-0.050 7+0.000 0i;-0.000 2+0.0000i;0.482 9+0.427 5i;0.482 9-0.427 5i;0.347 1;0.0042。

    其最大特征值的模為0.644 9<1,因此不動(dòng)點(diǎn)φ*是穩(wěn)定的,該系統(tǒng)是軌道穩(wěn)定的。

    4.2.2 極限環(huán)

    圖9 給出了雙足機(jī)器人以穩(wěn)定的周期步態(tài)行走足夠長(zhǎng)的時(shí)間后的相位軌跡。由于機(jī)器人雙腿步態(tài)的對(duì)稱(chēng)性,雙腿交替為支撐腿與擺動(dòng)腿,因此只畫(huà)出了從左腿以原長(zhǎng)觸地瞬間到右腿以原長(zhǎng)觸地瞬間的極限環(huán)。在極限環(huán)之外,本文用小棍圖來(lái)表示雙足機(jī)器人行走的步態(tài),腳末端的黑點(diǎn)表示腿與地面接觸。相位軌跡的循環(huán)方向用箭頭表示。

    階段Ⅰ:A點(diǎn)到B點(diǎn)(DS階段)。

    如圖9(a)所示,從標(biāo)記為A 的瞬間,即機(jī)器人單雙支撐切換瞬間開(kāi)始行走,(也就是左腿以原長(zhǎng)剛接觸地面變?yōu)橹瓮葧r(shí)刻),此時(shí)機(jī)器人處于DS 狀態(tài)。A 點(diǎn)位于龐加萊截面上,因此髖關(guān)節(jié)質(zhì)點(diǎn)的水平速度==1.147 6 m/s。由于系統(tǒng)有足夠的能量,它將繼續(xù)向前移動(dòng),伸展左腿,直到達(dá)到其原長(zhǎng)度(點(diǎn)B)。

    圖9 系統(tǒng)的相位軌跡Fig.9 Phase trajectories of system

    階段Ⅱ:B點(diǎn)到C點(diǎn)(SS階段)。

    在B 點(diǎn)瞬間,左腿失去與地面的接觸,以原長(zhǎng)向前擺動(dòng),機(jī)器人從DS 階段切換到右腿SS 階段。可見(jiàn)B 點(diǎn)也在龐加萊截面上,因此髖關(guān)節(jié)質(zhì)點(diǎn)的水平速度=1.147 6 m/s。當(dāng)機(jī)器人到達(dá)C 點(diǎn)時(shí),右腿垂直站立,左腿處于擺動(dòng)階段。

    階段Ⅲ:C點(diǎn)到D點(diǎn)(SS階段)。

    在C 點(diǎn),機(jī)器人系統(tǒng)處于VLO 狀態(tài)。為保證步態(tài)對(duì)稱(chēng),髖關(guān)節(jié)質(zhì)點(diǎn)的垂直速度=0 m/s。右腿保持與地面接觸,左腿繼續(xù)向前擺動(dòng)。當(dāng)機(jī)器人到達(dá)D 點(diǎn)時(shí),左腿以其原長(zhǎng)度接觸地面,雙足機(jī)器人從右腿SS 階段切換到DS 階段。然后兩條腿互換角色,相位軌跡回到下一個(gè)行走階段的A 點(diǎn)(實(shí)際上,A 點(diǎn)和D 點(diǎn)是同一點(diǎn))。

    圖9(b)為三維相位軌跡,可以更直觀地看出,隨著機(jī)器人按照x軸方向的行走,極限環(huán)依次螺旋上升,系統(tǒng)狀態(tài)變量已形成穩(wěn)定的極限環(huán),雙足機(jī)器人處于穩(wěn)定運(yùn)行狀態(tài)。

    從特征值的計(jì)算及圖9 的相軌跡可以看出,雖然在單支撐階段采用了部分反饋線性化控制方法,但是雅可比矩陣的特征值均位于單位圓內(nèi),形成穩(wěn)定的極限環(huán),證明系統(tǒng)是軌道穩(wěn)定的。

    4.3 擾動(dòng)抑制性能

    為了驗(yàn)證控制策略在擾動(dòng)下的有效性,在x=3.692 m處,施加Fd=[Fx,F(xiàn)y]T=(10,20)TN 的擾動(dòng),持續(xù)0.644 3 m,結(jié)果如圖10 所示。

    在圖10 中,虛線表示對(duì)系統(tǒng)施加擾動(dòng)的瞬間。可以看出,系統(tǒng)在擾動(dòng)下能夠保持穩(wěn)定的步態(tài),經(jīng)過(guò)一個(gè)短暫的過(guò)渡階段后,系統(tǒng)恢復(fù)到穩(wěn)定的周期步態(tài)。對(duì)于髖關(guān)節(jié)高度y,由于采用的是變腿長(zhǎng)度控制,機(jī)器人在受到擾動(dòng)時(shí),控制器控制伸縮腿,使系統(tǒng)能保持在原有的期望軌跡上;對(duì)于前進(jìn)速度x˙和軀干α,大約在2 步內(nèi)收斂到期望軌跡;對(duì)于擺動(dòng)腿夾角β,大約在4 步內(nèi)收斂到期望軌跡。總體上來(lái)看,機(jī)器人能夠抵抗外部擾動(dòng),繼續(xù)平穩(wěn)地行走。

    圖10 系統(tǒng)受到擾動(dòng)后的響應(yīng)Fig.10 Response of system after disturbance

    為了進(jìn)一步研究變長(zhǎng)度控制器的性能,對(duì)機(jī)器人施加不同的干擾,通過(guò)重復(fù)性實(shí)驗(yàn)研究其擾動(dòng)抑制區(qū)域??紤]到實(shí)際情況,干擾力限制在±100 N 內(nèi)。結(jié)果如圖11 所示。深灰色區(qū)域?yàn)闊o(wú)變長(zhǎng)度情況下的抗干擾區(qū)域,淺灰色區(qū)域?yàn)樽冮L(zhǎng)度情況下的抗干擾區(qū)域。對(duì)于圖11(a),當(dāng)機(jī)器人處于SS 階段時(shí),在3.692 m 處施加擾動(dòng);對(duì)于圖11(b),當(dāng)機(jī)器人處于DS 階段時(shí),在5.996 m 處施加擾動(dòng)??傻贸?,系統(tǒng)處于DS 階段的抗干擾性能優(yōu)于SS 階段,這是因?yàn)橄到y(tǒng)在SS 階段為欠驅(qū)動(dòng),在DS 階段為全驅(qū)動(dòng)??傮w而言,該控制方法對(duì)擾動(dòng)具有較好的魯棒性。

    圖11 系統(tǒng)對(duì)不同擾動(dòng)力的響應(yīng)Fig.11 Response of system to different disturbance force

    5 結(jié)語(yǔ)

    本文提出了VL-TSLIP-SL 模型,該模型由一個(gè)髖關(guān)節(jié)質(zhì)點(diǎn)、一個(gè)剛性軀干和兩條柔性腿組成,每條腿的末端都有一個(gè)腳質(zhì)量。本模型包含了軀干姿勢(shì)控制和擺動(dòng)腿動(dòng)力學(xué)。利用拉格朗日第二方程構(gòu)造機(jī)器人的動(dòng)力學(xué)方程,通過(guò)控制雙腿長(zhǎng)度,控制機(jī)器人的實(shí)際步態(tài)軌跡逐漸收斂到期望步態(tài)軌跡。由于系統(tǒng)的高耦合和非線性特點(diǎn),采用反饋線性化的方法將非線性系統(tǒng)轉(zhuǎn)換為線性系統(tǒng),實(shí)現(xiàn)機(jī)器人的步態(tài)漸近穩(wěn)定。利用Newton-Raphson 迭代法結(jié)合龐加萊映射分析可知,雙足機(jī)器人周期軌道的穩(wěn)定性等價(jià)于龐加萊映射不動(dòng)點(diǎn)的穩(wěn)定性。最后,通過(guò)數(shù)值仿真驗(yàn)證了其軌道穩(wěn)定性和抗干擾性能。未來(lái)的工作將進(jìn)一步研究機(jī)器人的參數(shù)對(duì)穩(wěn)定性的影響。此外,在本文理論研究的基礎(chǔ)上進(jìn)行實(shí)際樣機(jī)的驗(yàn)證是需要進(jìn)一步研究的課題。

    猜你喜歡
    龐加萊步態(tài)擾動(dòng)
    小螞蟻與“三角步態(tài)”
    Bernoulli泛函上典則酉對(duì)合的擾動(dòng)
    龐加萊偵察術(shù)
    中外文摘(2022年7期)2022-05-17 09:36:42
    龐加萊偵察術(shù)
    青年文摘(2021年20期)2021-12-11 18:45:12
    龐加萊偵查術(shù)
    (h)性質(zhì)及其擾動(dòng)
    基于面部和步態(tài)識(shí)別的兒童走失尋回系統(tǒng)
    電子制作(2018年18期)2018-11-14 01:48:04
    基于Kinect的學(xué)步期幼兒自然步態(tài)提取
    小噪聲擾動(dòng)的二維擴(kuò)散的極大似然估計(jì)
    用于光伏MPPT中的模糊控制占空比擾動(dòng)法
    欧美久久黑人一区二区| 精品第一国产精品| 女生性感内裤真人,穿戴方法视频| 精品福利观看| 国产精品一区二区在线不卡| 国产午夜精品久久久久久| 国产精品综合久久久久久久免费 | 国产aⅴ精品一区二区三区波| 成人免费观看视频高清| 久久 成人 亚洲| 热99re8久久精品国产| 久久婷婷人人爽人人干人人爱 | 日韩中文字幕欧美一区二区| 国产国语露脸激情在线看| 免费av毛片视频| 欧美精品啪啪一区二区三区| 自拍欧美九色日韩亚洲蝌蚪91| 国产成人精品无人区| 亚洲电影在线观看av| 午夜久久久在线观看| 亚洲七黄色美女视频| 午夜免费观看网址| 午夜激情av网站| 国产区一区二久久| 亚洲aⅴ乱码一区二区在线播放 | 日本 av在线| 一本综合久久免费| 美女 人体艺术 gogo| 国产三级黄色录像| 少妇粗大呻吟视频| 亚洲国产欧美网| 校园春色视频在线观看| 久久精品成人免费网站| 色综合亚洲欧美另类图片| 欧美激情久久久久久爽电影 | 国产精品99久久99久久久不卡| 欧美另类亚洲清纯唯美| 在线免费观看的www视频| 一区二区三区激情视频| 欧美日本视频| 在线播放国产精品三级| 这个男人来自地球电影免费观看| 国产精品免费一区二区三区在线| 女人被躁到高潮嗷嗷叫费观| 女人爽到高潮嗷嗷叫在线视频| 美女高潮到喷水免费观看| 精品第一国产精品| 最新在线观看一区二区三区| 免费观看人在逋| 午夜免费观看网址| 国产成人欧美| 亚洲专区字幕在线| 国产成人av激情在线播放| 热99re8久久精品国产| 人成视频在线观看免费观看| 天堂动漫精品| 亚洲成人精品中文字幕电影| 日本黄色视频三级网站网址| 看免费av毛片| aaaaa片日本免费| 老鸭窝网址在线观看| 女生性感内裤真人,穿戴方法视频| 巨乳人妻的诱惑在线观看| 亚洲三区欧美一区| 亚洲在线自拍视频| 视频在线观看一区二区三区| 午夜福利免费观看在线| 日韩欧美一区二区三区在线观看| 国产欧美日韩一区二区三区在线| 国产亚洲精品av在线| 多毛熟女@视频| 国产欧美日韩综合在线一区二区| 高清毛片免费观看视频网站| 国产欧美日韩精品亚洲av| 神马国产精品三级电影在线观看 | 丝袜在线中文字幕| 最近最新中文字幕大全电影3 | 国产男靠女视频免费网站| 亚洲电影在线观看av| 国产成人精品久久二区二区免费| av片东京热男人的天堂| 老鸭窝网址在线观看| 性色av乱码一区二区三区2| 男女下面进入的视频免费午夜 | 真人一进一出gif抽搐免费| 一夜夜www| 国产精品久久久av美女十八| 亚洲精品一卡2卡三卡4卡5卡| 黑人操中国人逼视频| 伦理电影免费视频| 日韩有码中文字幕| 黄频高清免费视频| www.999成人在线观看| 91成人精品电影| 一区福利在线观看| 美女大奶头视频| 在线观看www视频免费| 在线十欧美十亚洲十日本专区| 欧美久久黑人一区二区| 国产熟女午夜一区二区三区| 国产成人精品无人区| 国产精品久久久人人做人人爽| 身体一侧抽搐| 又黄又爽又免费观看的视频| 精品国内亚洲2022精品成人| 亚洲人成伊人成综合网2020| 国产一区二区激情短视频| 日韩 欧美 亚洲 中文字幕| 国产高清视频在线播放一区| 91在线观看av| 亚洲欧美日韩高清在线视频| 中出人妻视频一区二区| 久久香蕉激情| 电影成人av| 精品国产亚洲在线| 国产激情久久老熟女| 十八禁人妻一区二区| 狠狠狠狠99中文字幕| 午夜福利,免费看| 97碰自拍视频| 国产亚洲av高清不卡| 久久精品亚洲熟妇少妇任你| 麻豆一二三区av精品| 精品欧美一区二区三区在线| 制服诱惑二区| av视频在线观看入口| 国产黄a三级三级三级人| 在线视频色国产色| 国产主播在线观看一区二区| 在线观看免费视频日本深夜| 成人国产综合亚洲| 亚洲最大成人中文| 香蕉久久夜色| 9191精品国产免费久久| 黄片播放在线免费| 最新美女视频免费是黄的| 国产激情久久老熟女| 老司机午夜十八禁免费视频| 两性夫妻黄色片| 十八禁人妻一区二区| 丝袜美腿诱惑在线| 国产精品九九99| 午夜免费观看网址| 在线观看一区二区三区| 男女午夜视频在线观看| 亚洲精品国产区一区二| 一级a爱片免费观看的视频| 国产精品影院久久| 午夜两性在线视频| 免费搜索国产男女视频| 亚洲一区中文字幕在线| 久久精品国产亚洲av高清一级| 欧美精品啪啪一区二区三区| 日本在线视频免费播放| 亚洲欧美精品综合久久99| 亚洲成a人片在线一区二区| 99香蕉大伊视频| 一本久久中文字幕| 国产高清有码在线观看视频 | 两个人免费观看高清视频| 精品久久久久久,| 他把我摸到了高潮在线观看| 天天躁狠狠躁夜夜躁狠狠躁| 黄色 视频免费看| 变态另类成人亚洲欧美熟女 | 宅男免费午夜| 亚洲片人在线观看| 男女下面进入的视频免费午夜 | 精品午夜福利视频在线观看一区| 亚洲人成伊人成综合网2020| 久久久国产成人免费| 麻豆av在线久日| 国产色视频综合| 久久久久国内视频| 大型av网站在线播放| 人成视频在线观看免费观看| 免费观看人在逋| 男女下面插进去视频免费观看| 久久久精品欧美日韩精品| 亚洲精品国产精品久久久不卡| 男女床上黄色一级片免费看| 日韩欧美一区二区三区在线观看| 中文字幕人成人乱码亚洲影| 村上凉子中文字幕在线| 免费看a级黄色片| 婷婷精品国产亚洲av在线| 天天躁夜夜躁狠狠躁躁| 亚洲国产欧美日韩在线播放| 亚洲专区中文字幕在线| 亚洲专区中文字幕在线| 日本免费一区二区三区高清不卡 | 国产精品av久久久久免费| 国产午夜精品久久久久久| 国产精品二区激情视频| 久久精品影院6| 欧美老熟妇乱子伦牲交| 精品乱码久久久久久99久播| 免费在线观看视频国产中文字幕亚洲| 国产av又大| 男人操女人黄网站| 69精品国产乱码久久久| bbb黄色大片| 日韩一卡2卡3卡4卡2021年| 国产成人欧美在线观看| 欧美另类亚洲清纯唯美| 日韩欧美国产在线观看| 91老司机精品| 高潮久久久久久久久久久不卡| 中文字幕av电影在线播放| 在线国产一区二区在线| 欧美绝顶高潮抽搐喷水| 亚洲午夜理论影院| 亚洲av成人一区二区三| 成人国产综合亚洲| 亚洲精品一卡2卡三卡4卡5卡| 一进一出抽搐gif免费好疼| 午夜福利高清视频| 97人妻精品一区二区三区麻豆 | 桃色一区二区三区在线观看| 大码成人一级视频| 欧美中文综合在线视频| 中文字幕最新亚洲高清| 麻豆一二三区av精品| 精品国产国语对白av| 老司机深夜福利视频在线观看| 精品福利观看| 亚洲三区欧美一区| 日韩精品青青久久久久久| 亚洲少妇的诱惑av| 亚洲国产毛片av蜜桃av| 美女大奶头视频| 亚洲激情在线av| 变态另类丝袜制服| 可以在线观看的亚洲视频| 丰满人妻熟妇乱又伦精品不卡| 精品福利观看| 亚洲,欧美精品.| 一级片免费观看大全| 日本在线视频免费播放| 国产视频一区二区在线看| 久热这里只有精品99| 久久午夜亚洲精品久久| 精品久久久久久成人av| 国产熟女xx| 黑人巨大精品欧美一区二区蜜桃| 久久天堂一区二区三区四区| 亚洲国产欧美一区二区综合| 在线观看免费午夜福利视频| 91大片在线观看| 777久久人妻少妇嫩草av网站| 伊人久久大香线蕉亚洲五| 日韩欧美三级三区| av视频在线观看入口| 后天国语完整版免费观看| 日本在线视频免费播放| 无限看片的www在线观看| 午夜福利高清视频| 亚洲av美国av| 亚洲国产欧美一区二区综合| 欧美一级毛片孕妇| 99国产精品99久久久久| 在线观看www视频免费| 国产精品香港三级国产av潘金莲| 久久中文字幕人妻熟女| 99精品久久久久人妻精品| 国产人伦9x9x在线观看| 一边摸一边抽搐一进一出视频| 午夜免费成人在线视频| 琪琪午夜伦伦电影理论片6080| 青草久久国产| 久久久久精品国产欧美久久久| 欧美国产精品va在线观看不卡| 波多野结衣高清无吗| 久久精品影院6| 久久性视频一级片| 在线av久久热| 国产在线精品亚洲第一网站| 日日爽夜夜爽网站| 又黄又爽又免费观看的视频| 波多野结衣高清无吗| 日韩欧美一区二区三区在线观看| 亚洲成av片中文字幕在线观看| 18美女黄网站色大片免费观看| 97超级碰碰碰精品色视频在线观看| √禁漫天堂资源中文www| 可以在线观看毛片的网站| 9热在线视频观看99| 欧美一区二区精品小视频在线| 久久精品国产亚洲av香蕉五月| АⅤ资源中文在线天堂| 热re99久久国产66热| 男人的好看免费观看在线视频 | 日韩一卡2卡3卡4卡2021年| 首页视频小说图片口味搜索| 午夜久久久久精精品| 真人做人爱边吃奶动态| 一边摸一边做爽爽视频免费| 欧美+亚洲+日韩+国产| 黄色视频不卡| 午夜福利视频1000在线观看 | 国产精品99久久99久久久不卡| 亚洲少妇的诱惑av| 成人亚洲精品一区在线观看| 国产熟女午夜一区二区三区| 精品久久久久久久久久免费视频| 国产成人欧美| 变态另类丝袜制服| 69精品国产乱码久久久| 人妻丰满熟妇av一区二区三区| 精品国产亚洲在线| 国产精品,欧美在线| 久久精品成人免费网站| 多毛熟女@视频| 岛国在线观看网站| 亚洲片人在线观看| 国产成人影院久久av| 久久人妻av系列| 亚洲午夜精品一区,二区,三区| 日本欧美视频一区| 免费看美女性在线毛片视频| 亚洲成a人片在线一区二区| 国产精品亚洲美女久久久| 婷婷精品国产亚洲av在线| 免费高清在线观看日韩| 国产成人av教育| 国产成人免费无遮挡视频| 亚洲国产欧美日韩在线播放| 天堂√8在线中文| 欧美人与性动交α欧美精品济南到| 啦啦啦观看免费观看视频高清 | 制服丝袜大香蕉在线| 精品一区二区三区四区五区乱码| 看黄色毛片网站| 纯流量卡能插随身wifi吗| 亚洲久久久国产精品| 夜夜爽天天搞| 久久久国产成人精品二区| 欧美乱色亚洲激情| 女人高潮潮喷娇喘18禁视频| 俄罗斯特黄特色一大片| 国产成人欧美在线观看| 岛国在线观看网站| 男人舔女人下体高潮全视频| 久久久久久久精品吃奶| 午夜成年电影在线免费观看| 九色亚洲精品在线播放| 国产精品久久久人人做人人爽| 麻豆av在线久日| 制服人妻中文乱码| 999久久久精品免费观看国产| 日本精品一区二区三区蜜桃| 久久香蕉激情| 91精品国产国语对白视频| 久久欧美精品欧美久久欧美| 国产一区二区三区在线臀色熟女| aaaaa片日本免费| 99久久99久久久精品蜜桃| 91成人精品电影| 久久中文字幕一级| 婷婷丁香在线五月| 97人妻天天添夜夜摸| 亚洲第一青青草原| 十八禁人妻一区二区| 一级毛片女人18水好多| 亚洲 国产 在线| 亚洲av日韩精品久久久久久密| 日本一区二区免费在线视频| 亚洲av片天天在线观看| 亚洲美女黄片视频| 人人妻人人爽人人添夜夜欢视频| 一级,二级,三级黄色视频| 中文字幕最新亚洲高清| 日韩中文字幕欧美一区二区| 亚洲av成人av| 极品人妻少妇av视频| www日本在线高清视频| 欧美午夜高清在线| 欧美成狂野欧美在线观看| 欧美最黄视频在线播放免费| 国产av在哪里看| 男女之事视频高清在线观看| 亚洲国产精品久久男人天堂| 亚洲熟女毛片儿| 91精品三级在线观看| 国产极品粉嫩免费观看在线| 精品久久久精品久久久| 男女做爰动态图高潮gif福利片 | aaaaa片日本免费| 天天一区二区日本电影三级 | 欧美色欧美亚洲另类二区 | or卡值多少钱| 色av中文字幕| 国产午夜福利久久久久久| 久久精品人人爽人人爽视色| 性欧美人与动物交配| 黄色成人免费大全| 一二三四社区在线视频社区8| 免费在线观看亚洲国产| netflix在线观看网站| 精品国产一区二区三区四区第35| 欧美黑人欧美精品刺激| 给我免费播放毛片高清在线观看| 精品无人区乱码1区二区| 丰满人妻熟妇乱又伦精品不卡| 精品国产亚洲在线| 老汉色av国产亚洲站长工具| 99香蕉大伊视频| 欧美日本视频| 国产一区在线观看成人免费| 亚洲精品久久国产高清桃花| 亚洲情色 制服丝袜| 久久久久久免费高清国产稀缺| 国产一卡二卡三卡精品| 禁无遮挡网站| 精品国产国语对白av| 日韩成人在线观看一区二区三区| 亚洲精品中文字幕一二三四区| 亚洲国产中文字幕在线视频| 亚洲精品在线美女| 国产午夜精品久久久久久| 欧美色欧美亚洲另类二区 | 一区二区三区精品91| 黄色a级毛片大全视频| 国产av在哪里看| 国产精品精品国产色婷婷| 亚洲男人的天堂狠狠| 999久久久精品免费观看国产| 叶爱在线成人免费视频播放| 色尼玛亚洲综合影院| 午夜福利高清视频| 亚洲av熟女| 黄色a级毛片大全视频| 亚洲伊人色综图| 久久精品91无色码中文字幕| 中文字幕av电影在线播放| 美女免费视频网站| 给我免费播放毛片高清在线观看| 精品卡一卡二卡四卡免费| 黄色女人牲交| 国产极品粉嫩免费观看在线| 色老头精品视频在线观看| 亚洲av成人av| 人妻久久中文字幕网| 老司机靠b影院| 亚洲七黄色美女视频| 50天的宝宝边吃奶边哭怎么回事| 色在线成人网| 欧美乱妇无乱码| 成年版毛片免费区| 欧美日本中文国产一区发布| 99久久综合精品五月天人人| 日韩中文字幕欧美一区二区| 91成年电影在线观看| 色尼玛亚洲综合影院| 久久久久亚洲av毛片大全| 精品欧美一区二区三区在线| 日日摸夜夜添夜夜添小说| 欧美在线黄色| 99精品久久久久人妻精品| 又黄又爽又免费观看的视频| 99精品欧美一区二区三区四区| www国产在线视频色| 国产一级毛片七仙女欲春2 | 亚洲av成人av| 色av中文字幕| 日韩欧美国产一区二区入口| 亚洲国产精品成人综合色| 看片在线看免费视频| 国产精品久久久久久精品电影 | 亚洲成av人片免费观看| 国产亚洲精品av在线| 岛国视频午夜一区免费看| 大码成人一级视频| 午夜福利高清视频| 视频在线观看一区二区三区| 精品久久久久久久人妻蜜臀av | 淫秽高清视频在线观看| 亚洲精品国产一区二区精华液| 999久久久国产精品视频| 国产成人精品无人区| 久久 成人 亚洲| 亚洲国产精品sss在线观看| av福利片在线| 老司机在亚洲福利影院| 亚洲熟妇熟女久久| 欧美黄色淫秽网站| 久久久久国产精品人妻aⅴ院| 日韩欧美三级三区| 亚洲免费av在线视频| 亚洲三区欧美一区| 叶爱在线成人免费视频播放| 国产激情欧美一区二区| 男人舔女人下体高潮全视频| 亚洲色图 男人天堂 中文字幕| 日韩欧美三级三区| 精品一区二区三区av网在线观看| 国产成人欧美| 51午夜福利影视在线观看| 高潮久久久久久久久久久不卡| 亚洲国产精品999在线| 成人手机av| 色婷婷久久久亚洲欧美| 黄色视频不卡| 丰满人妻熟妇乱又伦精品不卡| 大型黄色视频在线免费观看| 夜夜爽天天搞| 日日摸夜夜添夜夜添小说| 中文字幕人成人乱码亚洲影| 别揉我奶头~嗯~啊~动态视频| 成人国产综合亚洲| 亚洲无线在线观看| 久久人妻av系列| 精品国产一区二区三区四区第35| 麻豆国产av国片精品| 免费在线观看视频国产中文字幕亚洲| 免费高清视频大片| 国产区一区二久久| 黄色 视频免费看| 母亲3免费完整高清在线观看| 丝袜美足系列| 深夜精品福利| 老司机福利观看| 老熟妇仑乱视频hdxx| 老鸭窝网址在线观看| 亚洲 欧美一区二区三区| 久久婷婷人人爽人人干人人爱 | 老司机在亚洲福利影院| 天天添夜夜摸| 欧美最黄视频在线播放免费| 欧美老熟妇乱子伦牲交| www国产在线视频色| 欧美一区二区精品小视频在线| 色播亚洲综合网| 99久久99久久久精品蜜桃| 免费高清视频大片| 色尼玛亚洲综合影院| 亚洲少妇的诱惑av| 国产欧美日韩一区二区精品| 精品福利观看| 久久中文字幕人妻熟女| 久久国产精品人妻蜜桃| 男女下面进入的视频免费午夜 | 黄色女人牲交| 亚洲精品国产一区二区精华液| 国产精品久久久av美女十八| 国产国语露脸激情在线看| 夜夜看夜夜爽夜夜摸| 亚洲aⅴ乱码一区二区在线播放 | 国产精品一区二区三区四区久久 | 欧美日韩乱码在线| 亚洲 欧美一区二区三区| 亚洲成人国产一区在线观看| 精品午夜福利视频在线观看一区| 久久久久亚洲av毛片大全| 99在线视频只有这里精品首页| 精品不卡国产一区二区三区| 大型av网站在线播放| 9191精品国产免费久久| 亚洲精品粉嫩美女一区| 精品久久久久久久久久免费视频| 99精品欧美一区二区三区四区| 亚洲avbb在线观看| 日韩成人在线观看一区二区三区| 中文字幕人妻熟女乱码| 亚洲三区欧美一区| 久久久久久久精品吃奶| 免费在线观看视频国产中文字幕亚洲| 一个人免费在线观看的高清视频| 可以在线观看毛片的网站| 国产欧美日韩精品亚洲av| xxx96com| 国产精品久久久久久精品电影 | 亚洲人成电影观看| 国产精品国产高清国产av| 久久人妻福利社区极品人妻图片| 热re99久久国产66热| 国产一区二区激情短视频| 国内精品久久久久精免费| 99精品欧美一区二区三区四区| 亚洲精品国产色婷婷电影| 亚洲国产看品久久| 精品欧美一区二区三区在线| 亚洲自拍偷在线| 两人在一起打扑克的视频| 国产精品久久久久久亚洲av鲁大| 国产极品粉嫩免费观看在线| 午夜视频精品福利| 午夜精品久久久久久毛片777| 999精品在线视频| 香蕉国产在线看| 一区二区三区激情视频| 久久久久国内视频| 少妇 在线观看| 色精品久久人妻99蜜桃| 黄色成人免费大全| 国产精品久久视频播放| 国产精品免费视频内射| 1024视频免费在线观看| 久热爱精品视频在线9| 一边摸一边抽搐一进一小说| 日韩精品中文字幕看吧| 高清黄色对白视频在线免费看| 国产精品乱码一区二三区的特点 | 日日夜夜操网爽| 国产黄a三级三级三级人| 亚洲精品av麻豆狂野| 国产精品日韩av在线免费观看 | 精品国产美女av久久久久小说| 日韩欧美在线二视频| 久久精品国产亚洲av香蕉五月| 日本三级黄在线观看| 免费av毛片视频| 国产日韩一区二区三区精品不卡| 精品乱码久久久久久99久播| 人人澡人人妻人|