移動(dòng)機(jī)器人原理與技術(shù) 課件 第1、2章 緒論、移動(dòng)機(jī)器人運(yùn)動(dòng)控制系統(tǒng)

移動(dòng)機(jī)器人技術(shù)原理與應(yīng)用第一章

緒論移動(dòng)機(jī)器人的發(fā)展移動(dòng)機(jī)器人的基本結(jié)構(gòu)移動(dòng)機(jī)器人的研究?jī)?nèi)容1.1機(jī)器人與移動(dòng)機(jī)器人概念1.21.31.41.1機(jī)器人與移動(dòng)機(jī)器人概念滿足以下三個(gè)條件的機(jī)器稱為機(jī)器人：(1)具有腦、手、腳、等三要素的個(gè)體；(2)具有非接觸傳感器和接觸傳感器；

(3)具有平衡覺(jué)和固有覺(jué)的傳感器。其中，非接觸傳感器和接觸傳感器相當(dāng)于人的五官，使機(jī)器人能夠識(shí)別外界環(huán)境，而平衡覺(jué)和固有覺(jué)則是機(jī)器人感知本身狀態(tài)所不可缺少的傳感器。1.1機(jī)器人與移動(dòng)機(jī)器人概念我國(guó)對(duì)機(jī)器人的定義是：“機(jī)器人是一種自動(dòng)化的機(jī)器，所不同的是這種機(jī)器具備一些與人或生物相似的智能能力，如感知能力、規(guī)劃能力、動(dòng)作能力和協(xié)同能力，是一種具有高度靈活性的自動(dòng)化機(jī)器?！睓C(jī)器人技術(shù)主要分兩大類，即工業(yè)機(jī)器人和移動(dòng)機(jī)器人。移動(dòng)機(jī)器人是一種在復(fù)雜環(huán)境下工作的，具有自行組織、自主運(yùn)行、自主規(guī)劃的智能機(jī)器人。智能移動(dòng)機(jī)器人是一個(gè)集環(huán)境感知、動(dòng)態(tài)決策與規(guī)劃、行為控制與執(zhí)行等多功能于一體的綜合系統(tǒng)。1.2移動(dòng)機(jī)器人的發(fā)展從移動(dòng)機(jī)構(gòu)角度看，移動(dòng)機(jī)器人通常包括輪式移動(dòng)機(jī)器人、履帶式移動(dòng)機(jī)器人兩種基本的移動(dòng)機(jī)器人。在此基礎(chǔ)上，移動(dòng)機(jī)器人的移動(dòng)機(jī)構(gòu)逐漸發(fā)展出現(xiàn)步進(jìn)式移動(dòng)機(jī)構(gòu)、蠕動(dòng)式移動(dòng)機(jī)構(gòu)、蛇行式移動(dòng)機(jī)構(gòu)和混合式移動(dòng)機(jī)構(gòu)，以適應(yīng)不同的工作環(huán)境和場(chǎng)合。一般室內(nèi)移動(dòng)機(jī)器人通常采用輪式移動(dòng)機(jī)構(gòu)，輪式移動(dòng)機(jī)器人有著自重輕、承載大、機(jī)構(gòu)簡(jiǎn)單、驅(qū)動(dòng)和控制相對(duì)方便、行走速度快、機(jī)動(dòng)靈活、工作效率高等優(yōu)點(diǎn)，但其運(yùn)動(dòng)穩(wěn)定性受路況影響較大。1.2移動(dòng)機(jī)器人的發(fā)展履帶式移動(dòng)機(jī)器人具有接地壓力小，在松軟的地面附著性能和通用性能好，爬樓梯、越障平穩(wěn)性高，自復(fù)位能力良好。但是履帶式移動(dòng)機(jī)器人的速度慢、功耗大、轉(zhuǎn)向時(shí)對(duì)地面的破壞程度大。以腿足式移動(dòng)機(jī)器人為代表的步進(jìn)式移動(dòng)機(jī)構(gòu)，自由度較多，能夠滿足某些特殊的性能要求，能適應(yīng)復(fù)雜的地形，但因其機(jī)構(gòu)復(fù)雜，存在難以控制、功耗大的缺點(diǎn)。蠕動(dòng)式移動(dòng)機(jī)構(gòu)和蛇行式移動(dòng)機(jī)構(gòu)通常作為模仿某種生物運(yùn)動(dòng)方式的仿生機(jī)器人采用的相應(yīng)的移動(dòng)機(jī)構(gòu)。1.2.1輪式移動(dòng)機(jī)器人的發(fā)展1.國(guó)外輪式移動(dòng)機(jī)器人發(fā)展1969年美國(guó)SRI研制成功“Shakey”系統(tǒng)，它只能解決簡(jiǎn)單的感知、運(yùn)動(dòng)規(guī)劃和控制問(wèn)題，采用的是兩個(gè)主動(dòng)輪再加上兩個(gè)從動(dòng)輪的驅(qū)動(dòng)方式。同時(shí)，安裝了包括視覺(jué)傳感器、超聲傳感器在內(nèi)的許多傳感器。1.2.1輪式移動(dòng)機(jī)器人的發(fā)展1.國(guó)外輪式移動(dòng)機(jī)器人發(fā)展

1970年，前蘇聯(lián)將Lunokhod月球車送上月球，主要任務(wù)是收集月球表面照片，全車擁有3個(gè)攝像頭、激光測(cè)距、X射線探測(cè)儀、磁場(chǎng)探測(cè)儀等裝置，它的八個(gè)相互獨(dú)立的電動(dòng)車輪均為驅(qū)動(dòng)輪。1.2.1輪式移動(dòng)機(jī)器人的發(fā)展1.國(guó)外輪式移動(dòng)機(jī)器人發(fā)展

1971年，美國(guó)將“四輪電動(dòng)漫游者”月球車送到月球進(jìn)行探測(cè)，該月球車上裝配了儀表盤，可顯示速度、方向、坡度、電力和溫度，具有導(dǎo)航功能。1.2.1輪式移動(dòng)機(jī)器人的發(fā)展1.國(guó)外輪式移動(dòng)機(jī)器人發(fā)展

1997年美國(guó)宇航局推出的“旅居者”號(hào)火星車裝有一部自主式導(dǎo)航系統(tǒng)和使車體可以就地轉(zhuǎn)彎的獨(dú)立操縱的前后輪。其本身攜帶太陽(yáng)能板，利用無(wú)線電遙控與地面保持聯(lián)系，在支桿上裝有一架相機(jī)和天氣探測(cè)器。1.2.1輪式移動(dòng)機(jī)器人的發(fā)展1.國(guó)外輪式移動(dòng)機(jī)器人發(fā)展

美國(guó)在2004年也相繼將機(jī)遇號(hào)與勇氣號(hào)送上火星，除了六個(gè)輪子的移動(dòng)機(jī)機(jī)構(gòu)，還具有與人肩、肘和腕關(guān)節(jié)類似的結(jié)構(gòu)，能夠靈活地伸展、彎曲和轉(zhuǎn)動(dòng)。另外，裝有一對(duì)全景照相機(jī)、顯微鏡成像儀、穆斯鮑爾分光計(jì)和阿爾法粒子X(jué)射線分光計(jì)等多種工具。1.2.1輪式移動(dòng)機(jī)器人的發(fā)展1.國(guó)外輪式移動(dòng)機(jī)器人發(fā)展

2011年，美國(guó)將好奇號(hào)火星車送上了火星，好奇號(hào)安裝有桅桿相機(jī)、火星手持透鏡成像儀、火星降落成像儀、火星樣本分析儀、化學(xué)與礦物學(xué)分析儀、化學(xué)與攝像機(jī)儀器、輻射評(píng)估探測(cè)器、火星車環(huán)境監(jiān)測(cè)站、火星科學(xué)實(shí)驗(yàn)室進(jìn)入、降落與著陸儀等設(shè)備，同時(shí)安裝有導(dǎo)航相機(jī)、化學(xué)相機(jī)、避險(xiǎn)相機(jī)以及機(jī)械手臂。1.2.1輪式移動(dòng)機(jī)器人的發(fā)展2.國(guó)內(nèi)輪式移動(dòng)機(jī)器人發(fā)展

