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

    礦用鉆孔機器人加卸鉆桿的避障軌跡規(guī)劃研究

    2023-12-05 05:43:54姚亞峰姚寧平梁春苗彭光宇
    煤田地質(zhì)與勘探 2023年11期
    關鍵詞:機械手鉆桿插值

    姚亞峰,姚寧平,彭 濤,梁春苗,彭光宇

    (1.煤炭科學研究總院,北京 100013;2.中煤科工西安研究院(集團)有限公司,陜西 西安 710077)

    煤礦井下鉆機主要用于瓦斯抽采、地質(zhì)勘探、探放水等領域,是煤礦安全生產(chǎn)不可或缺的裝備之一[1-3]。自2015 年起,國家部委陸續(xù)發(fā)布了一些提升煤礦發(fā)展水平、提高安全生產(chǎn)水平的技術性指導意見[4-5],這對于煤礦井下鉆機向智能化轉(zhuǎn)型發(fā)展具有重要意義。自動加卸鉆桿技術是智能化鉆機研究的關鍵技術之一。常見煤礦井下智能化鉆機以負載敏感電液比例多路閥為主要核心,以PLC 智能控制器為控制單元,遙控器為操作終端,位移傳感器、壓力傳感器等為檢測反饋元件,實現(xiàn)了自動加卸鉆桿裝置中各機械臂的同步運行和邏輯控制[6-8],但也存在裝置結(jié)構復雜、檢測元件多、定位精度低、重復定位誤差大等問題,對于加卸鉆桿功能的運行可靠性影響較大[9-10]。

    針對典型加卸鉆桿系統(tǒng)存在的問題,開發(fā)了防爆伺服電機驅(qū)動的六自由度機械手及其控制系統(tǒng),并應用于鉆孔機器人加卸鉆桿,具有加卸鉆桿效率高、重復定位精度高及工作范圍大等特點,可滿足鉆孔機器人連續(xù)快速加卸鉆桿需求[11-12]。通過將機械手、主機和鉆桿倉等安裝在共同的履帶車體平臺上,開發(fā)了一體式鉆孔機器人。由于鉆孔設計需求,鉆孔中心位置即主機的主軸中心孔位置會隨著主機的調(diào)姿而發(fā)生變化,同時在加卸鉆桿過程中還存在障礙物,因此,每個鉆孔的加卸鉆桿過程都存在變目標的避障軌跡規(guī)劃問題。

    針對機器人協(xié)作中軌跡規(guī)劃問題,相關學者提出對兩個不同自由度的機器人采用視覺系統(tǒng)識別標記,并利用標記點進行實時跟蹤定位[13]。針對多關節(jié)平面機器人,提出了一種有效和準確的避障軌跡規(guī)劃和跟蹤策略,設計了合適的二階滑??刂破鱽肀WC足夠的跟蹤精度,該方法可獲得有效和準確的軌跡規(guī)劃[14]。針對零件掃描建模問題,提出了基于六軸機器人的零件掃描路徑規(guī)劃方法,有效控制了重疊掃描區(qū)域[15]。隨著機器人的規(guī)模應用,國內(nèi)在該方向的研究逐漸成為了熱點。針對六自由度串聯(lián)機械臂,進行了改進RRT算法的機械臂避障路徑規(guī)劃研究[16]。針對六軸工業(yè)機器人軌跡規(guī)劃等的方法問題,從單機軌跡規(guī)劃、雙機協(xié)作柔順控制、單機在線運動規(guī)劃等方面入手,提出合理的軌跡優(yōu)化和運動規(guī)劃策略[17]。針對機器人碼垛中的避障問題,提出一種實現(xiàn)自主避障的軌跡規(guī)劃方法[18]。針對算法改進方面,在傳統(tǒng)RRT 算法的基礎上,提出了一種擴展點選擇策略和自適應步長策略,并結(jié)合Dijkstra 算法對改進算法產(chǎn)生的路徑進行優(yōu)化[19]。

    國內(nèi)外學者在工業(yè)機器人的裝配、碼垛、協(xié)作等場景中進行了避障軌跡規(guī)劃研究,研究重點集中于軌跡規(guī)劃算法優(yōu)化,但在煤礦井下鉆孔機器人等裝備上卻鮮有研究和應用。在煤礦井下工作環(huán)境中,機械手和主機之間加卸鉆桿的避障環(huán)境、工作空間及負載特性等與工業(yè)機器人的應用場景顯著不同,不僅存在電氣元件和控制系統(tǒng)的防爆問題,還存在障礙物及目標位置變化、工作空間小、運動沖擊大等問題,這些問題的研究對于提高鉆孔機器人加卸鉆桿控制系統(tǒng)的智能化程度具有重要意義。本文從煤礦井下鉆孔機器人加卸鉆桿系統(tǒng)組成原理、避障軌跡規(guī)劃策略、具體的避障軌跡規(guī)劃算法、仿真分析及試驗驗證等方面開展研究,提出了適應主機姿態(tài)變化的加卸鉆桿軌跡規(guī)劃方法。

    1 鉆孔機器人加卸鉆桿系統(tǒng)

    一體式鉆孔機器人的加卸鉆桿系統(tǒng)以防爆六自由度機械手為主體,與主機、鉆桿倉、穩(wěn)固裝置等安裝在共同的車體平臺上,并通過控制系統(tǒng)實現(xiàn)鉆桿的自動加卸功能,其結(jié)構如圖1 所示。機械手采用防爆伺服電機驅(qū)動,由6 個串聯(lián)機械臂(連桿)、6 個轉(zhuǎn)動關節(jié)和末端手爪等組成,其中6 個轉(zhuǎn)動關節(jié)分別為基座的回轉(zhuǎn)、腰的俯仰、小臂的俯仰、小臂的回轉(zhuǎn)、腕部關節(jié)的俯仰和腕部關節(jié)的回轉(zhuǎn)。根據(jù)機械手各連桿參數(shù)、連桿坐標系和各關節(jié)限位角度,采用標準DH 參數(shù)法進行運動學建模[20],可得到機械手的DH 參數(shù)見表1。主機是鉆孔機器人的關鍵部件,包括變幅裝置、動力頭、夾持器、給進裝置等,其中變幅裝置可實現(xiàn)鉆孔開孔的參數(shù)調(diào)節(jié),包括舉升、傾角和機身平移3 個自由度。鉆桿倉是貯存鉆桿的裝置,鉆桿倉中的鉆桿按照固定的行間距和列間距排列。

    表1 防爆六自由度機械手連桿DH 參數(shù)Table 1 DH parameters of explosion-proof six-DOF manipulator

    圖1 鉆孔機器人加卸鉆桿系統(tǒng)Fig.1 Drill pipe loading and unloading system of drilling robot

    鉆孔機器人的加鉆桿流程是利用機械手從鉆桿倉中抓取鉆桿,并根據(jù)規(guī)劃算法運送鉆桿至主機的加卸鉆桿位置,再利用夾持器夾緊鉆桿,隨后機械手松開鉆桿并返回等待下一個流程,卸鉆桿流程則相反。隨著鉆孔設計不同,主機的調(diào)姿狀態(tài)發(fā)生變化,主機上的加卸鉆桿位置也隨之變化,如圖2 所示,因此,對于不同的鉆孔開孔位置,機械手都要重新規(guī)劃軌跡。在機械手運動過程中,機械手的連桿臂及手爪中的鉆桿要避開穩(wěn)固裝置、主機零部件等障礙物,其中穩(wěn)固裝置的位置是固定的,而主機上各零部件的位置則是變化的。

    圖2 主機的調(diào)姿Fig.2 Attitude adjustment of host machine

    主機的3 個自由度中,舉升和平移為線性關節(jié),傾角則為旋轉(zhuǎn)關節(jié),具體參數(shù)見表2,根據(jù)主機的機械結(jié)構參數(shù)可知調(diào)整姿態(tài)前后加卸鉆桿位置的變化關系。設主機的舉升、傾角及機身平移參數(shù)分別為H、β、L,設定各參數(shù)為0 時加卸鉆桿位置中心的坐標為A(x1,y1,z1),參數(shù)變化后的坐標為B(x2,y2,z2),如圖3 所示,則有以下公式:

    表2 主機的三自由度參數(shù)Table 2 Three-DOF parameters of host machine

    圖3 鉆桿位置中心的坐標變化Fig.3 Change of coordinates in position center of drill pipe

    2 機械手加卸鉆桿的避障軌跡規(guī)劃策略

    2.1 軌跡規(guī)劃方法

    機械手的路徑規(guī)劃只涉及關節(jié)角度,軌跡規(guī)劃則是在路徑規(guī)劃基礎上對機械手的關節(jié)角速度、角加速度及角加加速度等進行規(guī)劃,以滿足光滑性和連續(xù)性等要求。軌跡規(guī)劃包括笛卡爾空間規(guī)劃和關節(jié)空間規(guī)劃。笛卡爾空間規(guī)劃是根據(jù)已知點的笛卡爾坐標直接插補,然后對插補的每個坐標點通過機械手運動學逆解運算得到對應的關節(jié)變量。關節(jié)空間規(guī)劃只對幾個關鍵點進行運動學逆解運算,然后對運動學逆解得到的機械手關節(jié)變量通過插補算法進行規(guī)劃。對于由多自由度串聯(lián)機械臂組成的機械手來說,通常是結(jié)合關節(jié)空間和笛卡爾空間下進行規(guī)劃。

    2.2 避障方法

    在機械手避障軌跡規(guī)劃研究中,需要對障礙物進行模型簡化,便于進行碰撞檢測的運算。障礙物一般采用球體、長方體及圓柱體等規(guī)則幾何體進行包絡。但對于復雜模型和狹窄空間,可采用由多個頂點坐標確定的無規(guī)則凸包絡體進行模型簡化,可以有效減小包圍盒尺寸,提高避障環(huán)境的真實性[21-22]。在同一個坐標系下分別建立機械手和主機的URDF 格式模型以及鉆桿倉、穩(wěn)固裝置等環(huán)境模型,再利用包絡法建立加卸鉆桿系統(tǒng)的碰撞檢測模型,其中穩(wěn)固裝置和鉆桿倉為規(guī)則幾何體,機械手和主機的各連桿臂為凸包絡體,如圖4 所示。

    圖4 加卸鉆桿系統(tǒng)的碰撞檢測模型Fig.4 Collision detection model of drill pipe loading and unloading system

    兩個三維物體之間的最近距離可用最小歐氏距離來表示,歐氏距離的計算方法如下。設三維空間中兩點A(x1,y1,z1),B(x2,y2,z2),則A、B點之間的歐氏距離為:

    規(guī)則幾何體之間的最小歐氏距離有固定的計算公式,對于不規(guī)則的凸包絡體來說,每個凸包絡體的外表面都可以看作是由若干個點云信息組成的,通過計算兩個凸包絡體外表面點云之間的歐氏距離,當最小歐氏距離大于0 時,則認為兩者無碰撞。

    2.3 避障軌跡規(guī)劃的分段策略

    在鉆孔機器人的鉆桿倉中,鉆桿呈等間距縱橫排列,因此,可采用碼垛算法抓取鉆桿。從圖4 中可以看出,鉆桿倉和主機本身就是一個凸包絡體,基于凸包絡體進行碰撞檢測時,若直接從初始位置到終點位置進行軌跡規(guī)劃,鉆桿會與這兩個凸包絡體碰撞。因此,為了簡化規(guī)劃算法,可以根據(jù)鉆桿倉和主機的結(jié)構特點將軌跡分為3 段。

    第一段:從抓桿位置到鉆桿倉上方固定位置,此段路徑為直線,應采用笛卡爾空間規(guī)劃方法,在得到每個插值路徑點的機械手關節(jié)變量后,根據(jù)關節(jié)變量與時間的函數(shù)關系采用一階、二階及三階導數(shù)法可得到關節(jié)的角速度、角加速度和角加加速度。

    第二段:從鉆桿倉上方固定位置到主機加桿位置上方,機械手要根據(jù)主機位姿變化調(diào)整軌跡并避開障礙物,應采用關節(jié)空間規(guī)劃方法。由于機械手在鉆桿倉和穩(wěn)固裝置之間的路徑不受主機位姿變化影響,可通過增加一個過渡點來簡化規(guī)劃算法。根據(jù)初始、末端和過渡點得到各插值路徑點的關節(jié)角度,并利用最小歐氏距離方法判斷是否碰撞,最后用導數(shù)法則得到各關節(jié)的角速度、角加速度和角加加速度。

    第三段:從主機加桿位置上方到加桿位置,此段路徑同樣采用直線規(guī)劃,具體方法與第一段相似。

    3 加卸鉆桿的避障軌跡規(guī)劃算法

    3.1 最小沖擊算法

    1) 基于七次多項式插值算法

    機械手軌跡規(guī)劃中,通過采用不同的多項式插值函數(shù),可以生成不同的軌跡。多項式插值軌跡規(guī)劃主要包括三次、五次、七次多項式插值[23],采用七次多項式規(guī)劃可以保證速度、加速度和加加速度的連續(xù)性,實現(xiàn)機械手的最小沖擊軌跡規(guī)劃,有利于減小加卸鉆桿過程中機械手的高速運動沖擊。

    機械手的關節(jié)角度或笛卡爾坐標與時間的函數(shù)都可以用如下七次多項式表示:

    令T=t1-t0,h=q1-q0,可求得式(3)中各系數(shù)如下:

    根據(jù)以上公式再結(jié)合導數(shù)法則可得到任意時間節(jié)點對應的速度、加速度和加加速度。根據(jù)機械手加卸鉆桿的避障軌跡規(guī)劃策略,第一段和第三段軌跡可基于直線坐標點在笛卡爾空間下采用最小沖擊規(guī)劃算法進行規(guī)劃。第二段軌跡要考慮避開障礙物,在關節(jié)空間下進行最小沖擊規(guī)劃,并開展機械手運動中的碰撞檢測。如果檢測出碰撞,則可調(diào)整過渡點并重新開始規(guī)劃和碰撞檢測,如果繼續(xù)發(fā)生碰撞,則優(yōu)先更改過渡點,或者繼續(xù)增加過渡點,直到不會發(fā)生碰撞為止,最后根據(jù)關節(jié)角度的變化得到角速度、角加速度和角加加速度。

    2) 仿真分析

    將主機的URDF 格式模型按照舉升H=200 mm、傾角α=45°和機身平移L=440 mm 進行參數(shù)調(diào)節(jié),機器人的URDF 格式模型按照開始抓取鉆桿的姿態(tài)進行參數(shù)調(diào)節(jié),并在此環(huán)境下進行加鉆桿的軌跡規(guī)劃仿真。按照最小沖擊避障軌跡規(guī)劃算法對三段軌跡分別進行規(guī)劃,設定仿真時間段分別為0~5、5~25、25~30 s,總仿真時間為30 s,可得到如圖5 所示的仿真路徑,圖中紅色為機械手末端鉆桿中心的運動軌跡。在圖5中第二段中,機械手運動路徑平滑但路徑繞行較長。

    圖5 最小沖擊算法規(guī)劃的加桿路徑Fig.5 Loading path of drill pipe by minimum impact algorithm

    根據(jù)機械手各關節(jié)軌跡參數(shù)得到的仿真曲線如圖6 所示,可以看出,三段軌跡中機械手各關節(jié)的角度、角速度、角加速度和角加加速度都是連續(xù)的。另一方面,第二段軌跡中關節(jié)角速度、角加速度和角加加速度的絕對值數(shù)值很大,其中角加加速度的絕對值峰值達到了52.481 rad/s3,這對于機械手的運行來說是非常不利的。因此,該方法雖然得到了最小的沖擊規(guī)劃,但卻是通過提高機械手關節(jié)運行速度和運行距離等參數(shù)實現(xiàn)的,同時也犧牲了機械手的運行壽命。

    圖6 最小沖擊軌跡規(guī)劃算法得到的機械手各關節(jié)軌跡仿真曲線Fig.6 Trajectory simulation curves of manipulator joints obtained by minimum impact trajectory planning algorithm

    3.2 沖擊優(yōu)化的避障軌跡規(guī)劃算法

    1) 改進雙樹RRT 算法

    為了在避障環(huán)境條件下縮短機械手的運行距離,設計采用快速擴展隨機樹(RRT)規(guī)劃算法,該算法也適合解決多自由度串聯(lián)機械手在復雜環(huán)境中的避障路徑規(guī)劃問題。常見的RRT 算法有單樹RRT 算法和雙樹RRT 算法等[24-25]。通過采用最近路徑漸進優(yōu)化方法,可以對雙樹RRT 算法進行改進。改進雙樹RRT算法在開始和目標點處同時創(chuàng)建兩個根節(jié)點樹,為了擴展每棵樹,隨機生成一個配置,如果不和環(huán)境障礙物發(fā)生碰撞,則根據(jù)設置的最大連接距離從最近的節(jié)點開始邁出一步,隨后嘗試使用新的擴展樹連接對面樹上最近的節(jié)點,此時在無碰撞前提下可啟用直接連接方式來縮短路徑。相比單樹RRT 算法,采用改進雙樹RRT 算法可以得到搜索速度更高、路徑更短的優(yōu)化路徑。

    2) B 樣條曲線路徑優(yōu)化

    利用改進型雙樹RRT 算法可得到初始無碰撞路徑點,由于該算法得到的路徑通常是不光滑的,可以通過三次均勻B 樣條曲線進行路徑的優(yōu)化,得到一組光滑的路徑點。p次B 樣條曲線的表達式如下:

    式中:Ni,k(t)為B 樣條曲線的基函數(shù),可由de Boor-Cox 遞推公式求得;Pi為 B 樣條曲線的控制頂點;t為經(jīng)過歸一化處理的時間變量。

    對于三次B 樣條曲線來說,其基函數(shù)為:

    則三次均勻B 樣條曲線可以表示為:

    式中:P0、P1、P2、P4為4 個控制頂點。

    3) 基于優(yōu)化路徑的最小沖擊算法

    依據(jù)B 樣條曲線優(yōu)化的各路徑點,基于七次多項式插值的最小沖擊規(guī)劃方法進行插值計算,并按照最小歐氏距離計算方法進行包絡體碰撞檢測驗證,可得到關節(jié)角度、角速度、角加速度及角加加速度都相對連續(xù)的沖擊優(yōu)化軌跡規(guī)劃算法。由于前面的第一段和第三段軌跡規(guī)劃算法能得到較優(yōu)的軌跡,因此只需對第二段軌跡按照雙樹RRT 規(guī)劃算法+B 樣條曲線優(yōu)化+最小沖擊算法的沖擊優(yōu)化規(guī)劃算法進行改進,具體的規(guī)劃流程如圖7 所示。

    圖7 沖擊優(yōu)化軌跡規(guī)劃算法Fig.7 Impact-optimal trajectory planning algorithm

    4) 仿真分析

    選取同樣的主機姿態(tài)按照上述多種算法組合的沖擊優(yōu)化算法進行軌跡規(guī)劃仿真分析,設定總仿真時間為30 s,圖8 為機械手的運動路徑,圖9 為機械手各關節(jié)運行參數(shù)仿真曲線。由圖8 可以看出,相比圖5 中的路徑,路徑曲線較短,由圖9d 可知,角加速度的絕對值最大峰值為0.957 rad/s3,對比圖6d 降低了98.2%,該算法相比前面的最小沖擊軌跡規(guī)劃算法來說,總路徑較短,角加加速度等的數(shù)值更小且相對連續(xù)。

    圖8 沖擊優(yōu)化算法規(guī)劃的加桿路徑Fig.8 Loading path of drill pipe by impact-optimal trajectory planning algorithm

    圖9 沖擊優(yōu)化算法得到的關節(jié)參數(shù)仿真曲線Fig.9 Trajectory simulation curves of manipulator joints obtained by impact-optimal trajectory planning algorithm

    4 試驗驗證

    調(diào)節(jié)鉆孔機器人的主機姿態(tài)與仿真模型一致,并根據(jù)沖擊優(yōu)化避障軌跡規(guī)劃方法的仿真結(jié)果采用機械手示教法進行驗證。為了盡可能接近仿真路徑又能減少輸入數(shù)據(jù)量,選取仿真中三段軌跡的起始點、終止點、3 個關鍵點及4 個過渡點共9 個坐標點的關節(jié)角度和角速度作為輸入數(shù)據(jù),見表3 和表4。在第一段軌跡和第三段軌跡中的各個輸入坐標點之間采用線性插值得到插值路徑點的關節(jié)角度和角速度,在第二段軌跡中的各個輸入坐標點之間采用多項式插值得到插值路徑點的關節(jié)角度和角速度。

    表3 機械手工具坐標系對應的各關節(jié)角度Table 3 Each joint angle in manipulator tool coordinate system 單位:(°)

    表4 機械手工具坐標系對應的各關節(jié)角速度Table 4 Each joint angular velocity in manipulator tool coordinate system 單位:(°)/s

    將9 個坐標點的關節(jié)角度和角速度通過機械手示教器輸入并設置好插值方法,操作鉆孔機器人進行加桿過程的軌跡規(guī)劃測試,圖10 為各坐標點的加桿狀態(tài)圖。圖中機械手從鉆桿倉最遠位置處(起始點)抓取鉆桿后,直線運行至鉆桿倉上部關鍵點1,此時各關節(jié)速度變?yōu)?,然后按照一定的曲線軌跡運行至關鍵點2附近,并繼續(xù)運行至關鍵點3,此時各關節(jié)速度又降為0,最后,按照直線軌跡運行至終止點,完成軌跡規(guī)劃的驗證。在整個加桿過程中,機械手各機械臂及其手爪中的鉆桿都未與鉆孔機器人的穩(wěn)固裝置、主機上的零部件等障礙物碰撞,因此也驗證了避障軌跡規(guī)劃的正確性。

    圖10 各關鍵位置加桿狀態(tài)Fig.10 Loading state of drill pipe at each key position

    在完成軌跡規(guī)劃測試驗證后,根據(jù)測試的軌跡選取包含上述9 個坐標點的共43 個坐標點的關節(jié)角度和關節(jié)角速度,采用導數(shù)法則計算關節(jié)角加速度和角加加速度,并繪制各關節(jié)變化曲線,如圖11 所示,對比軌跡規(guī)劃仿真結(jié)果可知,實際的測試軌跡在關節(jié)角度、角速度、角加速度和角加加速度變化趨勢方面具有較高的相似性,但在局部峰值數(shù)據(jù)等方面有一定的誤差,這與實際測試中選取的坐標點較少而影響到導數(shù)法則的計算結(jié)果有關。

    圖11 各關節(jié)參數(shù)變化曲線Fig.11 Change curves of joint parameters

    為了進一步驗證機械手中鉆桿的運動路徑,根據(jù)機械手運動學正解求解方法,可以得到機械手末端鉆桿中心的坐標,根據(jù)坐標數(shù)據(jù)繪制的運動路徑如圖12所示,相比仿真曲線基本一致。從圖中可以看出,第一段和第三段路徑為直線,第二段路徑由兩段曲線組成,兩段之間通過關鍵點2 采用圓弧過渡連接,有利于提高加卸鉆桿效率。

    圖12 機械手手爪中鉆桿中心點運動軌跡Fig.12 Trajectory of drill pipe center in manipulator claw

    5 結(jié)論

    a.提出了加卸鉆桿避障軌跡規(guī)劃策略,采用三段式方法,第一段從待抓鉆桿至鉆桿倉上方,在笛卡爾空間下采用直線規(guī)劃;第二段從第一段的終點至主機待加桿位置上方,該位置可根據(jù)主機調(diào)整姿態(tài)前后加卸鉆桿位置的函數(shù)關系得到,在關節(jié)空間下采用多項式插值算法進行規(guī)劃,并可通過增加過渡點解決避障問題;第三段從第二段終點至鉆桿放置位置,該位置也由主機調(diào)整姿態(tài)前后加卸鉆桿位置得到,并在笛卡爾空間下采用直線規(guī)劃。

    b.提出了基于改進雙樹RRT 算法+B 樣條曲線路徑優(yōu)化+七次多項式插值組合算法的沖擊優(yōu)化避障軌跡規(guī)劃算法,該算法得到的路徑較短,不僅可保證關節(jié)角度、角速度、角加速度和角加加速度的連續(xù)性,且角加加速度的絕對值峰值相比直接采用基于最小沖擊的七次多項式插值規(guī)劃算法降低了98.2%,可顯著提升機械手的使用工況。

    c.采用給定少數(shù)坐標點并結(jié)合插值方法進行了機械手加桿試驗,通過繪制關節(jié)曲線和鉆桿中心實際運動路徑并進行了對比分析,相比仿真曲線具有較高的相似度。試驗驗證了沖擊優(yōu)化避障軌跡規(guī)劃算法的正確性,為鉆孔機器人六自由度機械手加卸鉆桿的避障軌跡規(guī)劃提供了一種可行的方法。

    猜你喜歡
    機械手鉆桿插值
    抓取脆弱物體的機械手
    鉆桿接頭堆焊耐磨帶組織性能分析
    冶金設備(2021年2期)2021-07-21 08:44:22
    鉆桿接頭內(nèi)螺紋加工自動化試驗研究
    基于Sinc插值與相關譜的縱橫波速度比掃描方法
    鉆桿自動輸送機的研制與應用
    搬運機械手PLC控制系統(tǒng)設計
    一種改進FFT多譜線插值諧波分析方法
    基于四項最低旁瓣Nuttall窗的插值FFT諧波分析
    石油鉆桿轉(zhuǎn)換接頭脆性斷裂失效分析
    大型鑄鍛件(2015年4期)2016-01-12 06:35:13
    基于ADAMS與MATLAB的機械手控制系統(tǒng)仿真研究
    機電信息(2015年3期)2015-02-27 15:54:53
    两个人视频免费观看高清| 国产一级毛片七仙女欲春2 | 别揉我奶头~嗯~啊~动态视频| 日韩欧美三级三区| 婷婷六月久久综合丁香| 一级毛片高清免费大全| 久久久久精品国产欧美久久久| 亚洲一区高清亚洲精品| 免费人成视频x8x8入口观看| 免费高清在线观看日韩| 美女大奶头视频| 亚洲人成电影免费在线| 女人爽到高潮嗷嗷叫在线视频| 久久热在线av| 国产极品粉嫩免费观看在线| 少妇 在线观看| 最近最新中文字幕大全电影3 | 中文字幕最新亚洲高清| 亚洲人成电影免费在线| 亚洲狠狠婷婷综合久久图片| 精品久久久久久,| 又紧又爽又黄一区二区| 视频在线观看一区二区三区| 国内久久婷婷六月综合欲色啪| 亚洲性夜色夜夜综合| 亚洲成人国产一区在线观看| 国产成+人综合+亚洲专区| 亚洲精品久久国产高清桃花| 十八禁网站免费在线| 欧美性长视频在线观看| 黄片播放在线免费| 99久久综合精品五月天人人| 日韩av在线大香蕉| 亚洲精品美女久久av网站| 国产欧美日韩精品亚洲av| 美女高潮到喷水免费观看| 两个人视频免费观看高清| 中文字幕人妻熟女乱码| 久久国产精品人妻蜜桃| 国产亚洲精品综合一区在线观看 | 电影成人av| 久久午夜亚洲精品久久| 欧洲精品卡2卡3卡4卡5卡区| 香蕉久久夜色| 乱人伦中国视频| 久久天堂一区二区三区四区| 男女之事视频高清在线观看| 国产欧美日韩一区二区精品| 色av中文字幕| 亚洲专区国产一区二区| 国产男靠女视频免费网站| 亚洲第一青青草原| 亚洲国产精品成人综合色| 69精品国产乱码久久久| 在线av久久热| 99国产精品一区二区三区| 丝袜在线中文字幕| 他把我摸到了高潮在线观看| 18禁美女被吸乳视频| 午夜免费激情av| www.熟女人妻精品国产| 国产免费男女视频| 97碰自拍视频| 天堂动漫精品| 高清黄色对白视频在线免费看| 日韩有码中文字幕| 国产成人啪精品午夜网站| 亚洲一卡2卡3卡4卡5卡精品中文| 欧美久久黑人一区二区| av电影中文网址| 亚洲精品国产区一区二| 男女床上黄色一级片免费看| 国产色视频综合| 亚洲欧美精品综合久久99| 国产人伦9x9x在线观看| 国产亚洲精品综合一区在线观看 | 国产欧美日韩综合在线一区二区| 9色porny在线观看| 熟妇人妻久久中文字幕3abv| 国产精品亚洲美女久久久| 亚洲欧美激情在线| 久久久久国产精品人妻aⅴ院| 国产精品亚洲一级av第二区| 久久国产乱子伦精品免费另类| 亚洲男人天堂网一区| av网站免费在线观看视频| 非洲黑人性xxxx精品又粗又长| 高清在线国产一区| 国产成人av激情在线播放| 色婷婷久久久亚洲欧美| 大型黄色视频在线免费观看| 色综合亚洲欧美另类图片| 欧美日韩乱码在线| 午夜精品在线福利| 十分钟在线观看高清视频www| 国产精品一区二区在线不卡| 脱女人内裤的视频| 国产亚洲欧美精品永久| 国产精品乱码一区二三区的特点 | 国产高清videossex| e午夜精品久久久久久久| 后天国语完整版免费观看| 国产成人精品在线电影| 亚洲狠狠婷婷综合久久图片| 亚洲精品久久成人aⅴ小说| 午夜精品国产一区二区电影| 久久精品国产亚洲av香蕉五月| 久久久精品欧美日韩精品| 国产成人影院久久av| 女人被狂操c到高潮| 国产1区2区3区精品| 亚洲中文字幕日韩| 男人舔女人下体高潮全视频| 久久人妻福利社区极品人妻图片| 黄色片一级片一级黄色片| 丰满人妻熟妇乱又伦精品不卡| 91在线观看av| 亚洲成人免费电影在线观看| 国产精品爽爽va在线观看网站 | 欧美日韩亚洲综合一区二区三区_| 中亚洲国语对白在线视频| 亚洲第一欧美日韩一区二区三区| 一本综合久久免费| 精品国产一区二区三区四区第35| 日本免费a在线| 欧美人与性动交α欧美精品济南到| 国产高清videossex| 亚洲一区中文字幕在线| 亚洲国产精品999在线| av有码第一页| 制服丝袜大香蕉在线| 波多野结衣一区麻豆| 日本在线视频免费播放| 老司机在亚洲福利影院| 国产精品香港三级国产av潘金莲| 欧美日韩亚洲综合一区二区三区_| bbb黄色大片| 啦啦啦观看免费观看视频高清 | 美女高潮到喷水免费观看| 一本久久中文字幕| 一卡2卡三卡四卡精品乱码亚洲| av网站免费在线观看视频| 午夜免费观看网址| 露出奶头的视频| 国产精品 国内视频| 一级,二级,三级黄色视频| 日本免费a在线| 国产亚洲欧美在线一区二区| 在线视频色国产色| 国产午夜福利久久久久久| 亚洲欧美激情在线| 国产午夜福利久久久久久| 亚洲精品在线美女| 亚洲欧美激情在线| 国产精品98久久久久久宅男小说| 在线十欧美十亚洲十日本专区| 老司机深夜福利视频在线观看| 757午夜福利合集在线观看| 97人妻天天添夜夜摸| 久久欧美精品欧美久久欧美| 他把我摸到了高潮在线观看| 久久精品成人免费网站| 免费在线观看亚洲国产| 国产日韩一区二区三区精品不卡| 欧美不卡视频在线免费观看 | 99久久综合精品五月天人人| 搡老熟女国产l中国老女人| cao死你这个sao货| 精品日产1卡2卡| 国产成人啪精品午夜网站| 9191精品国产免费久久| 韩国精品一区二区三区| 久久中文字幕一级| 成熟少妇高潮喷水视频| 777久久人妻少妇嫩草av网站| 18禁观看日本| 涩涩av久久男人的天堂| 高清黄色对白视频在线免费看| 亚洲人成伊人成综合网2020| 欧美绝顶高潮抽搐喷水| 国产又爽黄色视频| 久久久久久久精品吃奶| 一卡2卡三卡四卡精品乱码亚洲| 亚洲va日本ⅴa欧美va伊人久久| 亚洲三区欧美一区| 欧美国产精品va在线观看不卡| 国产成年人精品一区二区| 日韩 欧美 亚洲 中文字幕| www.自偷自拍.com| 免费在线观看影片大全网站| 日韩成人在线观看一区二区三区| 日本免费a在线| 亚洲欧美激情综合另类| 国产精品亚洲美女久久久| 亚洲精品在线观看二区| 久久人妻福利社区极品人妻图片| 精品日产1卡2卡| 亚洲自偷自拍图片 自拍| www.自偷自拍.com| 亚洲av日韩精品久久久久久密| 国产av又大| 两个人看的免费小视频| 欧美激情久久久久久爽电影 | 日韩av在线大香蕉| 国产亚洲欧美精品永久| 老司机靠b影院| 亚洲激情在线av| 他把我摸到了高潮在线观看| 日本撒尿小便嘘嘘汇集6| 国产精品野战在线观看| 精品电影一区二区在线| 免费女性裸体啪啪无遮挡网站| 成人国语在线视频| 夜夜躁狠狠躁天天躁| 日韩精品中文字幕看吧| 无限看片的www在线观看| 国产欧美日韩一区二区精品| 午夜精品久久久久久毛片777| 女人精品久久久久毛片| 啦啦啦韩国在线观看视频| 熟妇人妻久久中文字幕3abv| 国产精品亚洲一级av第二区| 波多野结衣av一区二区av| 午夜福利一区二区在线看| 国产欧美日韩一区二区三| 久久天堂一区二区三区四区| 十八禁网站免费在线| 成人精品一区二区免费| 真人做人爱边吃奶动态| 久久精品亚洲精品国产色婷小说| 国产亚洲精品一区二区www| 一边摸一边抽搐一进一出视频| 国产视频一区二区在线看| 12—13女人毛片做爰片一| 精品电影一区二区在线| 亚洲av电影在线进入| 99精品久久久久人妻精品| 色尼玛亚洲综合影院| 在线十欧美十亚洲十日本专区| 国产一区在线观看成人免费| 免费搜索国产男女视频| 夜夜躁狠狠躁天天躁| 国产亚洲av高清不卡| avwww免费| 男女之事视频高清在线观看| 校园春色视频在线观看| 亚洲五月色婷婷综合| 国产蜜桃级精品一区二区三区| 夜夜爽天天搞| 亚洲av片天天在线观看| 精品人妻在线不人妻| 视频在线观看一区二区三区| 黑人欧美特级aaaaaa片| 国产亚洲精品av在线| 麻豆国产av国片精品| 久久久久久亚洲精品国产蜜桃av| 国产1区2区3区精品| 久久久久久久午夜电影| 国产精品 国内视频| 最好的美女福利视频网| 午夜日韩欧美国产| 俄罗斯特黄特色一大片| 女同久久另类99精品国产91| 亚洲精品一卡2卡三卡4卡5卡| 在线观看免费视频网站a站| 日韩国内少妇激情av| 男男h啪啪无遮挡| 亚洲第一电影网av| 大陆偷拍与自拍| 丁香欧美五月| 91成人精品电影| 少妇熟女aⅴ在线视频| 午夜免费鲁丝| 国产aⅴ精品一区二区三区波| 亚洲 欧美一区二区三区| 两个人看的免费小视频| 精品欧美一区二区三区在线| 久久久久国内视频| 亚洲一码二码三码区别大吗| 免费av毛片视频| 国产亚洲精品第一综合不卡| 成人18禁在线播放| av天堂久久9| 午夜日韩欧美国产| 亚洲欧美激情在线| 999久久久精品免费观看国产| 欧美+亚洲+日韩+国产| 国产主播在线观看一区二区| 波多野结衣高清无吗| 欧美绝顶高潮抽搐喷水| 亚洲精品国产一区二区精华液| 国产区一区二久久| 久久久久国内视频| 欧美日韩乱码在线| 久久久久久国产a免费观看| 一区二区日韩欧美中文字幕| 欧美成人性av电影在线观看| 久久久国产成人精品二区| 国产成人免费无遮挡视频| 女人高潮潮喷娇喘18禁视频| 性色av乱码一区二区三区2| 欧美日韩乱码在线| 麻豆av在线久日| 少妇被粗大的猛进出69影院| 色哟哟哟哟哟哟| 欧美精品亚洲一区二区| 黑人操中国人逼视频| 精品无人区乱码1区二区| 色播亚洲综合网| 中文字幕另类日韩欧美亚洲嫩草| 黄色女人牲交| 丁香欧美五月| 亚洲伊人色综图| 欧美激情久久久久久爽电影 | 欧美最黄视频在线播放免费| svipshipincom国产片| 亚洲欧洲精品一区二区精品久久久| 久久精品国产99精品国产亚洲性色 | 国产成人精品无人区| 制服丝袜大香蕉在线| av网站免费在线观看视频| 国产成人av教育| 首页视频小说图片口味搜索| 看免费av毛片| 国产亚洲欧美98| 两人在一起打扑克的视频| aaaaa片日本免费| 很黄的视频免费| 欧美色欧美亚洲另类二区 | 青草久久国产| 久久久久久久午夜电影| 成人免费观看视频高清| 欧美黑人欧美精品刺激| 他把我摸到了高潮在线观看| 午夜福利欧美成人| 婷婷六月久久综合丁香| 久久国产精品男人的天堂亚洲| 亚洲精品中文字幕在线视频| 午夜精品国产一区二区电影| 久久人人97超碰香蕉20202| 纯流量卡能插随身wifi吗| 国产成人欧美| 妹子高潮喷水视频| 午夜福利高清视频| 欧美日本亚洲视频在线播放| 男女做爰动态图高潮gif福利片 | 亚洲中文日韩欧美视频| 午夜免费鲁丝| 在线观看舔阴道视频| 欧美精品啪啪一区二区三区| 激情在线观看视频在线高清| 亚洲午夜精品一区,二区,三区| 色播亚洲综合网| 亚洲精品美女久久久久99蜜臀| 国产精品,欧美在线| АⅤ资源中文在线天堂| 啦啦啦 在线观看视频| 国产欧美日韩精品亚洲av| 久久久水蜜桃国产精品网| 亚洲av成人av| 巨乳人妻的诱惑在线观看| 91麻豆精品激情在线观看国产| 亚洲视频免费观看视频| av视频在线观看入口| 精品国产一区二区久久| 久久久久国产一级毛片高清牌| 色综合欧美亚洲国产小说| 两性夫妻黄色片| 国产麻豆69| 熟女少妇亚洲综合色aaa.| 中文字幕最新亚洲高清| 精品国产乱子伦一区二区三区| 成人欧美大片| 国产精品野战在线观看| 午夜久久久在线观看| 国内精品久久久久精免费| 99精品在免费线老司机午夜| 色播在线永久视频| 亚洲一区中文字幕在线| 国产精品亚洲一级av第二区| 天天躁夜夜躁狠狠躁躁| 99久久久亚洲精品蜜臀av| 午夜影院日韩av| 午夜福利欧美成人| 天堂动漫精品| 叶爱在线成人免费视频播放| 日韩大码丰满熟妇| 婷婷精品国产亚洲av在线| 免费在线观看黄色视频的| 国产激情欧美一区二区| 成年版毛片免费区| 少妇粗大呻吟视频| 亚洲全国av大片| 日本免费一区二区三区高清不卡 | 亚洲少妇的诱惑av| 极品人妻少妇av视频| 午夜精品国产一区二区电影| 久久精品成人免费网站| 看黄色毛片网站| 亚洲精品国产精品久久久不卡| 亚洲五月天丁香| 在线播放国产精品三级| 日韩欧美三级三区| 亚洲在线自拍视频| 男女下面进入的视频免费午夜 | 狂野欧美激情性xxxx| 亚洲国产精品sss在线观看| 欧美成狂野欧美在线观看| 身体一侧抽搐| 给我免费播放毛片高清在线观看| 亚洲精品国产区一区二| 免费看十八禁软件| 亚洲熟女毛片儿| 在线观看午夜福利视频| 久久国产精品影院| 色播亚洲综合网| 久久精品亚洲熟妇少妇任你| 色综合亚洲欧美另类图片| 两个人视频免费观看高清| 老司机福利观看| 欧美性长视频在线观看| 国产乱人伦免费视频| 啦啦啦免费观看视频1| 男女下面插进去视频免费观看| 可以免费在线观看a视频的电影网站| 欧美精品啪啪一区二区三区| 男女下面进入的视频免费午夜 | 国产亚洲av嫩草精品影院| 国产一区二区三区视频了| 久久人妻熟女aⅴ| 女人爽到高潮嗷嗷叫在线视频| av在线天堂中文字幕| 欧美 亚洲 国产 日韩一| 搡老妇女老女人老熟妇| 曰老女人黄片| 这个男人来自地球电影免费观看| 999久久久精品免费观看国产| 后天国语完整版免费观看| ponron亚洲| bbb黄色大片| 国产野战对白在线观看| 91麻豆av在线| 1024香蕉在线观看| 国产精品一区二区免费欧美| 国产精品日韩av在线免费观看 | 人成视频在线观看免费观看| 国产亚洲精品久久久久久毛片| 国产精华一区二区三区| 老司机靠b影院| 久久久精品国产亚洲av高清涩受| 国产在线观看jvid| 多毛熟女@视频| 1024香蕉在线观看| 国产精品电影一区二区三区| 俄罗斯特黄特色一大片| 亚洲色图av天堂| 视频在线观看一区二区三区| 不卡一级毛片| 热99re8久久精品国产| 久久国产乱子伦精品免费另类| 一卡2卡三卡四卡精品乱码亚洲| 国产精品久久久久久精品电影 | 夜夜看夜夜爽夜夜摸| 国产熟女午夜一区二区三区| 亚洲伊人色综图| 成年女人毛片免费观看观看9| 午夜福利欧美成人| 日韩欧美国产在线观看| 99在线人妻在线中文字幕| 国产亚洲精品综合一区在线观看 | 欧美激情 高清一区二区三区| 亚洲欧美日韩高清在线视频| 天天添夜夜摸| 国产精品乱码一区二三区的特点 | 国产一区二区三区视频了| 黄色片一级片一级黄色片| 无遮挡黄片免费观看| svipshipincom国产片| 深夜精品福利| 咕卡用的链子| 久久久久久久久久久久大奶| 变态另类成人亚洲欧美熟女 | 无遮挡黄片免费观看| 日本在线视频免费播放| 变态另类丝袜制服| 老司机深夜福利视频在线观看| 色精品久久人妻99蜜桃| 老汉色∧v一级毛片| 操美女的视频在线观看| avwww免费| 淫妇啪啪啪对白视频| 亚洲av日韩精品久久久久久密| 精品久久久精品久久久| 日本 欧美在线| 亚洲精品国产区一区二| 女人精品久久久久毛片| 国产精品久久久久久精品电影 | 女人被躁到高潮嗷嗷叫费观| 亚洲成国产人片在线观看| 一进一出好大好爽视频| 亚洲欧美日韩高清在线视频| 久久久水蜜桃国产精品网| 亚洲专区字幕在线| 十八禁人妻一区二区| 一进一出抽搐gif免费好疼| 久久久国产成人精品二区| 久热这里只有精品99| 黄色a级毛片大全视频| 99国产综合亚洲精品| 成年版毛片免费区| 色精品久久人妻99蜜桃| 国产精品综合久久久久久久免费 | 99久久久亚洲精品蜜臀av| 可以在线观看的亚洲视频| 亚洲第一av免费看| 国产成人av激情在线播放| 叶爱在线成人免费视频播放| 亚洲精品一卡2卡三卡4卡5卡| 久9热在线精品视频| 女人高潮潮喷娇喘18禁视频| 欧洲精品卡2卡3卡4卡5卡区| 日韩三级视频一区二区三区| 欧美性长视频在线观看| 欧美成狂野欧美在线观看| 午夜福利18| 最新在线观看一区二区三区| 国产午夜福利久久久久久| 日本a在线网址| 男男h啪啪无遮挡| 黑人巨大精品欧美一区二区蜜桃| 18禁美女被吸乳视频| 免费观看精品视频网站| 国产精品香港三级国产av潘金莲| 中文字幕人妻熟女乱码| 老熟妇乱子伦视频在线观看| 淫秽高清视频在线观看| 精品久久久久久成人av| 国产精品综合久久久久久久免费 | 操美女的视频在线观看| 国产99白浆流出| 久久人人97超碰香蕉20202| 色精品久久人妻99蜜桃| 免费在线观看日本一区| 久久人人精品亚洲av| 免费看十八禁软件| 国产成+人综合+亚洲专区| 男女床上黄色一级片免费看| 国产麻豆69| 麻豆成人av在线观看| 色综合站精品国产| 两人在一起打扑克的视频| 亚洲第一av免费看| 久久人妻av系列| 久久人妻福利社区极品人妻图片| 久久国产精品影院| 美女 人体艺术 gogo| 国产蜜桃级精品一区二区三区| 欧美一级a爱片免费观看看 | 亚洲视频免费观看视频| 欧美乱码精品一区二区三区| 久久精品成人免费网站| 久久欧美精品欧美久久欧美| 亚洲精品国产一区二区精华液| 欧美激情 高清一区二区三区| 女人爽到高潮嗷嗷叫在线视频| 中亚洲国语对白在线视频| 国产欧美日韩一区二区三区在线| 欧美中文综合在线视频| 99国产精品免费福利视频| 精品久久久久久久人妻蜜臀av | 99国产精品99久久久久| 电影成人av| 成人特级黄色片久久久久久久| 两人在一起打扑克的视频| 欧美老熟妇乱子伦牲交| 咕卡用的链子| 后天国语完整版免费观看| 在线观看一区二区三区| 波多野结衣巨乳人妻| 日本a在线网址| 国产午夜福利久久久久久| 两人在一起打扑克的视频| 男女床上黄色一级片免费看| 久久久久国产精品人妻aⅴ院| tocl精华| 午夜福利欧美成人| 久久久久久久久中文| 嫁个100分男人电影在线观看| 国产成人系列免费观看| 脱女人内裤的视频| 欧美在线一区亚洲| 成人国产一区最新在线观看| 伦理电影免费视频| 99国产综合亚洲精品| 欧美亚洲日本最大视频资源| 成熟少妇高潮喷水视频| 国产成人精品在线电影| 亚洲精品在线美女| 精品久久久久久成人av| 成在线人永久免费视频| 不卡一级毛片| 亚洲国产精品久久男人天堂| 一个人免费在线观看的高清视频| 欧美成人午夜精品| 女人被狂操c到高潮| 亚洲精品国产精品久久久不卡| 麻豆成人av在线观看| 精品久久蜜臀av无| 久久香蕉国产精品| 午夜两性在线视频| 久久久国产成人精品二区| 女生性感内裤真人,穿戴方法视频| 女同久久另类99精品国产91| 亚洲第一欧美日韩一区二区三区| 成人免费观看视频高清|