韓衛(wèi)民,翁 楓,馬志剛,梁遠(yuǎn)星,周松濤,張謝許

(廣東電網(wǎng)有限責(zé)任公司廣州供電局,廣東 廣州 510620)

0 引言

貝塞爾曲線是計(jì)算機(jī)圖形圖像造型的一種工具,是圖形造型運(yùn)用的最多的基本線條之一。它通過(guò)控制曲線上的4 個(gè)點(diǎn)(起始點(diǎn)、終止點(diǎn)以及兩個(gè)相互分離的中間點(diǎn))來(lái)創(chuàng)造、編輯圖形。其中起重要作用的是位于曲線中央的控制線。這條線是虛擬的,中間與貝塞爾曲線交叉,兩端是控制端點(diǎn)。移動(dòng)兩端的端點(diǎn)時(shí),貝塞爾曲線改變曲線的曲率(彎曲的程度);移動(dòng)中間點(diǎn)(也就是移動(dòng)虛擬的控制線)時(shí),貝塞爾曲線在起始點(diǎn)和終止點(diǎn)鎖定的情況下做均勻移動(dòng)[1]。

無(wú)人車的局部路徑規(guī)劃吸引了國(guó)內(nèi)外的研究者進(jìn)行廣泛的研究,現(xiàn)有的方法可以分為五大類,分別是:傳統(tǒng)路徑規(guī)劃算法(模擬退火法、人工勢(shì)場(chǎng)法等)、啟發(fā)式搜索算法(Dijkstra 算法、A*算法及其變種等)、離散優(yōu)化算法(模型預(yù)測(cè)算法、幾何軌線算法等)、隨機(jī)采樣算法(隨機(jī)路圖法、快速隨機(jī)拓展樹(shù)法等)和智能仿生算法(遺傳算法、蟻群算法、神經(jīng)網(wǎng)絡(luò)等)[2]。幾何軌線法中的貝塞爾曲線方法是法國(guó)工程師Bezier 在1962 年為了設(shè)計(jì)汽車車身形狀提出的,之后貝塞爾曲線由于具有良好的數(shù)學(xué)特性而被廣泛應(yīng)用到車輛路徑規(guī)劃領(lǐng)域。本文研究的是將四階貝塞爾曲線應(yīng)用在智能AGV 車(Automated Guided Vehicle,AGV)路徑規(guī)劃和精準(zhǔn)入叉中的問(wèn)題[3]。

1 利用貝塞爾曲線規(guī)劃智能AGV 的行走路徑

智能AGV 車實(shí)現(xiàn)從駐車點(diǎn)到取貨點(diǎn)的行駛,駐車點(diǎn)和取貨點(diǎn)的狀態(tài)是貝塞爾曲線構(gòu)建的形成條件[3],駐車點(diǎn)的狀態(tài)包括水平坐標(biāo)(x,y)、航向角Ψ,曲率k,如下圖1 所示。

圖1 駐車點(diǎn)轉(zhuǎn)向模型

曲率k、轉(zhuǎn)彎半徑r、AGV 車的軸距L以及前輪轉(zhuǎn)角之間的關(guān)系:

智能AGV 車的初始狀態(tài)X1=[x1,y1,Ψ1,k1] 和取貨點(diǎn)狀態(tài)XT=[xT,yT,ΨT,kT]

使用四階貝塞爾曲線的特征,規(guī)劃行走路徑,通用公式如下。

結(jié)合智能AGV 車的行走特征外廓尺寸,在AGV 路徑規(guī)劃時(shí),給定起點(diǎn)和終點(diǎn),由調(diào)度系統(tǒng)利用四階貝塞爾曲線規(guī)劃智能AGV 的行走路線,如圖2 所示。在試驗(yàn)情景中,AGV 車進(jìn)入貨車車廂取貨,當(dāng)AGV 車到達(dá)車廂門口時(shí),車前激光掃描設(shè)備掃描車廂輪廓,通過(guò)計(jì)算生產(chǎn)車廂地圖,確定AGV 車的運(yùn)行終點(diǎn),以入口為起點(diǎn),再比對(duì)導(dǎo)航激光掃描生成輪廓測(cè)距數(shù)據(jù)與傳感器采集實(shí)時(shí)數(shù)據(jù),利用貝塞爾曲線規(guī)劃更新路線,如圖3 所示。

圖2 四階貝塞爾曲線

圖3 智能AGV 車取貨流程

2 智能AGV 車的精準(zhǔn)入叉

在進(jìn)入車廂后,AGV 車自帶的激光掃描裝置掃描貨物形態(tài),生成貨物插孔的位置、角度和形狀圖形,確定AGV 車行走終點(diǎn)Pi 的坐標(biāo)值(xi,yi)及終點(diǎn)的方向Ψ,這樣已知AGV 車體起點(diǎn)和終點(diǎn),利用貝塞爾規(guī)劃車體行進(jìn)路線,在前進(jìn)過(guò)程中動(dòng)態(tài)調(diào)整起點(diǎn)位置,反復(fù)糾偏調(diào)整姿態(tài),使得AGV 車的叉齒準(zhǔn)確進(jìn)入貨物底部插孔叉取或放置貨物。

導(dǎo)航激光和傳感器將采集的車輛位置信息及貨物位置信息反饋給車輛調(diào)度系統(tǒng)軟件,車輛管理調(diào)度系統(tǒng)利用貝塞爾曲線規(guī)劃AGV 車的運(yùn)行路徑,根據(jù)叉取對(duì)象的位置和方向,反復(fù)調(diào)整車輛進(jìn)叉方向和位置,最終讓智能導(dǎo)航AGV 車的叉齒從正確的位置和方向進(jìn)入貨物底部,并將其運(yùn)送到規(guī)定位置。

3 結(jié)語(yǔ)

本文將貝塞爾曲線的方法應(yīng)用到智能AGV車的路徑規(guī)劃和精準(zhǔn)取放貨中,在設(shè)備需要拐彎的位置利用貝塞爾曲線規(guī)劃AGV 車的前進(jìn)路線,同時(shí)配合激光掃描定位技術(shù),確定起始點(diǎn)和終點(diǎn),再利用貝塞爾曲線規(guī)劃AGV 車的進(jìn)叉路線,最終成功叉取貨物。