畢業(yè)設(shè)計(jì)（論文）-基于模糊控制非完整性機(jī)器人路徑跟蹤控制

1、<p><b>　　摘要</b></p><p>　　智能車輛是一個(gè)集環(huán)境感知、規(guī)劃決策、自動(dòng)駕駛等多種功能于一體的綜合系統(tǒng)。它是目前各國(guó)重點(diǎn)發(fā)展的智能交通系統(tǒng)中一個(gè)重要組成部分，同時(shí)在柔性制造和裝配系統(tǒng)、軍事領(lǐng)域以及特殊環(huán)境下也得到廣泛運(yùn)用。發(fā)展智能車輛能夠提高車輛行駛的安全性、舒適性，達(dá)到提高交通效率、改善交通環(huán)境的目的.</p><p><b&g

2、t;　　本文的工作如下：</b></p><p>　　1)概述了移動(dòng)機(jī)器人路徑跟蹤控制的研究現(xiàn)狀；</p><p>　　2)介紹了兩輪差動(dòng)機(jī)器人的運(yùn)動(dòng)學(xué)模型及其基本結(jié)構(gòu)；</p><p>　　3)分析了路徑跟蹤的整個(gè)過(guò)程，改進(jìn)了視線導(dǎo)航策略，為后文設(shè)計(jì)正確的算法和仿真奠定了基礎(chǔ)；</p><p>　　4)介紹了模糊控制器的基本結(jié)構(gòu)

3、及其設(shè)計(jì)規(guī)則；</p><p>　　5)基于改進(jìn)的視線導(dǎo)航策略設(shè)計(jì)了速度和角速度模糊控制器；</p><p>　　6)在matlab環(huán)境下對(duì)設(shè)計(jì)的模糊控制器做了仿真，得到的實(shí)驗(yàn)結(jié)果表明本文所提算法具有運(yùn)行速度快，跟蹤準(zhǔn)確，魯棒性好等優(yōu)點(diǎn)，同時(shí)在初始誤差較大的情況下也能很好跟蹤期望的路徑。</p><p>　　關(guān)鍵詞：移動(dòng)機(jī)器人 運(yùn)動(dòng)學(xué)模型 模糊控制</p

4、><p><b>　　Abstract</b></p><p>　　Intelligent vehicle is a system integrated with the functions of environment-sensing，decision-making and automatically driving. It has been an important

5、part of the Intelligent Transportation System and widely used in flexible manufacturing and resembling system，military field and special environments. The research on intelligent vehicle can improve the safety and comfor

6、t of vehicle driving，and the efficiency and environment of transportation.</p><p>　　This research work and the results achieved are as follows：</p><p>　　1) The present state on the mobile robot

7、path tracking control is summarized;</p><p>　　2) Kinematic models of mobile robots with differential steering and its basic structure are introduced;</p><p>　　3) The whole process of path tracki

8、ng is analyzed, traditional line of sight guidance is improved, designed to correct later laid the foundation for algorithms and simulation; </p><p>　　4) The basic structure of fuzzy controller and its desig

9、n rules are introduced;</p><p>　　5) Based on the improved line of sight guidance, velocity and angular velocity fuzzy controller are designed; </p><p>　　6) Matlab environment in the design of th

10、e fuzzy controller is simulated, the results obtained show that the proposed algorithm is fast, tracking accuracy, robustness and good, while in the case of large initial error can well track the desired path.</p>

11、<p>　　Key words: Mobile Robots Kinematic Model Fuzzy Control </p><p><b>　　目 錄</b></p><p><b>　　摘要I</b></p><p>　　AbstractII</p><p><

12、;b>　　1 緒 論1</b></p><p>　　1.1背景與意義1</p><p>　　1.2 非完整移動(dòng)機(jī)器人的運(yùn)動(dòng)控制問(wèn)題2</p><p>　　1.3 路徑跟蹤的研究現(xiàn)狀5</p><p><b>　　1.4主要內(nèi)容6</b></p><p>　　2 兩輪差

13、動(dòng)移動(dòng)機(jī)器人模型8</p><p>　　2.1移動(dòng)機(jī)器人結(jié)構(gòu)8</p><p>　　2.2 移動(dòng)機(jī)器人的運(yùn)動(dòng)學(xué)模型9</p><p>　　2.3 移動(dòng)機(jī)器人路徑跟蹤過(guò)程10</p><p>　　2.4 移動(dòng)機(jī)器人軌跡跟蹤控制未來(lái)發(fā)展趨勢(shì)11</p><p>　　2.5 改進(jìn)的視線導(dǎo)航算法12</p&g

14、t;<p>　　3 移動(dòng)機(jī)器人路徑跟蹤的模糊控制15</p><p>　　3.1模糊控制器的基本思想15</p><p>　　3.2 模糊控制器的組成及其設(shè)計(jì)方法16</p><p>　　3.3控制系統(tǒng)設(shè)計(jì)20</p><p>　　3.3.1 路徑跟蹤問(wèn)題描述21</p><p>　　3.3.2

15、 路徑跟蹤模糊控制器的設(shè)計(jì)（控制器的結(jié)構(gòu)，控制規(guī)則的建立）21</p><p>　　4 仿真結(jié)果與分析27</p><p>　　4.1 仿真步驟27</p><p>　　4.2 仿真結(jié)果分析28</p><p><b>　　結(jié)論31</b></p><p><b>　　致謝3

16、2</b></p><p><b>　　參考文獻(xiàn)33</b></p><p>　　附錄：程序流程圖34</p><p><b>　　1 緒 論</b></p><p><b>　　1.1背景與意義</b></p><p>　　近十多年來(lái)

17、，隨著科學(xué)技術(shù)的迅速發(fā)展和人民生活水平的日益提高，機(jī)器人的應(yīng)用領(lǐng)域也在逐漸擴(kuò)大，己經(jīng)從最初的工業(yè)機(jī)器人發(fā)展到現(xiàn)在的服務(wù)機(jī)器人和智能機(jī)器人。機(jī)器人的功能己不再只是從事某項(xiàng)簡(jiǎn)單的操作，而是可以承擔(dān)多種任務(wù)；機(jī)器人的工作環(huán)境也不僅是固定在工廠和車間現(xiàn)場(chǎng)，而是開(kāi)始走向海洋、太空和戶外，更多的是走向了醫(yī)院、家庭和娛樂(lè)場(chǎng)所，從而形成了新興的服務(wù)機(jī)器人行業(yè)。服務(wù)機(jī)器人主要是代替人們從事艱苦、危險(xiǎn)和乏味的工作，或者是為人們的生活提供方便，使人們生活得更

18、加舒適和愉快。從某種意義上說(shuō)機(jī)器人也是機(jī)器進(jìn)化過(guò)程的產(chǎn)物，它必將成為工業(yè)以及非產(chǎn)業(yè)界的重要生產(chǎn)和服務(wù)性設(shè)備。</p><p>　　機(jī)器人技術(shù)的發(fā)展與自動(dòng)控制技術(shù)的發(fā)展是密不可分的。自動(dòng)控制系統(tǒng)是機(jī)器人的中樞神經(jīng)，它控制著機(jī)器人的思維、決策和行為，在機(jī)器人發(fā)展史上，幾乎所有自動(dòng)控制技術(shù)都在機(jī)器人控制上得到應(yīng)用。目前，機(jī)器人技術(shù)是綜合了計(jì)算機(jī)、控制論、機(jī)構(gòu)學(xué)、信息和傳感技術(shù)、人工智能、仿生學(xué)等多學(xué)科而形成的高新技術(shù)，

19、是當(dāng)代十分活躍的研究開(kāi)發(fā)領(lǐng)域，它包括正在逐步深入的機(jī)器人學(xué)基礎(chǔ)技術(shù)研究，也包括對(duì)國(guó)民經(jīng)濟(jì)有著重要作用的機(jī)器人工程應(yīng)用技術(shù)研究。近年來(lái)，越來(lái)越多的專家學(xué)者已經(jīng)致力于這個(gè)領(lǐng)域的研究，并取得了豐碩的成果。隨著人工智能技術(shù)和計(jì)算機(jī)技術(shù)的迅速發(fā)展，機(jī)器人的感知系統(tǒng)和控制系統(tǒng)在智能化水平上得到了很大提高，機(jī)器人已經(jīng)從看聽(tīng)說(shuō)和使用工具到開(kāi)始執(zhí)行一些決策和思考的智能行為，其應(yīng)用從傳統(tǒng)的加工制造業(yè)逐漸擴(kuò)展到軍事偵察、海洋勘探、宇宙探索等重要領(lǐng)域，并開(kāi)始進(jìn)

20、入家庭和服務(wù)行業(yè)，代替人們從事各種各樣的生產(chǎn)勞動(dòng)。</p><p>　　移動(dòng)機(jī)器人是機(jī)器人學(xué)中的一個(gè)重要分支，具有重要的軍用和民用價(jià)值。早在20世紀(jì)60年代末期，就已經(jīng)開(kāi)始了關(guān)于移動(dòng)機(jī)器人的研究。1968年，美國(guó)斯坦福國(guó)際研究所研制出了取名為Shakcy的自主移動(dòng)機(jī)器人。其目的是研究應(yīng)用人工智能技術(shù)，在復(fù)雜環(huán)境下機(jī)器人系統(tǒng)的自主推理、規(guī)劃和控制能力。20世紀(jì)70年代末，隨著計(jì)算機(jī)的應(yīng)用和傳感技術(shù)的發(fā)展，移動(dòng)機(jī)器人

