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

    機(jī)械臂環(huán)境三維重建與避障算法研究

    2024-01-26 09:19:20陳新度孔德良
    機(jī)械設(shè)計(jì)與制造 2024年1期
    關(guān)鍵詞:位姿三維重建坐標(biāo)系

    陳新度,徐 學(xué),高 萌,孔德良

    (1.廣東工業(yè)大學(xué)機(jī)電工程學(xué)院,廣東 廣州 510006;2.佛山智能裝備技術(shù)研究院,廣東 佛山 528234 3.廣東工業(yè)大學(xué)省部共建精密電子制造技術(shù)與裝備國(guó)家重點(diǎn)實(shí)驗(yàn)室,廣東 廣州 510006)

    1 前言

    工業(yè)機(jī)械臂作為仿人手的自動(dòng)裝置,具有通用性強(qiáng)、運(yùn)動(dòng)靈活等優(yōu)點(diǎn)[1]。隨著機(jī)器人應(yīng)用場(chǎng)景的復(fù)雜、非結(jié)構(gòu)化,對(duì)其提出了實(shí)時(shí)感知和避障的要求。常規(guī)可預(yù)先建立障礙物空間模型或通過(guò)示教方法,以形成無(wú)碰撞軌跡。但此類(lèi)方法只能針對(duì)靜態(tài)環(huán)境,對(duì)動(dòng)態(tài)環(huán)境不具有泛化性。因此,在未知環(huán)境中的三維重建和避障規(guī)劃成為亟需解決的實(shí)際問(wèn)題。

    在目標(biāo)識(shí)別方面,主要分為基于模板匹配、三維局部特征、學(xué)習(xí)的方法。文獻(xiàn)[2]利用快速形狀匹配算法將三維CAD模型在多視角的位姿映射作為模板,與位姿完成匹配。文獻(xiàn)[3]通過(guò)提取二維圖像和點(diǎn)云圖像的多模態(tài)信息,實(shí)現(xiàn)物體的識(shí)別定位。文獻(xiàn)[4]以各視點(diǎn)下的RGB-D圖像融合CNN網(wǎng)絡(luò),完成待測(cè)物體的目標(biāo)識(shí)別。

    在三維重建方面,主要以基于傳統(tǒng)多視角幾何、深度學(xué)習(xí)算法為主。如文獻(xiàn)[5]提出的Kinect Fusion,開(kāi)啟了RGB實(shí)時(shí)三維重建的序幕,此后有Elastic Fusion[6]、Bundle Fusion[7]等。文獻(xiàn)[8]提出Pixel2Mesh,用端到端的神經(jīng)網(wǎng)絡(luò)實(shí)現(xiàn)了從單張彩色圖直接生成用網(wǎng)格表示的物體三維信息。

    在機(jī)器人避障規(guī)劃方面,文獻(xiàn)[9]將障礙物映射到構(gòu)形空間,利用A?算法搜索避障路徑,但將空間障礙物投影到二維平面中,無(wú)法充分發(fā)揮高自由度工業(yè)機(jī)械臂在避障方面的優(yōu)勢(shì)。文獻(xiàn)[10]提出RRT-connect,通過(guò)雙樹(shù)搜索大幅提升規(guī)劃速度,但由于隨機(jī)采樣,不具備漸進(jìn)最優(yōu)。

    綜上分析可看出,雖然識(shí)別定位、三維重建和避障規(guī)劃方面研究成果較豐富,但三者的結(jié)合,即目標(biāo)物識(shí)別后對(duì)于未知環(huán)境空間的重建及效果、避障算法驅(qū)動(dòng)機(jī)械臂避開(kāi)重建的障礙的效果等研究尚存在不足。據(jù)此,本研究提出一種基于視覺(jué)的三維重建與避障規(guī)劃方法。

    通過(guò)搭建基于機(jī)器人操作系統(tǒng)(ROS)的實(shí)驗(yàn)平臺(tái),使用深度相機(jī)獲取ArUco標(biāo)記上的特征點(diǎn)坐標(biāo),求解目標(biāo)物的姿態(tài);通過(guò)改進(jìn)重建方法,融合機(jī)械臂末端位姿和點(diǎn)云數(shù)據(jù),對(duì)未知環(huán)境空間進(jìn)行三維重建,作為后續(xù)規(guī)劃的障礙空間;應(yīng)用RRT的改進(jìn)算法進(jìn)行機(jī)械臂的避障運(yùn)動(dòng)規(guī)劃,并進(jìn)行了真機(jī)驗(yàn)證。

    2 原理與方法

    2.1 相機(jī)模型與標(biāo)定

    物體的三維空間坐標(biāo)與圖像坐標(biāo)存在線性關(guān)系。世界坐標(biāo)系、相機(jī)坐標(biāo)系以及圖像坐標(biāo)系之間的關(guān)系,如圖1所示。而坐標(biāo)點(diǎn)間的轉(zhuǎn)換關(guān)系,如式(1)所示。

    圖1 各坐標(biāo)系轉(zhuǎn)換模型Fig.1 Transformation Model of Each Coordinate System

    式中:Puv—標(biāo)記在像素坐標(biāo)系下的像素坐標(biāo);Pw—標(biāo)記在世界坐標(biāo)系中的坐標(biāo);K—相機(jī)內(nèi)參;T—相機(jī)外參。這里采用ArUco 自帶的標(biāo)定算法[11]對(duì)相機(jī)進(jìn)行標(biāo)定,確定攝像頭的內(nèi)參矩陣K以及畸變參數(shù)D,標(biāo)定結(jié)果為:

    研究構(gòu)建了眼在手上的手眼系統(tǒng),如圖2所示。A為末端與機(jī)械臂基坐標(biāo)系的變換關(guān)系,可通過(guò)機(jī)械臂正解獲得;C為相機(jī)與標(biāo)定板的變換,即已求的相機(jī)外參;B為相機(jī)與機(jī)械臂末端的變換關(guān)系,該關(guān)系是最終要求解的手眼矩陣。

    圖2 手眼標(biāo)定示意圖Fig.2 Schematic Diagram of Hand-eye Calibration

    為求解B,需要多次變換機(jī)械臂姿態(tài)拍攝標(biāo)定板,獲得不同角度下的標(biāo)定圖像,從而推導(dǎo)出相機(jī)相對(duì)于末端的變換矩陣。

    建立不同空間轉(zhuǎn)換回路,如式(2)所示:

    式(4)、式(5)代入式(3)得:

    式(6)就轉(zhuǎn)換成了經(jīng)典方程AX=XB的求解問(wèn)題[12]。通過(guò)兩步法求解手眼矩陣為:

    2.2 目標(biāo)識(shí)別與位姿估計(jì)

    位姿估計(jì)即找到現(xiàn)實(shí)世界和圖像投影之間的對(duì)應(yīng)點(diǎn),求得相機(jī)與目標(biāo)之間的相對(duì)位姿。本研究選用基于二進(jìn)制標(biāo)記的方法,優(yōu)點(diǎn)在于單個(gè)標(biāo)記即可提供足夠多的對(duì)應(yīng)點(diǎn),且具有錯(cuò)誤檢測(cè)與校正機(jī)制[13]。選用的ArUco標(biāo)記由一個(gè)四邊全黑的邊框以及內(nèi)部的二進(jìn)制矩陣組成,黑色代表0,白色代表1,每一個(gè)標(biāo)記都有一個(gè)獨(dú)有的ID,標(biāo)記大小為(5×5),標(biāo)記尺寸為(40×40)mm,ID為1,標(biāo)記的中心點(diǎn)為原點(diǎn),如圖3所示。

    表1 集成的插件及參數(shù)設(shè)置Tab.1 Integrated Plug-in and Parameter Settings

    圖3 ArUco標(biāo)記圖Fig.3 Marked Diagram of Aruco

    ArUco標(biāo)記的識(shí)別步驟,如圖4所示。將獲取的RGB圖像經(jīng)過(guò)灰度化、自適應(yīng)閾值分割、輪廓濾波、透視變換得到正視圖;并利用Otsu 分離出白黑色位,分析標(biāo)記ID;將角點(diǎn)亞像素級(jí)細(xì)化后,根據(jù)小孔成像模型,通過(guò)ArUco標(biāo)記的4個(gè)角點(diǎn)像素坐標(biāo),使用solvePnP函數(shù)[14]即可求得標(biāo)記與相機(jī)之間的變換矩陣。

    圖4 ArUco位姿估計(jì)流程圖Fig.4 Flow Chart of Aruco Pose Estimation

    ArUco標(biāo)記、相機(jī)、末端和基座關(guān)系,如圖5所示。

    圖5 各坐標(biāo)系變換關(guān)系圖Fig.5 Transformation Relation Diagram of Each Coordinate System

    轉(zhuǎn)換關(guān)系,如式(7)所示。通過(guò)求得的標(biāo)記與相機(jī)之間的變換矩陣、手眼矩陣和末端位姿,可得標(biāo)記與機(jī)械臂基坐標(biāo)系之間的變換矩陣,即目標(biāo)物空間三維姿態(tài)。

    2.3 融合末端位姿的三維重建

    ICP算法是用來(lái)解決點(diǎn)云之間的配準(zhǔn)問(wèn)題,計(jì)算出最優(yōu)匹配變換矩陣,使得誤差最小[15]。但在兩點(diǎn)云相差較大的情況下,ICP容易陷入局部最優(yōu)解,所以需要在精配準(zhǔn)之前進(jìn)行粗配準(zhǔn)[16],并以粗配準(zhǔn)得到的轉(zhuǎn)換矩陣作為其初始轉(zhuǎn)換矩陣。由于采用的是手眼系統(tǒng),而末端相對(duì)于機(jī)械臂基座的位姿關(guān)系容易獲得,可通過(guò)在配準(zhǔn)之前,獲取機(jī)器人末端位姿,將對(duì)應(yīng)時(shí)刻的點(diǎn)云數(shù)據(jù)統(tǒng)一到同一坐標(biāo)系下,再進(jìn)行后續(xù)的配準(zhǔn)融合工作。

    假定相機(jī)在位置1、2 處分別獲取點(diǎn)云,且獲得對(duì)應(yīng)處的位姿,有:

    由式(8)、式(9)可得:

    化簡(jiǎn)式(10)得:

    式中:n∈N+,n≥2。

    得到各點(diǎn)云剛體變換矩陣后,再將其融合FPFH_ICP配準(zhǔn)算法,得到基于基坐標(biāo)系的全局點(diǎn)云模型。

    利用八叉樹(shù)數(shù)據(jù)結(jié)構(gòu)描述作業(yè)空間(全局點(diǎn)云),將各象限定義為八叉樹(shù)的葉子節(jié)點(diǎn),并不斷進(jìn)行迭代,直到滿足終止條件[17]。假設(shè)t=1,…,T時(shí)刻,觀測(cè)的數(shù)據(jù)為z1,…,zT,則第n個(gè)葉子節(jié)點(diǎn)的狀態(tài)信息為:

    式中:P(n|z1:T)—空間節(jié)點(diǎn)n在1到t時(shí)刻被占有的概率;

    P(n|z1:T-1)—空間節(jié)點(diǎn)n在1到t-1時(shí)刻被占有的概率;

    P(n|zT)—空間節(jié)點(diǎn)n在t時(shí)刻被占有的概率;

    P(n)—先驗(yàn)概率。

    2.4 RRT*改進(jìn)算法

    RRT-Connect算法通過(guò)雙向搜索和貪婪策略大大降低了計(jì)算量,提高了搜索速度,但由于隨機(jī)采樣,路徑較長(zhǎng),無(wú)法達(dá)到漸進(jìn)最優(yōu)。

    RRT*通過(guò)引入路徑代價(jià)的概念,不斷迭代找到漸進(jìn)最優(yōu)路徑,但降低了計(jì)算效率。

    針對(duì)上述缺陷,提出了改進(jìn)算法CAN-RRT*(RRT* with Caucy Sample、Attractive Force and NodeReject),通過(guò)引入柯西采樣函數(shù)取代隨機(jī)采樣,使采樣點(diǎn)更大概率落在障礙物附近,降低采樣的盲目性;通過(guò)引入目標(biāo)引力和動(dòng)態(tài)步長(zhǎng)法,提高局部搜索速度;利用節(jié)點(diǎn)拒絕策略來(lái)剔除不必要的采樣節(jié)點(diǎn),使算法能夠以高效率生成最終路徑。

    柯西分布概率密度函數(shù)為f(x,x0,g),其中,x0—峰值的位置參數(shù);γ—最大值一半處的一半寬度的尺度參數(shù)。

    令l=|x-x0|,表示采樣點(diǎn)與障礙物的距離,l越小,函數(shù)值越大,l越大,函數(shù)值越小。

    引入目標(biāo)引力,引力勢(shì)能為:

    式中:k—引力系數(shù)。可得qgoal對(duì)qnear的目標(biāo)引力為:

    擴(kuò)展后新節(jié)點(diǎn)位置,如式(18)所示。

    式中:ρ1—隨機(jī)方向步長(zhǎng);ρ2—目標(biāo)方向步長(zhǎng)。

    在采樣過(guò)程選擇一個(gè)節(jié)點(diǎn)之后,在節(jié)點(diǎn)擴(kuò)展前使用節(jié)點(diǎn)剔除策略,如式(19)所示,即如果當(dāng)前的最低成本低于直接從初始節(jié)點(diǎn)到該節(jié)點(diǎn)以及從該節(jié)點(diǎn)到目標(biāo)節(jié)點(diǎn)的總成本,則剔除該節(jié)點(diǎn)。

    式中:qstart—起點(diǎn)位姿;qgoal—目標(biāo)位姿;q—候選節(jié)點(diǎn);σbest—當(dāng)前最低路徑成本。

    偽代碼,如圖6所示。

    圖6 CAN-RRT*偽代碼Fig.6 Pseudocode of CAN-RRT*

    其中,(1)CaucySample():柯西采樣函數(shù),在C-space得到隨機(jī)節(jié)點(diǎn)xrand;(2)Neares(t):最近鄰點(diǎn)函數(shù),得到最接近qrand的節(jié)點(diǎn)qnearest;(3)AttractiveForce(():目標(biāo)引力與動(dòng)態(tài)步長(zhǎng)函數(shù),產(chǎn)生新節(jié)點(diǎn)qnew;(4)NodeRejec(t():節(jié)點(diǎn)拒絕函數(shù);(5)GetSortedLis(t():集合排序函數(shù),返回按成本函數(shù)升序排列的列表;(6)ChooseBest-Paren(t():最優(yōu)父節(jié)點(diǎn)函數(shù);(7)RewireVertices(():重布線函數(shù),找到隨機(jī)樹(shù)Tb中距離xnew最近的節(jié)點(diǎn)xconn;(8)connec(t):返回連接xstart和xgoal的無(wú)碰撞路徑;(9)SwapTrees():交換雙樹(shù)。

    在三維、隨機(jī)障礙的環(huán)境下,對(duì)CAN-RRT*算法進(jìn)行避障規(guī)劃,如圖7所示。

    圖7 CAN-RRT*運(yùn)動(dòng)規(guī)劃Fig.7 Motion Planning of CAN-RRT*

    3 實(shí)驗(yàn)驗(yàn)證與分析

    3.1 實(shí)驗(yàn)平臺(tái)搭建

    3.1.1 真實(shí)平臺(tái)搭建

    所搭建的實(shí)驗(yàn)平臺(tái),如圖8所示。該平臺(tái)包含機(jī)器人、深度相機(jī)和末端執(zhí)行器。采用的機(jī)器人由Universal Robots 制造,型號(hào)為UR5,負(fù)載5kg,工作范圍為850mm,理論重復(fù)定位精度為±0.03mm;深度相機(jī)為INTEL 公司的RealSense D435i,其具有彩色、紅外及IMU模塊,測(cè)量距離為(0.105~10)m;末端執(zhí)行器為因時(shí)機(jī)器人的EG2-4B2電動(dòng)夾爪,重復(fù)定位精度±0.5mm,最大速度97mm/s。

    圖8 UR5機(jī)器人平臺(tái)Fig.8 UR5 Robot Platform

    視覺(jué)系統(tǒng)獲取工件及作業(yè)環(huán)境的信息,機(jī)械臂經(jīng)規(guī)劃,運(yùn)動(dòng)到工件位置,末端執(zhí)行器對(duì)工件進(jìn)行夾持,并將工件放到貨架指定位置處。

    3.1.2 仿真及控制搭建

    基于ROS開(kāi)發(fā)了仿真及控制平臺(tái),集成碰撞檢測(cè)、正逆運(yùn)動(dòng)學(xué)求解、軌跡平滑等功能,部分插件選擇及參數(shù)設(shè)置,如表1 所示。RVIZ界面的部署,如圖9所示。系統(tǒng)的避障規(guī)劃流程,如圖10所示。

    圖9 機(jī)器人仿真與控制平臺(tái)Fig.9 Robot Simulation and Control Platform

    圖10 機(jī)器人仿真及控制系統(tǒng)Fig.10 Robot Simulation and Control System

    視覺(jué)定位系統(tǒng)獲取工件姿態(tài),三維重建系統(tǒng)生成障礙模型,信息匯總到規(guī)劃場(chǎng)景中,提供給CAN-RRT*規(guī)劃器生成無(wú)碰撞路徑,并通過(guò)Movelt驅(qū)動(dòng)機(jī)械臂,運(yùn)動(dòng)到目標(biāo)位置成夾持任務(wù)。

    3.2 識(shí)別定位分析

    為了驗(yàn)證視覺(jué)定位精度,開(kāi)展了精度評(píng)估實(shí)驗(yàn),如圖13 所示。使用4點(diǎn)法將機(jī)器人末端TCP移到頂針末端,使用Halcon手眼標(biāo)定獲得相機(jī)與機(jī)器人坐標(biāo)系之間的變換矩陣,ArUco標(biāo)記張貼在平面上。將頂針末端移動(dòng)至與ArUco原點(diǎn)重合,從RVIZ中監(jiān)聽(tīng)該點(diǎn)在機(jī)器人基座坐標(biāo)系下的位姿,作為真實(shí)值,即1.2節(jié)式(7)中的,通過(guò)ArUco 的姿態(tài)估計(jì)矩陣、機(jī)器人手眼標(biāo)定矩陣和機(jī)械臂末端位姿矩陣,得到ArUco標(biāo)記原點(diǎn)的計(jì)算值。通過(guò)比較兩者之間的偏差可以評(píng)估視覺(jué)定位精度。使用ID字典為5的ArUco標(biāo)記,相機(jī)距離平面350mm,垂直向下拍攝,統(tǒng)計(jì)實(shí)驗(yàn)數(shù)據(jù),如表2、圖11所示。

    表2 同一位置目標(biāo)點(diǎn)識(shí)別位姿Tab.2 Recognized Pose of the Same Target Point

    圖11 同一位置定位數(shù)據(jù)偏差圖Fig.11 Location Data Deviation Diagram of the Same Location

    重復(fù)測(cè)量十次,實(shí)驗(yàn)結(jié)果表明,X、Y、Z方向基本穩(wěn)定在8mm以內(nèi),姿態(tài)角可以穩(wěn)定在2°以內(nèi),驗(yàn)證了目標(biāo)識(shí)別精度的可行性。

    3.3 三維建模分析

    對(duì)機(jī)械臂作業(yè)的環(huán)境進(jìn)行重建,重建效果,如圖12所示。可以看出,融合末端位姿的重建方法能夠有效的將環(huán)境中的障礙物重建到規(guī)劃環(huán)境中,但某些地方還存在空洞現(xiàn)象。

    圖12 全局點(diǎn)云效果圖Fig.12 Rendering of Global Point Cloud

    這里采用定位精度和尺寸精度來(lái)衡量重建的效果。如圖13中的長(zhǎng)方體物體,實(shí)際尺寸為(277mm,200mm,126mm),進(jìn)行多次重建,取其中8次結(jié)果對(duì)比。

    圖13 作業(yè)空間障礙物及標(biāo)記點(diǎn)Fig.13 Obstacles and Markers in Working Space

    分析表3,可知在物體長(zhǎng)寬高方向上誤差均值分別為1.37mm、1.78mm、1.34mm,誤差控制在5mm以內(nèi),基本上達(dá)到重建的要求,表3中單位為mm。

    表3 三維重建尺寸數(shù)據(jù)Tab.3 Dimensional Data of 3D Reconstruction

    為了驗(yàn)證三維建模的定位精度,在障礙物表面貼上黑白標(biāo)定板,如圖13所示。選取10個(gè)不同位置處的角點(diǎn),采用類(lèi)似上文的方案,通過(guò)尖端觸點(diǎn)得到各角點(diǎn)真實(shí)位姿,將模型轉(zhuǎn)換到機(jī)械臂基坐標(biāo)系下,比較對(duì)應(yīng)角點(diǎn)的偏差來(lái)評(píng)估定位精度。實(shí)驗(yàn)結(jié)果,如表4、圖14所示。

    表4 各角點(diǎn)真實(shí)值與掃描值數(shù)據(jù)Tab.4 Real Value and Scanning Value of Each Corner

    圖14 角點(diǎn)定位數(shù)據(jù)偏差圖Fig.14 Data Deviation Diagram of the Corner Location

    實(shí)驗(yàn)結(jié)果表明,角點(diǎn)在X、Y方向誤差穩(wěn)定在8mm以內(nèi),深度方向誤差保持在5mm左右,姿態(tài)角誤差穩(wěn)定在3°以內(nèi),驗(yàn)證了三維建模的定位精度。

    3.4 避障運(yùn)動(dòng)規(guī)劃分析

    將1.3節(jié)中的尺度參數(shù)γ設(shè)為1,最小距離ε設(shè)為0.5,步長(zhǎng)ρ1設(shè)為1.6°,步長(zhǎng)ρ2設(shè)為1.8°,引力系數(shù)設(shè)為1.1,搜索半徑設(shè)為3,最大迭代次數(shù)設(shè)為1000,在三維空間、確定障礙物的環(huán)境場(chǎng)景下進(jìn)行1000次重復(fù)實(shí)驗(yàn),相關(guān)數(shù)據(jù)經(jīng)均值處理,統(tǒng)計(jì),如表5所示。

    表5 各規(guī)劃算法規(guī)劃對(duì)比Tab.5 Comparison of Planning Algorithms

    由表5 可看出,相比RRT,改進(jìn)后的算法路徑長(zhǎng)度縮短了22.2%,搜索時(shí)間降低了55.9%,采樣節(jié)點(diǎn)數(shù)下降了54.3%,有效性得到驗(yàn)證。

    將CAN-RRT*算法添加到開(kāi)源運(yùn)動(dòng)規(guī)劃庫(kù)OMPL 中,通過(guò)Movelt控制機(jī)械臂。分別設(shè)置規(guī)劃時(shí)間上限為0.1s,0.2s,0.5s,初始狀態(tài)位置不變,目標(biāo)狀態(tài)為通過(guò)ArUco 碼識(shí)別的姿態(tài)(0.152,0.536,0.437,-0.287,-1.48645,0.0902),障礙空間為三維重建獲得的柵格地圖,每種情況進(jìn)行1000次重復(fù)實(shí)驗(yàn),統(tǒng)計(jì)結(jié)果,如表6所示??煽闯鲈撍惴ㄔ跁r(shí)間上限為0.1s時(shí),成功率達(dá)到96.5%,表明該算法有效且可靠。

    表6 CAN-RRT*規(guī)劃成功率Tab.6 Planning Success Rate of CAN-RRT*

    3.5 避障運(yùn)動(dòng)失敗原因分析

    為了給后期的研究工作提供改進(jìn)思路,對(duì)規(guī)劃失敗原因進(jìn)行分析統(tǒng)計(jì),如表7所示。主要由以下原因造成:(1)在當(dāng)前目標(biāo)狀態(tài)及障礙物的情況下,逆解求解錯(cuò)誤;(2)規(guī)劃超時(shí);(3)碰撞檢測(cè)失??;(4)識(shí)別誤差及機(jī)械臂運(yùn)動(dòng)誤差。

    表7 失敗原因統(tǒng)計(jì)Tab.7 Statistics on the Cause of Failure

    由表7可知,識(shí)別誤差與運(yùn)動(dòng)誤差占總體5.7%,說(shuō)明對(duì)于目標(biāo)物的姿態(tài)定位比較準(zhǔn)確,而規(guī)劃超時(shí)僅有1 次,說(shuō)明CANRRT*算法在規(guī)劃速度方面滿足需求。

    逆解求解失敗和路徑段碰撞檢測(cè)錯(cuò)誤占總體88%,前者主要是因?yàn)樵诋?dāng)前目標(biāo)狀態(tài)及障礙物位置下,機(jī)械臂本身不存在到達(dá)該點(diǎn)的構(gòu)型;而后者失敗原因在于碰撞檢測(cè)分辨率設(shè)置略大,導(dǎo)致部分情況下碰撞檢測(cè)跳過(guò)了障礙物。可考慮設(shè)置更小的碰撞檢測(cè)分辨率來(lái)解決這個(gè)問(wèn)題,但同時(shí)會(huì)導(dǎo)致規(guī)劃時(shí)間增長(zhǎng)。

    4 結(jié)束語(yǔ)

    鑒于當(dāng)前工業(yè)機(jī)器人在復(fù)雜、未知環(huán)境中的避障規(guī)劃方面的不足,本研究提出了基于視覺(jué)的三維重建與避障規(guī)劃的方法和流程。首先使用ArUco碼對(duì)工件識(shí)別定位,然后利用機(jī)械臂末端位姿和FPFH_ICP算法對(duì)環(huán)境點(diǎn)云進(jìn)行融合,重建了復(fù)雜環(huán)境下的工作空間,最后應(yīng)用改進(jìn)的CAN-RRT*算法,實(shí)現(xiàn)了未知環(huán)境下的避障運(yùn)動(dòng)。

    研究通過(guò)實(shí)驗(yàn)驗(yàn)證了方法的可行性和穩(wěn)定性,不僅適用于關(guān)節(jié)臂機(jī)器人,而且也適用于其他構(gòu)型的機(jī)器人。

    猜你喜歡
    位姿三維重建坐標(biāo)系
    基于Mimics的CT三維重建應(yīng)用分析
    軟件(2020年3期)2020-04-20 00:56:34
    解密坐標(biāo)系中的平移變換
    坐標(biāo)系背后的故事
    基于重心坐標(biāo)系的平面幾何證明的探討
    基于關(guān)系圖的無(wú)人機(jī)影像三維重建
    基于共面直線迭代加權(quán)最小二乘的相機(jī)位姿估計(jì)
    基于CAD模型的單目六自由度位姿測(cè)量
    三維重建結(jié)合3D打印技術(shù)在腔鏡甲狀腺手術(shù)中的臨床應(yīng)用
    小型四旋翼飛行器位姿建模及其仿真
    多排螺旋CT三維重建在頜面部美容中的應(yīng)用
    欧美日韩福利视频一区二区| 欧美日韩瑟瑟在线播放| 12—13女人毛片做爰片一| av欧美777| 久久中文看片网| 狠狠狠狠99中文字幕| 如日韩欧美国产精品一区二区三区| 桃色一区二区三区在线观看| 怎么达到女性高潮| 一边摸一边做爽爽视频免费| 亚洲视频免费观看视频| 1024视频免费在线观看| 黑人猛操日本美女一级片| 欧美国产精品va在线观看不卡| av天堂在线播放| 国产欧美日韩精品亚洲av| 国产精品av久久久久免费| 免费在线观看黄色视频的| 亚洲欧美日韩高清在线视频| 久久精品91蜜桃| 国产精品久久久人人做人人爽| а√天堂www在线а√下载| e午夜精品久久久久久久| 日日摸夜夜添夜夜添小说| 亚洲熟女毛片儿| 国产精品久久久人人做人人爽| 亚洲黑人精品在线| 狂野欧美激情性xxxx| 久久人妻av系列| 91九色精品人成在线观看| 男人舔女人的私密视频| 国产一区二区在线av高清观看| av在线天堂中文字幕 | 国产色视频综合| av福利片在线| 久99久视频精品免费| 狂野欧美激情性xxxx| 精品久久久久久久久久免费视频 | 午夜视频精品福利| 免费少妇av软件| 国产主播在线观看一区二区| 无遮挡黄片免费观看| 亚洲五月色婷婷综合| 一级黄色大片毛片| 国产精品亚洲一级av第二区| 国产视频一区二区在线看| 日本免费一区二区三区高清不卡 | 精品一品国产午夜福利视频| 男女床上黄色一级片免费看| 久久久水蜜桃国产精品网| 18禁美女被吸乳视频| 国产精华一区二区三区| 可以免费在线观看a视频的电影网站| 黄片播放在线免费| 香蕉久久夜色| 男人舔女人下体高潮全视频| 在线观看午夜福利视频| 国产日韩一区二区三区精品不卡| 一边摸一边做爽爽视频免费| 久久精品国产清高在天天线| 亚洲五月婷婷丁香| 淫妇啪啪啪对白视频| 亚洲精品一卡2卡三卡4卡5卡| 一区福利在线观看| 免费人成视频x8x8入口观看| 天堂影院成人在线观看| 麻豆成人av在线观看| 国产精品香港三级国产av潘金莲| 中国美女看黄片| www.熟女人妻精品国产| 亚洲专区国产一区二区| 两个人免费观看高清视频| 18美女黄网站色大片免费观看| 黄色丝袜av网址大全| 亚洲专区国产一区二区| 亚洲精品美女久久久久99蜜臀| 母亲3免费完整高清在线观看| 精品午夜福利视频在线观看一区| 国产精品免费视频内射| 亚洲av成人av| 在线观看免费日韩欧美大片| 一夜夜www| 国产成人av教育| 一级毛片女人18水好多| 日本免费一区二区三区高清不卡 | 欧美日韩一级在线毛片| netflix在线观看网站| 波多野结衣高清无吗| 黑丝袜美女国产一区| 午夜精品在线福利| 中文字幕av电影在线播放| 超碰97精品在线观看| 亚洲精品美女久久久久99蜜臀| 别揉我奶头~嗯~啊~动态视频| 中文字幕av电影在线播放| 日本免费一区二区三区高清不卡 | 中文字幕人妻丝袜制服| 国产有黄有色有爽视频| 中亚洲国语对白在线视频| 视频在线观看一区二区三区| 99久久精品国产亚洲精品| 久久影院123| 久久国产亚洲av麻豆专区| 欧美激情久久久久久爽电影 | 国产视频一区二区在线看| 97人妻天天添夜夜摸| av免费在线观看网站| 亚洲一区二区三区色噜噜 | 国产亚洲欧美在线一区二区| av有码第一页| 亚洲五月婷婷丁香| 成熟少妇高潮喷水视频| 精品高清国产在线一区| 激情视频va一区二区三区| 欧美在线黄色| 在线天堂中文资源库| 久久精品91无色码中文字幕| 99久久精品国产亚洲精品| 黄色怎么调成土黄色| 少妇 在线观看| 999久久久国产精品视频| 亚洲国产精品sss在线观看 | 久久久精品国产亚洲av高清涩受| 人人妻人人添人人爽欧美一区卜| 久久香蕉精品热| 国产蜜桃级精品一区二区三区| 久久中文字幕一级| 日韩有码中文字幕| 国产av一区在线观看免费| 一区二区三区国产精品乱码| 变态另类成人亚洲欧美熟女 | 纯流量卡能插随身wifi吗| 亚洲片人在线观看| 久久精品人人爽人人爽视色| tocl精华| 制服人妻中文乱码| 午夜91福利影院| 亚洲国产欧美日韩在线播放| 亚洲国产精品sss在线观看 | 久久久国产成人精品二区 | 国产精品日韩av在线免费观看 | 黄色片一级片一级黄色片| 欧美最黄视频在线播放免费 | 精品熟女少妇八av免费久了| 久久久久国产精品人妻aⅴ院| 在线永久观看黄色视频| 国产成人av教育| 日韩国内少妇激情av| 国产高清激情床上av| 超色免费av| 看片在线看免费视频| 亚洲成人免费av在线播放| 久久久久久久精品吃奶| 国产1区2区3区精品| av中文乱码字幕在线| 啪啪无遮挡十八禁网站| 黄片播放在线免费| 久久国产精品男人的天堂亚洲| 久久精品成人免费网站| 欧美乱码精品一区二区三区| 亚洲,欧美精品.| 国产成人av教育| 女性被躁到高潮视频| 日韩欧美三级三区| 中出人妻视频一区二区| 亚洲一区二区三区色噜噜 | 国产1区2区3区精品| 搡老岳熟女国产| 1024视频免费在线观看| 午夜日韩欧美国产| 亚洲成人国产一区在线观看| 亚洲成国产人片在线观看| 色老头精品视频在线观看| 亚洲精品一二三| 真人一进一出gif抽搐免费| 欧美日韩国产mv在线观看视频| 午夜a级毛片| 国产熟女午夜一区二区三区| 两性午夜刺激爽爽歪歪视频在线观看 | 十八禁人妻一区二区| 免费观看精品视频网站| av欧美777| 午夜精品久久久久久毛片777| 日韩免费高清中文字幕av| 80岁老熟妇乱子伦牲交| 麻豆国产av国片精品| 免费在线观看视频国产中文字幕亚洲| 欧美激情极品国产一区二区三区| 国产高清videossex| 亚洲精品中文字幕在线视频| 满18在线观看网站| 亚洲国产欧美网| avwww免费| tocl精华| 久热爱精品视频在线9| 19禁男女啪啪无遮挡网站| 久久草成人影院| 中文亚洲av片在线观看爽| 午夜福利免费观看在线| av天堂久久9| 免费看a级黄色片| 国产成人影院久久av| 黑人操中国人逼视频| 国产免费av片在线观看野外av| 在线国产一区二区在线| 黄片小视频在线播放| 操美女的视频在线观看| 色哟哟哟哟哟哟| 国产精品自产拍在线观看55亚洲| 久久久久精品国产欧美久久久| 久久婷婷成人综合色麻豆| 久久中文字幕人妻熟女| 一级毛片精品| 80岁老熟妇乱子伦牲交| 午夜精品久久久久久毛片777| 亚洲国产欧美网| 精品一区二区三卡| 妹子高潮喷水视频| 亚洲三区欧美一区| 国产又色又爽无遮挡免费看| 免费观看人在逋| 国产精华一区二区三区| 91麻豆av在线| 一级黄色大片毛片| 国产精品久久久人人做人人爽| 国内毛片毛片毛片毛片毛片| bbb黄色大片| 一区二区三区国产精品乱码| 久久人人97超碰香蕉20202| 亚洲精品国产精品久久久不卡| 成年人黄色毛片网站| 我的亚洲天堂| 国产无遮挡羞羞视频在线观看| 国产欧美日韩精品亚洲av| 99香蕉大伊视频| 真人做人爱边吃奶动态| 韩国精品一区二区三区| 黑丝袜美女国产一区| 少妇的丰满在线观看| 香蕉久久夜色| 国产在线观看jvid| 久久精品成人免费网站| 久久青草综合色| 婷婷精品国产亚洲av在线| 免费女性裸体啪啪无遮挡网站| 国产成人av激情在线播放| 天天躁狠狠躁夜夜躁狠狠躁| 在线观看日韩欧美| 欧美精品亚洲一区二区| 欧美日韩乱码在线| 亚洲av片天天在线观看| 精品乱码久久久久久99久播| www.精华液| 亚洲少妇的诱惑av| 一级作爱视频免费观看| 超碰97精品在线观看| 人成视频在线观看免费观看| 超碰成人久久| 亚洲人成77777在线视频| 亚洲精品国产色婷婷电影| 日本五十路高清| 日韩大码丰满熟妇| 欧美人与性动交α欧美软件| 天堂√8在线中文| 色尼玛亚洲综合影院| 久久久国产欧美日韩av| 午夜精品久久久久久毛片777| av免费在线观看网站| 国内毛片毛片毛片毛片毛片| 亚洲午夜理论影院| 天堂√8在线中文| 国产片内射在线| 美女大奶头视频| bbb黄色大片| 日本黄色视频三级网站网址| 国产黄色免费在线视频| 777久久人妻少妇嫩草av网站| 亚洲九九香蕉| 欧美日韩国产mv在线观看视频| 国产欧美日韩精品亚洲av| 色尼玛亚洲综合影院| 天天躁狠狠躁夜夜躁狠狠躁| 女人精品久久久久毛片| 久久人人97超碰香蕉20202| 91国产中文字幕| 欧美激情久久久久久爽电影 | 国产黄色免费在线视频| 亚洲专区国产一区二区| 电影成人av| 欧美 亚洲 国产 日韩一| 久久精品人人爽人人爽视色| 免费在线观看日本一区| 国产精品一区二区三区四区久久 | 18美女黄网站色大片免费观看| 欧美人与性动交α欧美软件| 欧美日韩亚洲综合一区二区三区_| 亚洲精品av麻豆狂野| 99热只有精品国产| 最近最新中文字幕大全电影3 | 又紧又爽又黄一区二区| 国产精品 国内视频| 午夜福利影视在线免费观看| 国产91精品成人一区二区三区| 亚洲精品国产一区二区精华液| 97人妻天天添夜夜摸| 亚洲第一青青草原| 亚洲人成电影观看| 人人妻人人添人人爽欧美一区卜| 麻豆久久精品国产亚洲av | 在线播放国产精品三级| 999久久久精品免费观看国产| 91成年电影在线观看| 日韩一卡2卡3卡4卡2021年| 美女国产高潮福利片在线看| 免费在线观看完整版高清| 国产精品秋霞免费鲁丝片| 欧美不卡视频在线免费观看 | 免费在线观看黄色视频的| 欧美日韩瑟瑟在线播放| 精品乱码久久久久久99久播| 无人区码免费观看不卡| 日韩精品中文字幕看吧| 亚洲视频免费观看视频| 精品熟女少妇八av免费久了| 老司机亚洲免费影院| 亚洲激情在线av| 免费在线观看亚洲国产| 激情视频va一区二区三区| 69av精品久久久久久| 高潮久久久久久久久久久不卡| 午夜影院日韩av| 午夜亚洲福利在线播放| 色尼玛亚洲综合影院| 国产精品综合久久久久久久免费 | 天堂动漫精品| 日本撒尿小便嘘嘘汇集6| 不卡av一区二区三区| 岛国视频午夜一区免费看| 18禁黄网站禁片午夜丰满| 色播在线永久视频| 亚洲第一av免费看| tocl精华| 不卡av一区二区三区| 丰满的人妻完整版| 国产精品美女特级片免费视频播放器 | 成在线人永久免费视频| av国产精品久久久久影院| 国产深夜福利视频在线观看| 久久亚洲真实| 真人做人爱边吃奶动态| 欧美黑人精品巨大| 人人妻人人澡人人看| 又黄又爽又免费观看的视频| 99在线人妻在线中文字幕| 亚洲欧美精品综合久久99| 国产一区二区三区视频了| 中文字幕另类日韩欧美亚洲嫩草| 高清在线国产一区| 伊人久久大香线蕉亚洲五| 国产欧美日韩一区二区精品| ponron亚洲| 国产欧美日韩一区二区精品| 日韩免费av在线播放| 亚洲人成电影免费在线| 自线自在国产av| 一区在线观看完整版| 不卡一级毛片| 国产欧美日韩综合在线一区二区| 亚洲精品在线观看二区| 性欧美人与动物交配| 亚洲欧美日韩无卡精品| 99久久综合精品五月天人人| 精品一区二区三卡| 色尼玛亚洲综合影院| 久久精品国产亚洲av香蕉五月| 精品欧美一区二区三区在线| 美女午夜性视频免费| 自拍欧美九色日韩亚洲蝌蚪91| 亚洲欧美日韩无卡精品| 高清av免费在线| 亚洲精品久久成人aⅴ小说| 欧洲精品卡2卡3卡4卡5卡区| 丰满的人妻完整版| 国产精品一区二区免费欧美| 国产一区二区在线av高清观看| 黄色毛片三级朝国网站| 视频区欧美日本亚洲| 丝袜美足系列| 久久中文字幕人妻熟女| 欧美日韩瑟瑟在线播放| 麻豆av在线久日| 黄色成人免费大全| 国产成人影院久久av| 一区二区三区激情视频| 午夜精品久久久久久毛片777| 国产高清视频在线播放一区| 亚洲欧美激情综合另类| 久久国产精品男人的天堂亚洲| 成人三级做爰电影| 亚洲精品久久成人aⅴ小说| 黑人猛操日本美女一级片| 久久天堂一区二区三区四区| 日韩大尺度精品在线看网址 | 女警被强在线播放| 男人舔女人的私密视频| 国产精品亚洲av一区麻豆| 国产xxxxx性猛交| 欧洲精品卡2卡3卡4卡5卡区| 免费在线观看完整版高清| 人妻丰满熟妇av一区二区三区| 日韩三级视频一区二区三区| 国产精品电影一区二区三区| 淫秽高清视频在线观看| 久久精品亚洲熟妇少妇任你| 午夜福利在线观看吧| 亚洲精品成人av观看孕妇| 一边摸一边抽搐一进一小说| 免费在线观看影片大全网站| 99久久国产精品久久久| 人人妻,人人澡人人爽秒播| 久久久国产成人精品二区 | 日韩大尺度精品在线看网址 | 日本vs欧美在线观看视频| 男女午夜视频在线观看| 精品午夜福利视频在线观看一区| 亚洲视频免费观看视频| 日日夜夜操网爽| 日韩视频一区二区在线观看| 不卡av一区二区三区| 母亲3免费完整高清在线观看| 午夜两性在线视频| 一进一出抽搐动态| 欧美av亚洲av综合av国产av| 在线播放国产精品三级| 成年人免费黄色播放视频| 国产成人免费无遮挡视频| 视频区欧美日本亚洲| 国产伦一二天堂av在线观看| 久久精品亚洲av国产电影网| 每晚都被弄得嗷嗷叫到高潮| 亚洲免费av在线视频| 日韩精品免费视频一区二区三区| av天堂久久9| 99在线人妻在线中文字幕| 亚洲av片天天在线观看| 久久久久久久精品吃奶| 精品一区二区三区视频在线观看免费 | 亚洲欧美日韩高清在线视频| 久久久久久大精品| 超碰成人久久| 超色免费av| 欧美一区二区精品小视频在线| 久久这里只有精品19| 天天影视国产精品| 在线播放国产精品三级| 国产黄a三级三级三级人| 欧美日韩国产mv在线观看视频| 高清黄色对白视频在线免费看| 一边摸一边做爽爽视频免费| 国产成人av教育| 亚洲第一av免费看| 精品第一国产精品| 视频区欧美日本亚洲| 免费日韩欧美在线观看| 91国产中文字幕| 成人国产一区最新在线观看| 人妻久久中文字幕网| 欧美激情 高清一区二区三区| 窝窝影院91人妻| 91av网站免费观看| 麻豆成人av在线观看| 中文字幕人妻熟女乱码| 天天影视国产精品| 久久人人爽av亚洲精品天堂| 淫秽高清视频在线观看| 国产乱人伦免费视频| tocl精华| 亚洲国产精品sss在线观看 | 精品人妻在线不人妻| 淫妇啪啪啪对白视频| 成在线人永久免费视频| 一级a爱视频在线免费观看| 69精品国产乱码久久久| 一级a爱片免费观看的视频| 中文字幕最新亚洲高清| 一个人免费在线观看的高清视频| 欧美日韩瑟瑟在线播放| 亚洲色图 男人天堂 中文字幕| 日韩精品青青久久久久久| 久久久国产一区二区| 国产精品一区二区三区四区久久 | 中出人妻视频一区二区| 亚洲男人天堂网一区| 久久精品国产综合久久久| 一级片免费观看大全| 色哟哟哟哟哟哟| 亚洲一区高清亚洲精品| 亚洲第一青青草原| 搡老熟女国产l中国老女人| 一级片免费观看大全| 久久久久久人人人人人| av网站在线播放免费| 亚洲久久久国产精品| 国产成人精品久久二区二区免费| 免费人成视频x8x8入口观看| 午夜视频精品福利| av网站在线播放免费| 亚洲熟妇中文字幕五十中出 | 麻豆av在线久日| 18禁观看日本| 高清av免费在线| 亚洲精品美女久久av网站| 亚洲一区二区三区不卡视频| 男人的好看免费观看在线视频 | 中文字幕最新亚洲高清| 亚洲人成77777在线视频| 国产精品99久久99久久久不卡| 在线观看免费午夜福利视频| 男人舔女人下体高潮全视频| 亚洲精品av麻豆狂野| 高清黄色对白视频在线免费看| 欧美亚洲日本最大视频资源| 精品午夜福利视频在线观看一区| 老汉色av国产亚洲站长工具| 欧美 亚洲 国产 日韩一| 久久九九热精品免费| 女人高潮潮喷娇喘18禁视频| 最新美女视频免费是黄的| 天天添夜夜摸| 成人特级黄色片久久久久久久| 97超级碰碰碰精品色视频在线观看| 两个人免费观看高清视频| 99国产精品99久久久久| 中亚洲国语对白在线视频| 欧美+亚洲+日韩+国产| 亚洲成国产人片在线观看| 男女床上黄色一级片免费看| 亚洲va日本ⅴa欧美va伊人久久| 在线观看免费日韩欧美大片| 亚洲国产精品sss在线观看 | 亚洲精品一二三| 韩国av一区二区三区四区| 丝袜人妻中文字幕| 亚洲成人免费av在线播放| 亚洲在线自拍视频| 欧洲精品卡2卡3卡4卡5卡区| 国产亚洲欧美在线一区二区| 一二三四在线观看免费中文在| 欧美日韩福利视频一区二区| 亚洲片人在线观看| 热re99久久国产66热| 国产成人精品无人区| 麻豆久久精品国产亚洲av | 老汉色av国产亚洲站长工具| 国产精品国产高清国产av| 日韩有码中文字幕| 婷婷六月久久综合丁香| 9191精品国产免费久久| 日韩av在线大香蕉| 黑人巨大精品欧美一区二区蜜桃| 成人影院久久| 免费女性裸体啪啪无遮挡网站| 欧美亚洲日本最大视频资源| 美女扒开内裤让男人捅视频| 色综合站精品国产| 一边摸一边做爽爽视频免费| 国产精品亚洲av一区麻豆| 十八禁网站免费在线| 亚洲午夜精品一区,二区,三区| 黄色片一级片一级黄色片| 国产欧美日韩一区二区三| 国产伦一二天堂av在线观看| 波多野结衣一区麻豆| 亚洲国产看品久久| 一区二区三区国产精品乱码| 国产成人影院久久av| 亚洲国产毛片av蜜桃av| 日日夜夜操网爽| 麻豆av在线久日| 色在线成人网| 亚洲 欧美一区二区三区| 国产精品 国内视频| 新久久久久国产一级毛片| 午夜免费鲁丝| 夜夜爽天天搞| av中文乱码字幕在线| 国产高清国产精品国产三级| 一二三四社区在线视频社区8| 中文字幕av电影在线播放| 91av网站免费观看| 曰老女人黄片| 嫁个100分男人电影在线观看| 欧美亚洲日本最大视频资源| 国产国语露脸激情在线看| 亚洲专区中文字幕在线| 国产欧美日韩综合在线一区二区| 村上凉子中文字幕在线| 国产成人啪精品午夜网站| 在线免费观看的www视频| 男男h啪啪无遮挡| 国产亚洲精品久久久久5区| www日本在线高清视频| 亚洲人成电影观看| 男人舔女人的私密视频| 久久草成人影院| 午夜免费观看网址| 看片在线看免费视频| 精品免费久久久久久久清纯| 亚洲人成网站在线播放欧美日韩| 99热国产这里只有精品6| 亚洲欧美日韩无卡精品| 国产在线精品亚洲第一网站| 免费高清在线观看日韩| 免费日韩欧美在线观看| 高清毛片免费观看视频网站 |