機(jī)器人避障單目標(biāo)點(diǎn)研究

金晗 潘晨 楊仁 楊宗林

摘 要：本文主要是對(duì)機(jī)器人在一個(gè)平面區(qū)域內(nèi)的通過不同障礙物到指定目標(biāo)點(diǎn)進(jìn)行研究，首先通過機(jī)器人與障礙物的最小安全距離對(duì)不同障礙物的禁區(qū)進(jìn)行了劃分，把障礙物劃分為有頂點(diǎn)和無頂點(diǎn)兩大類。然后證明了機(jī)器人在障礙物頂點(diǎn)處轉(zhuǎn)彎路徑最優(yōu)，轉(zhuǎn)彎半徑最小路徑最優(yōu)，轉(zhuǎn)彎圓心在障礙物頂點(diǎn)處（圓行障礙物在圓心）路徑最優(yōu)。

關(guān)鍵詞：機(jī)器人；避障；單目標(biāo)點(diǎn)

把機(jī)器人的行進(jìn)路線看成一根有彈性的繩子，根據(jù)實(shí)際情況我們推論：禁區(qū)頂點(diǎn)處變向路徑最小，轉(zhuǎn)彎半徑最小路徑最短，轉(zhuǎn)彎弧圓心在頂點(diǎn)路徑最短。

1.禁區(qū)劃分

由于機(jī)器人行進(jìn)過程中與障礙物有最小距離的限制，因此我們先畫出包絡(luò)障礙物的禁區(qū)，對(duì)于有圓形障礙物來說，禁區(qū)還是一個(gè)圓，對(duì)于有頂點(diǎn)的障礙物來說禁區(qū)拐角處為一個(gè)圓弧，具體如圖1：

圖1 禁區(qū)示意圖

2.障礙物有頂點(diǎn)

2.1禁區(qū)頂點(diǎn)變向路徑最小

如下圖2所示，機(jī)器人從指定的A點(diǎn)到C點(diǎn)，需要進(jìn)行變向，從圖形可以看出來，在禁區(qū)邊緣變向總路徑會(huì)最小，下面我們進(jìn)行證明：

圖2 禁區(qū)頂點(diǎn)處變向圖

假設(shè)D點(diǎn)為禁區(qū)頂點(diǎn)，先不考慮轉(zhuǎn)彎半徑等因素，其中B為禁區(qū)外任意一點(diǎn)，AD變延長線交BC于E點(diǎn)。由三角形的任意兩邊之和大于第三邊可以得到：

AB+BE>AD+DE

EC+DE>DC

兩式相加得到：

AB+BE+EC+DE>AD+DE+DC

化簡得到：

AB+BC>AD+DC

即，由A點(diǎn)到B點(diǎn)，選擇在頂點(diǎn)D處轉(zhuǎn)向，總路徑最短。推論得證。

2.2轉(zhuǎn)彎半徑最小路徑最短

機(jī)器人從A點(diǎn)到B點(diǎn)需要繞過禁區(qū)，在禁區(qū)頂點(diǎn)附近（前面已證）轉(zhuǎn)彎。選擇的轉(zhuǎn)彎半徑越小，得到的路徑越短。下面從物理學(xué)的角度進(jìn)行證明：

如下圖3所示，將A到B的路徑看做一條可伸縮的繩子。假設(shè)其兩點(diǎn)相連時(shí)，繩子自然伸長。如線段AB。由于機(jī)器人要繞過禁區(qū)，因此拉長繩子繞過禁區(qū)，又因?yàn)闄C(jī)器人有最小轉(zhuǎn)彎半徑為10，禁區(qū)直徑也為10，因此可以把繩子直接繞過禁區(qū)邊緣。

由于繩子的彈性勢(shì)能EP與伸長量ΔL的關(guān)系為：

EP=12kΔL2

因此繩子伸長量最小時(shí)，路徑最短。

圖3 機(jī)器人過障礙轉(zhuǎn)彎半徑

根據(jù)最小勢(shì)能原理[1]可知，當(dāng)彈性體平衡時(shí)，系統(tǒng)勢(shì)能最小。即彈性體在自由條件下，有由高勢(shì)能向低勢(shì)能轉(zhuǎn)化的趨勢(shì)?，F(xiàn)在將圓環(huán)看成也有彈性，在如圖所示的條件下為初始狀態(tài)。圓環(huán)受力如圖所示，此時(shí)圓環(huán)有縮小的趨勢(shì)，隨著圓環(huán)的縮小系統(tǒng)趨于平衡，彈性繩有最小勢(shì)能。由能量守恒也可以說明，繩子的彈性勢(shì)能轉(zhuǎn)化為彈性圓環(huán)的彈性勢(shì)能，于是彈性繩的彈性勢(shì)能減小。

因此，隨著圓環(huán)的半徑的減小，繩子的勢(shì)能減小，即最短路徑變短。所以最小轉(zhuǎn)彎半徑最小路徑最短得證。

2.3結(jié)論分析

結(jié)合2.1、2.2證明得到結(jié)論：

機(jī)器人過有頂點(diǎn)的障礙物時(shí)，沿以頂點(diǎn)為圓心，最小轉(zhuǎn)彎半徑為半徑的圓弧轉(zhuǎn)彎路徑最短，即機(jī)器人沿禁區(qū)邊緣轉(zhuǎn)彎路徑最短。（作者單位：1.大連理工大學(xué)機(jī)械工程學(xué)院2012級(jí)，2.大連理工大學(xué)化工與環(huán)境生命學(xué)部2014級(jí)，3.大連理工大學(xué)機(jī)械工程學(xué)院2012級(jí)，4.湖南省懷化市氣象局）

參考文獻(xiàn)：

[1] 姜啟源，謝金星.數(shù)學(xué)建模[M].北京：高等教育出版社，2003.

[2] 吳濤.移動(dòng)機(jī)器人避障與路徑規(guī)劃研究[D].華中科技大學(xué)，2004.