21、的研究又出現(xiàn)了新高潮，特別是在80年代中期，設(shè)計(jì)和制造機(jī)器人的浪潮席卷全世界。一大批世界著名的公司開(kāi)始研制移動(dòng)機(jī)器人平臺(tái)，這些移動(dòng)機(jī)器人主要是作為大學(xué)實(shí)驗(yàn)室及研究機(jī)構(gòu)的移動(dòng)機(jī)器人實(shí)驗(yàn)平臺(tái)，從而促進(jìn)了移動(dòng)機(jī)器人學(xué)多種研究方向的出現(xiàn)。20世紀(jì)90年代以來(lái)，以研制高水平的環(huán)境信息傳感器和信息處理技術(shù)，高適應(yīng)性的移動(dòng)機(jī)器人控制技術(shù)、真實(shí)環(huán)境下的規(guī)劃技術(shù)為標(biāo)志，開(kāi)展了移動(dòng)機(jī)器人更高層次的研究。按照目前移動(dòng)機(jī)器人的研究成果和發(fā)展方向，可以給移動(dòng)機(jī)器

22、人做出如下定義，移動(dòng)機(jī)器人是一種能夠在道路和野外連續(xù)地、實(shí)時(shí)地自主運(yùn)動(dòng)的智能機(jī)器人,是一種集環(huán)境感知、動(dòng)態(tài)決策與規(guī)劃、行為控制與執(zhí)行等多功能于一體的高智能化機(jī)器系統(tǒng)。移動(dòng)機(jī)器人的研究涉及圖像實(shí)時(shí)處理、計(jì)算機(jī)視覺(jué)、傳感</p><p>　　移動(dòng)機(jī)器人是一個(gè)集環(huán)境感知、動(dòng)態(tài)決策與規(guī)劃、運(yùn)動(dòng)控制與執(zhí)行等多種功能為一體的綜合系統(tǒng)。運(yùn)動(dòng)控制對(duì)于自主移動(dòng)機(jī)器人來(lái)說(shuō)，是最基本的也是必須實(shí)現(xiàn)的底層控制功能，是移動(dòng)機(jī)器人實(shí)現(xiàn)其他功

23、能的基礎(chǔ)。由于移動(dòng)機(jī)器人具有非完整約束，即系統(tǒng)模型中具有不可積分的微分方程，故具有非完整約束的移動(dòng)機(jī)器人運(yùn)動(dòng)控制是是一個(gè)十分復(fù)雜而富有挑戰(zhàn)性的問(wèn)題。</p><p>　　1.2 非完整移動(dòng)機(jī)器人的運(yùn)動(dòng)控制問(wèn)題</p><p>　　非完整移動(dòng)機(jī)器人作為一個(gè)新型的課題，近年來(lái)已日益受到國(guó)內(nèi)外控制界的重視。機(jī)器人在運(yùn)動(dòng)的過(guò)程中，通常需要考慮與外部環(huán)境之間的接觸因素，這樣的帶有一定的約束條件的系統(tǒng)

24、，稱為受限系統(tǒng)(constrained system)。由于可以通過(guò)積分和非線性變換從約束條件中解出若干個(gè)狀態(tài)變量，進(jìn)而可將原系統(tǒng)轉(zhuǎn)化為一個(gè)低維系統(tǒng)，所以此類系統(tǒng)的分析與綜合問(wèn)題與無(wú)約束系統(tǒng)相比而言沒(méi)有太大的困難，在理論與應(yīng)用研究方面己取得滿意的進(jìn)展。而非完整約束則是同時(shí)限制空間位置和運(yùn)動(dòng)速度，并且不能通過(guò)積分轉(zhuǎn)化為空間位置的約束，簡(jiǎn)單地說(shuō)即為不可積約束或運(yùn)動(dòng)約束，如輪子和地面之間的滾動(dòng)約束、某些關(guān)節(jié)無(wú)驅(qū)動(dòng)或者驅(qū)動(dòng)器失靈等情形。相應(yīng)地我

25、們稱具有非完整約束的系統(tǒng)為非完整系統(tǒng)(nonholonomic system)。對(duì)于該類系統(tǒng)，由于約束是不可積的，不存在相應(yīng)的降維變換，使系統(tǒng)呈現(xiàn)一些復(fù)雜特性，如不能實(shí)現(xiàn)輸入狀態(tài)線性化、不能采用光滑非線性反饋實(shí)現(xiàn)漸近穩(wěn)定等，非線性控制中的一些有效方法也不再適用于該類系統(tǒng)，因而非完整性使機(jī)器人的控制問(wèn)題變得相當(dāng)困難。但同時(shí)，非完整性使得機(jī)器人本身的結(jié)構(gòu)具有更高的靈活性和可靠性，它允許機(jī)器人的某些關(guān)</p><p>

26、　　非完整控制系統(tǒng)的運(yùn)動(dòng)控制根據(jù)控制目標(biāo)的不同，大致可以分為三類典型的控制問(wèn)題：路徑跟隨(path following)、軌跡跟蹤(trajectory tracking)和點(diǎn)鎮(zhèn)定問(wèn)題(point stabilization)。</p><p>　　路徑跟隨，如圖1-1所示，是指根據(jù)某種控制理論，為非完整移動(dòng)機(jī)器人系統(tǒng)設(shè)計(jì)一個(gè)控制輸入作用即控制律，使非完整移動(dòng)機(jī)器人能夠到達(dá)并最終以給定的速度跟蹤運(yùn)動(dòng)平面上給定的某

27、條軌跡。在慣性坐標(biāo)系里，機(jī)器人必須從一個(gè)給定的初始狀態(tài)出發(fā)，到達(dá)和跟隨一條理想的幾何路徑，機(jī)器人的初始點(diǎn)可以在這條路徑上，也可以不在該路徑上。在路徑跟隨問(wèn)題中，給定的某條路徑也稱為期望路徑，是指一條幾何曲線 ，這條路徑通常是由某個(gè)或某些參數(shù)的表達(dá)式來(lái)描述的，而用來(lái)描述理想路徑的參數(shù)和時(shí)間是無(wú)關(guān)的，因?yàn)榭刂普哧P(guān)心的只是機(jī)器人相對(duì)于給定路徑的位置。在移動(dòng)機(jī)器人的路徑跟隨問(wèn)題上，一般選取兩個(gè)輸入量中的前進(jìn)量為任意的常量或時(shí)變量，而另一個(gè)輸入量

28、用作控制量。因此路徑跟隨問(wèn)題可以轉(zhuǎn)換成關(guān)于路徑跟隨誤差的一個(gè)標(biāo)量函數(shù)的零點(diǎn)穩(wěn)定問(wèn)題，控制的目標(biāo)是使機(jī)器人和給定路徑之間的距離為零。給定的速度是指給定的線速度v和角速度ω，也稱期望速度即參考控制輸入，用 來(lái)表示，從物理上看 和 的取值變化受 的具體形式的限制，同樣不能包含時(shí)間參數(shù)，而且要求 ， 和 可預(yù)先給定或者由路徑生成器生成。</p><p>　　圖1-1 路徑跟隨示意圖</p><p>

29、;　　軌跡跟蹤如圖1-2所示，是指根據(jù)某種控制理論，為非完整移動(dòng)機(jī)器人系統(tǒng)設(shè)計(jì)一個(gè)控制輸入作用即控制律，使非完整移動(dòng)機(jī)器人能夠到達(dá)并最終以給定的速度跟蹤運(yùn)動(dòng)平面上給定的某條軌跡。在慣性坐標(biāo)系里，機(jī)器人必須從一個(gè)給定的初始狀態(tài)出發(fā)，到達(dá)并跟隨一條理想軌跡。機(jī)器人的初始點(diǎn)可以在這條軌跡上，也可以不在該軌跡上。軌跡跟蹤問(wèn)題與路徑跟隨問(wèn)題的最大區(qū)別在于：要跟蹤的理想軌跡是一條與時(shí)間呈一定關(guān)系的幾何曲線。這里，給定的某條軌跡稱為期望軌跡，是指一條

30、幾何曲線 ，各個(gè)自變量是時(shí)間 的函數(shù)，曲線方程是 的隱函數(shù)；給定的速度是指線速度 和角速度 ，也稱為期望速度即參考控制輸入，用 來(lái)表示。在移動(dòng)機(jī)器人的軌跡跟蹤問(wèn)題里，機(jī)器人必須跟蹤滿足特定時(shí)間規(guī)律的笛卡爾軌跡，即機(jī)器人必須跟蹤一個(gè)移動(dòng)的參考機(jī)器人。</p><p>　　圖1-2 軌跡跟蹤示意圖</p><p>　　點(diǎn)鎮(zhèn)定，也稱為位姿鎮(zhèn)定、姿態(tài)跟蹤、或設(shè)定點(diǎn)調(diào)節(jié)，簡(jiǎn)稱鎮(zhèn)定控制，如圖1-3所示

31、，是指根據(jù)某種控制理論，為非完整移動(dòng)機(jī)器人系統(tǒng)設(shè)計(jì)一個(gè)控制輸入作用即控制律，使非完整移動(dòng)機(jī)器人能夠到達(dá)運(yùn)動(dòng)平面上的任意給定的某個(gè)目標(biāo)點(diǎn)，并且能夠穩(wěn)定在該目標(biāo)點(diǎn)。上面各種名稱中的點(diǎn)、位姿、姿態(tài)、設(shè)定點(diǎn)都是指給定的目標(biāo)點(diǎn)，統(tǒng)稱為期望位姿 ，其數(shù)值可預(yù)先給定或根據(jù)軌跡規(guī)劃器生成。這里提到點(diǎn)鎮(zhèn)定就要說(shuō)一下Brockett光滑鎮(zhèn)定條件，由于非完整系統(tǒng)受到非完整約束，所以不能應(yīng)用反饋線性化或光滑定常反饋的控制器設(shè)計(jì)方法漸近鎮(zhèn)定系統(tǒng)，只能尋求不連續(xù)控