玉兔號(hào)月球車于2019年在月球開(kāi)始工作，采取自主導(dǎo)航和地面遙控的組合模式，不僅可以自主前進(jìn)、轉(zhuǎn)彎、后退，還可以原地打轉(zhuǎn)、橫向側(cè)擺，在危機(jī)四伏的月面上暢行無(wú)阻。1.2.1輪式移動(dòng)機(jī)器人的發(fā)展2.國(guó)內(nèi)輪式移動(dòng)機(jī)器人發(fā)展

祝融號(hào)火星車于2021年登陸火星。祝融號(hào)火星車在火星表面完成自動(dòng)避障、自動(dòng)行駛、自動(dòng)探測(cè)，同時(shí)與環(huán)繞器保持通訊，接受從地球發(fā)來(lái)的指令等任務(wù)。1.2.2腿足式移動(dòng)機(jī)器人1.國(guó)外腿足式移動(dòng)機(jī)器人發(fā)展

第一代雙足機(jī)器人

Atlas三代機(jī)器人1.2.2腿足式移動(dòng)機(jī)器人1.國(guó)外腿足式移動(dòng)機(jī)器人發(fā)展1968年由美國(guó)GE公司設(shè)計(jì)的在崎嶇地形下幫助步兵攜帶的設(shè)備WalkingTruck，該設(shè)備是由四條相同的機(jī)械腿與機(jī)體相連接，機(jī)械腿是由三個(gè)轉(zhuǎn)動(dòng)副組成有三個(gè)自由度，能夠?qū)崿F(xiàn)足端兩個(gè)方向的轉(zhuǎn)動(dòng)和一個(gè)方向的移動(dòng)。1.2.2腿足式移動(dòng)機(jī)器人1.國(guó)外腿足式移動(dòng)機(jī)器人發(fā)展日本于1976年研究出KUMO—I、PV—II以及TITIN系列四足機(jī)器人，最具有代表性的是TITIN—VII，腿部采用三個(gè)轉(zhuǎn)動(dòng)副為驅(qū)動(dòng)來(lái)實(shí)現(xiàn)機(jī)器人的移動(dòng)，擁有三個(gè)自由度，具有多種步行步態(tài)，有較高的自適應(yīng)能力。1.2.2腿足式移動(dòng)機(jī)器人1.國(guó)外腿足式移動(dòng)機(jī)器人發(fā)展德國(guó)研制了一款猿猴類型的機(jī)器人iStructDemonstrator，它具有機(jī)械手臂、腿部和脊椎，能夠模擬靈長(zhǎng)目動(dòng)物的行為，它將取代當(dāng)前月球勘測(cè)任務(wù)中的滾輪式探測(cè)器。1.2.2腿足式移動(dòng)機(jī)器人1.國(guó)外腿足式移動(dòng)機(jī)器人發(fā)展意大利開(kāi)發(fā)的具有代表性的液壓動(dòng)力四足機(jī)器人Hyq，該機(jī)器人有十二個(gè)自由度，其中八個(gè)為液壓驅(qū)動(dòng)，四個(gè)為電動(dòng)，每個(gè)腿都設(shè)計(jì)了踝關(guān)節(jié)和足端，能夠?qū)崿F(xiàn)靜態(tài)步行和單腿豎直平面跳躍。1.2.2腿足式移動(dòng)機(jī)器人1.國(guó)外腿足式移動(dòng)機(jī)器人發(fā)展美國(guó)波士頓動(dòng)力公司于2005年研發(fā)了四腿機(jī)器人BigDog。它的單腿運(yùn)動(dòng)主要是靠三個(gè)轉(zhuǎn)動(dòng)副和一個(gè)移動(dòng)副來(lái)完成，整體結(jié)構(gòu)擁有十二或十六個(gè)主動(dòng)自由度，驅(qū)動(dòng)方式主要以內(nèi)燃機(jī)為動(dòng)力源驅(qū)動(dòng)液壓系統(tǒng)。1.2.2腿足式移動(dòng)機(jī)器人1.國(guó)外腿足式移動(dòng)機(jī)器人發(fā)展波士頓動(dòng)力2015年推出了Spot，它具有十二個(gè)自由度，采用電池能源提供動(dòng)力，從而驅(qū)動(dòng)液壓系統(tǒng)，以液壓系統(tǒng)作為驅(qū)動(dòng)輸出動(dòng)力，進(jìn)而控制每段肢體的動(dòng)作。1.2.2腿足式移動(dòng)機(jī)器人1.國(guó)外腿足式移動(dòng)機(jī)器人發(fā)展2020年，波士頓動(dòng)力推出了Spotmini四足機(jī)器人，它擁有頭戴式機(jī)械臂，能夠操縱其周圍的環(huán)境以及收集數(shù)據(jù)，使用手臂打開(kāi)門、轉(zhuǎn)動(dòng)閥門和打開(kāi)開(kāi)關(guān)等等。1.2.2腿足式移動(dòng)機(jī)器人2.國(guó)內(nèi)腿足式移動(dòng)機(jī)器人發(fā)展我國(guó)首個(gè)四足機(jī)器人“萊卡狗”，重量?jī)H22kg，已經(jīng)完全擺脫了外部供電，自帶電池一次充電可以支持2~3小時(shí)的行走。1.2.2腿足式移動(dòng)機(jī)器人2.國(guó)內(nèi)腿足式移動(dòng)機(jī)器人發(fā)展浙江大學(xué)四足仿生機(jī)器人“絕影”的出現(xiàn)表示著中國(guó)的四足機(jī)器人技術(shù)已經(jīng)能夠?qū)?biāo)國(guó)際一流水平。“絕影”的主要優(yōu)勢(shì)在于動(dòng)作自然柔順，反應(yīng)快速準(zhǔn)確，面對(duì)復(fù)雜環(huán)境能表現(xiàn)出很強(qiáng)的適應(yīng)力。1.2.2腿足式移動(dòng)機(jī)器人2.國(guó)內(nèi)腿足式移動(dòng)機(jī)器人發(fā)展在2018世界機(jī)器人大會(huì)上，上海交通大學(xué)攜新型六足機(jī)器人“青騅”參加了比賽。它采用自主開(kāi)發(fā)的電機(jī)傳感復(fù)合驅(qū)動(dòng)器，實(shí)現(xiàn)了力覺(jué)動(dòng)態(tài)控制行走，輕量化設(shè)計(jì)讓該機(jī)器人具備更高的功率自重比，六足3-3步態(tài)行走具有更高的穩(wěn)定性。1.2.2腿足式移動(dòng)機(jī)器人2.國(guó)內(nèi)腿足式移動(dòng)機(jī)器人發(fā)展在2018世界機(jī)器人大會(huì)上，一款六足并聯(lián)機(jī)器人又被稱作“章魚俠”，它具有視覺(jué)、力覺(jué)、識(shí)別地形、主動(dòng)避障、自主開(kāi)門、感知外載、自主平衡等各項(xiàng)功能，這款機(jī)器人最突出的優(yōu)勢(shì)是它的負(fù)載能力與全向運(yùn)動(dòng)性能。1.2.3輪腿式移動(dòng)機(jī)器人輪腿式移動(dòng)機(jī)器人兼具輪式優(yōu)勢(shì)和腿部能力，平地移動(dòng)快、效率高、噪音低，借助腿部能力則能完成適應(yīng)不平地面、跳躍通過(guò)臺(tái)階等動(dòng)作，越障能力強(qiáng)。德國(guó)研究了輪腿式移動(dòng)機(jī)器人“ALDURO”，具有兩個(gè)足和兩個(gè)輪子，并且兩個(gè)輪子在必要的時(shí)候可以成為足，變換為四足步行機(jī)器人。日本研究的輪腿式機(jī)器人“Roller-Walk”，輪子豎立起來(lái)就成為輪式探測(cè)車，輪子放平，就可以以爬行的方式前進(jìn)。1.2.3輪腿式移動(dòng)機(jī)器人美國(guó)波士頓動(dòng)力的最新機(jī)器人產(chǎn)品“Handle”是輪腿式移動(dòng)機(jī)器人，能在多種惡劣環(huán)境下順利行動(dòng)，如山地、雪地和崎嶇的地形。1.2.3輪腿式移動(dòng)機(jī)器人北京理工大學(xué)運(yùn)動(dòng)驅(qū)動(dòng)與控制研究團(tuán)隊(duì)研發(fā)了“北理哪吒”，是一款輪足復(fù)合式運(yùn)動(dòng)的機(jī)器人平臺(tái)，可用于無(wú)人作戰(zhàn)、搶險(xiǎn)救援、物資運(yùn)輸、資源勘探等領(lǐng)域。1.2.3輪腿式移動(dòng)機(jī)器人騰訊RoboticsX實(shí)驗(yàn)室推出了最低身高只有35厘米的輪腿式移動(dòng)機(jī)器人Ollie，它可以跳上40厘米的臺(tái)階，豎直起跳高度最高可達(dá)60厘米，甚至能輕松完成360度空翻挑戰(zhàn)；在平地上時(shí)，Ollie更像是一個(gè)“不倒翁”，能抗住各種“突發(fā)”狀況。1.3移動(dòng)機(jī)器人的基本結(jié)構(gòu)1.3.1移動(dòng)機(jī)器人的執(zhí)行機(jī)構(gòu)1.常見(jiàn)的車輪

