沈璐璐
(陜西能源職業(yè)技術(shù)學(xué)院,西安,712000)
機(jī)器人避障問(wèn)題
沈璐璐
(陜西能源職業(yè)技術(shù)學(xué)院,西安,712000)
本文主要研究了機(jī)器人在一個(gè)區(qū)域內(nèi)按照一定的行走規(guī)則避開(kāi)該區(qū)域內(nèi)的十二個(gè)障礙物,由出發(fā)點(diǎn)到達(dá)目標(biāo)點(diǎn)的最短路徑和最短時(shí)間路徑的問(wèn)題。首先分析得到行走路徑由圓弧和與那些圓弧相切的直線組成。然后將路徑中遇到的拐點(diǎn)分解為一個(gè)或者兩個(gè)的情況,并給出了各種情況下路徑距離以及切點(diǎn)坐標(biāo)的求法。最后針對(duì)不同的目標(biāo)點(diǎn)分別建立模型并計(jì)算出最短路徑距離以及途中直線和圓弧的起點(diǎn)、終點(diǎn)坐標(biāo)。在此基礎(chǔ)上,建立非線形規(guī)劃模型,利用LINGO求出的最短時(shí)間路徑。
最短路徑;最短時(shí)間路徑;非線形規(guī)劃模型;LINGO
圖1是一個(gè)800×800的平面區(qū)域,內(nèi)部有12個(gè)不同形狀的障礙物。在處有一個(gè)機(jī)器人,它只能在區(qū)域內(nèi)活動(dòng)且不能與障礙物碰撞。機(jī)器人的行走路徑由直線和圓弧組成,其中圓弧是轉(zhuǎn)彎路徑,該路徑由與直線相切的圓弧組成,也可以由兩個(gè)或多個(gè)相切的圓弧組成,但每個(gè)圓弧的半徑最小為10個(gè)單位。同時(shí)機(jī)器人行走線路與障礙物間的最近距離為10個(gè)單位。機(jī)器人直線行走的最大速度為個(gè)單位/秒,最大轉(zhuǎn)彎速度為是轉(zhuǎn)彎半徑。障礙物的數(shù)學(xué)描述如下表:
圖1
1.1 問(wèn)題一
根據(jù)行走規(guī)則,畫(huà)出行走過(guò)程中的危險(xiǎn)隔離線,每到拐點(diǎn)處,隔離線都為半徑為10的圓弧。不難發(fā)現(xiàn),起點(diǎn)到目標(biāo)點(diǎn)的路徑中不管障礙物有多少,最短的路徑都應(yīng)該是若干半徑為10的圓弧和與那些圓弧相切的直線組成。此問(wèn)題中求的最短路徑中遇到的拐點(diǎn)要么為1個(gè),要么為多個(gè),對(duì)于不同個(gè)數(shù)的拐點(diǎn)分情況討論如下。
(1) 一個(gè)拐點(diǎn):
圖2
(2) 多個(gè)拐點(diǎn):多個(gè)拐點(diǎn)可每次只考慮兩個(gè)拐點(diǎn),最后再相加。兩個(gè)拐點(diǎn)的情況可分為圖3和圖4兩種。
圖3
圖4
從O到A有兩條路徑,如圖5。
圖5
圖6
1.2 問(wèn)題二
本模型全面考慮了出發(fā)點(diǎn)到目標(biāo)點(diǎn)的可行路徑,并選擇出幾條可能的最短路徑,分情況討論并計(jì)算出各條路徑的距離,最終比較得出最短路徑,結(jié)果精確度較高。并建立非線形規(guī)劃模型求解出從出發(fā)點(diǎn)到目標(biāo)點(diǎn)的最短時(shí)間,簡(jiǎn)單易懂,利用軟件求解,精確度高且費(fèi)時(shí)少。但是當(dāng)障礙物較多或者障礙物形狀,本模型還需進(jìn)一步改進(jìn),尋找更高效的方法。
[1] 機(jī)器人行走問(wèn)題, http://wenku.baidu.com/ view/606c2a094a7302768e99399a.html.
[2] 謝金星,薛毅,優(yōu)化建模與LINDO/LINGO軟件[M],北京:清華大學(xué)出版社,2005.
[3] 韓中庚,數(shù)學(xué)建模方法及其應(yīng)用[M],北京:高等教育出版社,2005.
公式1:
The robot obstacle avoidance
Shen Lulu
(Shaanxi Energy Vocational and Technical College,Xi’an,712000,China)
This paper studies the shortest path and the shortest time path problem from the starting point to the target point in a region with twelve obstacles,the robot walks in that area according to certain rules to avoid those obstacles.Firstly,the walking path constituted by some arcs and straigt lines tangent to those arcs.The path can be decomposed into one or two inflection points,then gives solving methods of the path distance and tangent point coordinate in various situations.Finally,for different target points,models are established and calculates the shortest path distance and the starting and ending points coordinates of the straight lines and arcs.On this basis,a non-linear programming model is established, and the shortest time path form O to A is solved by LINGO.
The shortest path;The shortest time path;non-linear programming model;LINGO