32、制律、時(shí)變控制律或混合控制律在移動(dòng)機(jī)器人中的應(yīng)用。</p><p>　　圖1-3點(diǎn)鎮(zhèn)定示意圖</p><p>　　1.3 路徑跟蹤的研究現(xiàn)狀</p><p>　　在目前的輪式移動(dòng)機(jī)器人研究領(lǐng)域中，路徑跟蹤控制問(wèn)題由于其廣泛的應(yīng)用需求而得到越來(lái)越多的關(guān)注。諸如在定位焊接、地雷探測(cè)、物料搬運(yùn)、道路清掃以及室內(nèi)室外運(yùn)輸?shù)仍S多應(yīng)用中，精確的路徑跟蹤成為移動(dòng)機(jī)器人應(yīng)用的實(shí)質(zhì)

33、。</p><p>　　目前對(duì)機(jī)器人的路徑跟蹤的研究主要集中在兩個(gè)方向上，一是路徑的設(shè)置及其信息的獲取，二是控制方法的研究。</p><p>　　路徑的設(shè)置主要有兩種方法，即有線路徑和計(jì)算機(jī)地圖路徑。移動(dòng)機(jī)器人有線路徑可以是埋在地下的電纜、鋪刷在地面上的磁性路徑或有色亮帶、自然或人工擺設(shè)的墻壁。計(jì)算機(jī)路徑可以是基于全局路徑規(guī)劃的路徑，也可以是示教的路徑。</p><p&

34、gt;　　移動(dòng)機(jī)器人路徑跟蹤的控制方法多種多樣，從經(jīng)典的PID控制到各種智能控制器都可用來(lái)進(jìn)行移動(dòng)機(jī)器人的路徑跟蹤，在工程實(shí)際中也得到了應(yīng)用。已經(jīng)提出的移動(dòng)機(jī)器人路徑跟蹤控制方法可以分為以下四類：線性化方法、非線性化方法、變結(jié)構(gòu)控制、智能控制方法。文獻(xiàn)[3-4]利用移動(dòng)機(jī)器人的路徑曲率的微分表示曲率、位置誤差、姿態(tài)誤差的線性組合形式，稱其為“操縱函數(shù)(Steering Function)，并取位置誤差、位置誤差的一次微分、位置誤差的二次

35、微分作為變量，使控制系統(tǒng)線性化；文獻(xiàn)采用預(yù)測(cè)控制的方法，根據(jù)對(duì)機(jī)器人的運(yùn)動(dòng)預(yù)測(cè)，提前實(shí)現(xiàn)相應(yīng)的控制動(dòng)作，能在2~3個(gè)控制周期內(nèi)準(zhǔn)確逼近參考路徑，且不存在一般反饋控制器的振蕩問(wèn)題；2010年Yong Zhang, Jin Cheng（2010）等人提出利用LOS瞄準(zhǔn)線（把路徑跟蹤轉(zhuǎn)化為跟蹤機(jī)器人的位置指向參考位置的向量）如圖1-4所示：設(shè)計(jì)模糊控制器實(shí)現(xiàn)轉(zhuǎn)角的控制，從仿真結(jié)果分析，能夠?qū)σ话懵窂侥軌驅(qū)崿F(xiàn)很好的跟蹤。由于始終跟蹤直線矢量，當(dāng)

36、速度快時(shí)就會(huì)出現(xiàn)超調(diào)。在文獻(xiàn)中，作者采用滑模控制，得到具有很好的魯棒性的控制律。</p><p>　　圖1-4 LOS瞄準(zhǔn)線法示意圖</p><p>　　傳統(tǒng)方法存在的問(wèn)題有：控制量可能過(guò)大，超出實(shí)際機(jī)械約束的限制，雖然能通過(guò)限幅來(lái)解決，但同時(shí)會(huì)使算法的控制性能有所降低。特別是初始位置誤差較大的時(shí)候，這個(gè)問(wèn)題尤為突出?？刂拼嬖谄娈慄c(diǎn)，奇異情況就發(fā)生在移動(dòng)機(jī)器人的運(yùn)動(dòng)方向與通過(guò)機(jī)器人位置所做

37、的期望路徑的法線方向一致。沒(méi)有考慮路徑跟蹤的方向性，控制機(jī)器人時(shí)為了達(dá)到期望的速度和角速度而使車輪轉(zhuǎn)速有正負(fù)向的切換，由于運(yùn)動(dòng)慣性和驅(qū)動(dòng)電機(jī)的繼電特性，這在實(shí)際的幾何路徑跟蹤過(guò)程中是不宜于發(fā)生的。</p><p>　　由于經(jīng)典控制方法和現(xiàn)代控制方法在控制機(jī)器人這種復(fù)雜系統(tǒng)時(shí)所表現(xiàn)出的種種不足，模糊控制等智能控制方法被越來(lái)越多地引入到機(jī)器人的控制中。智能控制方法所具有的自學(xué)習(xí)能力和非線性映射能力，為解決機(jī)器人控制問(wèn)

38、題提供了新的手段，引起了廣大機(jī)器人研究人員的關(guān)注，近年來(lái)很多學(xué)者將智能控制與傳統(tǒng)控制方法相結(jié)合，取得很多有用的成果。從而出現(xiàn)了機(jī)器人模糊自適應(yīng)控制、智能魯棒控制、模糊神經(jīng)網(wǎng)絡(luò)控制等智能化控制方法。</p><p><b>　　1.4主要內(nèi)容</b></p><p>　　本文以兩輪差動(dòng)輪式機(jī)器人為研究對(duì)象，對(duì)機(jī)器人的路徑跟蹤控制進(jìn)行了研究。本論文的主要工作如下：<

39、/p><p>　?。?）分析了移動(dòng)機(jī)器人的運(yùn)動(dòng)學(xué)模型及其路徑跟蹤過(guò)程，并改進(jìn)了視線導(dǎo)航策略即參考點(diǎn)的選擇方法。</p><p>　?。?）根據(jù)改進(jìn)的視線導(dǎo)航策略設(shè)計(jì)了角速度和線速度控制器，并對(duì)該算法進(jìn)行了仿真。</p><p>　　本論文的具體內(nèi)容安排如下：</p><p>　　第一章 簡(jiǎn)述機(jī)器人技術(shù)的發(fā)展，介紹了幾類非完整移動(dòng)機(jī)器人的控制問(wèn)題，

40、深入分析路徑跟蹤的研究現(xiàn)狀，指出了傳統(tǒng)方法存在的一些問(wèn)題。</p><p>　　第二章 分析了兩輪差動(dòng)移動(dòng)機(jī)器人的運(yùn)動(dòng)學(xué)模型和移動(dòng)機(jī)器人的路徑跟蹤過(guò)程，改進(jìn)了路徑導(dǎo)航策略。</p><p>　　第三章 了解模糊控制器的基本思想，掌握模糊控制器的組成及其設(shè)計(jì)方法，對(duì)路徑跟蹤模糊控制器進(jìn)行設(shè)計(jì)，設(shè)計(jì)出速度模糊控制器和角速度模糊控制器。</p><p>　　第四章 進(jìn)行仿

41、真實(shí)驗(yàn)，通過(guò)仿真結(jié)果不斷對(duì)模糊控制器參數(shù)進(jìn)行修正，得出最優(yōu)結(jié)果，實(shí)現(xiàn)對(duì)路徑跟蹤的matlab仿真。</p><p>　　第五章 總結(jié)全文并對(duì)未來(lái)工作進(jìn)行展望。</p><p><b>　　第六章 致謝</b></p><p>　　2 兩輪差動(dòng)移動(dòng)機(jī)器人模型</p><p>　　移動(dòng)機(jī)器人分很多種類，從工作環(huán)境來(lái)分，可分為

42、室內(nèi)移動(dòng)機(jī)器人和室外移動(dòng)機(jī)器人；按移動(dòng)方式來(lái)分，可分為輪式移動(dòng)機(jī)器人、步行移動(dòng)機(jī)器人、蛇形機(jī)器人、履帶式移動(dòng)機(jī)器人、爬行機(jī)器人等；按控制體系結(jié)構(gòu)來(lái)分，可分為功能式(水平式)結(jié)構(gòu)機(jī)器人、行為式(垂直式)結(jié)構(gòu)機(jī)器人和混合式機(jī)器人；按功能和用途來(lái)分，可分為醫(yī)療機(jī)器人、軍用機(jī)器人、助殘機(jī)器人、清潔機(jī)器人等；按作業(yè)空間來(lái)分，可分為陸地移動(dòng)機(jī)器人、水下機(jī)器人、無(wú)人飛機(jī)和空間機(jī)器人。針對(duì)差動(dòng)輪驅(qū)動(dòng)的移動(dòng)機(jī)器人動(dòng)力學(xué)的高度非線性和運(yùn)動(dòng)環(huán)境的不確定性，提

43、出了基于模糊邏輯的移動(dòng)機(jī)器人路徑跟蹤控制方法。該方法通過(guò)合理選擇模糊控制器的參數(shù)和優(yōu)化規(guī)則庫(kù)，使其輸出合適的線速度和角速度，從而控制移動(dòng)機(jī)器人準(zhǔn)確地跟蹤預(yù)規(guī)劃的路徑。提出了兩輪差動(dòng)式移動(dòng)機(jī)器人的動(dòng)力學(xué)模型，使得該模糊控制器對(duì)不同幾何參教的差動(dòng)式機(jī)器人具有普遍的適應(yīng)性。在實(shí)際場(chǎng)地試驗(yàn)和亞太機(jī)器人大賽中驗(yàn)證該方法的有效性。本章將兩輪差動(dòng)驅(qū)動(dòng)一輪隨動(dòng)的移動(dòng)機(jī)器人作為研究對(duì)象，在分析其系統(tǒng)結(jié)構(gòu)和路徑跟蹤工作過(guò)程的基礎(chǔ)上分別給出了兩輪差動(dòng)驅(qū)動(dòng)的移