(a)標(biāo)準(zhǔn)輪(b)小腳輪

(c)瑞典輪

(d)球形輪移動(dòng)機(jī)器人常用的車輪1.3.1移動(dòng)機(jī)器人的執(zhí)行機(jī)構(gòu)1.常見(jiàn)的車輪標(biāo)準(zhǔn)輪有兩個(gè)自由度，分別是圍繞輪軸和接觸點(diǎn)的轉(zhuǎn)動(dòng)；小腳輪有三個(gè)自由度，分別是圍繞垂直軸的轉(zhuǎn)動(dòng)、圍繞偏移的輪軸和接觸點(diǎn)的轉(zhuǎn)動(dòng)。在操縱時(shí)繞偏心軸旋轉(zhuǎn)，會(huì)引起加到底盤上的力。瑞典輪也稱為麥克納姆輪，車輪外緣布置的輥?zhàn)虞S線與車輪軸線具有一定夾角，也有三個(gè)自由度，分別圍繞輪軸、輥?zhàn)雍徒佑|點(diǎn)的轉(zhuǎn)動(dòng)。輪子摩擦小，可以沿可能的軌跡按照運(yùn)動(dòng)學(xué)原理移動(dòng)；球形輪可以沿任何方向受動(dòng)力而旋轉(zhuǎn)。1.3.1移動(dòng)機(jī)器人的執(zhí)行機(jī)構(gòu)2.

輪式移動(dòng)機(jī)器人輪子配置方式

3輪移動(dòng)機(jī)構(gòu)1.3.1移動(dòng)機(jī)器人的執(zhí)行機(jī)構(gòu)2.

輪式移動(dòng)機(jī)器人輪子配置方式圖(a)所示的驅(qū)動(dòng)方式為后兩輪差速驅(qū)動(dòng)，舵輪轉(zhuǎn)向，調(diào)整舵輪角度使移動(dòng)機(jī)器人在不轉(zhuǎn)動(dòng)車頭的情況下實(shí)現(xiàn)變道、轉(zhuǎn)向等動(dòng)作，甚至可以實(shí)現(xiàn)沿任意點(diǎn)為半徑的轉(zhuǎn)彎運(yùn)動(dòng)，有很強(qiáng)的靈活性。圖(b)所示的驅(qū)動(dòng)方式為前輪驅(qū)動(dòng)加轉(zhuǎn)向、后兩輪隨動(dòng)。此種方式不需要考慮電機(jī)配合的問(wèn)題。圖(c)所示的驅(qū)動(dòng)方式為通過(guò)兩驅(qū)動(dòng)輪的差動(dòng)來(lái)實(shí)現(xiàn)轉(zhuǎn)向，轉(zhuǎn)向時(shí)的半徑、速度、角速度，都由兩個(gè)驅(qū)動(dòng)輪確定?？梢詫?shí)現(xiàn)原地打轉(zhuǎn)等動(dòng)作，有比較強(qiáng)的靈活性。1.3.1移動(dòng)機(jī)器人的執(zhí)行機(jī)構(gòu)2.

輪式移動(dòng)機(jī)器人輪子配置方式采用三輪機(jī)構(gòu)的機(jī)器人轉(zhuǎn)彎過(guò)程中形成的速度瞬心位于后兩輪軸心連線上，所以即使機(jī)器人旋轉(zhuǎn)半徑為零，旋轉(zhuǎn)中心也與車體的中心不一致。但三輪機(jī)構(gòu)中具有一個(gè)明顯的優(yōu)點(diǎn)是不需要專門的懸掛系統(tǒng)去保持各輪與地面的可靠接觸，設(shè)計(jì)中只需要注意車體中心位置合理即可。1.3.1移動(dòng)機(jī)器人的執(zhí)行機(jī)構(gòu)2.

輪式移動(dòng)機(jī)器人輪子配置方式4輪移動(dòng)機(jī)構(gòu)1.3.1移動(dòng)機(jī)器人的執(zhí)行機(jī)構(gòu)2.

