模糊控制算法在移動(dòng)機(jī)器人路徑規(guī)劃中的應(yīng)用

王凱凱　陳永平

摘要：路徑規(guī)劃技術(shù)是智能移動(dòng)機(jī)器人的核心技術(shù)之一，也是目前研究的熱點(diǎn)問(wèn)題。本文通過(guò)模糊控制算法對(duì)移動(dòng)機(jī)器人進(jìn)行路徑規(guī)劃，設(shè)計(jì)了雙輸入雙輸出的模糊控制器。仿真結(jié)果表明，該方法規(guī)劃出了一條良好的路徑，機(jī)器人可以順利到達(dá)目標(biāo)點(diǎn)，驗(yàn)證了該算法的有效性。

關(guān)鍵詞：移動(dòng)機(jī)器人；模糊控制；路徑規(guī)劃

中圖分類(lèi)號(hào)：TP242 文獻(xiàn)標(biāo)識(shí)碼：A 文章編號(hào)：1007-9416（2019）01-0004-02

隨著科學(xué)技術(shù)的發(fā)展，人類(lèi)對(duì)智能化要求的不斷提高，對(duì)移動(dòng)機(jī)器人路徑規(guī)劃的研究目前也取得了巨大的成就，模糊控制是類(lèi)似與人類(lèi)的思維能力的一種控制方式，其具有人類(lèi)智能的推理能力以及模糊性，在機(jī)器人的路徑規(guī)劃中，常常用到模糊推理這種思想，往往把機(jī)器人的避障、調(diào)速和目標(biāo)導(dǎo)航等行為統(tǒng)稱(chēng)為機(jī)器人的運(yùn)動(dòng)[1-2]，機(jī)器人利用不同的方式分別控制這些行為，并通過(guò)一系列的決策來(lái)選擇機(jī)器人進(jìn)行最優(yōu)的行進(jìn)方案[3]。目前除了模糊控制方法以外，還有許多算法可以進(jìn)行路徑規(guī)劃，如A星算法、可視圖法、人工勢(shì)場(chǎng)法和蟻群算法等[4-5]。

路徑規(guī)劃可以分為局部路徑規(guī)劃和全局路徑規(guī)劃兩種，全局路徑規(guī)劃是基于已知所有環(huán)境信息的規(guī)劃，局部路徑規(guī)劃是基于未知環(huán)境或部分已知環(huán)境下的規(guī)劃。本文主要通過(guò)模糊控制算法對(duì)移動(dòng)機(jī)器人運(yùn)行中的角速度和線(xiàn)速度進(jìn)行控制，得到移動(dòng)機(jī)器人的軌跡。

1 環(huán)境感知

傳感器是機(jī)器人獲取信息的元件可稱(chēng)作為移動(dòng)機(jī)器人的“眼睛”。機(jī)器人的一些基本行為如定位導(dǎo)航、環(huán)境建模和躲避障礙物等行為的實(shí)現(xiàn)都是通過(guò)這樣的眼睛來(lái)實(shí)現(xiàn)的。通過(guò)傳感器把采集到的數(shù)據(jù)作為模糊控制器的輸入信號(hào)。

2 模糊控制算法設(shè)計(jì)

本文設(shè)計(jì)一個(gè)雙輸入雙輸出的模糊控制器，把移動(dòng)機(jī)器人與目標(biāo)點(diǎn)之間的距離和移動(dòng)機(jī)器人方向角與目標(biāo)點(diǎn)方向角之間的差值作為輸入，實(shí)現(xiàn)對(duì)移動(dòng)機(jī)器人在沒(méi)有障礙物的情況下的線(xiàn)速度和角度的控制，在這種行為下，機(jī)器人會(huì)在運(yùn)動(dòng)的過(guò)程中不斷的調(diào)整位姿駛向目標(biāo)點(diǎn)。

2.1 輸入量輸出量模糊化

假設(shè)機(jī)器人的方向與X軸的夾角為移動(dòng)機(jī)器人航向角Qr，目標(biāo)點(diǎn)與機(jī)器人質(zhì)心的連線(xiàn)與X軸的夾角為目標(biāo)點(diǎn)方向角Qt，航向角與方向角的差值為ΔQ，移動(dòng)機(jī)器人與目標(biāo)點(diǎn)的距離為D，移動(dòng)機(jī)器人移動(dòng)角速度為W，移動(dòng)線(xiàn)速度為V。

趨向目標(biāo)點(diǎn)的設(shè)計(jì)中定義D、ΔQ為模糊控制器輸入量，W、V為模糊控制器輸出量。

將移動(dòng)機(jī)器人與目標(biāo)點(diǎn)之間的距離D分為3個(gè)子模糊集{近，中，遠(yuǎn)}，模糊語(yǔ)言描述為：{NEAR，MID，F(xiàn)AR}，論域?yàn)閇0，6]；將角度信息ΔQ分為5個(gè)部分，模糊語(yǔ)言變量為：{NB，NS，ZE，PS，PB}={負(fù)大，負(fù)小，零，正小，正大}，論域[-π/2，π/2]。