44、動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型及移動(dòng)機(jī)器人路徑跟蹤過(guò)程。</p><p>　　2.1移動(dòng)機(jī)器人結(jié)構(gòu)</p><p>　　許多實(shí)際系統(tǒng)常常要與外部環(huán)境接觸，這類系統(tǒng)受到一定的約束條件，因而稱其為受限系統(tǒng)。通常的約束條件可以歸結(jié)為完整約束和非完整約束兩類，完整約束只限制受控對(duì)象的空間位置，或者同時(shí)限制空間位置及運(yùn)動(dòng)速度，因此稱其為幾何約束，而非完整約束則是對(duì)系統(tǒng)運(yùn)動(dòng)速度的約束，并且不能通過(guò)積分轉(zhuǎn)化為空間位

45、置的約束，簡(jiǎn)單地說(shuō)即為不可積的速度約束。相應(yīng)地我們稱受完整約束的系統(tǒng)為完整系統(tǒng)，而受非完整約束的系統(tǒng)為非完整系統(tǒng)。</p><p>　　移動(dòng)機(jī)器人隨其應(yīng)用環(huán)境和移動(dòng)方式的不同，研究?jī)?nèi)容也有很大差別。其共同的基本技術(shù)有傳感器技術(shù)、移動(dòng)技術(shù)、操作器、控制技術(shù)、人工智能等方面。它有相當(dāng)于人的眼、耳、皮膚的視覺(jué)傳感器、聽(tīng)覺(jué)傳感器和觸覺(jué)傳感器。移動(dòng)機(jī)構(gòu)有輪式（如四輪式、兩輪式、全方向式、履帶式）、足式（如 6足、4足、2足

46、）、混合式(用輪子和足)、特殊式(如吸附式、軌道式、蛇式)等類型。輪子適于平坦的路面，足式移動(dòng)機(jī)構(gòu)適于山岳地帶和凹凸不平的環(huán)境。移動(dòng)機(jī)器人的控制方式從遙控、監(jiān)控向自治控制發(fā)展，綜合應(yīng)用機(jī)器視覺(jué)、問(wèn)題求解、專家系統(tǒng)等人工智能等技術(shù)研制自治型移動(dòng)機(jī)器人。根據(jù)移動(dòng)方式來(lái)分，可分為：輪式移動(dòng)機(jī)器人、步行移動(dòng)機(jī)器人(單腿式、雙腿式和多腿式)、履帶式移動(dòng)機(jī)器人、爬行機(jī)器人、蠕動(dòng)式機(jī)器人和游動(dòng)式機(jī)器人等類型；按工作環(huán)境來(lái)分，可分為：室內(nèi)移動(dòng)機(jī)器人和室

47、外移動(dòng)機(jī)器人；按控制體系結(jié)構(gòu)來(lái)分，可分為:功能式(水平式)結(jié)構(gòu)機(jī)器人、行為式(垂直式)結(jié)構(gòu)機(jī)器人和混合式機(jī)器人；按功能和用途來(lái)分，可分為:醫(yī)療機(jī)器人、軍用機(jī)器人、助殘機(jī)器人、清潔機(jī)器人等。</p><p>　　一般來(lái)說(shuō)，凡是帶有滾動(dòng)輪子的系統(tǒng)，如果沿輪子軸線方向沒(méi)有滑動(dòng)的話，都是受非完整約束的系統(tǒng)，所以對(duì)于輪式移動(dòng)機(jī)器人，在無(wú)滑動(dòng)運(yùn)動(dòng)的假設(shè)下，輪子與地面接觸點(diǎn)的瞬時(shí)速度為零，為純滾動(dòng)運(yùn)動(dòng)，這時(shí)機(jī)器人可以向前或向后

48、作直線、旋轉(zhuǎn)運(yùn)動(dòng)，但不能橫向運(yùn)動(dòng)，系統(tǒng)受非完整約束，自由度為2，控制輸入為驅(qū)動(dòng)線速度和轉(zhuǎn)向角速度。本文的研究工作都是以前兩輪驅(qū)動(dòng)的移動(dòng)機(jī)器人作為研究對(duì)象的，前兩輪處在同一軸線上，并 由兩個(gè)電機(jī)分別驅(qū)動(dòng)，可以通過(guò)控制兩個(gè)驅(qū)動(dòng)輪的速度，使機(jī)器人跟蹤不同的路徑；后輪是可以任意方向滾動(dòng)的小角輪，小角輪的作用是使車體穩(wěn)定，但會(huì)給系統(tǒng)帶來(lái)力學(xué)上的干擾沖突。這種結(jié)構(gòu)方式的優(yōu)點(diǎn)是轉(zhuǎn)向靈活，當(dāng)兩驅(qū)動(dòng)輪速率相同，方向相反時(shí)，車體可以原地轉(zhuǎn)彎。兩輪差動(dòng)驅(qū)動(dòng)

49、的移動(dòng)機(jī)器人可以視為一種較為典型的三輪式移動(dòng)機(jī)器人。</p><p>　　2.2 移動(dòng)機(jī)器人的運(yùn)動(dòng)學(xué)模型</p><p>　　圖2-1 兩輪差動(dòng)驅(qū)動(dòng)的移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型</p><p>　　兩輪差動(dòng)驅(qū)動(dòng)的移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型如圖2-1所示。取左右兩輪中心連線上的中點(diǎn) 作為運(yùn)動(dòng)中心，設(shè) 和 分別為左、右驅(qū)動(dòng)輪的轉(zhuǎn)動(dòng)角速度，假設(shè)移動(dòng)機(jī)器人在平面上做純滾動(dòng)無(wú)滑動(dòng)的運(yùn)動(dòng)，

50、則中心點(diǎn) 的切向速度和轉(zhuǎn)動(dòng)角速度可以被寫成如下形式：</p><p><b>　　(2-1)</b></p><p><b>　　(2-2)</b></p><p>　　其中 是輪子的半徑， 是連接兩輪中點(diǎn)的輪軸的長(zhǎng)度。</p><p><b>　　則運(yùn)動(dòng)學(xué)模型為</b><

51、;/p><p><b>　　(2-3)</b></p><p>　　式中， 為移動(dòng)機(jī)器人的運(yùn)動(dòng)中心 在全局坐標(biāo)系下的位置坐標(biāo)， 為機(jī)人航向角， 為移動(dòng)機(jī)器人的線速度， 為移動(dòng)機(jī)器人的角速度。</p><p>　　為解決兩輪差動(dòng)驅(qū)動(dòng)的移動(dòng)機(jī)器人路徑跟蹤問(wèn)題，首先要解決的是對(duì)其路跟蹤問(wèn)題的數(shù)學(xué)描述。移動(dòng)機(jī)器人的位姿就是指移動(dòng)機(jī)器人在全局坐標(biāo)系中所的位置

52、和方向。假設(shè)機(jī)器人在 軸方向上的位置坐標(biāo)分別是 ，機(jī)器人的方向角(即機(jī)器人運(yùn)動(dòng)方向與 軸的夾角)為 ，用系統(tǒng)狀態(tài) 表示機(jī)器的位姿量。</p><p>　　本文討論的兩輪差動(dòng)驅(qū)動(dòng)移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)特性微分方程描述為式(2.3)，表示為矩陣形式如下：</p><p><b>　　(2-4)</b></p><p>　　根據(jù)兩輪差動(dòng)驅(qū)動(dòng)移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)

53、模型，將機(jī)器人的速度和角速度，即 為輸入控制量，以實(shí)現(xiàn)機(jī)器人的速度和角速度控制。則機(jī)器人路徑跟蹤要完成的任務(wù)就是給定機(jī)器人一個(gè)初始狀態(tài)，尋找合適的輸入變量 ，使得輪式移動(dòng)機(jī)器人系統(tǒng)沿著期望的路徑行走。</p><p>　　2.3 移動(dòng)機(jī)器人路徑跟蹤過(guò)程</p><p>　　目前，移動(dòng)機(jī)器人的路徑跟蹤問(wèn)題的提法有很多種，參看文獻(xiàn)[8-10]它們有一個(gè)共同點(diǎn)：就是控制目的是使移動(dòng)機(jī)器人能精確的

54、沿著期望的幾何路徑行走。本文將移動(dòng)機(jī)器人的路徑跟蹤問(wèn)題描述為:在一定導(dǎo)航系統(tǒng)的配合下，采取一種有效的控制決策，設(shè)計(jì)適當(dāng)?shù)目刂扑惴?，使得移?dòng)機(jī)器人按事先規(guī)劃好的在平面直角坐標(biāo)系中的曲線運(yùn)動(dòng)稱為移動(dòng)機(jī)器人的路徑跟蹤問(wèn)題。它和軌跡跟蹤問(wèn)題不同，它不要求移動(dòng)機(jī)器人在一定的時(shí)刻具有一定的位置和航向，可以想象現(xiàn)實(shí)生活中有很多這樣的路徑跟蹤問(wèn)題，如貨物運(yùn)輸、道路清掃等，只關(guān)心移動(dòng)機(jī)器人自身的運(yùn)動(dòng)軌跡與期望軌跡的重合度。路徑跟蹤需要給出以幾何參數(shù)描述的