輪式移動(dòng)機(jī)器人輪子配置方式圖(a)中，四個(gè)車輪布置在矩形平面的四角，后兩輪差速驅(qū)動(dòng)，前兩舵輪同步轉(zhuǎn)向。圖(b)中前兩舵輪驅(qū)動(dòng)兼轉(zhuǎn)向。圖(c)所示結(jié)構(gòu)為四輪轉(zhuǎn)向加兩輪驅(qū)動(dòng)方式，這種方式使得四輪移動(dòng)機(jī)器人具有了橫向移動(dòng)的能力。采用四輪機(jī)構(gòu)的移動(dòng)機(jī)器人有兩個(gè)缺點(diǎn)：一是部分四輪機(jī)構(gòu)的機(jī)器人移動(dòng)能力受到限制，轉(zhuǎn)向運(yùn)動(dòng)的實(shí)現(xiàn)需要一定的前行行程；二是這種布局需要一個(gè)緩沖懸掛系統(tǒng)以保持穩(wěn)定、可靠的驅(qū)動(dòng)能力，另外部分結(jié)構(gòu)的橫滑運(yùn)動(dòng)必須考慮。1.3.2移動(dòng)機(jī)器人的驅(qū)動(dòng)系統(tǒng)移動(dòng)機(jī)器人的驅(qū)動(dòng)系統(tǒng)的功能是將能源動(dòng)力傳送到執(zhí)行機(jī)構(gòu)。移動(dòng)機(jī)器人主要使用三種驅(qū)動(dòng)方法，即液壓驅(qū)動(dòng)，氣動(dòng)驅(qū)動(dòng)和電動(dòng)機(jī)驅(qū)動(dòng)。液壓驅(qū)動(dòng)就是利用液壓泵對(duì)液體加壓，使其具有高壓勢(shì)能，然后通過(guò)分流閥推動(dòng)執(zhí)行機(jī)構(gòu)進(jìn)行動(dòng)作，從而達(dá)到將液體的壓力使能轉(zhuǎn)換成做功的機(jī)械能。1.3.2移動(dòng)機(jī)器人的驅(qū)動(dòng)系統(tǒng)液壓驅(qū)動(dòng)的最大特點(diǎn)就是動(dòng)力比較大、力和力矩慣性比大、反應(yīng)快，比較容易實(shí)現(xiàn)直接驅(qū)動(dòng)，適用于要求承載能力和慣性大的場(chǎng)合。其缺點(diǎn)是多了一套液壓系統(tǒng)，對(duì)液壓元件要求高，否則容易造成液體滲漏，噪聲較大，對(duì)環(huán)境有一定的污染。氣壓驅(qū)動(dòng)的基本原理與液壓驅(qū)動(dòng)相似。其優(yōu)點(diǎn)是空氣來(lái)源方便、動(dòng)作迅捷、結(jié)構(gòu)簡(jiǎn)單、造價(jià)低廉、維修方便，其缺點(diǎn)是不宜進(jìn)行速度控制、氣壓不易過(guò)高、負(fù)載能力較低等。1.3.2移動(dòng)機(jī)器人的驅(qū)動(dòng)系統(tǒng)電動(dòng)機(jī)驅(qū)動(dòng)是利用各種電動(dòng)機(jī)產(chǎn)生的力或轉(zhuǎn)矩直接驅(qū)動(dòng)移動(dòng)機(jī)器人，常見(jiàn)的輪式移動(dòng)機(jī)器人應(yīng)用的電機(jī)有四種類型：步進(jìn)電機(jī)、直流伺服電機(jī)、交流伺服電機(jī)和線性電機(jī)。直流伺服電機(jī)在移動(dòng)機(jī)器人中使用較多，其可以通過(guò)調(diào)節(jié)電樞電壓的方式控制轉(zhuǎn)速，具有電源方便，響應(yīng)快，信息傳遞、檢測(cè)、處理都很方便，驅(qū)動(dòng)能力較大的優(yōu)點(diǎn)；其缺點(diǎn)是轉(zhuǎn)速較高，必須采用減速機(jī)構(gòu)將其轉(zhuǎn)速降低，結(jié)構(gòu)有些復(fù)雜。1.3.3移動(dòng)機(jī)器人的控制系統(tǒng)移動(dòng)機(jī)器人的控制系統(tǒng)是由控制計(jì)算機(jī)及相應(yīng)的控制軟件和伺服控制器組成，它相當(dāng)于人的神經(jīng)系統(tǒng)，是移動(dòng)機(jī)器人的指揮系統(tǒng)，對(duì)其執(zhí)行機(jī)構(gòu)發(fā)出如何動(dòng)作的命令。移動(dòng)機(jī)器人的控制系統(tǒng)主要有集中控制、主從控制、分散控制和分布式控制等幾種形式。1.3.3移動(dòng)機(jī)器人的控制系統(tǒng)1．集中控制系統(tǒng)集中式控制系統(tǒng)用一臺(tái)計(jì)算機(jī)實(shí)現(xiàn)全部控制功能。其優(yōu)點(diǎn)是：硬件成本較低，便于信息的采集和分析，易與實(shí)現(xiàn)系統(tǒng)的最優(yōu)控制，整體性與協(xié)調(diào)性較好。缺點(diǎn)是：系統(tǒng)控制缺乏靈活性，控制危險(xiǎn)容易集中，一旦出現(xiàn)故障，其影響面廣，后果嚴(yán)重；由于機(jī)器人的實(shí)時(shí)性要求很高，當(dāng)系統(tǒng)進(jìn)行大量數(shù)據(jù)計(jì)算會(huì)降低系統(tǒng)實(shí)時(shí)性，系統(tǒng)對(duì)多任務(wù)的響應(yīng)能力也會(huì)與系統(tǒng)的實(shí)時(shí)性相沖突；此外，系統(tǒng)連線復(fù)雜，會(huì)降低系統(tǒng)的可靠性。1.3.3移動(dòng)機(jī)器人的控制系統(tǒng)2．主從控制系統(tǒng)采用主、從兩級(jí)處理器實(shí)現(xiàn)系統(tǒng)的全部控制功能。主CPU實(shí)現(xiàn)管理、環(huán)境檢測(cè)、路徑規(guī)劃和系統(tǒng)自診斷等；從CPU實(shí)現(xiàn)動(dòng)作控制。主從控制系統(tǒng)實(shí)時(shí)性較好，適于高精度，但其系統(tǒng)擴(kuò)展性較差，維修困難。1.3.3移動(dòng)機(jī)器人的控制系統(tǒng)3．分散控制系統(tǒng)按移動(dòng)機(jī)器人的功能將系統(tǒng)控制分成幾個(gè)模塊，每一個(gè)模塊各有不同的控制任務(wù)和控制策略，各模式之間可以是主從關(guān)系，也可以是平等關(guān)系。這種方式實(shí)時(shí)性好，易于實(shí)現(xiàn)高速、高精度控制，易于擴(kuò)展，可實(shí)現(xiàn)智能控制。其主要思想是“分散控制，集中管理”，即系統(tǒng)對(duì)其總體目標(biāo)和任務(wù)可以進(jìn)行綜合協(xié)調(diào)和分配，并通過(guò)子系統(tǒng)的協(xié)調(diào)工作來(lái)完成控制任務(wù)，整個(gè)系統(tǒng)在功能、邏輯和物理等方面都是分散的，所以又稱為集散控制系統(tǒng)或分散控制系統(tǒng)。1.3.3移動(dòng)機(jī)器人的控制系統(tǒng)4．分布式控制系統(tǒng)分布式控制系統(tǒng)常采用兩級(jí)控制方式，通常由上位機(jī)、下位機(jī)和網(wǎng)絡(luò)組成。上位機(jī)類似于人的大腦，實(shí)現(xiàn)高級(jí)控制功能，下位機(jī)類似于人的低級(jí)神經(jīng)系統(tǒng)，實(shí)現(xiàn)運(yùn)動(dòng)控制等底層功能。上位機(jī)和下位機(jī)通過(guò)通訊總線相互協(xié)調(diào)工作。分布式控制系統(tǒng)的優(yōu)點(diǎn)在于：系統(tǒng)靈活性好，控制系統(tǒng)的危險(xiǎn)性降低，采用多處理器的分散控制，有利于系統(tǒng)功能的并行執(zhí)行，提高系統(tǒng)的處理效率，縮短響應(yīng)時(shí)間。1.3.4

移動(dòng)機(jī)器人的感知決策系統(tǒng)移動(dòng)機(jī)器人的感知決策系統(tǒng)由兩部分組成：感知系統(tǒng)和分析-決策智能系統(tǒng)。感知系統(tǒng)主要由具有感知不同信息的傳感器構(gòu)成，屬于硬件部分，包括視覺(jué)、觸覺(jué)、嗅覺(jué)等等傳感器分析-決策智能系統(tǒng)主要是靠計(jì)算機(jī)專用或通用軟件來(lái)完成，例如專家咨詢系統(tǒng)、智能算法、優(yōu)化算法等。1.4

移動(dòng)機(jī)器人的研究?jī)?nèi)容1．移動(dòng)機(jī)器人機(jī)構(gòu)設(shè)計(jì)移動(dòng)機(jī)器人機(jī)械結(jié)構(gòu)的選擇和設(shè)計(jì)，是根據(jù)移動(dòng)機(jī)器人在各個(gè)領(lǐng)域以及各種場(chǎng)合的實(shí)際應(yīng)用需要進(jìn)行的。移動(dòng)機(jī)器人是一個(gè)機(jī)構(gòu)、電氣和軟件的綜合系統(tǒng)，它的任何一個(gè)部分都不是孤立的，結(jié)構(gòu)的問(wèn)題影響到控制和算法。1.4

