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

    針對動態(tài)障礙物的7R機(jī)械臂實(shí)時避障方法

    2022-11-08 13:30:58李世龍龔世秋
    關(guān)鍵詞:位形桿件連桿

    趙 京, 李世龍, 龔世秋

    (北京工業(yè)大學(xué)材料與制造學(xué)部, 北京 100124)

    隨著機(jī)器人的應(yīng)用范圍越來越廣,冗余機(jī)械臂憑其在避障、避奇異、避極限、關(guān)節(jié)容錯等方面突出的性能,成為當(dāng)前研究的熱點(diǎn)[1].

    避障路徑規(guī)劃是冗余機(jī)械臂控制的基本問題之一[2-3],目前常用的冗余機(jī)械臂動態(tài)避障算法主要為人工勢場法和梯度投影法. 人工勢場法憑借其算法簡單、適應(yīng)動態(tài)障礙以及不需要逆運(yùn)動學(xué)求解的獨(dú)特優(yōu)勢得到廣泛研究[4],針對其算法本身具有局部最小解、目標(biāo)不可達(dá)等問題,已經(jīng)有許多學(xué)者進(jìn)行了相關(guān)的改進(jìn)擴(kuò)展研究,如針對移動式機(jī)械臂的路徑規(guī)劃問題[5],通過修改勢能函數(shù)繞開局部極小點(diǎn)[6]等. 梯度投影法能夠在保證末端位姿約束的前提下,利用零空間矩陣映射將避障速度映射到冗余機(jī)械臂的自運(yùn)動中[7],在避障的同時能夠良好地體現(xiàn)出機(jī)械臂的冗余特性,實(shí)現(xiàn)避障次要任務(wù)[8].

    上述方法在其各自適應(yīng)的領(lǐng)域取得了良好的避障效果,但卻有各自的局限性:梯度投影法,主要用在機(jī)械臂末端有具體的任務(wù)軌跡約束情況下[9],其避障效果常常因自運(yùn)動的較小轉(zhuǎn)動幅度而受到限制[10-11];而改進(jìn)人工勢場法,是以引入額外的計(jì)算項(xiàng)來解決原算法的缺陷[12-13],其在機(jī)械臂的運(yùn)動控制應(yīng)用中主要有2個層面:一種是在笛卡兒空間構(gòu)建引力和斥力,并將合力通過雅可比矩陣轉(zhuǎn)換為對機(jī)械臂的速度控制[14],另一種是基于關(guān)節(jié)鄰近空間搜索的不斷迭代,對當(dāng)前關(guān)節(jié)位形下的所有相鄰位形全部進(jìn)行勢能計(jì)算以篩選最優(yōu)解[15],這2種方法都會隨著機(jī)械臂自由度的增多導(dǎo)致計(jì)算量急劇增大,已無法滿足在動態(tài)障礙物環(huán)境下的實(shí)時需求.

    因此,針對當(dāng)前廣泛采用的七自由度冗余機(jī)械臂,以及無末端軌跡約束的條件下,本文通過分析冗余機(jī)械臂的結(jié)構(gòu)特點(diǎn),提出了具有高實(shí)時性的避障算法,并通過仿真驗(yàn)證了算法的有效性.

    1 避障策略

    1.1 避障基本思路

    目前,在有障礙物環(huán)境下的機(jī)器人的規(guī)劃控制策略有很多種,如通過不同手段以求解運(yùn)動軌跡的A*、RRT等,或是引入新的評判概念以減小計(jì)算量的人工勢場、偽距離等. 但無論控制策略的形式如何多樣化,其關(guān)鍵過程主要分為2個階段:1)達(dá)點(diǎn)過程中與障礙物的靠近與遠(yuǎn)離; 2)即將碰撞時的避障規(guī)劃,如圖1所示.

    圖1 機(jī)械臂避障策略Fig.1 Obstacle avoidance strategy of manipulator

    本文著手于冗余機(jī)械臂在向目標(biāo)達(dá)點(diǎn)運(yùn)動過程中如何快速避開障礙物. 對于冗余機(jī)械臂而言,其末端滿足目標(biāo)位姿的關(guān)節(jié)位形解有無數(shù)種,如何在無數(shù)種解中選擇一種作為目標(biāo)關(guān)節(jié)位形進(jìn)行達(dá)點(diǎn)運(yùn)動,同時如何在運(yùn)動過程中即將靠近障礙物時進(jìn)行避障規(guī)劃,是本文的主要研究內(nèi)容.

    1.2 7R機(jī)械臂模型

    本文以常見的七自由度冗余串聯(lián)正交機(jī)械臂為研究對象,其結(jié)構(gòu)及關(guān)節(jié)配置如圖2所示.

    圖2 7R機(jī)械臂的結(jié)構(gòu)模型Fig.2 Structure model of 7R manipulator

    此類型的七自由度機(jī)械臂可模仿人手臂結(jié)構(gòu)進(jìn)行關(guān)節(jié)布置,θ1、θ2、θ3組合模擬人臂肩關(guān)節(jié)運(yùn)動,θ5、θ6、θ7組合模擬腕關(guān)節(jié)運(yùn)動,中間θ4模擬肘關(guān)節(jié)運(yùn)動. 該構(gòu)型的機(jī)械臂能夠在末端位姿保持不變的同時,其肘部E點(diǎn)可以繞肩部S點(diǎn)與腕部W點(diǎn)的連線進(jìn)行自運(yùn)動,能夠良好地體現(xiàn)出冗余機(jī)械臂的冗余特性,如圖3所示.

    圖3 7R機(jī)械臂自運(yùn)動示意圖Fig.3 Self motion diagram of 7R manipulator

    1.3 達(dá)點(diǎn)階段

    在給定了機(jī)械臂末端需要達(dá)點(diǎn)的目標(biāo)位姿,關(guān)節(jié)空間中存在著無數(shù)組解,這些不同的解的集合即為滿足目標(biāo)位形的自運(yùn)動解集. 如何從解集中求得合適的位形解,就需要從這些解的集合中根據(jù)條件需求進(jìn)行選擇,按相關(guān)指標(biāo)確定合適的肘部自運(yùn)動角,即可得到唯一逆解[16].

    以自運(yùn)動角變量φ為輸入?yún)?shù),即可得到對應(yīng)的關(guān)節(jié)角度逆解集合Q,再根據(jù)目標(biāo)點(diǎn)、障礙物以及機(jī)械臂三者之間的關(guān)系,按設(shè)定指標(biāo)即可快速求出解集中的合適逆解,主體表達(dá)公式為

    Q={q|q=f(R,P,φ),φ∈[0,2π]}

    (1)

    式中:R、P分別為機(jī)械臂末端的姿態(tài)矩陣和位置向量;φ為自運(yùn)動角變量;q為對應(yīng)自運(yùn)動角φ的關(guān)節(jié)逆解向量;Q為對應(yīng)不同自運(yùn)動角的q的集合.

    1.4 避障階段

    當(dāng)障礙物靠近機(jī)械臂連桿時,將最接近障礙物的桿件設(shè)為主要危險桿件,對其進(jìn)行避障引導(dǎo). 根據(jù)串聯(lián)機(jī)械臂的運(yùn)動特性分析,其控制方式有2個特點(diǎn):1)單根連桿的位置和姿態(tài)僅由靠近基座一側(cè)(前側(cè))的多個關(guān)節(jié)進(jìn)行耦合控制,而與靠近機(jī)械臂末端執(zhí)行器一側(cè)(后側(cè))的關(guān)節(jié)無關(guān),若前側(cè)的關(guān)節(jié)不變,無論后側(cè)的關(guān)節(jié)怎么變化,這根連桿的位置和姿態(tài)都不會變化,因此要使最近桿遠(yuǎn)離障礙物僅需對桿件前側(cè)的關(guān)節(jié)進(jìn)行控制即可;2)當(dāng)連桿運(yùn)動形式以靠近基座的上一根連桿為參照物時,可視為以桿長為半徑、兩桿連接點(diǎn)為球心的球體運(yùn)動,如圖4所示.

    圖4 避障的等效控制示意圖Fig.4 Equivalent control schematic of avoidance

    圖4中距障礙物最近桿為L3桿,其相對于L2桿的運(yùn)動由連桿所在的前2個關(guān)節(jié)θ3、θ4進(jìn)行控制,因此通過前2個關(guān)節(jié)即可對最近桿進(jìn)行一定程度的運(yùn)動控制,在求逆解時也具有計(jì)算量低的優(yōu)勢.

    但是,僅靠控制單一桿件避障會有一定的局限性. 仍以圖4所示為例,當(dāng)障礙物較靠近連接點(diǎn)E時,僅對L3桿控制時無法高效地避開障礙物,無論L3桿如何轉(zhuǎn)動,障礙物距連接點(diǎn)E仍較近,因此結(jié)合串聯(lián)機(jī)械臂的控制特點(diǎn),將對L3桿的避障控制退化到前側(cè)的L2桿上,在對最近桿避障控制的同時,也對靠近基座的上一連桿進(jìn)行避障控制,從而使機(jī)械臂有效地避開障礙物.

    2 避障實(shí)施算法

    2.1 障- 桿距離計(jì)算

    機(jī)械臂在執(zhí)行操作任務(wù)過程中,與障礙物的碰撞檢測是進(jìn)行避障規(guī)劃的基礎(chǔ). 目前常用的碰撞檢測采用線段- 球體包絡(luò)盒檢測:將障礙物用球體包絡(luò),同時將機(jī)械臂的桿件用圓柱體包絡(luò). 對于隨機(jī)運(yùn)動的動態(tài)障礙物,保證障礙物位置檢測的效率尤為重要,傳統(tǒng)的在歐式空間的點(diǎn)線距離計(jì)算方法在高維機(jī)械臂運(yùn)動過程中,需要對每根連桿構(gòu)建直線方程,計(jì)算量大,且易引起計(jì)算誤差. 因此本文引入機(jī)械臂連桿之間的坐標(biāo)系轉(zhuǎn)換概念,每根桿件i都有相對于基系的轉(zhuǎn)換矩陣0Ti,將障礙物坐標(biāo)逆向投影到每根連桿的局部坐標(biāo)系iPobs(x,y,z)中,以簡單的矩陣運(yùn)算來快速計(jì)算障礙物與每根桿件的距離,障礙物在連桿i坐標(biāo)系下的坐標(biāo)為

    iPobs=(0Ti)-10Pobs

    (2)

    依據(jù)障礙物與桿件的位置關(guān)系,可知在連桿坐標(biāo)系下的桿障位置情況主要有3種,如圖5所示.

    圖5 障礙物在桿件坐標(biāo)系中的3種位置情況Fig.5 Three positions of obstacles in the rod coordinate

    根據(jù)不同的位置關(guān)系,可快速計(jì)算得到障礙物到桿件i的距離di為

    (3)

    (4)

    式中:Li連桿的桿長;robs、rlink分別為障礙物和桿件的包絡(luò)盒半徑;dmin為障礙物到機(jī)械臂連桿的最小距離. 當(dāng)障礙物靠近連桿L1時,由于此桿件固連于基座,關(guān)節(jié)的轉(zhuǎn)動對于桿障關(guān)系沒有影響,故此情況條件忽略不予探究. 同時可得到連桿i上與障礙物最近點(diǎn)Pn的坐標(biāo).

    2.2 單桿件避障

    在確定與障礙物最接近的連桿后,根據(jù)桿障的幾何位置關(guān)系,對此連桿進(jìn)行避障規(guī)劃.

    如圖6(a)所示,E-W-末端為機(jī)械臂在達(dá)點(diǎn)運(yùn)動過程中的當(dāng)前位形,Et-Wt-目標(biāo)位形的末端為從自運(yùn)動解集中優(yōu)選出的目標(biāo)位形,Pobs為障礙物. 此時桿件已無法由當(dāng)前位形直接運(yùn)動到目標(biāo)位形,本文在最近點(diǎn)處引入2個避障向量vavo與vatt,兩者共同作用引導(dǎo)此桿件避開障礙物,如圖6(b)所示. 圖中Pn為連桿上與障礙物最近點(diǎn),Pt,n為在目標(biāo)位形上的對應(yīng)相同點(diǎn),Pi,1與Pi,2分別為連桿i靠近基座和機(jī)械臂末端的2個端點(diǎn),vavo為垂直躲避分量,其方向垂直于最近點(diǎn)Pn與障礙物Pobs的連線,vatt為吸引分量,沿Pn指向Pt,n,兩者表示為

    圖6 機(jī)械臂與障礙物碰撞圖Fig.6 Collision diagram of robot arm and obstacle

    (5)

    式中vavo的默認(rèn)方向?yàn)橛牲c(diǎn)E、W、Pobs三點(diǎn)構(gòu)成的平面的法線方向,而本文需要其方向?yàn)橹赶蜻h(yuǎn)離障礙物的一側(cè),即在平面的兩側(cè)中與點(diǎn)Pt,n相同的一側(cè),以達(dá)到快速避障并達(dá)點(diǎn)的效果. 因此,對vavo的方向進(jìn)行判別并優(yōu)化,若其方向與點(diǎn)Pt,n在平面不同側(cè),則避障分量vavo的方向取反,若相同則不變.

    (6)

    式(6)得到的是標(biāo)準(zhǔn)單位大小的避障引導(dǎo)分量,還需要根據(jù)當(dāng)前位形、障礙物、目標(biāo)位形三者的位置關(guān)系,實(shí)時調(diào)節(jié)兩分量的大小.

    vs=kθvavo+(1-kθ)vattkθ=(tanh (kθ,1+kθ,2θ)+1)/kθ,3θ=arccos (vPn,Pobsvatt/(‖vPn,Pobs‖‖vatt‖))

    (7)

    式中:θ為向量vPn,Pobs與vatt的夾角;vs為垂直躲避分量和吸引分量的合向量;kθ為與θ相關(guān)的曲線調(diào)節(jié)權(quán)重;kθ,1、kθ,2、kθ,3為相關(guān)調(diào)節(jié)參數(shù).

    如圖7所示,當(dāng)θ<π/2時,障礙物位于當(dāng)前位形和目標(biāo)位形中間,k趨近于1,垂直躲避分量vavo起主要引導(dǎo)作用,引導(dǎo)機(jī)械臂快速避開障礙物;當(dāng)θ逐漸增大至π時,k由1單調(diào)減小至0,分量vatt起主要引導(dǎo)作用,引導(dǎo)機(jī)械臂快速脫離障礙物.

    圖7 等效的機(jī)械臂與障礙物Fig.7 Equivalent manipulator and obstacle

    機(jī)械臂的連桿可視為剛體,桿件上每一點(diǎn)處的運(yùn)動方向都相同,故最近點(diǎn)Pn處的避障向量可以等效為在桿端Pi,2處的方向相同的避障引導(dǎo)向量. 基于式(5)~(9)得到的避障引導(dǎo)總向量vs為單位向量,還需要引入與桿障最小距離dmin相關(guān)的動態(tài)調(diào)節(jié)步長,即

    vLi=kdvskd=(1-tanh (kd,1(dmin-dsafe)+kd,2))/kd,3

    (8)

    式中:vLi為等效的連桿i末端處的避障引導(dǎo)速度;kd為與桿障距離相關(guān)的動態(tài)調(diào)節(jié)步長;kd,1、kd,2、kd,3為相關(guān)調(diào)節(jié)參數(shù);dsafe為桿障距離的安全閾值,當(dāng)dmin>dsafe時,kd=0;當(dāng)dmin逐漸由dsafe減小至0時,kd由0單調(diào)增大至1,避免了在達(dá)點(diǎn)運(yùn)動和避障運(yùn)動兩者間切換時產(chǎn)生的關(guān)節(jié)速度突變,如圖8所示.

    圖8 避障速度權(quán)重的變化趨勢Fig.8 Change trend of weight for avoidance speed

    根據(jù)桿件與關(guān)節(jié)的構(gòu)型關(guān)系分析,桿件i末端的運(yùn)動控制可簡化為上一連桿i-1的2個關(guān)節(jié)驅(qū)動,這種簡化關(guān)系可將單根桿件的運(yùn)動控制視為定長半徑的球坐標(biāo)系控制,如圖9所示.

    圖9 單根連桿的等效控制Fig.9 Equivalent control of single link

    連桿i的桿長可視為球坐標(biāo)系的半徑r,上一連桿i-1的2個關(guān)節(jié)θ2i-1、θ2i可視為球坐標(biāo)系的兩坐標(biāo)分軸θ、φ.在得到連桿i末端處的引導(dǎo)速度后,可求得對應(yīng)的關(guān)節(jié)角變化

    i-1PLi,2=(0Ti-1)-1(0Pi,2+vi)

    (9)

    θ2i=arccos (i-1Pi,2(z)/Li)θ2i-1=arccos (i-1Pi,1(x)/(Lisinθ2i))

    (10)

    式中i-1Pi,2為連桿i末端在上一連桿i-1的局部坐標(biāo)系下的位置投影.

    2.3 多桿聯(lián)合避障

    僅依靠對單根連桿進(jìn)行避障控制在某些桿障位置下有一定的局限性,如圖10所示.

    圖10 單根連桿規(guī)劃的局限情況Fig.10 Limitations of single link planning

    隨著障礙物的位置變化和機(jī)械臂的運(yùn)動,障礙物最近點(diǎn)Pn在連桿i上的位置也不斷變化,當(dāng)其較接近連桿的桿端Pi,1時,盡管避障引導(dǎo)向量vs仍然起效,但連桿需要很大行程的角度才能躲避繞開障礙物,這在實(shí)際的運(yùn)動控制中是不合理的. 因此面對上述情況,根據(jù)所確定的主要危險連桿和次要連桿進(jìn)行聯(lián)合避障規(guī)劃.

    當(dāng)最近點(diǎn)Pn接近連桿的桿端Pi,1時,在保留對連桿i規(guī)劃的同時,將避障引導(dǎo)向量vs退化至上一連桿i-1,對其進(jìn)行避障引導(dǎo),并引入改進(jìn)的Sigmod函數(shù)作為權(quán)重,平滑最近點(diǎn)Pn在Pi,1與Pi,2兩連桿之間運(yùn)動切換時的抖動,表示為

    wd=k1/(1+exp (-k2dPn,Pi,1))-k3

    (11)

    (12)

    式中d為最近點(diǎn)到其所在桿件上一端點(diǎn)的距離,距離越小則當(dāng)前桿件的關(guān)節(jié)避障角度變化的權(quán)重越小,上一桿件的權(quán)重越大. 當(dāng)d大于一半桿長Li/2時,wd趨近于1,此時對主要危險桿i進(jìn)行規(guī)劃引導(dǎo);當(dāng)d小于Li/2并大于0時,wd由1單調(diào)遞減至0,此時同時對主次危險桿i和i-1進(jìn)行避障規(guī)劃;當(dāng)d接近0時,wd=0,此時最近危險桿件已由連桿i轉(zhuǎn)變?yōu)閕-1,則算法將對連桿i-1和i-2進(jìn)行規(guī)劃引導(dǎo).

    2.4 最優(yōu)解選擇

    在避開障礙物后,繼續(xù)向目標(biāo)關(guān)節(jié)位形進(jìn)行達(dá)點(diǎn)運(yùn)動,若此時繼續(xù)以靠近障礙物之前的目標(biāo)位形進(jìn)行達(dá)點(diǎn),可能會出現(xiàn)陷入局部振蕩的現(xiàn)象,原因是障礙物與之前選定的目標(biāo)位形發(fā)生了干涉,即上一步規(guī)劃引導(dǎo)避開了障礙物,下一步進(jìn)行達(dá)點(diǎn)運(yùn)動時又重復(fù)接近障礙物. 因此,在對機(jī)械臂避障引導(dǎo)規(guī)劃完成后,根據(jù)此時障礙物與機(jī)械臂連桿之間的位置關(guān)系,重新在自運(yùn)動解集Q中選擇最優(yōu)目標(biāo)解.

    參考勢場原理,以與當(dāng)前關(guān)節(jié)的行程差值最小和到達(dá)目標(biāo)時與障礙物距離最大為優(yōu)化目的,建立勢場函數(shù)為

    (13)

    Ure=kre/(Pφ,E-Pobs)2

    (14)

    (15)

    式中:θnow為當(dāng)前時刻的關(guān)節(jié)角位形;Ujoi為當(dāng)前位形距自運(yùn)動解集中的不同目標(biāo)位形的關(guān)節(jié)行程勢能函數(shù);kjoi為相關(guān)引力增益參數(shù);Q(φ)n為自運(yùn)動解集中自運(yùn)動角為φ所對應(yīng)的關(guān)節(jié)位形解;Ure為解集中不同目標(biāo)位形下與肘關(guān)節(jié)點(diǎn)E和障礙物之間的距離成反比的排斥勢場函數(shù);kre為相關(guān)斥力增益調(diào)節(jié)參數(shù);Pφ,E為自運(yùn)動角變量為φ時的肘關(guān)節(jié)端點(diǎn)E在基座標(biāo)系下的位置. 可計(jì)算得到與當(dāng)前關(guān)節(jié)位形相距較近,同時又遠(yuǎn)離障礙物的新的最優(yōu)目標(biāo)解θtar.

    算法整體流程圖如圖11所示.

    圖11 算法流程Fig.11 Algorithm flowchart

    3 避障仿真

    為驗(yàn)證本文所提出的避障方法的有效性,本文以KUKA iiwa 14 R820機(jī)械臂模型對算法進(jìn)行了仿真,機(jī)械臂的具體尺寸參數(shù)如表1所示.

    仿真實(shí)驗(yàn)采用CoppeliaSim4.0(CS)與Matlab(M)的跨平臺聯(lián)合仿真,算法單次迭代時由CS提供實(shí)時的目標(biāo)點(diǎn)、障礙物位置以及機(jī)械臂關(guān)節(jié)角信息,將其傳輸給M進(jìn)行實(shí)時計(jì)算避障規(guī)劃,同時將規(guī)劃結(jié)果回傳給CS進(jìn)行仿真驗(yàn)證,為檢驗(yàn)算法的有效性,仿真在靜態(tài)和動態(tài)2種障礙物環(huán)境下分別進(jìn)行.

    表1 7R機(jī)械臂DH參數(shù)

    3.1 靜態(tài)障礙物的避障

    設(shè)定機(jī)械臂初始為零位形,待達(dá)點(diǎn)的末端目標(biāo)位置和姿態(tài)歐拉角為

    Pt,1=[-160 mm,850 mm,750 mm]TPt,2=[-115°,-10°,80°]T

    連桿和障礙物的參數(shù)

    dsafe=100 mm,robs=rL=50 mmPobs=[350 mm,400 mm,900 mm]T

    避障算法相關(guān)參數(shù)

    [kθ,1,kθ,2,kθ,3]=[6.5,-10/π,2]T[kd,1,kd,2,kd,3]=[30,3,100]T[kjoi,kre]=[150,10]T

    仿真避障過程如圖12所示,可以看出機(jī)械臂末端在運(yùn)動到目標(biāo)位姿的過程中,連桿有效地避開了障礙物. 末端的運(yùn)動軌跡如圖12(f)所示,圖中綠色小球?yàn)槟繕?biāo)點(diǎn),紅色小球?yàn)槌跏键c(diǎn),黑色小球及表面藍(lán)色網(wǎng)格為障礙物以及觸發(fā)避障規(guī)劃的安全邊界.

    圖12 機(jī)械臂靜態(tài)避障的仿真過程Fig.12 Simulation process of static obstacle avoidance

    仿真的數(shù)值結(jié)果如圖13所示,從初始零位形開始達(dá)點(diǎn)運(yùn)動,在1.21 s時刻檢測到接近障礙物,開始避障引導(dǎo)規(guī)劃,如圖12(b)所示;在2.77 s時刻,完全避開障礙物,繼續(xù)向目標(biāo)達(dá)點(diǎn)運(yùn)動,如圖12(d)所示. 機(jī)械臂的連桿L1為基座-E桿,由于此連桿固連于基座,關(guān)節(jié)的轉(zhuǎn)動對于桿障關(guān)系沒有影響,故忽略對于此連桿的距離檢測. 從圖13(a)可看出在機(jī)械臂的運(yùn)動過程中,各連桿始終與障礙物保持在安全距離之外,結(jié)果表明了本文算法在靜態(tài)障礙物環(huán)境中的有效性.

    圖13 靜態(tài)避障仿真結(jié)果Fig.13 Results of static obstacle avoidance simulation

    3.2 正弦動態(tài)障礙物的避障

    保持其他參數(shù)條件不變,將障礙物由靜態(tài)改為動態(tài)正弦運(yùn)動,設(shè)定初始位置和運(yùn)動速度為

    Pobs=[500 mm,400 mm,700 mm]Tvobs=[150 mm/s,100 mm/s,150sin (5t) mm/s]T

    障礙物將以正弦波的形式在機(jī)械臂達(dá)點(diǎn)軌跡上運(yùn)動,隨機(jī)性地多次靠近又遠(yuǎn)離機(jī)械臂,如圖14所示為在動態(tài)障礙物下的仿真過程.

    在每次障礙物靠近機(jī)械臂時,本文算法都有效地使機(jī)械臂避開了障礙物,同時在避障完成后機(jī)械臂末端順利地抵達(dá)了目標(biāo)位姿,完成達(dá)點(diǎn)任務(wù).

    仿真的數(shù)值結(jié)果如圖15所示,從初始零位形開始運(yùn)動,在1.44 s時刻首次檢測到接近障礙物,開始避障引導(dǎo)規(guī)劃,在2.11 s時刻,障礙物遠(yuǎn)離,機(jī)械臂繼續(xù)向目標(biāo)達(dá)點(diǎn)運(yùn)動,在2.64、3.97、5.22 s時刻,多次與障礙物靠近并在之后及時遠(yuǎn)離, 每時刻機(jī)械臂連桿與障礙物都未發(fā)生碰撞,且始終與障礙物保持安全距離,最終實(shí)現(xiàn)了達(dá)點(diǎn)并避障的任務(wù).

    圖14 機(jī)械臂動態(tài)避障的仿真過程Fig.14 Simulation process of dynamic obstacle avoidance

    圖15 動態(tài)避障仿真結(jié)果Fig.15 Simulation results of dynamic obstacle avoidance

    根據(jù)式(2)~(4)計(jì)算,在整個運(yùn)動過程中桿障最小距離為82.27 mm,較好地滿足了機(jī)械臂在達(dá)點(diǎn)運(yùn)動過程中的避障要求,能及時高效地對機(jī)械臂進(jìn)行實(shí)時避障規(guī)劃,提高在動態(tài)環(huán)境中的交互安全性. 為進(jìn)一步驗(yàn)證本文算法的高效性,將本文所提出的實(shí)時避障方法與傳統(tǒng)人工勢場法,在相同的仿真環(huán)境和參數(shù)條件下進(jìn)行計(jì)算性能對比,實(shí)驗(yàn)操作系統(tǒng)為Win10平臺,硬件主要參數(shù)為CPU:AMD Ryzen1600 3.2 GHz, GPU:GTX1060, RAM:32G,實(shí)驗(yàn)結(jié)果求取多次計(jì)算平均值,如表2所示.

    表2 算法性能比較

    從表2中可看出,本文避障規(guī)劃方法的平均單步迭代時間遠(yuǎn)遠(yuǎn)小于傳統(tǒng)算法,主要由于本文算法將整體的避障規(guī)劃轉(zhuǎn)化為僅對2根主次危險桿的引導(dǎo)規(guī)劃,避免了傳統(tǒng)算法隨著機(jī)械臂自由度增多而計(jì)算量成倍增加的問題. 因此本文方法能夠有效地在動態(tài)障礙物環(huán)境下實(shí)現(xiàn)快速避障的任務(wù).

    4 結(jié)論

    1) 根據(jù)桿障的位置關(guān)系,確定主次危險桿件,同時對2根連桿進(jìn)行避障規(guī)劃,并引入改進(jìn)的Sigmod函數(shù)平滑危險桿件切換時的抖動問題,具有明確的解析形式.

    2) 在求解出自運(yùn)動解集的基礎(chǔ)上,構(gòu)建了關(guān)節(jié)行程的引力勢場和桿障安全距離的斥力勢場,在避障完成后從解集中再次選擇最優(yōu)位形解,進(jìn)行達(dá)點(diǎn)運(yùn)動,避免了陷入局部最小解振蕩的問題.

    3) 通過仿真證明了本文方法的有效性和實(shí)時性,能較好地實(shí)現(xiàn)了機(jī)械臂在動態(tài)障礙物環(huán)境下的避障問題,后續(xù)將基于本文算法,研究在有關(guān)節(jié)約束及多障礙物下的避障問題.

    猜你喜歡
    位形桿件連桿
    中間支撐剛度對雙跨梁屈曲穩(wěn)定性的影響
    基于臨時支撐結(jié)構(gòu)的桿件初彎曲對其軸壓性能的影響
    四川建筑(2021年1期)2021-03-31 01:01:46
    某發(fā)動機(jī)連桿螺栓擰緊工藝開發(fā)
    塔式起重機(jī)拼裝式超長附著桿設(shè)計(jì)與應(yīng)用
    基于旋量理論的四自由度抓取機(jī)械手奇異位形分析
    KD379:便攜折疊式衣架
    某網(wǎng)架桿件彎曲的原因分析及處理
    基于可操作度的機(jī)器人最優(yōu)初始位形研究
    大眾科技(2015年11期)2015-11-24 01:57:16
    基于最優(yōu)初始位形的冗余度機(jī)器人可操作度優(yōu)化*
    連桿的運(yùn)動及有限元分析
    在线a可以看的网站| 十八禁国产超污无遮挡网站| a在线观看视频网站| 一个人免费在线观看电影| 免费av毛片视频| 黄片wwwwww| 日本免费一区二区三区高清不卡| 国产视频一区二区在线看| 欧美潮喷喷水| 美女大奶头视频| 成年女人看的毛片在线观看| 国产毛片a区久久久久| 中文字幕人妻熟人妻熟丝袜美| 最近在线观看免费完整版| 国产男人的电影天堂91| 一a级毛片在线观看| 不卡一级毛片| 91狼人影院| 国产精品野战在线观看| 夜夜夜夜夜久久久久| 最近视频中文字幕2019在线8| 少妇被粗大猛烈的视频| 熟女电影av网| 国产探花在线观看一区二区| 成年女人毛片免费观看观看9| 一个人免费在线观看电影| 少妇被粗大猛烈的视频| 亚洲中文日韩欧美视频| 1024手机看黄色片| www.www免费av| 舔av片在线| 少妇被粗大猛烈的视频| 免费av不卡在线播放| 国产精品一区二区免费欧美| 好男人在线观看高清免费视频| 男女视频在线观看网站免费| 国产黄a三级三级三级人| 美女高潮喷水抽搐中文字幕| 亚洲熟妇熟女久久| 婷婷色综合大香蕉| 欧美日韩黄片免| 国内少妇人妻偷人精品xxx网站| 熟女电影av网| 日韩欧美 国产精品| 一a级毛片在线观看| 国产精品爽爽va在线观看网站| 亚洲欧美日韩无卡精品| 国产 一区精品| 一区二区三区高清视频在线| 欧美+亚洲+日韩+国产| 精品人妻视频免费看| www日本黄色视频网| 日本五十路高清| 亚洲国产精品sss在线观看| 99国产极品粉嫩在线观看| 亚洲精华国产精华液的使用体验 | 国产男靠女视频免费网站| 婷婷色综合大香蕉| 久久久久久久久久黄片| 久久精品综合一区二区三区| 深爱激情五月婷婷| 免费人成视频x8x8入口观看| 美女cb高潮喷水在线观看| 美女高潮的动态| 精品国内亚洲2022精品成人| 欧美日本亚洲视频在线播放| 有码 亚洲区| 亚洲精品影视一区二区三区av| 麻豆av噜噜一区二区三区| 91狼人影院| 日韩欧美 国产精品| 国产91精品成人一区二区三区| 午夜免费激情av| 国产精品一区二区免费欧美| 身体一侧抽搐| a级毛片免费高清观看在线播放| 国产麻豆成人av免费视频| 中文字幕高清在线视频| 亚洲成人精品中文字幕电影| 免费人成视频x8x8入口观看| 九色国产91popny在线| 动漫黄色视频在线观看| 狂野欧美激情性xxxx在线观看| 很黄的视频免费| 中文字幕高清在线视频| 在线观看一区二区三区| 国产成人影院久久av| 日韩欧美在线二视频| 变态另类成人亚洲欧美熟女| 久久精品国产亚洲av香蕉五月| 久久久久久久精品吃奶| 久久久久久久亚洲中文字幕| 成人毛片a级毛片在线播放| 国产黄a三级三级三级人| 三级毛片av免费| 亚洲成av人片在线播放无| 村上凉子中文字幕在线| 亚洲精品久久国产高清桃花| 尤物成人国产欧美一区二区三区| 亚洲成人久久性| 琪琪午夜伦伦电影理论片6080| 美女 人体艺术 gogo| 可以在线观看毛片的网站| 两个人的视频大全免费| 国产一区二区激情短视频| 很黄的视频免费| 伊人久久精品亚洲午夜| 草草在线视频免费看| 日韩欧美精品免费久久| 人人妻人人看人人澡| 国产三级在线视频| videossex国产| 亚洲在线观看片| 又粗又爽又猛毛片免费看| 深爱激情五月婷婷| 国产大屁股一区二区在线视频| 亚洲中文字幕一区二区三区有码在线看| 在线看三级毛片| 成人高潮视频无遮挡免费网站| 日韩精品有码人妻一区| 成人性生交大片免费视频hd| 亚洲va日本ⅴa欧美va伊人久久| 热99在线观看视频| 俺也久久电影网| 欧美最黄视频在线播放免费| 日韩精品青青久久久久久| 欧美一区二区亚洲| 老师上课跳d突然被开到最大视频| 看免费成人av毛片| 波多野结衣高清作品| 乱系列少妇在线播放| 亚洲无线观看免费| 免费电影在线观看免费观看| 99热这里只有是精品在线观看| 99久久精品一区二区三区| 欧美区成人在线视频| 久久中文看片网| 亚洲国产色片| 少妇高潮的动态图| 99热只有精品国产| 成人二区视频| 三级男女做爰猛烈吃奶摸视频| 亚洲av美国av| 免费看av在线观看网站| 久久精品91蜜桃| 成人特级av手机在线观看| 免费看日本二区| 一级黄色大片毛片| 日韩精品青青久久久久久| 亚洲七黄色美女视频| 国产在视频线在精品| ponron亚洲| 一个人免费在线观看电影| 黄色丝袜av网址大全| 亚洲一区二区三区色噜噜| 亚洲最大成人av| 又爽又黄无遮挡网站| 中国美白少妇内射xxxbb| 老师上课跳d突然被开到最大视频| 亚洲人成伊人成综合网2020| 观看免费一级毛片| 内射极品少妇av片p| 日本黄大片高清| 五月伊人婷婷丁香| 俄罗斯特黄特色一大片| 亚洲成人久久爱视频| 天堂网av新在线| 免费av不卡在线播放| 色噜噜av男人的天堂激情| 国内毛片毛片毛片毛片毛片| 国产麻豆成人av免费视频| 99热精品在线国产| 国产午夜福利久久久久久| 国产91精品成人一区二区三区| 精品人妻熟女av久视频| 成年版毛片免费区| 淫秽高清视频在线观看| 久久人妻av系列| av中文乱码字幕在线| 免费搜索国产男女视频| netflix在线观看网站| 黄色女人牲交| 久久久国产成人精品二区| 国产视频一区二区在线看| 露出奶头的视频| 亚洲久久久久久中文字幕| 欧美日韩黄片免| 99九九线精品视频在线观看视频| 亚洲天堂国产精品一区在线| 日本色播在线视频| 久久久久久大精品| 国产成人福利小说| 久久香蕉精品热| 成人av一区二区三区在线看| 精品人妻视频免费看| 乱人视频在线观看| aaaaa片日本免费| 午夜视频国产福利| 日韩精品青青久久久久久| 琪琪午夜伦伦电影理论片6080| 别揉我奶头~嗯~啊~动态视频| 啦啦啦观看免费观看视频高清| 亚洲人成网站在线播放欧美日韩| 午夜a级毛片| 亚洲欧美日韩卡通动漫| 亚洲av中文字字幕乱码综合| 久久精品夜夜夜夜夜久久蜜豆| 人妻少妇偷人精品九色| 欧美区成人在线视频| 舔av片在线| 国内久久婷婷六月综合欲色啪| 在线观看av片永久免费下载| 色精品久久人妻99蜜桃| 成人永久免费在线观看视频| 丰满乱子伦码专区| 亚洲在线自拍视频| 精品一区二区免费观看| 别揉我奶头~嗯~啊~动态视频| 国产成人一区二区在线| 婷婷六月久久综合丁香| 最近在线观看免费完整版| 日韩欧美在线乱码| 亚洲熟妇熟女久久| 内地一区二区视频在线| 日日啪夜夜撸| 能在线免费观看的黄片| 成人特级黄色片久久久久久久| 亚洲精品国产成人久久av| 亚洲图色成人| 亚洲精品日韩av片在线观看| 三级毛片av免费| 熟女电影av网| 亚洲精品影视一区二区三区av| 中文字幕久久专区| 亚洲美女视频黄频| 欧美中文日本在线观看视频| 国产精品久久久久久亚洲av鲁大| 男人和女人高潮做爰伦理| 不卡视频在线观看欧美| 床上黄色一级片| 亚洲图色成人| 午夜福利欧美成人| 无人区码免费观看不卡| 国产高潮美女av| 久久亚洲真实| 日韩,欧美,国产一区二区三区 | 男人狂女人下面高潮的视频| 亚洲天堂国产精品一区在线| 人妻制服诱惑在线中文字幕| 色在线成人网| 天美传媒精品一区二区| 亚洲av不卡在线观看| 又黄又爽又免费观看的视频| 男女做爰动态图高潮gif福利片| 久久午夜福利片| 精品一区二区三区av网在线观看| 免费在线观看影片大全网站| 色综合站精品国产| 人妻少妇偷人精品九色| 91在线观看av| 欧美日韩精品成人综合77777| 中文字幕熟女人妻在线| 深爱激情五月婷婷| 国产精品人妻久久久影院| a在线观看视频网站| 十八禁国产超污无遮挡网站| 嫩草影视91久久| 我要看日韩黄色一级片| 人妻久久中文字幕网| 国产视频一区二区在线看| 亚洲无线在线观看| 免费在线观看成人毛片| 国产亚洲精品av在线| 久久婷婷人人爽人人干人人爱| 久9热在线精品视频| 看黄色毛片网站| 欧美日韩精品成人综合77777| 午夜免费激情av| 国产在视频线在精品| 午夜福利在线观看免费完整高清在 | 亚洲 国产 在线| 九九热线精品视视频播放| 特大巨黑吊av在线直播| 婷婷精品国产亚洲av| 国产精品国产三级国产av玫瑰| 一本一本综合久久| 国产伦在线观看视频一区| 成人国产麻豆网| 免费观看的影片在线观看| 可以在线观看毛片的网站| 国产三级在线视频| 国产高清有码在线观看视频| 精品欧美国产一区二区三| 少妇的逼水好多| 国产精品久久久久久亚洲av鲁大| 美女xxoo啪啪120秒动态图| 精品午夜福利视频在线观看一区| 国产精品1区2区在线观看.| 国产精品久久久久久精品电影| 欧美成人一区二区免费高清观看| 久久久精品大字幕| 精品人妻偷拍中文字幕| 日韩欧美免费精品| 天堂影院成人在线观看| 99久久九九国产精品国产免费| 99久久精品热视频| 日本欧美国产在线视频| 人人妻人人看人人澡| 国产精品无大码| 欧美日韩乱码在线| 欧美极品一区二区三区四区| 中文亚洲av片在线观看爽| 免费不卡的大黄色大毛片视频在线观看 | 亚洲成人免费电影在线观看| 亚洲精品粉嫩美女一区| 亚洲成a人片在线一区二区| 少妇熟女aⅴ在线视频| 久久99热这里只有精品18| 午夜精品久久久久久毛片777| 免费观看精品视频网站| 国内精品美女久久久久久| 99热只有精品国产| xxxwww97欧美| 亚洲人成网站在线播放欧美日韩| 国产精品一区二区三区四区久久| 国产欧美日韩一区二区精品| 国产免费男女视频| 久久亚洲精品不卡| 毛片女人毛片| 国产亚洲精品综合一区在线观看| 3wmmmm亚洲av在线观看| 午夜福利在线观看吧| 国产在线男女| 国产一区二区三区av在线 | 国产高潮美女av| 变态另类丝袜制服| 非洲黑人性xxxx精品又粗又长| 国产黄片美女视频| 99在线人妻在线中文字幕| 亚洲欧美精品综合久久99| 在线天堂最新版资源| 国产一区二区亚洲精品在线观看| 久久久久免费精品人妻一区二区| 国产免费男女视频| 97超级碰碰碰精品色视频在线观看| 天堂av国产一区二区熟女人妻| 国产精品电影一区二区三区| 1000部很黄的大片| 色综合站精品国产| 国产av一区在线观看免费| 久久人人精品亚洲av| 亚洲av免费高清在线观看| 搡老熟女国产l中国老女人| 88av欧美| 国产 一区 欧美 日韩| 婷婷色综合大香蕉| 夜夜夜夜夜久久久久| 12—13女人毛片做爰片一| 亚洲黑人精品在线| 国产黄片美女视频| 嫩草影院入口| 欧美激情久久久久久爽电影| 天美传媒精品一区二区| 久久精品国产亚洲av涩爱 | 成人二区视频| 深夜a级毛片| 欧美xxxx性猛交bbbb| 动漫黄色视频在线观看| 桃红色精品国产亚洲av| 日本黄色视频三级网站网址| 久久久久国内视频| 在线观看66精品国产| 免费人成视频x8x8入口观看| 亚洲色图av天堂| 岛国在线免费视频观看| 国产精品国产高清国产av| 国产伦人伦偷精品视频| 午夜精品一区二区三区免费看| 国产高清不卡午夜福利| av专区在线播放| 黄色欧美视频在线观看| 欧美又色又爽又黄视频| 男女视频在线观看网站免费| 直男gayav资源| 国产伦一二天堂av在线观看| 免费在线观看影片大全网站| 九九久久精品国产亚洲av麻豆| 天天躁日日操中文字幕| 一本一本综合久久| 亚洲三级黄色毛片| 欧美又色又爽又黄视频| or卡值多少钱| 女的被弄到高潮叫床怎么办 | 久久人人爽人人爽人人片va| 午夜激情福利司机影院| 久久精品国产亚洲av涩爱 | 国产激情偷乱视频一区二区| 男人舔奶头视频| 国产一区二区三区在线臀色熟女| 国产精品野战在线观看| 91久久精品国产一区二区三区| 国产欧美日韩精品一区二区| 久久久久久大精品| 中国美白少妇内射xxxbb| 最近视频中文字幕2019在线8| 亚洲中文日韩欧美视频| 99九九线精品视频在线观看视频| 国产精品99久久久久久久久| 两个人视频免费观看高清| 欧美精品啪啪一区二区三区| 毛片一级片免费看久久久久 | 欧美日韩乱码在线| 老熟妇乱子伦视频在线观看| 国产精品久久视频播放| av.在线天堂| 成年人黄色毛片网站| 国产一区二区三区视频了| 亚洲av免费高清在线观看| 日韩欧美 国产精品| 能在线免费观看的黄片| av天堂在线播放| 欧美丝袜亚洲另类 | 精品久久久久久成人av| 一进一出好大好爽视频| 久久久精品大字幕| 色吧在线观看| 99精品久久久久人妻精品| 99久国产av精品| 一边摸一边抽搐一进一小说| 亚洲av电影不卡..在线观看| 欧美精品啪啪一区二区三区| 最新中文字幕久久久久| 成人无遮挡网站| 国产探花在线观看一区二区| 自拍偷自拍亚洲精品老妇| a在线观看视频网站| 男女那种视频在线观看| 在线天堂最新版资源| 我的女老师完整版在线观看| 久久6这里有精品| 亚洲久久久久久中文字幕| 不卡一级毛片| 日韩欧美免费精品| 国产在视频线在精品| 日本五十路高清| 午夜免费激情av| 在线播放无遮挡| 亚洲综合色惰| 午夜激情欧美在线| 亚洲经典国产精华液单| 有码 亚洲区| 亚洲男人的天堂狠狠| 精品人妻偷拍中文字幕| 国产精品女同一区二区软件 | 波多野结衣高清作品| 成人一区二区视频在线观看| 中文字幕熟女人妻在线| 看免费成人av毛片| 18禁裸乳无遮挡免费网站照片| 欧美精品啪啪一区二区三区| 国产精品永久免费网站| 日本-黄色视频高清免费观看| 精品午夜福利在线看| 精品无人区乱码1区二区| 国产免费男女视频| 色吧在线观看| 国产亚洲欧美98| 欧美黑人巨大hd| 久久久久久久久久久丰满 | 国产精品久久久久久精品电影| 99久久成人亚洲精品观看| 美女黄网站色视频| 淫妇啪啪啪对白视频| 我的女老师完整版在线观看| 国内精品久久久久精免费| 亚洲熟妇中文字幕五十中出| 免费在线观看日本一区| 琪琪午夜伦伦电影理论片6080| 日韩欧美在线乱码| 免费大片18禁| 看免费成人av毛片| 春色校园在线视频观看| 一进一出抽搐gif免费好疼| 欧美色视频一区免费| 大型黄色视频在线免费观看| 亚洲欧美激情综合另类| 欧美日韩精品成人综合77777| 99久久成人亚洲精品观看| 亚洲av美国av| 久久久精品大字幕| 九九热线精品视视频播放| 亚洲午夜理论影院| 免费看美女性在线毛片视频| 日韩,欧美,国产一区二区三区 | 91精品国产九色| 国内揄拍国产精品人妻在线| 日韩欧美国产在线观看| 亚洲内射少妇av| 国产精品不卡视频一区二区| 免费搜索国产男女视频| 动漫黄色视频在线观看| 国产真实乱freesex| 欧美+亚洲+日韩+国产| 麻豆精品久久久久久蜜桃| 色在线成人网| 精品99又大又爽又粗少妇毛片 | 国产精品久久电影中文字幕| 亚洲综合色惰| 亚洲在线自拍视频| 欧美一区二区国产精品久久精品| 亚洲成av人片在线播放无| 观看美女的网站| 久久久久国产精品人妻aⅴ院| 欧美黑人巨大hd| 国产极品精品免费视频能看的| 亚洲国产色片| 精品人妻1区二区| 国产亚洲欧美98| 黄色女人牲交| 淫妇啪啪啪对白视频| 亚洲狠狠婷婷综合久久图片| 日本熟妇午夜| 在线观看午夜福利视频| av在线蜜桃| 少妇人妻精品综合一区二区 | a级一级毛片免费在线观看| 天美传媒精品一区二区| 日本黄大片高清| 国内精品久久久久久久电影| 久久这里只有精品中国| 久久久久久久久中文| 久久天躁狠狠躁夜夜2o2o| 91久久精品电影网| 极品教师在线视频| 五月玫瑰六月丁香| 人妻制服诱惑在线中文字幕| 麻豆成人午夜福利视频| 五月伊人婷婷丁香| 可以在线观看毛片的网站| 国产高清有码在线观看视频| 91久久精品电影网| 欧洲精品卡2卡3卡4卡5卡区| 国产国拍精品亚洲av在线观看| 搞女人的毛片| 久9热在线精品视频| 亚洲国产精品sss在线观看| 九色国产91popny在线| 最近视频中文字幕2019在线8| 欧美区成人在线视频| 桃色一区二区三区在线观看| 久久久久久久久大av| 看黄色毛片网站| 最近最新免费中文字幕在线| 男女啪啪激烈高潮av片| 久久精品国产亚洲av天美| 国产一区二区激情短视频| 日韩精品中文字幕看吧| 一本久久中文字幕| 亚洲国产精品sss在线观看| 人妻丰满熟妇av一区二区三区| 成人午夜高清在线视频| 亚洲成人久久性| 亚洲av不卡在线观看| 国产av不卡久久| 又黄又爽又免费观看的视频| or卡值多少钱| 午夜视频国产福利| 夜夜看夜夜爽夜夜摸| 精品人妻视频免费看| 最近在线观看免费完整版| 又黄又爽又免费观看的视频| 日日撸夜夜添| 亚洲av不卡在线观看| 午夜免费成人在线视频| 精品欧美国产一区二区三| 亚洲无线观看免费| 久久久久久九九精品二区国产| a在线观看视频网站| 亚洲中文字幕一区二区三区有码在线看| 在线观看午夜福利视频| 夜夜看夜夜爽夜夜摸| 美女cb高潮喷水在线观看| 国内少妇人妻偷人精品xxx网站| 色视频www国产| 3wmmmm亚洲av在线观看| 欧美国产日韩亚洲一区| 免费不卡的大黄色大毛片视频在线观看 | 精品一区二区三区人妻视频| 在线免费观看不下载黄p国产 | 在线看三级毛片| 88av欧美| 国产白丝娇喘喷水9色精品| 午夜爱爱视频在线播放| 久久久久久久久大av| 伊人久久精品亚洲午夜| 国产成人av教育| 亚州av有码| 成年版毛片免费区| 夜夜夜夜夜久久久久| 国产av不卡久久| 又紧又爽又黄一区二区| 成年女人毛片免费观看观看9| 久久精品影院6| h日本视频在线播放| 免费在线观看成人毛片| 丰满人妻一区二区三区视频av| 国产精品亚洲美女久久久| 简卡轻食公司| 九九久久精品国产亚洲av麻豆| 欧美人与善性xxx| 给我免费播放毛片高清在线观看| 亚洲自拍偷在线| 免费人成在线观看视频色| 最后的刺客免费高清国语| 国产真实伦视频高清在线观看 |