基于AABB包圍盒的雙機械臂避碰技術(shù)的研究

干智峰

摘 要

機械臂避碰技術(shù)能夠保證機械臂在工作過程中的安全，對于增強機械臂在整個應(yīng)用領(lǐng)域中的安全性具有重要意義。本文基于雙機械臂的D-H模型和AABB包圍盒技術(shù)提出了雙機械臂避碰方法。并通過MATLAB和Adams聯(lián)合仿真對雙機械臂避碰方法進行了驗證。仿真結(jié)果顯示，該方法實現(xiàn)了雙機械臂之間的碰撞檢測，能夠防止機械臂在運動過程中發(fā)生碰撞。

關(guān)鍵詞

機械臂;D-H模型;AABB包圍盒;MATLAB Adams

中圖分類號： TP242 ? ? ? ? ? ? ? ? ? ? 文獻標識碼： A

DOI：10.19694/j.cnki.issn2095-2457 . 2020 . 17 . 34

Abstract

The collision avoidance technology of the manipulator is effective enough to ensure the safety of the manipulator in the working process， which is of great significance to enhance the safety of the manipulator in the whole application field. Based on the D-H model of double manipulator and AABB bounding box technology， this paper presents a collision avoidance method of double manipulator. The collision avoidance method of double manipulator is verified by the joint simulation of MATLAB and Adams. The simulation results show that the collision detection between the two manipulators is fully realized by this method， which can prevent the collision of the two manipulators in the process of movement.

Key words

Robotic arm; D-H model; AABB enclosure; MATLAB Adams

0 引言

隨著機械臂和多機械臂系統(tǒng)在實際生產(chǎn)中大量應(yīng)用，人們對機械臂在使用過程中的安全性也提出了更高的要求。其中最重要的就是要防止機械臂在運動過程中發(fā)生碰撞。

機械臂避碰算法的核心是機械臂碰撞檢測算法。通過碰撞檢測算法提前對機械臂的位置狀態(tài)進行預(yù)判，進而防止機械臂發(fā)生碰撞。在碰撞檢測算法中主要可以分為：空間剖分法和層次包圍盒方法兩大類。其中層次包圍盒法的應(yīng)用非常普遍，且其非常適用于復(fù)雜環(huán)境中的碰撞檢測。由于機械臂具有復(fù)雜的幾何結(jié)構(gòu)和運動，所以在本文中，采用包圍盒技術(shù)對運動中的兩個機械臂進行碰撞檢測。

1 AABB包圍盒碰撞檢測方法簡介

AABB包圍盒的碰撞檢測，是基于分離軸定理。該包圍盒構(gòu)造方法簡單，只需要找出其在坐標軸上投影的最大值和最小值即可，具有非常好的簡單性。此外，當(dāng)將AABB包圍盒用于變形物體的時候，不需要重新構(gòu)造包圍盒。只需將變形后物體中變形的基本集合元素進行更新，然后自下向上重新構(gòu)造包圍盒形成父節(jié)點，最后對整個包圍盒進行更新。

2 基于AABB包圍盒的雙機械臂避碰技術(shù)

2.1 機械臂包圍盒構(gòu)建方式

雙機械臂避碰技術(shù)的核心是雙機械臂包圍盒的碰撞檢測。首先需要為機械臂建立AABB包圍盒。如何用簡單的方法，建立具有良好緊密性的包圍盒是碰撞檢測的關(guān)鍵。為了提高包圍盒對機械臂包圍的緊密性，結(jié)合機械臂的幾何特性，本文提出采用分段建模的方式，對整個機械臂進行建模。

在對機械臂進行分段的時候，充分考慮了機械臂的特點，對機械臂進行D-H建模，將D-H模型關(guān)節(jié)坐標系作為每段的分割節(jié)點，依次將機械臂分割成了六段，并將這六段分別基于不同的D-H模型的關(guān)節(jié)坐標系進行建模。

2.2 機械臂AABB包圍盒的建立

2.2.1 機械臂D-H模型