移動(dòng)機(jī)器人的研究?jī)?nèi)容2．移動(dòng)機(jī)器人傳感器技術(shù)移動(dòng)機(jī)器人傳感器技術(shù)主要是對(duì)移動(dòng)機(jī)器人自身內(nèi)部的位置和方向信息以及外部環(huán)境信息的檢測(cè)和處理。采用的傳感器分為內(nèi)部傳感器和外部傳感器。其中內(nèi)部傳感器有:編碼器、線加速度計(jì)、陀螺儀、GPS、磁羅盤、激光傳感器、激光雷達(dá)等。外部傳感器有視覺(jué)傳感器、超聲波傳感器、紅外傳感器、接觸和接近傳感器。1.4

移動(dòng)機(jī)器人的研究?jī)?nèi)容3．移動(dòng)機(jī)器人導(dǎo)航目前的移動(dòng)機(jī)器人導(dǎo)航方式主要可分為慣性導(dǎo)航、路標(biāo)導(dǎo)航及基于環(huán)境信息的地圖模型匹配導(dǎo)航等方式。環(huán)境地圖模型匹配導(dǎo)航是機(jī)器人通過(guò)自身的各種傳感器，探測(cè)周圍環(huán)境，利用感知的局部環(huán)境信息進(jìn)行局部地圖構(gòu)造，并與其內(nèi)部事先存儲(chǔ)的完整地圖進(jìn)行匹配，進(jìn)而確定自身位置。根據(jù)規(guī)劃的全局路徑，采用路徑跟蹤和避障技術(shù)，實(shí)現(xiàn)導(dǎo)航，涉及到環(huán)境地圖構(gòu)建和模型匹配兩個(gè)問(wèn)題。1.4

移動(dòng)機(jī)器人的研究?jī)?nèi)容3．移動(dòng)機(jī)器人導(dǎo)航路標(biāo)導(dǎo)航是將環(huán)境中的特殊景物作為路標(biāo)，機(jī)器人在知道這些路標(biāo)在環(huán)境中的坐標(biāo)、形狀等特征的前提下，通過(guò)對(duì)路標(biāo)的探測(cè)確定自身位置。根據(jù)路標(biāo)的不同，可分為人工路標(biāo)導(dǎo)航和自然路標(biāo)導(dǎo)航，前者通過(guò)對(duì)人為放置的特殊標(biāo)志的識(shí)別實(shí)現(xiàn)導(dǎo)航，后者是機(jī)器人通過(guò)對(duì)環(huán)境中自然特征的識(shí)別完成導(dǎo)航。路標(biāo)探測(cè)的穩(wěn)定性和魯棒性是研究的主要問(wèn)題。1.4

移動(dòng)機(jī)器人的研究?jī)?nèi)容3．移動(dòng)機(jī)器人導(dǎo)航慣性導(dǎo)航通過(guò)描述移動(dòng)機(jī)器人的方位角和根據(jù)從某一參考點(diǎn)出發(fā)測(cè)定的行駛距離來(lái)確定移動(dòng)機(jī)器人當(dāng)前位置的一種方法。這種導(dǎo)航方式通過(guò)與已知的地圖路線來(lái)比較，進(jìn)而控制移動(dòng)機(jī)器人的運(yùn)動(dòng)方向和距離，這樣便能實(shí)現(xiàn)移動(dòng)機(jī)器人的自主導(dǎo)航。1.4

移動(dòng)機(jī)器人的研究?jī)?nèi)容4．移動(dòng)機(jī)器人定位移動(dòng)機(jī)器人定位就是確定移動(dòng)機(jī)器人在其運(yùn)動(dòng)環(huán)境中的世界坐標(biāo)系的坐標(biāo)。移動(dòng)機(jī)器人定位方法主要分為相對(duì)定位和絕對(duì)定位。在移動(dòng)機(jī)器人的車輪上裝有光電編碼器或其他測(cè)速傳感器，通過(guò)對(duì)車輪轉(zhuǎn)動(dòng)的記錄粗略地確定位置和姿態(tài)是一種最基本的相對(duì)定位。1.4

移動(dòng)機(jī)器人的研究?jī)?nèi)容4．移動(dòng)機(jī)器人定位在移動(dòng)機(jī)器人工作的環(huán)境里，人為地設(shè)置一些坐標(biāo)已知的路標(biāo)，如超聲波發(fā)射器、激光反射板等,通過(guò)對(duì)路標(biāo)的探測(cè)來(lái)確定移動(dòng)機(jī)器人自身的位置可看做一種絕對(duì)定位方式。1.4

移動(dòng)機(jī)器人的研究?jī)?nèi)容5．移動(dòng)機(jī)器人路徑規(guī)劃路徑規(guī)劃是指按照某一性能指標(biāo)搜索一條從起始狀態(tài)到目標(biāo)狀態(tài)的最優(yōu)或者近似最優(yōu)的無(wú)碰路徑。根據(jù)對(duì)環(huán)境信息了解的不同，可以分為兩種類型：環(huán)境信息完全知道的全局路徑規(guī)劃；環(huán)境信息部分未知甚至完全未知，移動(dòng)機(jī)器人通過(guò)傳感器實(shí)時(shí)地對(duì)工作環(huán)境進(jìn)行探測(cè)，以獲取障礙物的位置、形狀和尺寸等信息進(jìn)行的局部路徑規(guī)劃。全局路徑規(guī)劃包括環(huán)境建模和路徑搜索策略兩個(gè)子問(wèn)題，部路徑規(guī)劃要解決運(yùn)動(dòng)過(guò)程中的避障問(wèn)題。1.4

移動(dòng)機(jī)器人的研究?jī)?nèi)容6．移動(dòng)機(jī)器人同時(shí)定位與地圖構(gòu)建SLAM主要研究在對(duì)機(jī)器人位姿和其作業(yè)環(huán)境都不具備先驗(yàn)知識(shí)的情況下，如何應(yīng)用合理的表征方法建模以描述作業(yè)環(huán)境并同時(shí)確定其自身位姿。1.4

移動(dòng)機(jī)器人的研究?jī)?nèi)容7．多移動(dòng)機(jī)器人系統(tǒng)多移動(dòng)機(jī)器人系統(tǒng)一般由幾個(gè)至幾十個(gè)移動(dòng)機(jī)器人組成，其可以是由異構(gòu)的移動(dòng)機(jī)器人組成，但基本特征在于系統(tǒng)中機(jī)器人均可按照指令合作完成對(duì)象任務(wù)，系統(tǒng)中各個(gè)移動(dòng)機(jī)器人的基本信息，如：位置、速度、方向、目標(biāo)、能量等能夠進(jìn)行交互。多移動(dòng)機(jī)器人系統(tǒng)的研究分為對(duì)移動(dòng)機(jī)器人合作和多移動(dòng)機(jī)器人協(xié)調(diào)兩大類，主要研究多移動(dòng)機(jī)器人如何分解和分配任務(wù)以及運(yùn)動(dòng)如何協(xié)調(diào)一致。移動(dòng)機(jī)器人技術(shù)原理與應(yīng)用第二章