55、期望參考點(diǎn)信息，以代替軌跡跟蹤中的期望時(shí)間序列，這些期望參考點(diǎn)信息的選擇都是人為決定的，在這里被稱為路徑跟蹤控制策略。</p><p>　　圖2-2 移動(dòng)機(jī)器人路徑跟蹤系統(tǒng)示意圖</p><p>　　本文主要是在己知目標(biāo)路徑的情況下對(duì)跟蹤控制方法的研究，一般情況下，目標(biāo)路徑都是通過(guò)環(huán)境識(shí)別和路徑規(guī)劃得到的一條可跟蹤的期望路徑。如圖2-2是一個(gè)基于視覺(jué)導(dǎo)航的移動(dòng)機(jī)器人路徑跟蹤系統(tǒng)示意圖，系統(tǒng)

56、中利用位姿反饋控制方法實(shí)現(xiàn)路徑跟蹤。其中控制系統(tǒng)包括了控制策略和控制律。移動(dòng)機(jī)器人通過(guò)環(huán)境識(shí)別和路徑規(guī)劃等方法得到目標(biāo)路徑后，需要在考慮自身的非完整約束和機(jī)械約束的基礎(chǔ)上，按照一定的控制方法消除與目標(biāo)路徑的位姿誤差，并能最終沿著目標(biāo)路徑行走。因此對(duì)控制策略和控制律這兩部分設(shè)計(jì)的好壞直接決定著路徑跟蹤的精度，是控制系統(tǒng)的核心。</p><p>　　2.4 移動(dòng)機(jī)器人軌跡跟蹤控制未來(lái)發(fā)展趨勢(shì)</p>&

57、lt;p>　　研究移動(dòng)機(jī)器人軌跡跟蹤控制問(wèn)題，雖然理論意義重大，但最終還是要服務(wù)于控制系統(tǒng)實(shí)現(xiàn)，即應(yīng)用于實(shí)際機(jī)器人平臺(tái)。因此人們總是希望所設(shè)計(jì)的控制律，在理論上可行的前提下能盡量同時(shí)兼顧下列特性：硬件設(shè)計(jì)和軟件編程上能夠應(yīng)用于實(shí)際的非完整移動(dòng)機(jī)器人平臺(tái)(可行性)；占用最少的系統(tǒng)資源做出最快的響應(yīng)(實(shí)時(shí)性)；適用于不同的非完整移動(dòng)機(jī)器人平臺(tái)(通用性)；閉環(huán)系統(tǒng)在原點(diǎn)平衡狀態(tài)是全局一致漸近穩(wěn)定的(穩(wěn)定性)；不改變控制器參數(shù)的取值而對(duì)各

58、種不同的期望值都能取得滿意的鎮(zhèn)定或跟蹤效果(魯棒性)：控制量的變化要盡量光滑連續(xù)以降低系統(tǒng)機(jī)械和能量損耗并延長(zhǎng)有效工作時(shí)間和使用壽命(光滑性)1321。運(yùn)動(dòng)學(xué)模型與動(dòng)力學(xué)模型相比，除了模型簡(jiǎn)單通用不存在不確定項(xiàng)之外，還有一個(gè)巨大的優(yōu)勢(shì)在于，運(yùn)動(dòng)學(xué)模型本身即符合非完整約束條件。這樣，在某些條件下，控制律設(shè)計(jì)就可以不必再單獨(dú)考慮非完整約束條件。有鑒于此，非完整移動(dòng)機(jī)器人軌跡跟蹤控制問(wèn)題的理論研究將以智能控制方法為發(fā)展趨勢(shì)，以期更好地解決穩(wěn)定

59、性、魯棒性和光滑性問(wèn)題。而應(yīng)用研究上，為確?？尚行?、通用性和實(shí)時(shí)性，將繼續(xù)基于非完整移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型，以狀態(tài)反饋控制方法為主導(dǎo)，同時(shí)尋求</p><p>　　2.5 改進(jìn)的視線導(dǎo)航算法</p><p>　　圖2-3 機(jī)器人與當(dāng)前期望位置的誤差</p><p>　　由于路徑跟蹤中目標(biāo)路徑的給定不含時(shí)間量，因此每個(gè)時(shí)刻，移動(dòng)機(jī)器人所跟蹤的目標(biāo)點(diǎn)的確定不能采用時(shí)間函數(shù)

60、，此時(shí)移動(dòng)機(jī)器人的路徑跟蹤控制事實(shí)上是一種相對(duì)參考點(diǎn)的糾偏控制，要控制移動(dòng)機(jī)器人沿某個(gè)規(guī)劃好的目標(biāo)路徑行走，首先要由控制策略實(shí)時(shí)給出作為控制器輸入的參考信號(hào)。在路徑跟蹤控制的研究中，有很多參考信號(hào)的選擇方法。如文獻(xiàn)[9]是把當(dāng)前期望點(diǎn)作為目標(biāo)參考信號(hào),其原理如圖2-3所示。這樣可以使 和 始終保持為零，從而簡(jiǎn)化了控制律的設(shè)計(jì)。但這樣選擇的參考信號(hào)不能反映未來(lái)特性，再加上機(jī)器人控制的時(shí)延性，會(huì)使在機(jī)器人達(dá)到當(dāng)前期望點(diǎn)時(shí)誤差為零，控制滯后，

61、嚴(yán)重時(shí)會(huì)在期望路徑附近發(fā)生反復(fù)抖動(dòng)，影響系統(tǒng)穩(wěn)定性。</p><p>　　事實(shí)上，駕駛員駕駛車輛在路面上行走就是一種典型的路徑跟蹤控制過(guò)程。經(jīng)分析人工駕駛車輛行為會(huì)很容易發(fā)現(xiàn)，駕駛員在駕駛車輛時(shí)很少關(guān)心當(dāng)前路面信息，而總是盯著前方路面，獲取了路面信息后經(jīng)大腦分析計(jì)算誤差來(lái)決定方向盤的回轉(zhuǎn)角度和安全駕駛的速度也就是速度檔位，因此大部分研究者選用提前角導(dǎo)引策略，這種策略通常被稱作視線導(dǎo)航策略，其核心思想就是將某個(gè)未來(lái)

62、期望點(diǎn)作為當(dāng)前控制的目標(biāo)參考點(diǎn)。這個(gè)參考點(diǎn)信息有很多種計(jì)算方法，由于在這里要解決的是移動(dòng)機(jī)器人跟蹤一條規(guī)劃好的路徑，所以只需參照汽車在沒(méi)有障礙物且平坦的路面行走時(shí)駕駛員的行為。人通過(guò)眼睛獲取并傳遞給大腦的信息就是路面的彎曲程度和車身相對(duì)前方路面的位姿誤差，而大腦做出檔位和方向盤回轉(zhuǎn)判斷的依據(jù)就是快而穩(wěn)的消除車身與視線點(diǎn)的誤差，這里的誤差應(yīng)該包括位置誤差和方向誤差。傳統(tǒng)意義上的視線導(dǎo)航原理就是將這個(gè)誤差作為閉環(huán)反饋控制量，調(diào)節(jié)移動(dòng)機(jī)器人的

63、速度和角速度實(shí)現(xiàn)路徑跟蹤控制。文獻(xiàn)中提出的固定距離參考點(diǎn)法就是一種視線導(dǎo)航策略，有效的解決了將當(dāng)前期望點(diǎn)作為參考點(diǎn)的弊端，但在移動(dòng)機(jī)器人離參考路徑較遠(yuǎn)而固定距離選的較小時(shí)，可能在期望路徑上找不到這樣的參考點(diǎn)，而在期望路</p><p>　　假設(shè)期望路徑由 (2-5)方程描述，為考慮路徑跟蹤的方向性，將它看作由 這樣足夠多個(gè)參考點(diǎn)有向序列構(gòu)成。參考信號(hào)的選取方案：在參考點(diǎn)序列中順序搜索，當(dāng)搜索到滿足如(2-6)約

64、束條件時(shí)停止搜索，并確定此時(shí)的點(diǎn) 為參考點(diǎn)。</p><p><b>　　(2-6)</b></p><p>　　式（2-5）中 為機(jī)器人的最大視距（即安裝好攝像頭后，視野中最近端到最遠(yuǎn)端的距離）， 為調(diào)節(jié)因子。</p><p>　　的選取是智能控制的一個(gè)關(guān)鍵技術(shù)，當(dāng)路徑彎曲度大時(shí)， 值應(yīng)取的小些，當(dāng)路徑彎曲度小時(shí)應(yīng)取的大些。因此可以設(shè)計(jì)一個(gè)簡(jiǎn)

65、單模糊調(diào)節(jié)因子產(chǎn)生器來(lái)控制 的大小。路徑的彎曲程度即為路徑的曲率 。若路徑由方程（2-5）表示，則路徑的曲率可由（2-7）求得：</p><p><b>　　(2-7)</b></p><p>　　該方法計(jì)算量較大，且對(duì)規(guī)劃路徑的要求較高，如線性性和高階可導(dǎo)性等，由于現(xiàn)實(shí)中路面的變化是很復(fù)雜的，且具有非線性，所以用曲率判斷路徑的彎曲程度是不實(shí)用的。在這里，我們只需要找

66、到能夠充分體現(xiàn)路徑的彎曲程度的量作替代作為調(diào)節(jié)因子產(chǎn)生器的輸入，同樣可以達(dá)到目的?？梢詤⒖嘉墨I(xiàn)[12]的方法，如圖2-4所示，將視野中的路徑沿 軸方向等分為 個(gè)矩形區(qū)域。在每個(gè)區(qū)域內(nèi)，將路徑視為直線，從而得到第 個(gè)區(qū)域路徑相對(duì)于第 個(gè)區(qū)域路徑的夾角 。</p><p>　　路徑的彎曲度 定義為：</p><p><b>　　(2-8)</b></p>&