在本文中，采用了KUKA KR16機器人進行D-H建模。

KR16機器人共有六個串聯(lián)旋轉(zhuǎn)關(guān)節(jié)。前三個關(guān)節(jié)用來控制機器人末端執(zhí)行器的位置，后三個關(guān)節(jié)用來確定末端執(zhí)行器的姿態(tài)。建立的模型如圖1所示。

2.2.2 建立包圍盒層次樹

機械臂包圍盒層次樹構(gòu)造過程如下：

（1）根據(jù)機械臂的幾何模型建立D-H模型，根據(jù)模型對機械臂進行分段;

（2）對某一分段的物體建立包圍盒;將該包圍盒作為層次包圍盒樹的根;

（3）根據(jù)最長軸方法，確定分段包圍盒的最長軸，將此軸作為分割軸;

（4）根據(jù)包圍盒中值法確定分割軸上的分割點，定位分割平面;

（5）應(yīng)用劃分出來的分割平面，將分段包圍盒劃分為了兩個子集;

（6）把步驟5的子集作為根節(jié)點，返回（3）直到包圍盒樹達到要求的深度;

（7）返回步驟2直到所有分段的包圍盒層次樹都構(gòu)建完成。

根據(jù)這種方法做出的層次包圍盒樹，是一棵完全二叉樹。如圖2為機器人末端執(zhí)行器的包圍盒層次樹示意圖。

2.3 雙機械臂碰撞檢測方法的實現(xiàn)

包圍盒的碰撞檢測將采用全局搜索和局部檢索的碰撞檢測方式。全局搜索是指通過包圍盒快速排除多數(shù)明顯不相交的對象;而局部檢索是全局搜索的后續(xù)階段，采用局部檢索對可能相交的物體進行進一步檢測。

2.3.1 AABB包圍盒全局搜索

雙機械臂碰撞檢測改進的全局搜索的主要包含以下幾個步驟，首先為機器人A、B計算AABB分段包圍盒，分別建立包圍盒在全局坐標系下的X、Y、Z軸上的投影列表XA、YA、ZA、XB、YB、ZB，并對列表進行第一次排序。之后對X、Y、Z軸三個軸進行劃分，得到機器人A、B在X、Y、Z軸三個軸投影到子序列。將對應(yīng)區(qū)域的子序列進行二次排序后，將子列表進行重新組合得到列表XO、YO、ZO。檢查在三個列表中是否有重疊區(qū)域。當(dāng)在三個列表上都重疊的時候，就說明包圍盒重疊了。利用全局搜索可以快速地排除大量明顯不相交的包圍盒。

2.3.2 運用分離軸定理逐步求精

根據(jù)全局搜索確定了進一步碰撞檢測的對象后，將采用分離軸定理對包圍盒進行碰撞檢測。

對于AABB包圍盒，在選取分離軸的時候，只需要分別取第一個包圍盒中三個相互垂直的邊，第二個包圍盒中三個相互垂直的邊，以及第一個包圍盒三個邊中的任意一個邊和第二個包圍盒三個邊中的任意一個邊所決定的平面的法線。按照這種做法，一共能夠計算出9個分離軸。所以，一共需要檢測15個分離軸。

首先任選一個分離軸，將機器人A的包圍盒頂點投影到選定分離軸，然后求出這六個值的最大值和最小值。同理，用同樣的方法求出機器人B的包圍盒投影到分離軸上的最大值和最小值，通過計算兩個包圍盒在分離軸上的投影范圍，記錄包圍盒在這個分離軸上的投影是否重疊。重復(fù)上述過程，直到將15個分離軸全部檢測。根據(jù)投影重疊進而判斷包圍盒是否發(fā)生碰撞。

3 雙機械臂避碰仿真實驗

在本節(jié)中，采用MATLAB和Adams聯(lián)合仿真來驗證雙機械臂避碰方法。