移動(dòng)機(jī)器人運(yùn)動(dòng)控制系統(tǒng)移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型移動(dòng)機(jī)器人動(dòng)力學(xué)模型移動(dòng)機(jī)器人運(yùn)動(dòng)控制算法2.1移動(dòng)機(jī)器人運(yùn)動(dòng)控制系統(tǒng)組成2.22.32.42.5移動(dòng)機(jī)器人運(yùn)動(dòng)控制系統(tǒng)硬件2.6移動(dòng)機(jī)器人運(yùn)動(dòng)控制系統(tǒng)軟件2.1移動(dòng)機(jī)器人運(yùn)動(dòng)控制系統(tǒng)組成通常情況下，移動(dòng)機(jī)器人運(yùn)動(dòng)控制系統(tǒng)主要由機(jī)械運(yùn)動(dòng)機(jī)構(gòu)、驅(qū)動(dòng)器和驅(qū)動(dòng)單元、運(yùn)動(dòng)控制器等部分和相應(yīng)的運(yùn)動(dòng)控制方法等內(nèi)容組成。2.1.1移動(dòng)機(jī)器人運(yùn)動(dòng)機(jī)構(gòu)輪式移動(dòng)機(jī)器人運(yùn)動(dòng)機(jī)構(gòu)的基本原理和主要特點(diǎn)運(yùn)動(dòng)機(jī)構(gòu)類型基本原理主要特點(diǎn)雙輪車體左右兩側(cè)各一個(gè)差速輪作為驅(qū)動(dòng)輪，其余車輪都為隨動(dòng)輪。差速輪本身不能旋轉(zhuǎn)，轉(zhuǎn)向都是靠?jī)?nèi)外驅(qū)動(dòng)輪之間的速度差來(lái)實(shí)現(xiàn)。因此不需要配置轉(zhuǎn)向電動(dòng)機(jī)可以原地旋轉(zhuǎn)，較靈活。對(duì)電動(dòng)機(jī)的控制精度要求不高，成本相對(duì)較低。對(duì)地面平整度要求高四輪車體四輪均為驅(qū)動(dòng)輪，靠?jī)?nèi)外側(cè)驅(qū)動(dòng)輪速度差實(shí)現(xiàn)轉(zhuǎn)向直線行走能力良好，驅(qū)動(dòng)力強(qiáng)，但電動(dòng)機(jī)控制相對(duì)復(fù)雜，成本較高。需要精細(xì)結(jié)構(gòu)設(shè)計(jì)使四輪著地，防止打滑單舵機(jī)通常為前驅(qū)，主要依靠車體前部的一個(gè)鉸軸轉(zhuǎn)向車輪作為驅(qū)動(dòng)輪控制轉(zhuǎn)向結(jié)構(gòu)簡(jiǎn)單、成本相對(duì)較低。對(duì)地面要求不高，使用環(huán)境廣泛。靈活性相對(duì)較低2.1.1移動(dòng)機(jī)器人運(yùn)動(dòng)機(jī)構(gòu)輪式移動(dòng)機(jī)器人運(yùn)動(dòng)機(jī)構(gòu)的基本原理和主要特點(diǎn)運(yùn)動(dòng)機(jī)構(gòu)類型基本原理主要特點(diǎn)雙舵機(jī)車體前后各安裝一個(gè)舵機(jī)，搭配左右兩側(cè)的隨動(dòng)輪，由前后舵輪控制轉(zhuǎn)向雙舵輪型轉(zhuǎn)向驅(qū)動(dòng)的優(yōu)點(diǎn)是可以實(shí)現(xiàn)360°回轉(zhuǎn)功能，并可以實(shí)現(xiàn)萬(wàn)向移動(dòng)，靈活性高且具有精確的運(yùn)行精度。缺點(diǎn)是雙舵輪成本高麥克納姆輪又稱瑞典輪。在中心圓周方向布置了一圈獨(dú)立的、傾斜角度(45°)的行星輪，這些成角度的行星輪把中心輪的前進(jìn)速度分解成X和Y兩個(gè)方向，實(shí)現(xiàn)前進(jìn)及橫行。其結(jié)構(gòu)緊湊，運(yùn)動(dòng)靈活，是一種全方位輪可以實(shí)現(xiàn)360°回轉(zhuǎn)功能和萬(wàn)向橫移，靈活性高，運(yùn)行占用空間小，更適合在復(fù)雜地形上的運(yùn)動(dòng)。缺點(diǎn)是成本相對(duì)較高，結(jié)構(gòu)形式復(fù)雜，對(duì)控制、制造、地面的要求較高2.1.2移動(dòng)機(jī)器人常用電動(dòng)機(jī)移動(dòng)機(jī)器人常用電動(dòng)機(jī)類型的原理和特點(diǎn)電動(dòng)機(jī)類型基本原理主要特點(diǎn)直流伺服電動(dòng)機(jī)直流電壓。直流伺服電動(dòng)機(jī)分為有刷和無(wú)刷電動(dòng)機(jī)直流伺服電動(dòng)機(jī)容易實(shí)現(xiàn)調(diào)速，控制精度高。有刷電動(dòng)機(jī)維護(hù)成本高步進(jìn)電動(dòng)機(jī)步進(jìn)電動(dòng)機(jī)是將電脈沖信號(hào)轉(zhuǎn)變?yōu)榻俏灰苹蚓€位移的開(kāi)環(huán)控制電動(dòng)機(jī)。在非超載情況下，電動(dòng)機(jī)的轉(zhuǎn)速、停止的位置只取決于脈沖信號(hào)的頻率和脈沖數(shù)而不受負(fù)載變化的影響，當(dāng)步進(jìn)驅(qū)動(dòng)器接收到一個(gè)脈沖信號(hào)，就驅(qū)動(dòng)步進(jìn)電動(dòng)機(jī)按設(shè)定的方向轉(zhuǎn)動(dòng)一個(gè)固定角度。它的旋轉(zhuǎn)是以固定的角度一步一步運(yùn)行的優(yōu)點(diǎn)是控制簡(jiǎn)單、精度高，沒(méi)有累積誤差，結(jié)構(gòu)簡(jiǎn)單，使用維修方便，制造成本低。缺點(diǎn)是效率較低、發(fā)熱大，有時(shí)會(huì)失步舵機(jī)由接收機(jī)發(fā)出信號(hào)給舵機(jī)，經(jīng)由電路板上的IC判斷轉(zhuǎn)動(dòng)方向，再驅(qū)動(dòng)無(wú)核心馬達(dá)開(kāi)始轉(zhuǎn)動(dòng)速度快、扭力大的舵機(jī)，價(jià)格較高且耗電大2.1.3移動(dòng)機(jī)器人常用運(yùn)動(dòng)控制器目前移動(dòng)機(jī)器人領(lǐng)域的運(yùn)動(dòng)控制器可分為三類：PLC(ProgrammableLogicController)CHULIQI、工控機(jī)和單片機(jī)。前兩種穩(wěn)定性好、編程簡(jiǎn)單，但成本較高，外圍接口不多；單片機(jī)成本低、可擴(kuò)展性強(qiáng)，但穩(wěn)定性與抗干擾能力不如前兩種。2.1.3移動(dòng)機(jī)器人常用運(yùn)動(dòng)控制器目前單片機(jī)的運(yùn)動(dòng)控制器絕大多數(shù)基于ARM處理器或者DSP處理器，在機(jī)器人需要完成諸多功能與調(diào)度管理時(shí)，運(yùn)動(dòng)控制器需要很多外圍功能模塊接口，因此控制器一般采用ARM處理器。在機(jī)器人完成一些復(fù)雜的運(yùn)動(dòng)算法時(shí)，運(yùn)動(dòng)控制器需要具備較強(qiáng)的計(jì)算能力，因此控制器一般采用DSP處理器。ARM處理器外圍接口多，可擴(kuò)展性強(qiáng)，但計(jì)算能力不佳，難以處理一些復(fù)雜的算法；DSP計(jì)算能力強(qiáng)，可處理比較復(fù)雜的算法，但外圍接口少，可擴(kuò)展性差。2.1.3移動(dòng)機(jī)器人常用運(yùn)動(dòng)控制器DSP芯片性能比較2.2移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型是根據(jù)移動(dòng)機(jī)器人底盤的幾何特性，為整個(gè)移動(dòng)機(jī)器人運(yùn)動(dòng)推導(dǎo)一個(gè)模型。輪式移動(dòng)機(jī)器人可分為非完整約束系統(tǒng)和完整約束系統(tǒng)兩類。獨(dú)立驅(qū)動(dòng)的個(gè)數(shù)等于定義系統(tǒng)的一個(gè)位姿需要的變量個(gè)數(shù)的移動(dòng)機(jī)器人屬于完整約束系統(tǒng)，非完整約束系統(tǒng)則是指定義系統(tǒng)的一個(gè)位姿需要的變量個(gè)數(shù)多于獨(dú)立的驅(qū)動(dòng)數(shù)。以雙輪差速驅(qū)動(dòng)的移動(dòng)機(jī)器人為例，建立和運(yùn)用運(yùn)動(dòng)學(xué)模型的基本步驟如下：2.2移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型1．建立平面全局參考坐標(biāo)系和移動(dòng)機(jī)器人局部參考坐標(biāo)系用來(lái)表示移動(dòng)機(jī)器人的位置。2．根據(jù)移動(dòng)機(jī)器人結(jié)構(gòu)幾何特征和各輪速度，首先計(jì)算在局部參考坐標(biāo)系中各輪的貢獻(xiàn)，得到前向運(yùn)動(dòng)學(xué)模型，前向運(yùn)動(dòng)學(xué)模型用來(lái)描述移動(dòng)機(jī)器人的幾何特征和單個(gè)輪子行為的函數(shù)關(guān)系。3．在給定移動(dòng)機(jī)器人位置和給定輪速的情況下，計(jì)算出移動(dòng)機(jī)器人在全局參考框架中的速度。2.2.1移動(dòng)機(jī)器人坐標(biāo)系xOy為全局參考坐標(biāo)系，xRCyR為機(jī)器人的局部參考坐標(biāo)系，局部參考坐標(biāo)系的原點(diǎn)為移動(dòng)機(jī)器人底盤上后輪軸的中點(diǎn)C。在全局參考坐標(biāo)系下，C的位置由坐標(biāo)x和y確定，θ表示全局參考坐標(biāo)系和局部參考坐標(biāo)系的角度差（θ為移動(dòng)機(jī)器人的航向角）。全局參考坐標(biāo)系和局部參考坐標(biāo)系2.2.1移動(dòng)機(jī)器人坐標(biāo)系移動(dòng)機(jī)器人在全局參考坐標(biāo)系中的位姿也叫做狀態(tài)向量可由這3個(gè)元素組成的向量ξI來(lái)描述：為了建立移動(dòng)機(jī)器人的運(yùn)動(dòng)和各個(gè)輪子運(yùn)動(dòng)之間的關(guān)系，需要給出局部參考坐標(biāo)系下的運(yùn)動(dòng)和全局參考坐標(biāo)系下運(yùn)動(dòng)的映射關(guān)系，該映射可由正交旋轉(zhuǎn)矩陣來(lái)完成：2.2.1移動(dòng)機(jī)器人坐標(biāo)系移動(dòng)機(jī)器人在局部參考坐標(biāo)系中的狀態(tài)向量ξR可計(jì)算得：由此可以將全局參考坐標(biāo)系中的運(yùn)動(dòng)映射到局部參考坐標(biāo)系中的運(yùn)動(dòng)，反之，將則局部參考坐標(biāo)系中的運(yùn)動(dòng)映射到全局參考坐標(biāo)系中：2.2.2移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型雙輪差速驅(qū)動(dòng)移動(dòng)機(jī)器人的局部坐標(biāo)系原點(diǎn)C位于兩輪中心，且與移動(dòng)機(jī)器人重心重合。移動(dòng)機(jī)器人有2個(gè)主動(dòng)輪，直徑r，兩輪的輪間距為。全局參考坐標(biāo)系中的雙輪差動(dòng)機(jī)器人2.2.2移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型在運(yùn)動(dòng)中，移動(dòng)機(jī)器人質(zhì)心運(yùn)動(dòng)的線速度為ν(t)、轉(zhuǎn)動(dòng)的角速度為ω(t)，移動(dòng)機(jī)器人左、右兩輪轉(zhuǎn)動(dòng)的角速度分別為