67、lt;p>　　圖2-4 路徑區(qū)域劃分</p><p>　　文中把 作為平緩路徑處理，把 作為急轉(zhuǎn)路徑處理（ 的值根據(jù)安裝攝像頭的高度可做調(diào)整）。因此可根據(jù) 把路徑進(jìn)行劃分，并根據(jù) 的值來(lái)確定的 的大小，具體對(duì)應(yīng)關(guān)系如表2-1所示：</p><p><b>　　表2-1 K值表</b></p><p>　　3 移動(dòng)機(jī)器人路徑跟蹤的模糊控制&

68、lt;/p><p>　　3.1模糊控制器的基本思想</p><p>　　模糊集合和模糊控制的概念是由美國(guó)加利福尼亞大學(xué)的自動(dòng)控制教授L.A.Zadeh在其《Fuzzy Sets》、《Fuzzy Algorithm》和《A Relational for Fuzzy Control》等著名論著中首先提出的，模糊集合的引入可以將人的判斷、思維過(guò)程用比較簡(jiǎn)單的數(shù)學(xué)形式直接表達(dá)出來(lái)，從而對(duì)復(fù)雜系統(tǒng)做出符

69、合實(shí)際和人類思維方式的處理，并使得有人的經(jīng)驗(yàn)參與的控制過(guò)程成為實(shí)際可能。</p><p>　　1973年，L.A.Zadeh教授又進(jìn)一步研究了模糊語(yǔ)言處理，給出了模糊推理的理論基礎(chǔ)。自從1974年英國(guó)Mamdnai制造出用于鍋爐和蒸氣機(jī)的第一個(gè)模糊控制器以來(lái)，模糊控制理論和應(yīng)用技術(shù)的發(fā)展歷史只有短短的30多年，雖然其發(fā)展歷史很短，但是發(fā)展速度之快、成果之多以及世人重視之程度卻是少有的，特別是1987年在日本，基于

70、模糊控制的仙臺(tái)地鐵開(kāi)通以后，各種家電的模糊控制產(chǎn)品相繼研制成功并進(jìn)入市場(chǎng)，如洗衣機(jī)、照相機(jī)、攝像機(jī)、復(fù)印機(jī)、吸塵器、電冰箱、微波爐、電飯鍋、空調(diào)器、電視機(jī)、淋浴器等，這些家電產(chǎn)品在節(jié)約能源、方便使用以及使用效果方面更富有“人情味”，更符合人的實(shí)際生活。同時(shí)，各種各樣的模糊控制系統(tǒng)也被研制成功。例如，各種熔爐、電氣爐、水泥生產(chǎn)爐的控制系統(tǒng)、核電站的供水系統(tǒng)、汽車控制系統(tǒng)、電梯升降機(jī)控制系統(tǒng)、機(jī)器人控制系統(tǒng)，以及活躍于航空、宇宙、通信領(lǐng)域的

71、專家系統(tǒng)。這些模糊控制系統(tǒng)的應(yīng)用取得了明顯的效益，并且受到了人們普遍的重視。</p><p>　　模糊理論與應(yīng)用的研究以及模糊產(chǎn)品的開(kāi)發(fā)像一股強(qiáng)勁的風(fēng)浪席卷世界各地。1989年，模糊理論的創(chuàng)始人L.A.Zadeh教授指出：模糊理論是對(duì)“徹底的排除不明確事物只以明確事物為對(duì)象”的科學(xué)界傳統(tǒng)所做的挑戰(zhàn)。這種理論對(duì)于如何處理與對(duì)待不明確事物，所依據(jù)思路與過(guò)去的科學(xué)實(shí)質(zhì)上完全不同。他認(rèn)為模糊理論今后將在兩個(gè)領(lǐng)域取得較大進(jìn)

72、展：一是熟練技術(shù)者替代系統(tǒng)，這種系統(tǒng)將人無(wú)意識(shí)進(jìn)行的操作由機(jī)器替代，如日本仙臺(tái)地鐵的自動(dòng)駕駛系統(tǒng)；二是替代專家的專家系統(tǒng)。為使專家頭腦中所進(jìn)行的思考與決策能實(shí)現(xiàn)自動(dòng)化，模糊理論將起重要的作用。當(dāng)然，模糊控制并不能解決所有可能性的問(wèn)題，但是，只要不回避現(xiàn)實(shí)中的不確定事物，并加以認(rèn)真對(duì)待，就有可能大大的提高在不確定(模糊)環(huán)境中進(jìn)行智慧思考與決策的人及機(jī)器的能力[13]。</p><p>　　L.A.Zadeh教授提

73、出的模糊集合論，其核心是對(duì)復(fù)雜的系統(tǒng)或過(guò)程建立一種語(yǔ)言分析的數(shù)學(xué)模式，使自然語(yǔ)言能直接能夠直接轉(zhuǎn)化為計(jì)算機(jī)所能接受的算法語(yǔ)言。模糊集合理論的誕生為處理客觀世界中存在的一類模糊性問(wèn)題提供了有力的工具。</p><p>　　模糊控制是以模糊集合理論、模糊語(yǔ)言變量及模糊推理為基礎(chǔ)的一類計(jì)算機(jī)數(shù)字控制方法，模糊控制同傳統(tǒng)的控制理論相結(jié)合，模擬人的思維方式，對(duì)難以建立數(shù)學(xué)模型的對(duì)象實(shí)施控制。模糊控制與傳統(tǒng)的控制方式相比具

74、有以下特點(diǎn)：</p><p>　　1．設(shè)計(jì)系統(tǒng)時(shí)不需要建立被控對(duì)象的數(shù)學(xué)模型。只要求掌握現(xiàn)場(chǎng)有經(jīng)驗(yàn)的操作人員或有關(guān)專家的經(jīng)驗(yàn)、知識(shí)或者操作者在操作過(guò)程中的操作數(shù)據(jù)及被控對(duì)象的運(yùn)行數(shù)據(jù)等。</p><p>　　2．被控對(duì)象特性參數(shù)的變化具有較強(qiáng)的魯棒性。適合于對(duì)難以建立數(shù)學(xué)模型的被控對(duì)象的復(fù)雜系統(tǒng)，如非線性、時(shí)變、滯后系統(tǒng)。</p><p>　　3．模糊控制為“語(yǔ)言型

75、”控制，從工業(yè)過(guò)程的定性認(rèn)識(shí)出發(fā)容易建立語(yǔ)言變量控制規(guī)則，易于形成知識(shí)庫(kù)。</p><p>　　它的核心部分為模糊控制器。模糊控制器實(shí)際是一臺(tái)微計(jì)算機(jī)，模糊控制規(guī)律由計(jì)算機(jī)程序?qū)崿F(xiàn)。模糊控制器通過(guò)輸入接口從被控對(duì)象獲取數(shù)字信號(hào)量，并將模糊控制器決策的數(shù)字信號(hào)經(jīng)過(guò)數(shù)模轉(zhuǎn)變?yōu)槟M信號(hào)，通過(guò)輸出接口送給執(zhí)行機(jī)構(gòu)去控制被控對(duì)象。在I／0裝置中，除A／D、D／A轉(zhuǎn)換外，還包括必要的電平轉(zhuǎn)換電路。廣義對(duì)象包括被控對(duì)象及執(zhí)行機(jī)

76、構(gòu)，被控對(duì)象可以是線性或非線性的、定常或時(shí)變的，也可以是單變量或多</p><p>　　變量的、有時(shí)滯或無(wú)時(shí)滯的以及有強(qiáng)干擾的多種情況。還需指出，被控對(duì)象缺乏精確數(shù)學(xué)模型的情況適宜選擇模糊控制，但也不排斥有較精確的數(shù)學(xué)模型的被控對(duì)象，同樣也可以采用模糊控制方案。傳感器是將被控對(duì)象或各種過(guò)程的被控制量轉(zhuǎn)換為電信號(hào)(模擬或數(shù)字)的一類裝置。傳感器在模糊控制系統(tǒng)中占有十分重要的地位，它的精度往往直接影響整個(gè)控制系統(tǒng)的精

77、度。因此在選擇傳感器時(shí)，應(yīng)根據(jù)系統(tǒng)要求選擇相應(yīng)的傳感器。模糊控制器結(jié)構(gòu)如圖3-1</p><p>　　圖3-1 模糊控制器結(jié)構(gòu)圖</p><p>　　3.2 模糊控制器的組成及其設(shè)計(jì)方法</p><p>　　模糊控制是建立在人工經(jīng)驗(yàn)基礎(chǔ)上的控制方法。對(duì)于一個(gè)熟練的操作人員，他并非需要了解被控對(duì)象精確的數(shù)學(xué)模型，而是憑借其豐富的實(shí)踐經(jīng)驗(yàn)，采取適當(dāng)?shù)膶?duì)策來(lái)巧妙地控制各復(fù)

78、雜過(guò)程。若把這些熟練操作員的實(shí)踐經(jīng)驗(yàn)加以總結(jié)和描述，并用語(yǔ)言表達(dá)出來(lái)，它就是一個(gè)定性的、不精確的控制規(guī)則。如果用模糊數(shù)學(xué)將其定量化，就轉(zhuǎn)化為模糊控制算法，從而形成了模糊控制理論。模糊控制具有如下明顯特點(diǎn)：</p><p>　　(1)模糊控制是以人對(duì)被控系統(tǒng)的控制經(jīng)驗(yàn)為依據(jù)而設(shè)計(jì)的控制器，所以無(wú)需知道被控對(duì)象的數(shù)學(xué)模型。</p><p>　　(2)模糊控制是一種反映人類智慧和思維的智能控制，

