- 相關推薦
移動機器人的路徑規劃方法的研究論文
摘 要:本文針對機器人及障礙物的位置可以實時測得,障礙物數量固定,形狀大小可預知,位置一般固定不動的情況,提出一種計算簡單、容易實現的移動機器人路徑規劃方法,可適用于某些特定的場合。
關鍵詞:移動機器人 路徑規劃 障礙物
中圖分類號:TP24 文獻標識碼:A 文章編號:1007-9416(2010)08-0015-02
1 引言
在有障礙物的工作環境中,如果機器人及障礙物的位置可以實時測得,則可以尋找一種移動機器人的優化路徑規劃算法,使機器人在運動過程中無碰撞地繞過所有的障礙物,安全的到達指定目標位置[1]。
路徑規劃問題根據機器人的工作環境模型可以分為兩種,一種是基于模型的路徑規劃,作業環境的全部信息都是預知的;另一種是基于傳感器的路徑規劃,作業環境的信息是全部未知或部分未知的。
本文提出一種計算簡單、容易實現的移動機器人路徑規劃方法,可供側重于應用的讀者參考。
2 問題描述
設機器人在長度為L的L×L的二維平面上能夠自由運動,將機器人模型化為點狀態機器人,在L×L的二維平面上存在若干個靜態障礙物和在一定范圍內運動的動態障礙物,根據安全性的要求進行了相應的“膨脹化”處理,使“膨脹化”后的障礙物邊界為安全區域,“膨脹化”后的障礙物邊界區域內為凸型,邊界為光滑曲線,邊界上各點曲率半徑≤δ(其中δ是正常量,可假設為圓的半徑),曲率中心在障礙物內部,單個機器人的路徑規劃是找出從起始點至終點的一條最短無碰路徑[2]。設終點(目標)的坐標為已知,機器人在任何時刻都能測出機器人所在位置與終點連線和機器人到障礙物邊界的切線的夾角。根據夾角的大小來判斷所選擇的無碰撞行走路徑[3]。如圖1所示,由于角α<β,所以,機器人行走路徑為RP→PQ→QG。
3 路徑規劃原理
3.1 求切線法的路徑規劃原理
根據幾何學園外兩點到園的四條切線,其切線與兩點連線夾角小的兩條線段之和小于切線與兩點連線夾角大的兩條線段之和。如圖2所示。設A和B兩點坐標分別為(XA,YA)和(XB,YB),如果角α<β,則AN+NB (1)利用兩點式求出機器人與目標之間的直線方程
由(X-XB)/(XA-XB)=(Y-YB)/(YA-YB)得:(YA-YB)X-(XA-XB)Y+(XAYB-YAXB)=0
(2)利用夾角求切線方程
如果測出過A、B兩點與園的切線和AB直線的夾角,則可求出切線方程。
在圖2中,直線AN的方程為:Y-YA=tanα(X-XA)
直線AM的方程為:Y-YA=tanβ(X-XA)
直線NB的方程為:Y-YB=tanα1(X-XB)
直線MB的方程為:Y-YB=tanβ1(X-XB)
(3)由四條切線求點A到點B的最短路徑
根據角α<β,可求出點A到點B的最短路徑為AN+NB
3.2 首先判斷機器人和給定的目標位置之間是否存在障礙物
如圖1所示,以R代表機器人,坐標為(XR,YR),以G代表目標位置,其坐標為(XG,YG),障礙物為A、B、C、D、E、F等,坐標為 (XA,YA)、(XB,YB)、(XC,YC)、(XD,YD)、(XE,YE)、(XF,YF)等。Rr表示機器人半徑、Ri(i=A、B、C、D、E、F)表示障礙物的碰撞半徑,也就是說在其半徑以外無碰撞的危險。要根據實際情況和控制要求來確定碰撞半徑。碰撞半徑Rp一般選擇大于障礙物的半徑Ri加上機器人半徑Rr,即Rp>Ri+Rr。
3.3 單障礙物情況
機器人在任何時刻都能夠測得機器人的位置坐標(XR,YR),目標位置是已知的(XG,YG),可測量出機器人與目標連線和機器人與障礙物碰撞圓的切線的兩個夾角αi和βi(i=1,2,…)。若αi<βi,則選αi方向的切線作為行走路徑;否則,則選βi方向的切線作為行走路徑;則如圖1所示。
3.4 多障礙物情況
對于多障礙物情況,可將移動機器人繞過多個障礙物最終到達目標位置作為一個總任務,每當繞過一個障礙物作為一個分任務。總任務就可分解為多個分任務,設第i個分任務的目標點為Gi和中途點為Bi,執行第i個分任務時,如果在到達Gi的路徑上存在障礙物,則增加第i+1個分任務,此時目標點Gi+1就是Bi;以此類推,尋找切線路徑直至到達給定的最終目標位置,計算所有分任務的最短切線路徑之和即為所求的最優路徑[4]。
4 行路徑算法
(1)機器人朝著目標按直線方向行走,直到以下任一情況發生:
①已經到達目標,結束。
②在機器人與目標之間發現障礙物,轉(2);
(2)按路徑規劃的原理選擇路徑,轉(1)。
5 結語
移動機器人路徑規劃的算法有很多,每一種算法能夠適用于幾種特定的場合。一個好的算法,不但理論簡單,計算快捷,容易理解,便于實現,而且實現的效果好,能夠提高運行效率。本文介紹的移動機器人的路徑規劃方法,容易理解,便于實現,可適用于某些特定的場合。
參考文獻
[1] 李彩虹,李貽斌,范晨.移動機器人動態避障算法[J].山東大學學報,2007,5(37):60-64.
[2] 陳剛.復雜環境下路徑規劃問題的遺傳路徑規劃方法[J].機器人,2001,(3):230-233.
[3] 霍迎輝等.移動機器人路徑規劃的最短切線路徑算法[J].廣東自動化與信息工程,2003,1(24):10-12.
[4] 曾碧,楊宜民.動態環境下基于蟻群算法的實時路徑規劃方法[J].計算機應用研究.2010,3(27): 860-863.
【移動機器人的路徑規劃方法的研究論文】相關文章:
基于環境模型的移動機器人路徑規劃05-01
基于概率地圖方法的無人機路徑規劃研究04-27
無人機初始路徑規劃空間建模方法研究04-27
衛星編隊的多沖量軌道機動路徑規劃方法04-26
論文研究方法怎么寫12-17
論文研究方法包括哪些12-17
科技論文評估方法研究04-30
論文質化研究方法與特點論文12-07
優化海南高職院校特色專業路徑研究論文04-27
港口概念規劃研究及方法探討04-28