和

，左、右兩輪的線速度分別為VL和VR。給定車輪直徑、車輪間距以及航向角，考慮到移動(dòng)機(jī)器人滿足剛體運(yùn)動(dòng)規(guī)律，下面的運(yùn)動(dòng)學(xué)方程成立：2.2.2移動(dòng)機(jī)器人運(yùn)動(dòng)學(xué)模型移動(dòng)機(jī)器人在全局坐標(biāo)系中的運(yùn)動(dòng)速度為：得到雙輪差速驅(qū)動(dòng)移動(dòng)機(jī)器人的運(yùn)動(dòng)學(xué)模型：2.3移動(dòng)機(jī)器人動(dòng)力學(xué)模型動(dòng)力學(xué)模型的作用是為了確定移動(dòng)機(jī)器人在受到外力作用時(shí)的運(yùn)動(dòng)結(jié)果。對(duì)于雙輪差速驅(qū)動(dòng)移動(dòng)機(jī)器人，直接應(yīng)用簡(jiǎn)單的受力分析方法即可獲得雙輪差速驅(qū)動(dòng)移動(dòng)機(jī)器人在外力作用下的位置、速度、加速度的約束關(guān)系。假設(shè)雙輪差速驅(qū)動(dòng)移動(dòng)機(jī)器人的整體質(zhì)量為m，左右兩輪輸出的轉(zhuǎn)動(dòng)慣量為J1、J2，左右電機(jī)驅(qū)動(dòng)力矩分別為T1、T2，左右兩輪的轉(zhuǎn)速分別為

和

，左右兩輪受到的xR方向的約束反力分別為FxR1、FxR2，兩輪沿軸方向受到的約束反力之和為FyR。2.3移動(dòng)機(jī)器人動(dòng)力學(xué)模型分別在移動(dòng)機(jī)器人坐標(biāo)系方向以及電機(jī)軸方向?qū)σ苿?dòng)機(jī)器人進(jìn)行受力分析，滿足力平衡與力矩平衡條件，可得到如下雙輪差速驅(qū)動(dòng)移動(dòng)機(jī)器人的運(yùn)動(dòng)力學(xué)方程：為移動(dòng)機(jī)器人在全局坐標(biāo)系中沿x、y方向的加速度，為角加速度。2.4移動(dòng)機(jī)器人運(yùn)動(dòng)控制算法移動(dòng)機(jī)器人基本的運(yùn)動(dòng)控制算法是以PID（比例、積分、微分）控制方法為理論基礎(chǔ)的，PID方法最大的優(yōu)點(diǎn)在于不需要了解被控對(duì)象的數(shù)學(xué)模型，只要根據(jù)經(jīng)驗(yàn)調(diào)整參數(shù)，便可獲得滿意的結(jié)果。在移動(dòng)機(jī)器人運(yùn)動(dòng)控制中，一般設(shè)計(jì)按位置偏差進(jìn)行比例、積分、微分控制的PID控制器。2.4.1PID控制方法1.

模擬PID調(diào)節(jié)器在連續(xù)控制系統(tǒng)中，模擬PID調(diào)節(jié)器是一種線性調(diào)節(jié)器。下圖是一個(gè)小功率直流調(diào)速系統(tǒng)結(jié)構(gòu)圖。其中為轉(zhuǎn)速給定信號(hào)，n為實(shí)際轉(zhuǎn)速，偏差e=nr-n；PID調(diào)節(jié)器的輸出電壓u經(jīng)過(guò)功率放大后，作為直流電機(jī)的電樞電壓去控制直流電機(jī)的轉(zhuǎn)速。小功率直流調(diào)速系統(tǒng)結(jié)構(gòu)圖2.4.1PID控制方法1.

模擬PID調(diào)節(jié)器PID控制系統(tǒng)的方框圖其中nr為設(shè)定值；n為系統(tǒng)輸出e=nr-n構(gòu)成控制偏差，為PID控制器的輸入；u為PID控制器的輸出，也是被控對(duì)象的輸入。2.4.1PID控制方法1.

模擬PID調(diào)節(jié)器模擬PID調(diào)節(jié)器的控制規(guī)律為：模擬PID控制器中的比例調(diào)節(jié)器的作用是對(duì)于偏差做出瞬時(shí)快速反應(yīng)。積分控制器的作用是把偏差累積的結(jié)果作為它的輸出。微分項(xiàng)的作用是阻止偏差的變化，偏差變化越快，微分調(diào)節(jié)器的輸出也越大。2.4.1PID控制方法2.