移動(dòng)機(jī)器人輸出角速度模糊語(yǔ)言描述為W={逆大，逆小，零，順小，順大}={WNB，WNS，WOE，WSS，WSB}，論域?yàn)閇-π/6，π/6]；移動(dòng)機(jī)器人線(xiàn)速度模糊語(yǔ)言描述為V={低速，中速，快速}={VS，VM，VB}，論域?yàn)閇0，0.4]。隸屬度函數(shù)如圖1所示。

2.2 建立模糊規(guī)則

根據(jù)輸入情況，可以得到本模糊控制器一共有15條模糊規(guī)則。機(jī)器人從起始點(diǎn)到目標(biāo)點(diǎn)類(lèi)似于人駕駛汽車(chē)去往目的地，根據(jù)人的駕駛經(jīng)驗(yàn)來(lái)建立模糊控制規(guī)則，大概思想為：

機(jī)器人航向角與方向角的差值不等于0時(shí)，機(jī)器人往ΔQ為0的方向旋轉(zhuǎn)直到該差值為0；機(jī)器人與目標(biāo)點(diǎn)的距離不等于0時(shí)，機(jī)器人朝著目標(biāo)點(diǎn)方向行走直到該距離為0。

模糊規(guī)則如表1所示。

2.3 去模糊化

通過(guò)模糊推理獲得的結(jié)果是一個(gè)模糊集，但是在實(shí)際應(yīng)用中必須要有一個(gè)確定的值才可以驅(qū)動(dòng)和控制執(zhí)行機(jī)構(gòu)，將模糊推理結(jié)果轉(zhuǎn)化為精確值的過(guò)程稱(chēng)為去模糊化。

常用的去模糊方法有重心法、最大隸屬度法和加權(quán)平均法等[6]三種。由于重心法的靈敏度比較高，輸出會(huì)隨著輸入微小的變化而變化。因此重心法的輸出就更為平滑，所以本文選擇該方法進(jìn)行去模糊。

3 仿真實(shí)驗(yàn)

利用MATLAB對(duì)本文的模糊控制算法進(jìn)行仿真驗(yàn)證，設(shè)置起始位置的航向角為0度，可以得到如圖2所示的移動(dòng)機(jī)器人軌跡圖。從圖可以看出機(jī)器人前段軌跡弧度較大、組成軌跡的*符號(hào)較稀疏，后段軌跡近似為直線(xiàn)、組成軌跡的*符號(hào)較密集，體現(xiàn)了機(jī)器人開(kāi)始階段航向角與方向角的差值較大、距離目標(biāo)點(diǎn)較遠(yuǎn)，隨著機(jī)器人移動(dòng)航向角與方向角的差值越來(lái)越小、距離目標(biāo)點(diǎn)越來(lái)越近。

4 結(jié)語(yǔ)

本文利用模糊控制算法對(duì)移動(dòng)機(jī)器人進(jìn)行了軌跡規(guī)劃，設(shè)計(jì)了雙輸入雙輸出的模糊控制器，創(chuàng)建了輸入和輸出的隸屬度函數(shù)和模糊規(guī)則表，最后利用MATLAB仿真出了移動(dòng)機(jī)器人的軌跡，仿真結(jié)果表明本模糊控制算法可行、有效。

參考文獻(xiàn)

[1] 王立新.模糊系統(tǒng)與模糊控制教程[M].北京：清華大學(xué)出版社，2003.

[2] 顧俊，張宇.模糊控制的應(yīng)用現(xiàn)狀與發(fā)展趨勢(shì)[J].化工自動(dòng)化及儀表，2017，09：811-812，902.

[3] 肖興輝，劉兆峰，白洪超，郭彬.基于模糊控制的移動(dòng)機(jī)器人應(yīng)用研究[J].智能城市，2017，05：43-47.

[4] 馬曉璐，張持健，鄭奎昂，鄒鵬飛.基于改進(jìn)人工勢(shì)場(chǎng)法的機(jī)器人路徑規(guī)劃[J].電子設(shè)計(jì)工程，2017（21）：30-33.

[5] 王殿君.基于改進(jìn)A*算法的室內(nèi)移動(dòng)機(jī)器人路徑規(guī)劃[J].清華大學(xué)學(xué)報(bào)（自然科學(xué)版），2012（8）：1085-1089.

[6] 廉小親.模糊控制技術(shù)[M].北京：中國(guó)電力出版社，2003.

Abstract：Path planning technology is one of the core technologies of intelligent mobile robots， and it is also a hot issue in current research. In this paper， the fuzzy control algorithm is used to plan the path of the mobile robot， and the fuzzy controller with dual input and double output is designed. The simulation results show that the proposed method has a good path and the robot can reach the target point smoothly， which verifies the effectiveness of the algorithm.

Key words：mobile robot； fuzzy control； path planning