• <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
    亚洲欧美清纯卡通| 久久久精品大字幕| 日本黄色视频三级网站网址| 亚洲成人中文字幕在线播放| 免费观看性生交大片5| 亚洲va在线va天堂va国产| 99热全是精品| 一级毛片aaaaaa免费看小| 九九在线视频观看精品| 亚洲伊人久久精品综合 | 久99久视频精品免费| 国产综合懂色| 一个人看的www免费观看视频| 久久99蜜桃精品久久| 精品午夜福利在线看| 欧美成人一区二区免费高清观看| 欧美成人精品欧美一级黄| 国产亚洲精品av在线| 一区二区三区高清视频在线| 亚洲av免费在线观看| 少妇猛男粗大的猛烈进出视频 | 亚洲欧美日韩卡通动漫| 成人二区视频| 黄色配什么色好看| 深夜a级毛片| 最近视频中文字幕2019在线8| 国产真实乱freesex| 国产 一区 欧美 日韩| 久久久久久久久久久免费av| 精品一区二区免费观看| 性插视频无遮挡在线免费观看| 久热久热在线精品观看| 色综合色国产| 精华霜和精华液先用哪个| 听说在线观看完整版免费高清| 国产成人aa在线观看| 日韩视频在线欧美| 中文天堂在线官网| 日韩强制内射视频| 久久久国产成人精品二区| 亚洲成av人片在线播放无| 在线观看av片永久免费下载| 狂野欧美激情性xxxx在线观看| 简卡轻食公司| 欧美高清成人免费视频www| 精品人妻偷拍中文字幕| 我要看日韩黄色一级片| 蜜桃亚洲精品一区二区三区| 亚洲经典国产精华液单| 国产精品,欧美在线| 好男人视频免费观看在线| 亚洲av电影不卡..在线观看| 成人亚洲欧美一区二区av| 亚洲欧美成人综合另类久久久 | 国产免费福利视频在线观看| 噜噜噜噜噜久久久久久91| 日韩 亚洲 欧美在线| 亚洲最大成人中文| 久久久久精品久久久久真实原创| 一边摸一边抽搐一进一小说| 国产大屁股一区二区在线视频| 精品国产露脸久久av麻豆 | 国国产精品蜜臀av免费| 韩国高清视频一区二区三区| 日韩国内少妇激情av| 欧美日韩在线观看h| 国产精品女同一区二区软件| 干丝袜人妻中文字幕| 麻豆成人av视频| av播播在线观看一区| 少妇裸体淫交视频免费看高清| 国产视频内射| 搞女人的毛片| 婷婷六月久久综合丁香| 亚洲av免费高清在线观看| 啦啦啦观看免费观看视频高清| 亚洲中文字幕一区二区三区有码在线看| 免费电影在线观看免费观看| 精品人妻熟女av久视频| 高清视频免费观看一区二区 | 深爱激情五月婷婷| 蜜桃亚洲精品一区二区三区| 久久久久久久久久久免费av| 亚洲熟妇中文字幕五十中出| 99热全是精品| 国产精品.久久久| 精品国产三级普通话版| 久久久久久国产a免费观看| 一级毛片我不卡| 欧美成人免费av一区二区三区| 看片在线看免费视频| 亚洲av二区三区四区| 男的添女的下面高潮视频| 少妇人妻一区二区三区视频| 国产精品三级大全| 一级毛片久久久久久久久女| 好男人视频免费观看在线| 51国产日韩欧美| 国产久久久一区二区三区| 国产激情偷乱视频一区二区| 成年版毛片免费区| 国产乱人视频| eeuss影院久久| 长腿黑丝高跟| 色播亚洲综合网| 三级毛片av免费| 亚洲美女搞黄在线观看| 大又大粗又爽又黄少妇毛片口| 亚洲经典国产精华液单| 国产三级在线视频| АⅤ资源中文在线天堂| 桃色一区二区三区在线观看| 国产白丝娇喘喷水9色精品| 黄色配什么色好看| 亚洲成人中文字幕在线播放| 国内精品宾馆在线| 亚洲欧美成人精品一区二区| 精品国产三级普通话版| 成人av在线播放网站| 小蜜桃在线观看免费完整版高清| 精华霜和精华液先用哪个| 六月丁香七月| 可以在线观看毛片的网站| 只有这里有精品99| 午夜福利在线观看吧| 观看免费一级毛片| 2022亚洲国产成人精品| 男女视频在线观看网站免费| 成人一区二区视频在线观看| 亚洲国产精品sss在线观看| 日日摸夜夜添夜夜爱| 直男gayav资源| 夜夜看夜夜爽夜夜摸| 长腿黑丝高跟| 欧美成人免费av一区二区三区| 三级男女做爰猛烈吃奶摸视频| 国产精品国产三级国产av玫瑰| 国产精品熟女久久久久浪| 日韩一区二区视频免费看| 国产真实伦视频高清在线观看| 欧美zozozo另类| 国产乱人偷精品视频| 永久网站在线| 久久99热这里只有精品18| 久久久久久伊人网av| 久久久精品大字幕| 色5月婷婷丁香| 成人亚洲欧美一区二区av| 特级一级黄色大片| 国产午夜福利久久久久久| 日韩av在线免费看完整版不卡| 久久这里只有精品中国| 中国国产av一级| 在现免费观看毛片| 内地一区二区视频在线| 国产亚洲精品av在线| 成人毛片a级毛片在线播放| 黄片wwwwww| 男女国产视频网站| 国产精华一区二区三区| 成人亚洲精品av一区二区| 国产又色又爽无遮挡免| 你懂的网址亚洲精品在线观看 | 日韩亚洲欧美综合| 国产综合懂色| 夫妻性生交免费视频一级片| 五月伊人婷婷丁香| 亚洲av免费在线观看| 成人综合一区亚洲| 日韩欧美 国产精品| 亚州av有码| 九九热线精品视视频播放| 亚洲国产精品成人综合色| 一级av片app| 91精品一卡2卡3卡4卡| 久久99精品国语久久久| 99在线人妻在线中文字幕| 亚洲国产欧美人成| 精品不卡国产一区二区三区| 欧美又色又爽又黄视频| 亚洲精品乱久久久久久| 国产精品三级大全| 女人被狂操c到高潮| 午夜免费男女啪啪视频观看| 欧美最新免费一区二区三区| av在线观看视频网站免费| 亚洲精品色激情综合| 大香蕉97超碰在线| videos熟女内射| 久久亚洲国产成人精品v| 日本免费在线观看一区| 色噜噜av男人的天堂激情| 亚洲精品影视一区二区三区av| 久久精品夜色国产| 欧美一级a爱片免费观看看| 国产精品一区二区在线观看99 | 看片在线看免费视频| 三级国产精品欧美在线观看| 国产精品一及| 一级毛片我不卡| 国产精品永久免费网站| 亚洲成人av在线免费| 深爱激情五月婷婷| av国产免费在线观看| 听说在线观看完整版免费高清| 一级黄片播放器| 免费人成在线观看视频色| 亚洲中文字幕一区二区三区有码在线看| 99久久中文字幕三级久久日本| 春色校园在线视频观看| 真实男女啪啪啪动态图| 国产成人精品久久久久久| 国产精品,欧美在线| 建设人人有责人人尽责人人享有的 | 级片在线观看| 国产亚洲精品av在线| 欧美日韩在线观看h| 欧美性猛交╳xxx乱大交人| 欧美成人免费av一区二区三区| 色综合色国产| 午夜a级毛片| 两个人视频免费观看高清| 亚洲人成网站在线播| 亚洲国产日韩欧美精品在线观看| 国产高潮美女av| 日日撸夜夜添| 91精品伊人久久大香线蕉| 如何舔出高潮| 欧美人与善性xxx| 国产午夜精品久久久久久一区二区三区| 亚洲精品国产成人久久av| 免费黄色在线免费观看| 日韩一区二区视频免费看| 欧美一区二区精品小视频在线| 99在线人妻在线中文字幕| 国产真实乱freesex| 国产欧美日韩精品一区二区| 欧美精品一区二区大全| 久久久久久大精品| 青春草国产在线视频| 中国美白少妇内射xxxbb| 国产 一区精品| 中文乱码字字幕精品一区二区三区 | 久久人妻av系列| 自拍偷自拍亚洲精品老妇| 国产在视频线精品| 日本熟妇午夜| 嫩草影院精品99| 国产综合懂色| 久久99热这里只有精品18| 国产精品一二三区在线看| 亚洲第一区二区三区不卡| 精品免费久久久久久久清纯| 久久久久久久久中文| 精品久久久久久电影网 | 色综合亚洲欧美另类图片| 秋霞在线观看毛片| 边亲边吃奶的免费视频| 精品久久久久久久末码| 天天一区二区日本电影三级| 免费大片18禁| 天堂av国产一区二区熟女人妻| 色综合亚洲欧美另类图片| 亚洲最大成人手机在线| 在线天堂最新版资源| 一区二区三区四区激情视频| 搞女人的毛片| 深爱激情五月婷婷| 日韩在线高清观看一区二区三区| 亚洲18禁久久av| 亚洲av电影不卡..在线观看| ponron亚洲| 精品久久久久久久末码| 免费无遮挡裸体视频| 男女国产视频网站| 看片在线看免费视频| 久久久久久久久久黄片| 色尼玛亚洲综合影院| 国产亚洲5aaaaa淫片| 禁无遮挡网站| .国产精品久久| 久久99热这里只频精品6学生 | 最近最新中文字幕免费大全7| 国产单亲对白刺激| 亚洲真实伦在线观看| 2021少妇久久久久久久久久久| 看免费成人av毛片| 91在线精品国自产拍蜜月| 天堂av国产一区二区熟女人妻| 日韩欧美三级三区| 最近最新中文字幕大全电影3| 黄片wwwwww| 国产亚洲一区二区精品| 国产三级中文精品| 国产精品一区www在线观看| 国产精品久久久久久久电影| 国产精品久久视频播放| 国产精品国产高清国产av| 美女xxoo啪啪120秒动态图| 秋霞伦理黄片| 亚洲欧洲日产国产| 国产探花在线观看一区二区| 精品一区二区三区视频在线| 欧美不卡视频在线免费观看| 精品免费久久久久久久清纯| 伦精品一区二区三区| 色综合站精品国产| 午夜视频国产福利| 久久久久久大精品| 18+在线观看网站| 亚洲国产欧洲综合997久久,| 久久久精品大字幕| 亚洲av成人av| 99热这里只有是精品50| 丰满人妻一区二区三区视频av| 成人亚洲精品av一区二区| 亚洲乱码一区二区免费版| 成人性生交大片免费视频hd| 男的添女的下面高潮视频| 午夜精品在线福利| 精品熟女少妇av免费看| 免费观看的影片在线观看| 欧美不卡视频在线免费观看| 99久久无色码亚洲精品果冻| 国产毛片a区久久久久| 99热网站在线观看| 久久精品久久久久久久性| 国产三级中文精品| 一区二区三区乱码不卡18| 久久精品熟女亚洲av麻豆精品 | 国产亚洲最大av| 精品久久久噜噜| 国产成人91sexporn| 成年av动漫网址| 村上凉子中文字幕在线| 国产单亲对白刺激| 婷婷色综合大香蕉| 国产一级毛片在线| 免费观看a级毛片全部| 成人鲁丝片一二三区免费| 日韩av在线免费看完整版不卡| 在线免费十八禁| 三级国产精品欧美在线观看| 在线免费十八禁| av在线蜜桃| 欧美成人一区二区免费高清观看| 精品国产一区二区三区久久久樱花 | 啦啦啦啦在线视频资源| 成人三级黄色视频| 欧美极品一区二区三区四区| 婷婷六月久久综合丁香| 国产在视频线在精品| 搡女人真爽免费视频火全软件| 国产精品久久久久久久久免| 日本色播在线视频| 国产精品蜜桃在线观看| 欧美日韩精品成人综合77777| 国产69精品久久久久777片| 只有这里有精品99| 国产一级毛片在线| 国内揄拍国产精品人妻在线| 尤物成人国产欧美一区二区三区| www.色视频.com| 欧美成人午夜免费资源| 久久99热这里只有精品18| 久久精品国产亚洲av天美| eeuss影院久久| 中文字幕亚洲精品专区| 日韩制服骚丝袜av| 级片在线观看| 国产精品一区二区三区四区久久| 成人欧美大片| 久久久精品94久久精品| 91狼人影院| 综合色丁香网| 国产精品乱码一区二三区的特点| 岛国在线免费视频观看| av福利片在线观看| 免费观看的影片在线观看| 成年女人看的毛片在线观看| 午夜精品在线福利| 日韩人妻高清精品专区| 久久99热6这里只有精品| 亚洲精品久久久久久婷婷小说 | 国产一级毛片七仙女欲春2| 国产精品熟女久久久久浪| 人妻夜夜爽99麻豆av| 亚洲欧美中文字幕日韩二区| 男女啪啪激烈高潮av片| 久久久久性生活片| av播播在线观看一区| 男人狂女人下面高潮的视频| 成人国产麻豆网| 欧美高清性xxxxhd video| 国内揄拍国产精品人妻在线| 国产亚洲av片在线观看秒播厂 | 99九九线精品视频在线观看视频| 亚洲欧美日韩东京热| 久久精品久久精品一区二区三区| 少妇高潮的动态图| 一二三四中文在线观看免费高清| 国产黄片美女视频| 国产亚洲av嫩草精品影院| 久久精品91蜜桃| 99久国产av精品国产电影| 国产午夜福利久久久久久| 99在线视频只有这里精品首页| 午夜福利高清视频| 欧美丝袜亚洲另类| av在线观看视频网站免费| 免费看av在线观看网站| 少妇被粗大猛烈的视频| 国产久久久一区二区三区| 亚洲av男天堂| 99热精品在线国产| 成人漫画全彩无遮挡| 中文资源天堂在线| 一二三四中文在线观看免费高清| 高清午夜精品一区二区三区| 中文乱码字字幕精品一区二区三区 | 日韩欧美精品v在线| 亚洲精品456在线播放app| 日韩精品有码人妻一区| 国产在视频线在精品| 国产高清视频在线观看网站| 国产午夜精品一二区理论片| 搡老妇女老女人老熟妇| 一个人看的www免费观看视频| 最后的刺客免费高清国语| 亚洲国产高清在线一区二区三| 亚洲国产色片| 亚洲精品久久久久久婷婷小说 | 亚洲精品自拍成人| 啦啦啦啦在线视频资源| 九九久久精品国产亚洲av麻豆| av黄色大香蕉| 国产成人精品婷婷| 久久久欧美国产精品| 天美传媒精品一区二区| 在线a可以看的网站| 一本一本综合久久| 国产亚洲5aaaaa淫片| 欧美成人免费av一区二区三区| 久久久成人免费电影| 久久久a久久爽久久v久久| 国产黄a三级三级三级人| 欧美变态另类bdsm刘玥| av在线播放精品| 小说图片视频综合网站| 国产人妻一区二区三区在| 91午夜精品亚洲一区二区三区| 成年免费大片在线观看| 婷婷六月久久综合丁香| 国产探花在线观看一区二区| 免费看美女性在线毛片视频| 夫妻性生交免费视频一级片| 国产精品久久久久久精品电影小说 | 国产在视频线精品| 久久精品人妻少妇| 亚洲精品456在线播放app| 在线免费观看的www视频| 国产久久久一区二区三区| 黑人高潮一二区| 美女被艹到高潮喷水动态| 嫩草影院精品99| 国产精品国产高清国产av| 欧美xxxx性猛交bbbb| 在线观看av片永久免费下载| 极品教师在线视频| 日日撸夜夜添| 赤兔流量卡办理| 亚洲国产最新在线播放| 纵有疾风起免费观看全集完整版 | 中文字幕制服av| 丰满人妻一区二区三区视频av| 天堂av国产一区二区熟女人妻| 日本免费a在线| av天堂中文字幕网| 日韩 亚洲 欧美在线| 亚洲乱码一区二区免费版| 99久久人妻综合| 一边亲一边摸免费视频| 国产伦一二天堂av在线观看| 最后的刺客免费高清国语| 天天躁夜夜躁狠狠久久av| 久热久热在线精品观看| 黑人高潮一二区| 在线播放无遮挡| 亚洲欧美日韩卡通动漫| 精品一区二区三区人妻视频| 青春草国产在线视频| 日本wwww免费看| 国产精品电影一区二区三区| 观看美女的网站| h日本视频在线播放| 国内精品宾馆在线| 欧美日韩在线观看h| 91精品国产九色| 亚洲成人中文字幕在线播放| 精品久久久久久成人av| 变态另类丝袜制服| 秋霞伦理黄片| 一级毛片电影观看 | 国产成年人精品一区二区| 久久久欧美国产精品| 免费搜索国产男女视频| 亚洲av日韩在线播放| 干丝袜人妻中文字幕| 我的女老师完整版在线观看| 小蜜桃在线观看免费完整版高清| 91精品伊人久久大香线蕉| 91久久精品电影网| 91精品国产九色| 亚洲av男天堂| 中国美白少妇内射xxxbb| 午夜福利在线观看吧| 又粗又爽又猛毛片免费看| 亚洲久久久久久中文字幕| 精品午夜福利在线看| 欧美人与善性xxx| 国产精华一区二区三区| 亚洲成人精品中文字幕电影| 国产精品麻豆人妻色哟哟久久 | 久久精品国产99精品国产亚洲性色| 七月丁香在线播放| 欧美日本视频| 一边摸一边抽搐一进一小说| 日本五十路高清| av黄色大香蕉| 噜噜噜噜噜久久久久久91| 在线观看66精品国产| 国产精品美女特级片免费视频播放器| 最新中文字幕久久久久| 国产淫语在线视频| 狠狠狠狠99中文字幕| 成人毛片60女人毛片免费| 亚洲欧美精品综合久久99| 亚洲精品乱久久久久久| 搞女人的毛片| 欧美色视频一区免费| 欧美日韩精品成人综合77777| 亚洲三级黄色毛片| 狠狠狠狠99中文字幕| 国产免费一级a男人的天堂| 一级av片app| 国产亚洲91精品色在线| 黄色一级大片看看| 国产成人aa在线观看| 婷婷六月久久综合丁香| 97超碰精品成人国产| 一区二区三区免费毛片| 免费看a级黄色片| 天堂影院成人在线观看| 舔av片在线| 亚洲成人av在线免费| a级毛色黄片| 日本wwww免费看| 日韩欧美在线乱码| 性色avwww在线观看| av播播在线观看一区| 国产日韩欧美在线精品| 欧美激情在线99| 天天躁夜夜躁狠狠久久av| 直男gayav资源| or卡值多少钱| av.在线天堂| 欧美成人精品欧美一级黄| 麻豆国产97在线/欧美| 国产精品国产高清国产av| 欧美xxxx性猛交bbbb| 亚洲综合色惰| 特级一级黄色大片| 麻豆成人午夜福利视频| 搡女人真爽免费视频火全软件| 天堂av国产一区二区熟女人妻| 精品久久久久久久末码| 2021天堂中文幕一二区在线观| 亚洲精品一区蜜桃| 青春草亚洲视频在线观看| h日本视频在线播放| 人妻系列 视频| 免费av毛片视频| 尾随美女入室| 亚洲四区av| 欧美日韩精品成人综合77777| 天堂av国产一区二区熟女人妻| 亚洲国产最新在线播放| 久久国产乱子免费精品| 天堂网av新在线| 亚洲欧美日韩卡通动漫| 亚洲精品日韩在线中文字幕| 老女人水多毛片| 国产高清有码在线观看视频| 亚洲激情五月婷婷啪啪| 欧美高清性xxxxhd video| 国产精品精品国产色婷婷| 国产熟女欧美一区二区| 晚上一个人看的免费电影| a级毛片免费高清观看在线播放| 国产精品一区二区在线观看99 | 麻豆av噜噜一区二区三区| 黑人高潮一二区| 少妇高潮的动态图| 三级国产精品片| 国产av不卡久久| 三级男女做爰猛烈吃奶摸视频| 婷婷色av中文字幕| 精品午夜福利在线看| 三级经典国产精品| 国产乱来视频区| 长腿黑丝高跟| 国产成人freesex在线| 国内精品宾馆在线| 精华霜和精华液先用哪个| 日韩欧美在线乱码|