控制律的離散化方法如果T為采樣周期，用離散采樣時(shí)刻點(diǎn)表示連續(xù)時(shí)間，以和式代替積分，以增量代替微分，可對(duì)上式作如下近似變換：2.4.1PID控制方法2.

控制律的離散化方法聯(lián)立以上兩式，可得離散（數(shù)值）型控制的近似計(jì)算公式：式中：ui為第個(gè)采樣時(shí)刻的輸出值；ei為第個(gè)采樣時(shí)刻的系統(tǒng)輸出偏差，即PID調(diào)節(jié)器的輸入值；ei-1為第i-1個(gè)采樣時(shí)刻的系統(tǒng)輸出偏差；u0為開(kāi)始進(jìn)行PID控制時(shí)原始的控制值。2.4.1PID控制方法2.

控制律的離散化方法當(dāng)控制量初始值為零時(shí)，上式可以重新寫成：在計(jì)算機(jī)控制中使用數(shù)字式的PID控制形式為:式中，

。這種形式的數(shù)字式PID控制器稱為絕對(duì)式數(shù)字是PID控制器。2.4.1PID控制方法2.

控制律的離散化方法在時(shí)刻PID控制量:有的系統(tǒng)采用步進(jìn)電機(jī)等增量型執(zhí)行機(jī)構(gòu)，執(zhí)行機(jī)構(gòu)需要的控制量，不是位置量的絕對(duì)數(shù)值，而是其增量值，則應(yīng)采用增量式PID算法。通過(guò)以上兩式可以得到控制量的增量：2.4.2PID控制控制器參數(shù)的選擇在數(shù)字PID控制中，采樣周期相對(duì)于系統(tǒng)的時(shí)間常數(shù)來(lái)說(shuō)，一般是很短的。此時(shí)，其參數(shù)Kp，TI，TD可按模擬PID控制器中的方法來(lái)選擇。PID參數(shù)的選擇有兩種可用的方法：理論設(shè)計(jì)法及實(shí)驗(yàn)確定法。2.4.2PID控制控制器參數(shù)的選擇1.

湊試法湊試法是通過(guò)模擬或閉環(huán)運(yùn)行觀察系統(tǒng)的響應(yīng)曲線(如階躍響應(yīng))，然后根據(jù)各調(diào)節(jié)參數(shù)對(duì)系統(tǒng)響應(yīng)的大致影響，反復(fù)湊試，改變參數(shù)，以達(dá)到滿意的響應(yīng),從而確定PID控制器參數(shù)。在湊試時(shí)，對(duì)參數(shù)按先比例、后積分、再微分的次序反復(fù)調(diào)試。具體的整定步驟如下：2.4.2PID控制控制器參數(shù)的選擇1.

湊試法（1）首先只整定比例部分，將比例系數(shù)由小變大，并觀察相應(yīng)的系統(tǒng)響應(yīng)，直至得到反應(yīng)快、超調(diào)小的響應(yīng)曲線。如果系統(tǒng)靜態(tài)誤差已小到允許范圍內(nèi)，并且已達(dá)到1/4衰減度的響應(yīng)曲線(最大超調(diào)衰減到1/4時(shí)，已進(jìn)入允許的穩(wěn)態(tài)誤差范圍)，那么只需用比例控制器即可，比例系數(shù)可由此確定。2.4.2PID控制控制器參數(shù)的選擇1.

湊試法（2）如果在比例調(diào)節(jié)的基礎(chǔ)上系統(tǒng)的靜態(tài)誤差達(dá)不到設(shè)計(jì)要求，則必須加入積分環(huán)節(jié)。整定時(shí)首先置積分常數(shù)為一較大值，并將經(jīng)第一步

整定得到的比例系數(shù)略微減小(如降為原值的80%)，然后逐步減小積分常數(shù)，并根據(jù)響應(yīng)曲線的好壞反復(fù)改變比例系數(shù)和積分常數(shù)，使在保持系統(tǒng)良好動(dòng)態(tài)性能的情況下,穩(wěn)態(tài)誤差得到消除，由此得到相應(yīng)的整定參數(shù)。2.4.2PID控制控制器參數(shù)的選擇1.

湊試法（3）若使用比例積分調(diào)節(jié)器消除了穩(wěn)態(tài)誤差,但動(dòng)態(tài)過(guò)程經(jīng)反復(fù)調(diào)整仍不令人滿意，則可加入微分環(huán)節(jié)，構(gòu)成比例-積分-微分調(diào)節(jié)器。在整定時(shí)，可先置微分常數(shù)為零，在第二步整定的基礎(chǔ)上，逐步增大的同時(shí)相應(yīng)地改變和，以獲得滿意的調(diào)節(jié)效果和相應(yīng)的參數(shù)。2.4.2PID控制控制器參數(shù)的選擇2.

實(shí)驗(yàn)經(jīng)驗(yàn)法為了減少湊試次數(shù)，可利用他人的經(jīng)驗(yàn)，根據(jù)要求事先做少量的實(shí)驗(yàn)以得到基準(zhǔn)參數(shù)，按照經(jīng)驗(yàn)公式由這些基準(zhǔn)參數(shù)導(dǎo)出控制器參數(shù)，這就是實(shí)驗(yàn)經(jīng)驗(yàn)法。臨界比例法就是其中之一，首先將調(diào)節(jié)器選為純比例調(diào)節(jié)器，形成閉環(huán)，改變比例系數(shù)，使系統(tǒng)對(duì)階躍輸入的響應(yīng)達(dá)到臨界的穩(wěn)定邊緣狀態(tài)。將這時(shí)的比例系數(shù)記為，臨界振蕩的周期記為

，根據(jù)齊格勒-尼柯?tīng)査固峁┑慕?jīng)驗(yàn)公式，就可以由這兩個(gè)基準(zhǔn)參數(shù)得到不同類型控制器的參數(shù)。2.4.2PID控制控制器參數(shù)的選擇2.

實(shí)驗(yàn)經(jīng)驗(yàn)法控制器類型Kp

TITD

P控制0.5Kr

PI控制0.45Kr

0.85Tr

PID控制0.6Kr

0.5Tr

0.12Tr

臨界比例法確定PID控制器參數(shù)2.4.3雙輪差速驅(qū)動(dòng)移動(dòng)機(jī)器人點(diǎn)到點(diǎn)運(yùn)動(dòng)控制移動(dòng)機(jī)器人的運(yùn)動(dòng)控制一般要實(shí)現(xiàn)移動(dòng)機(jī)器人兩種運(yùn)動(dòng)問(wèn)題：1．鎮(zhèn)定控制。又稱為點(diǎn)對(duì)點(diǎn)控制，其控制目標(biāo)是控制移動(dòng)機(jī)器人運(yùn)動(dòng)到工作空間的指定點(diǎn)。要求移動(dòng)機(jī)器人從任意的初始狀態(tài)停止到任意的終止?fàn)顟B(tài)，其目的是獲得一個(gè)反饋控制律，使得整個(gè)系統(tǒng)在一個(gè)平衡點(diǎn)漸近穩(wěn)定。對(duì)于移動(dòng)機(jī)器人而言，點(diǎn)鎮(zhèn)定又可稱為姿態(tài)鎮(zhèn)定或姿態(tài)調(diào)節(jié)。采用PID控制器即可實(shí)現(xiàn)鎮(zhèn)定控制。2.4.3雙輪差速驅(qū)動(dòng)移動(dòng)機(jī)器人點(diǎn)到點(diǎn)運(yùn)動(dòng)控制2．跟蹤控制。跟蹤控制可分為軌跡跟蹤控制和路徑跟蹤控制兩種。當(dāng)要求移動(dòng)機(jī)器人在特定時(shí)間到達(dá)特定點(diǎn)時(shí)，就需要進(jìn)行軌跡跟蹤控制。而當(dāng)要求移動(dòng)機(jī)器人以