在聯(lián)合仿真實驗中，設(shè)置多個場景來驗證算法的有效性。圖3（a）是機械臂的包圍盒沒有發(fā)生碰撞的場景。圖3（b）顯示的是機械臂的包圍盒在空間中的位置映射。如圖3所示，雙機械臂的包圍盒沒有發(fā)生碰撞，雙機械臂保持運動。

如圖4所示，機械臂分段包圍盒層次樹的根包圍盒發(fā)生了碰撞。

如圖5（a）所示，當(dāng)機械臂分段包圍盒層次樹的根包圍盒發(fā)生碰撞，此時，如圖5（b）所示，碰撞的包圍盒層次樹會向下遍歷，對子包圍盒進行碰撞檢測。如果子包圍盒沒有發(fā)生碰撞，即說明機械臂運行安全，機械臂會繼續(xù)運動。如果葉子結(jié)點包圍盒發(fā)生碰撞，則會給出碰撞信號，使機械臂停止運動。

圖6（a）表示的是計算得到的機械臂間包圍盒最小距離與時間的函數(shù)圖像，圖6（b）表示的是碰撞檢測狀態(tài)圖像。從圖6可以看出，在機械臂運動的過程中，包圍盒發(fā)生了碰撞，且包圍盒的葉子結(jié)點發(fā)生了碰撞，系統(tǒng)給出了碰撞信號。

圖7是層次包圍盒樹的碰撞檢測對比圖。如圖7（a）所示，在圖中共有兩處的包圍盒有重疊，在第一處的包圍盒層次樹的葉子結(jié)點包圍盒發(fā)生了碰撞，而在第二處，葉子節(jié)點包圍盒并沒有發(fā)生碰撞。從圖7（b）可以看出，只有第一處包圍盒距離為零時給出了碰撞信號，而第二處并沒有給出信號。

根據(jù)上述的仿真試驗，可以根據(jù)AABB包圍盒對雙機械臂進行碰撞檢測，當(dāng)包圍盒的葉子結(jié)點發(fā)生碰撞的時候，算法會給出碰撞信號。在實際應(yīng)用中，可以根據(jù)碰撞信號，提前對機械臂采取制動措施，防止機械臂發(fā)生碰撞。

4 小結(jié)

本文重點介紹了應(yīng)用在雙機械臂避碰中的基于AABB包圍盒的雙機械臂避碰算法。重點研究了避碰算法中核心的基于AABB包圍盒的碰撞檢測算法。剖析了AABB包圍盒的建立方法，并結(jié)合機械臂的結(jié)構(gòu)特性，提出采用分段建模的方式對機械臂包圍盒的構(gòu)造方法。此外，還詳細研究了雙機械臂基于AABB包圍盒的碰撞檢測方法。最后通過MATLAB和Adams聯(lián)合仿真對雙機械臂的避碰算法進行了驗證。仿真結(jié)果顯示，基于AABB包圍盒的雙機械臂避碰方法能夠有效地檢測到雙機械臂包圍盒的碰撞，并給出避碰信號。

參考文獻

[1]黃可.層次包圍盒的碰撞檢測算法研究[J].中國科技信息， 2010（17）：97-98.

[2]Barnes，Noble.Websters New Universal Unabridged Dictionary[J]，New York，1989：P1-2.

[3]Zhao W， Wen R. The Algorithm of Fast Collision Detection Based on Hybrid Bounding Box[C].International Conference on Computer Science and Electronics Engineering. IEEE， 2012：547-551.

[4]熊玉梅.虛擬環(huán)境中物體碰撞檢測技術(shù)的研究[D].上海大學(xué)， 2011.

[5]Ning T， Guo C. Optimization of collision detection method using hybrid bounding box[J]. Computer Engineering & Applications， 2011， 47（1）：1-3.

[6]謝斌斌.基于包圍盒的碰撞檢測技術(shù)的研究[D].哈爾濱工程大學(xué)，2015.

[7]王曉榮，王萌，李春貴.基于AABB包圍盒的碰撞檢測算法的研究[J].計算機工程與科學(xué)，2010，32（4）：59-61.