79、采用人類思維中的模糊量，如“高”、“中”、“低”、“大”、“小”等，控制量由模糊推理導(dǎo)出。這些模糊量和模糊推理是人類通常智能活動(dòng)的體現(xiàn)。</p><p>　　(3)模糊控制的核心是控制規(guī)則，這些規(guī)則是以人類語(yǔ)言表示的，容易被人們所接受和理解。</p><p>　　(4)模糊控制器結(jié)構(gòu)與一般的數(shù)字控制器無(wú)異，模糊控制算法易于用軟件實(shí)現(xiàn)。</p><p>　　(5)模糊

80、控制系統(tǒng)無(wú)論被控對(duì)象是線性的還是非線性的，都能執(zhí)行有效的控制，具有良好的魯棒性和適應(yīng)性。</p><p>　　模糊控制器的組成包括以下幾個(gè)部分：</p><p><b>　　1．語(yǔ)言變量</b></p><p>　　語(yǔ)言變量是自然語(yǔ)言中的詞或句，它的取值不是通常的數(shù)值而是用模糊語(yǔ)言表示的模糊集合，例如選擇“速度”作為語(yǔ)言變量，則它的取值不是具體

81、的數(shù)字，而是類似“慢”、“適中”、“快”等模糊語(yǔ)言值。</p><p><b>　　2．模糊集合</b></p><p>　　世界上的事物大多具有模糊性，例如美麗就是一個(gè)十分模糊的概念，為了描述具有模糊性的事物，人們引入了模糊集合的概念：一般而言，在不同程度上具有某中特定性質(zhì)的所有元素的總和叫做模糊集合。模糊集合常用運(yùn)算有并運(yùn)算、交運(yùn)算。</p><

82、;p><b>　　(3-1)</b></p><p><b>　　(3-2)</b></p><p><b>　　3．模糊關(guān)系</b></p><p>　　在集合論中，關(guān)系是用直積來(lái)定義的。若存在集合 和 ，則它們的直積 的一個(gè)子集 就叫做 到 的二元關(guān)系， ，當(dāng)對(duì)系統(tǒng)輸入一個(gè)量 時(shí)，通過(guò)模糊關(guān)

83、系 就可以求出對(duì)應(yīng)的輸出量 。</p><p>　　4．模糊控制器的輸入量維數(shù)</p><p>　　模糊控制系統(tǒng)可劃分為單變量模糊控制和多變量模糊控制。一維模糊控制器的輸入變量常選為受控變量和輸入給定的偏差量 ，僅僅采用偏差值很難反映受控過(guò)程的動(dòng)態(tài)特性，所能獲得的系統(tǒng)動(dòng)態(tài)性能不能令人滿意。二維模糊控制器的兩個(gè)輸入變量基本上都選用受控變量和輸入給定的偏差 和偏差變化 ，這種結(jié)構(gòu)能夠較嚴(yán)格地反

84、映受控過(guò)程中輸出變量的動(dòng)態(tài)特性，在控制效果上比一維模糊控制器好，是采用較廣泛的一類模糊控制器。</p><p>　　模糊控制器的設(shè)計(jì)包括以下幾項(xiàng)內(nèi)容：</p><p>　　確定模糊控制器的輸入變量和輸出變量，確定論域及量化因子、比例因子；模糊化；設(shè)計(jì)模糊控制器的控制規(guī)則，模糊推理；去模糊化。對(duì)以上部分內(nèi)容介紹如下：</p><p><b>　　1．模糊化&

85、lt;/b></p><p>　　模糊控制中，精確量的模糊化就是把物理量的精確值轉(zhuǎn)換成語(yǔ)言變量值。為了保證在所有論域內(nèi)的輸入量都能與某一模糊子集相對(duì)應(yīng)，模糊子集的數(shù)目和范圍必須遍及整個(gè)論域，這需要將輸入變量乘以相應(yīng)的量化因子。量化因子一般用 表示，誤差的量化因子為 ，誤差變化的量化因子 。</p><p><b>　　(3-3)</b></p>&

86、lt;p><b>　　(3-4)</b></p><p>　　每次采樣經(jīng)模糊處理得到的控制量是模糊量，不能直接用于控制對(duì)象，必須將其轉(zhuǎn)換為控制對(duì)象能接受的基本論域中去，即轉(zhuǎn)化為精確量。輸出控制量的比例因子由下式確定</p><p><b>　　(3-5)</b></p><p>　　由于控制量的基本論域?yàn)橐贿B續(xù)的實(shí)數(shù)

87、域，從控制量的模糊集論域轉(zhuǎn)化到基本論域的變換，可以利用 實(shí)現(xiàn)，式中 為控制量模糊集論域中的任一元素， 為控制量基本論域中的一個(gè)精確量。</p><p><b>　　2．選定隸屬函數(shù)</b></p><p>　　語(yǔ)言論域上的模糊子集由隸屬函數(shù) 來(lái)描述。 可以通過(guò)總結(jié)操作者的經(jīng)驗(yàn)來(lái)描述，隸屬函數(shù)形式有多種，隸屬函數(shù)曲線通常有單值型，高斯型以及三角形幾種形式，單值型隸屬函數(shù)

88、可以大大簡(jiǎn)化模糊計(jì)算量，但是無(wú)法克服輸入變量中的噪聲信號(hào)，而高斯型計(jì)算復(fù)雜，經(jīng)驗(yàn)表明三角形隸屬函數(shù)既可以一定程度上減少計(jì)算量，又可以克服輸入變量中的噪聲信號(hào)。通常采用三角型隸屬函數(shù)解析式(3-1)和曲線如下式及圖3-2所示。</p><p><b>　　(3-6)</b></p><p>　　圖3-2 三角型隸屬函數(shù)</p><p>　　3．建

89、立模糊控制器的控制規(guī)則</p><p>　　模糊控制規(guī)則實(shí)質(zhì)上是將操作者在控制過(guò)程中的實(shí)踐經(jīng)驗(yàn)(即手動(dòng)控制策略)加以總結(jié)而得到的一條條模糊條件語(yǔ)句的集合，它是模糊控制器設(shè)計(jì)的核心。確定模糊控制規(guī)則的原則：當(dāng)誤差大或較大時(shí)，選擇控制量應(yīng)該以盡快消除誤差為主；而當(dāng)誤差較小時(shí)，選擇控制量要注意防止超調(diào)，以系統(tǒng)的穩(wěn)定性為主要出發(fā)點(diǎn)。</p><p><b>　　4．模糊推理</b&

90、gt;</p><p>　　模糊推理過(guò)程是基于模糊邏輯中的蘊(yùn)涵關(guān)系及控制規(guī)則進(jìn)行的。由模糊控制規(guī)則，運(yùn)用模糊數(shù)學(xué)理論對(duì)模糊輸入量進(jìn)行計(jì)算推理，以獲得一個(gè)定性的模糊輸出量。</p><p>　　若已知某一時(shí)刻模糊控制器模糊規(guī)則為 ，則由模糊規(guī)則 ... 進(jìn)行推理，可得到模糊輸出量 (用模糊集合 表示)如下：</p><p>　　,又 ， ， 。 (3

91、-7)</p><p>　　其中， 表示將 第一行元素按列的次序?qū)懴潞螅賹⒌诙械脑亟又聦?，其它行以此類推?lt;/p><p><b>　　5．模糊量的判決</b></p><p>　　模糊控制器的輸出是一個(gè)模糊集，它包含控制量的各種信息，但被控對(duì)象僅能接受一個(gè)精確的控制量，這就要進(jìn)行模糊判決，把模糊量轉(zhuǎn)化為精確量。把模糊量轉(zhuǎn)換為精確量的

92、過(guò)程稱為清晰化，又稱為去模糊化或模糊判決。模糊判決方法有好多種，在此僅介紹模糊自動(dòng)控制中常用的兩種模糊判決方法如下：</p><p><b>　　(1)最大隸屬度法</b></p><p>　　對(duì)于模糊控制器的輸出模糊集 ，其對(duì)應(yīng)的論域?yàn)椋?，模糊判決的最大隸屬度原則就是選擇模糊集 中隸屬度最大的那個(gè)元素 作為判決結(jié)果，即 應(yīng)滿足。同時(shí)，若輸出量模糊集合 的隸屬度函數(shù)

93、只有一個(gè)峰值，則取隸屬度函數(shù)的最大值為精確量，若輸出量的隸屬度函數(shù)有多個(gè)峰值，則取這些極值的平均值為精確量。</p><p>　　(2)加權(quán)平均判決法</p><p>　　加權(quán)平均判決法的關(guān)鍵在于權(quán)系數(shù)的選擇。權(quán)系數(shù)與系統(tǒng)的響應(yīng)特性有關(guān)，因此可根據(jù)系統(tǒng)的設(shè)計(jì)要求或經(jīng)驗(yàn)來(lái)選擇適當(dāng)?shù)募訖?quán)系數(shù)，當(dāng)權(quán)系數(shù) 已確定時(shí)，模糊量的判決輸出見(jiàn)下式，為簡(jiǎn)單起見(jiàn)，通常選取隸屬函數(shù)作為加權(quán)系數(shù)。</p&g

94、t;<p><b>　　(3-8)</b></p><p>　　模糊控制器的設(shè)計(jì)實(shí)質(zhì)上是設(shè)計(jì)模糊控制算法。通常的做法是把系統(tǒng)偏差 、偏差變化率 和控制量 的轉(zhuǎn)化為模糊量，送給模糊算法器進(jìn)行處理，模糊算法根據(jù)系統(tǒng)控制規(guī)則決定的模糊關(guān)系，推理合成得到輸出量隸屬度函數(shù)，然后經(jīng)過(guò)模糊判決，得到輸出控制量。為了克服實(shí)時(shí)計(jì)算量大、耗時(shí)多的缺點(diǎn)，常規(guī)的模糊控制器在實(shí)際應(yīng)用中一般是首先通過(guò)離線

95、計(jì)算取得模糊控制表，此后將控制表存入計(jì)算機(jī)，需要時(shí)通過(guò)軟件查表的方式取得相應(yīng)的控制量。</p><p><b>　　3.3控制系統(tǒng)設(shè)計(jì)</b></p><p>　　隨著移動(dòng)機(jī)器人任務(wù)復(fù)雜性的增加，以及路徑跟蹤精度要求的提高，移動(dòng)機(jī)器人路徑跟蹤控制己經(jīng)經(jīng)歷了從傳統(tǒng)控制到智能控制的發(fā)展過(guò)程。幾乎所有的自動(dòng)控制技術(shù)都在機(jī)器人的控制上得到了應(yīng)用，取得了許多成果。傳統(tǒng)控制包括經(jīng)

96、典控制和現(xiàn)代控制理論，它們的主要特征是基于被控對(duì)象精確模型的控制。由于移動(dòng)機(jī)器人驅(qū)動(dòng)系統(tǒng)受電機(jī)特性差異、路面粗糙度等諸多因素的影響，整個(gè)系統(tǒng)表現(xiàn)為高度的非線性和不確定性，難以用精確的數(shù)學(xué)模型來(lái)描述。若是采用傳統(tǒng)控制方法勢(shì)必要利用不精確模型而又采用某個(gè)固定的控制算法，使整個(gè)系統(tǒng)缺乏靈活性和應(yīng)變性，難以達(dá)到好的控制效果。然而智能控制則不需要被控對(duì)象的精確數(shù)學(xué)模型，且控制靈活，魯棒性強(qiáng)，在滯后、時(shí)變、非線性等復(fù)雜系統(tǒng)中具有明顯優(yōu)勢(shì)。但目前應(yīng)用

97、到移動(dòng)機(jī)器人上的智能控制器大多數(shù)要求豐富的人工經(jīng)驗(yàn)確定控制規(guī)則，并且在設(shè)計(jì)完成后仍然存在系統(tǒng)對(duì)外界條件變化的自適應(yīng)和自優(yōu)化問(wèn)題。本文研究的目的就是既要使控制律的設(shè)計(jì)簡(jiǎn)單易實(shí)現(xiàn)，又能使機(jī)器人的控制具有一定的智能化特點(diǎn)。下面在控制器的設(shè)計(jì)上采用線速度和角速度分別控制，由于路徑跟蹤的時(shí)間無(wú)關(guān)性對(duì)線速度控制的要求不很精確，所以采用基于模糊邏輯的控制方法，而角速</p><p>　　3.3.1 路徑跟蹤問(wèn)題描述</p

98、><p>　　輪式移動(dòng)機(jī)器人是一類典型的非線性系統(tǒng)，對(duì)其控制往往通過(guò)改變角速度和線速度來(lái)實(shí)現(xiàn)。前者控制移動(dòng)機(jī)器人的轉(zhuǎn)向,后者控制移動(dòng)的速度。在通常工作狀態(tài)下,移動(dòng)機(jī)器人可以以某一巡航速度前進(jìn)。因此,最主要的是角速度的控制。</p><p>　　由于系統(tǒng)的欠驅(qū)動(dòng)特性,采用傳統(tǒng)方法對(duì)輪式移動(dòng)機(jī)器人進(jìn)行穩(wěn)定控制非常困難。而同樣是控制輪式系統(tǒng),人駕駛汽車卻可以很輕松地完成。這是因?yàn)槿四苓M(jìn)行智能推理,其

99、潛意識(shí)中有某種規(guī)則在指導(dǎo)。當(dāng)人駕駛汽車跟蹤附近路面上的一條車道線時(shí),他首先要進(jìn)行觀察,將此直線當(dāng)作參考路徑,衡量車體與參考路徑段的橫向距離以及它們所處方向的夾角,而這種衡量是以一種模糊的概念給出的,如“距離比較大,角度很小”等。當(dāng)發(fā)現(xiàn)車體離參考路徑很遠(yuǎn)且與期望方向偏角較大時(shí),可以駕駛汽車快速轉(zhuǎn)彎,向期望位置靠攏;而在離參考路徑很遠(yuǎn),汽車朝向已正對(duì)前方車道線上某一位置時(shí),就不需轉(zhuǎn)動(dòng)方向盤來(lái)改變行駛方向,而是一直保持當(dāng)前行駛狀態(tài),直至離車道

100、線上拐點(diǎn)比較近時(shí), 再找下一個(gè)參考路徑段。</p><p>　　因?yàn)槟：壿嬁梢悦枋鋈藢?duì)同類對(duì)象進(jìn)行控制的成功經(jīng)驗(yàn),而且不需對(duì)被控對(duì)象建立精確的模型,所以本文采用模糊控制策略對(duì)非完整移動(dòng)機(jī)器人進(jìn)行路徑跟蹤控制。</p><p>　　3.3.2 路徑跟蹤模糊控制器的設(shè)計(jì)（控制器的結(jié)構(gòu)，控制規(guī)則的建立）</p><p>　　模糊控制器的基本結(jié)構(gòu)由四個(gè)重要部件組成，包括：

101、知識(shí)庫(kù)、推理單元、模糊化輸入接口與去模糊化輸出接口。知識(shí)庫(kù)又包含模糊控制規(guī)則庫(kù)和數(shù)據(jù)庫(kù)，規(guī)則庫(kù)中的模糊規(guī)則體現(xiàn)了與領(lǐng)域問(wèn)題有關(guān)的專家經(jīng)驗(yàn)或知識(shí)，而數(shù)據(jù)庫(kù)則定義隸屬度、尺度變換因子以及模糊分級(jí)數(shù)等。推理單元按照這些規(guī)則和所給的事實(shí)執(zhí)行推理過(guò)程，求得合理的輸出。模糊輸入接口將明確的輸入轉(zhuǎn)換成模糊量，并用模糊集合表示，根據(jù)模糊推理單元得到控制量，而控制量也是模糊量，因此，要求去模糊化或稱為清晰化過(guò)程，把模糊控制量轉(zhuǎn)換為清晰值作為模糊控制器的輸

102、出，去模糊輸出接口就是將模糊的計(jì)算結(jié)果轉(zhuǎn)換為明確的輸出。</p><p>　　模糊控制器的建立應(yīng)該分為四個(gè)步驟：一是挑選能夠反映系統(tǒng)工作機(jī)制的控制輸入輸出變量；二是定義這些變量的模糊子集；三是用模糊規(guī)則建立輸出集與輸入集的關(guān)系；最后也是模糊控制器的核心部分，即進(jìn)行模糊推理及清晰化。</p><p>　　圖3-3 模糊控制器的各個(gè)變量</p><p>　　在設(shè)計(jì)一個(gè)模

103、糊控制系統(tǒng)前，系統(tǒng)的輸入輸出參數(shù)必須首先被識(shí)別。本文中，模糊控制器共有4個(gè)輸入輸出參數(shù)， 和 是輸入?yún)?shù)， 是機(jī)器人當(dāng)前位置和目標(biāo)點(diǎn)之間的距離， 是當(dāng)前角度 和期望角度 之差，如圖3-3所示?？刂破鞯妮敵鰠?shù)是線速度 和角速度 。各參數(shù)變量之間的約束關(guān)系為： </p><p><b>　　(3-9)</b></p><p>　　式中 的取值范圍為 。若 取負(fù)值，代表機(jī)

104、器人應(yīng)該向左逆時(shí)針旋轉(zhuǎn)；反之則應(yīng)向右順時(shí)針旋轉(zhuǎn)。</p><p>　　其中 被模糊化為 ，表示為 ,論域?yàn)?。本次設(shè)計(jì)用到的去模糊化方法均為重心法。</p><p>　　關(guān)于距離 的隸屬函數(shù)建立如下：</p><p>　　圖3-4 參數(shù) 的隸屬函數(shù)</p><p>　　其中 被模糊化為 ，表示為 ，論域?yàn)?。</p><p

105、>　　關(guān)于角度偏差 的隸屬函數(shù)建立如下：</p><p>　　圖3-5 參數(shù) 的隸屬函數(shù)</p><p>　　3.3.2.1 速度模糊控制器的設(shè)計(jì)</p><p>　　為了使設(shè)計(jì)的路徑跟蹤控制方法適合于復(fù)雜路徑乃至任意路徑的跟蹤，傳統(tǒng)的線速度恒定跟蹤方法就顯得不很合理。首先可以通過(guò)分析得出影響移動(dòng)機(jī)器人安全行駛的線速度有兩個(gè)因素: 機(jī)器人當(dāng)前位置和目標(biāo)點(diǎn)之間

106、的距離和當(dāng)前角度 和期望角度 之差。當(dāng)機(jī)器人當(dāng)前位置和目標(biāo)點(diǎn)之間的距離較大時(shí)，機(jī)器人線速度應(yīng)該較大；而當(dāng)前角度 和期望角度 之差較大時(shí)，速度應(yīng)該較小。通過(guò)以上分析，期望速度的生成應(yīng)考慮如下條件：</p><p>　　1、正確反映前述兩因素的影響規(guī)律；</p><p>　　2、不超過(guò)機(jī)器人所能達(dá)到的最大線速度。</p><p>　　本文采用模糊控制方法實(shí)現(xiàn)對(duì)移動(dòng)機(jī)器人