機(jī)械手-兩足行走機(jī)器人——頭部、臂部控制部分設(shè)計(jì)
機(jī)械手-兩足行走機(jī)器人——頭部、臂部控制部分設(shè)計(jì),機(jī)械手,行走,機(jī)器人,頭部,臂部,控制,節(jié)制,部分,部份,設(shè)計(jì)
南京理工大學(xué)泰州科技學(xué)院
畢業(yè)設(shè)計(jì)（論文）任務(wù)書
系 部：
機(jī)械工程系
專 業(yè)：
機(jī)械工程及自動(dòng)化
學(xué) 生 姓 名：
吳玉坤
學(xué) 號：
05010236
設(shè)計(jì)(論文)題目：
兩足行走機(jī)器人
—頭部、臂部控制部分設(shè)計(jì)
起 迄 日 期:
2009年 3月9 日 ~ 6月14日
設(shè)計(jì)(論文)地點(diǎn):
南京理工大學(xué)泰州科技學(xué)院
指 導(dǎo) 教 師:
路建萍 劉 艷
專業(yè)負(fù)責(zé)人:
龔光容
發(fā)任務(wù)書日期: 2009年 2月 26 日
畢 業(yè) 設(shè) 計(jì)（論 文）任 務(wù) 書
1．本畢業(yè)設(shè)計(jì)（論文）課題應(yīng)達(dá)到的目的：
通過該課題，一方面鞏固相關(guān)專業(yè)的理論知識，學(xué)會(huì)將各門課程知識融合在一起，靈活運(yùn)用，了解各種傳感器的原理、功能及使用場合，培養(yǎng)學(xué)生對機(jī)電一體化產(chǎn)品的設(shè)計(jì)能力。掌握工程設(shè)計(jì)的一般方法以及獨(dú)立分析問題和解決問題的能力，最終使學(xué)生的綜合素質(zhì)得以提高。
2．本畢業(yè)設(shè)計(jì)（論文）課題任務(wù)的內(nèi)容和要求（包括原始數(shù)據(jù)、技術(shù)要求、工作要求等）：
技術(shù)要求：
熟悉微機(jī)及接口實(shí)驗(yàn)板的使用方法。
了解機(jī)器人頭部、臂部控制系統(tǒng)的原理及設(shè)計(jì)方法。
總體方案的設(shè)計(jì)。
詳細(xì)方案的設(shè)計(jì)。
調(diào)試硬件電路并編制相應(yīng)的控制程序。
提交規(guī)范的設(shè)計(jì)文檔。
條件：
微機(jī)及相應(yīng)接口實(shí)驗(yàn)板和控制功能芯片。
畢 業(yè) 設(shè) 計(jì)（論 文）任 務(wù) 書
3．對本畢業(yè)設(shè)計(jì)（論文）課題成果的要求〔包括畢業(yè)設(shè)計(jì)論文、圖表、實(shí)物樣品等〕：
（1）開題報(bào)告、文獻(xiàn)綜述、資料翻譯；
（2）機(jī)器人頭部、臂部控制系統(tǒng)的原理圖；
（3）直流電動(dòng)機(jī)的控制軟件；
（4）畢業(yè)設(shè)計(jì)說明書。
4．主要參考文獻(xiàn)：
[1] 馬香峰.機(jī)器人機(jī)構(gòu)學(xué)[M]. 北京: 機(jī)械工業(yè)出版社, 1991.
[2] 王曉明．電動(dòng)機(jī)的單片機(jī)控制[M]．北京航空航天大學(xué)出版社，2003.
[3] 吳瑞祥.機(jī)器人技術(shù)及應(yīng)用[M]. 北京：北京航空航天大學(xué)出版社，1994.
[4] 熊有倫.機(jī)器人技術(shù)基礎(chǔ)[M].武漢：華中理工大學(xué)出版社，1996.
[5] 王志良.競賽機(jī)器人制作技術(shù)[M].北京：機(jī)械工業(yè)出版社，2007.
[6] 馬香峰等.工業(yè)機(jī)器人的操作機(jī)設(shè)計(jì)[M]. 北京：冶金工業(yè)出版社，1996年9月.
[7] 余達(dá)太，馬香峰. 工業(yè)機(jī)器人應(yīng)用工程[M]. 北京：冶金工業(yè)出版社，1999年4月.
[8] 劉政華等．機(jī)械電子學(xué)[M]．北京：國防科技大學(xué)出版社，1999.10.
[9] Ernest L. Halletl. Robotics: A User-Friendly Introduction[M]. New York:
CBS College Publishing,1985.
[10] Yoram Koren. Robotics for Engineers[M].McGraw-Hill Book Company, 1985.
[11] 張建民．機(jī)電一體化原理與應(yīng)用[M]．國防科技大學(xué)出版社，1992.
[12] 曲家騏等．伺服控制系統(tǒng)中的傳感器[M]．北京：機(jī)械工業(yè)出版社，1998.5
[13] 秦志強(qiáng)等. 基礎(chǔ)機(jī)器人制作與編程[M]. 北京： 電子工業(yè)出版社，2007.
[14] 高鐘毓．機(jī)電一體化系統(tǒng)設(shè)計(jì)[M]．北京：機(jī)械工業(yè)出版社，1997.
[15] 陳繼榮.智能電子創(chuàng)新制作[M]. 北京：科技出版社，2007.
[16] 張建民等．機(jī)電一體化系統(tǒng)設(shè)計(jì)[M]．北京：北京理工大學(xué)出版社，1997.
畢 業(yè) 設(shè) 計(jì)（論 文）任 務(wù) 書
5．本畢業(yè)設(shè)計(jì)（論文）課題工作進(jìn)度計(jì)劃：
起 迄 日 期
工 作 內(nèi) 容
2009年
3月 9 日～ 3月15日
3月16日～ 3月22日
3月23日～ 3月29日
3月30日～ 4月5 日
4月6 日～ 4月12日
4月13日～ 5月3日
5月4 日～ 5月10日
5月11日～ 5月17 日
5月18日～ 5月24 日
5月25日～ 5月31 日
6月1 日～ 6月7 日
6月8 日～ 6月14 日
選題，發(fā)放審題表及任務(wù)書，熟悉課題
完成外文資料翻譯
完成開題報(bào)告(包含文獻(xiàn)綜述)
查閱相關(guān)資料，熟悉直流電動(dòng)機(jī)及頭部、臂部的工作方式
總體控制方案設(shè)計(jì)
詳細(xì)方案設(shè)計(jì)，包括傳感器的選擇、控制電路設(shè)計(jì)等
系統(tǒng)聯(lián)調(diào)，對設(shè)計(jì)方案進(jìn)行評價(jià)與修改，使之完善
繪制控制系統(tǒng)電氣原理圖和流程圖
整理相關(guān)資料，撰寫并打印設(shè)計(jì)說明書
初步提交設(shè)計(jì)成果（包括圖紙及論文），整改
正式提交設(shè)計(jì)成果和設(shè)計(jì)說明書
準(zhǔn)備論文答辯
所在專業(yè)審查意見：
負(fù)責(zé)人：
2009年 月 日
系部意見：
系部主任：
2009年 月 日
南京理工大學(xué)泰州科技學(xué)院
畢業(yè)設(shè)計(jì)(論文)開題報(bào)告
學(xué) 生 姓 名：
吳玉坤
學(xué) 號：
05010236
專 業(yè)：
機(jī)械工程及自動(dòng)化
設(shè)計(jì)(論文)題目：
兩足行走機(jī)器人
—頭部、臂部控制部分設(shè)計(jì)
指 導(dǎo) 教 師:
路建萍 劉 艷
2009 年 3 月 22 日
開題報(bào)告填寫要求
1．開題報(bào)告（含“文獻(xiàn)綜述”）作為畢業(yè)設(shè)計(jì)（論文）答辯委員會(huì)對學(xué)生答辯資格審查的依據(jù)材料之一。此報(bào)告應(yīng)在指導(dǎo)教師指導(dǎo)下，由學(xué)生在畢業(yè)設(shè)計(jì)（論文）工作前期內(nèi)完成，經(jīng)指導(dǎo)教師簽署意見及所在專業(yè)審查后生效；
2．開題報(bào)告內(nèi)容必須用黑墨水筆工整書寫或按教務(wù)處統(tǒng)一設(shè)計(jì)的電子文檔標(biāo)準(zhǔn)格式（可從教務(wù)處網(wǎng)頁上下載）打印，禁止打印在其它紙上后剪貼，完成后應(yīng)及時(shí)交給指導(dǎo)教師簽署意見；
3．“文獻(xiàn)綜述”應(yīng)按論文的格式成文，并直接書寫（或打?。┰诒鹃_題報(bào)告第一欄目內(nèi)，學(xué)生寫文獻(xiàn)綜述的參考文獻(xiàn)應(yīng)不少于15篇科技論文的信息量，一般一本參考書最多相當(dāng)于三篇科技論文的信息量（不包括辭典、手冊）；
4．有關(guān)年月日等日期的填寫，應(yīng)當(dāng)按照國標(biāo)GB/T 7408—94《數(shù)據(jù)元和交換格式、信息交換、日期和時(shí)間表示法》規(guī)定的要求，一律用阿拉伯?dāng)?shù)字書寫。如“2009年3月15日”或“2009-03-15”。
畢 業(yè) 設(shè) 計(jì)（論 文）開 題 報(bào) 告
1．結(jié)合畢業(yè)設(shè)計(jì)（論文）課題情況，根據(jù)所查閱的文獻(xiàn)資料，每人撰寫
2000字左右的文獻(xiàn)綜述：
文 獻(xiàn) 綜 述
摘要 兩足步行機(jī)器人以其自動(dòng)化程度最高，動(dòng)態(tài)系統(tǒng)最為復(fù)雜，以及豐富的動(dòng)力學(xué)特性而成為機(jī)器人領(lǐng)域理論研究的熱點(diǎn)。兩足步行機(jī)器人類似人類行走，靈巧輕便，對行走環(huán)境有良好的適應(yīng)性，既能在平地上行走，也能在非結(jié)構(gòu)性的復(fù)雜地面行走，因而使得步行機(jī)器人的應(yīng)用范圍大大拓寬，受到國內(nèi)外學(xué)者的廣泛關(guān)注，在理論和實(shí)踐方面做出了卓有成效的研究，開發(fā)了多種結(jié)構(gòu)的步行機(jī)器人。本文詳細(xì)介紹了研究兩足步行機(jī)器人的組成，機(jī)器人的原因，兩足步行機(jī)器人的應(yīng)用前景。國內(nèi)外兩足步行機(jī)器人的現(xiàn)狀及發(fā)展趨勢。
關(guān)鍵詞 機(jī)構(gòu) 穩(wěn)定性 自由度
1 機(jī)器人的硬體組成
機(jī)器人一般由執(zhí)行機(jī)構(gòu)、驅(qū)動(dòng)裝置、檢測裝置和控制系統(tǒng)等組成。
執(zhí)行機(jī)構(gòu)即機(jī)器人本體，其臂部一般采用空間開鏈連桿機(jī)構(gòu)，其中的運(yùn)動(dòng)副（轉(zhuǎn)動(dòng)副或移動(dòng)副）常稱為關(guān)節(jié)，關(guān)節(jié)個(gè)數(shù)通常即為機(jī)器人的自由度數(shù)。根據(jù)關(guān)節(jié)配置型式和運(yùn)動(dòng)坐標(biāo)形式的不同，機(jī)器人執(zhí)行機(jī)構(gòu)可分為直角坐標(biāo)式、圓柱坐標(biāo)式、極坐標(biāo)式和關(guān)節(jié)坐標(biāo)式等類型。出于擬人化的考慮，常將機(jī)器人本體的有關(guān)部位分別稱為基座、腰部、臂部、腕部、手部（夾持器或末端執(zhí)行器）和行走部（對于移動(dòng)機(jī)器人）等[1]。
檢測裝置的作用是實(shí)時(shí)檢測機(jī)器人的運(yùn)動(dòng)及工作情況，根據(jù)需要反饋給控制系統(tǒng)，與設(shè)定信息進(jìn)行比較后，對執(zhí)行機(jī)構(gòu)進(jìn)行調(diào)整，以保證機(jī)器人的動(dòng)作符合預(yù)定的要求。作為檢測裝置的傳感器大致可以分為兩類：一類是內(nèi)部信息傳感器，用于檢測機(jī)器人各部分的內(nèi)部狀況，如各關(guān)節(jié)的位置、速度、加速度等，并將所測得的信息作為反饋信號送至控制器，形成閉環(huán)控制[2，3]。另一類是外部信息傳感器，用于獲取有關(guān)機(jī)器人的作業(yè)對象及外界環(huán)境等方面的信息，以使機(jī)器人的動(dòng)作能適應(yīng)外界情況的變化，使之達(dá)到更高層次的自動(dòng)化，甚至使機(jī)器人具有某種“感覺”，向智能化發(fā)展，例如視覺、聲覺等外部傳感器給出工作對象、工作環(huán)境的有關(guān)信息，利用這些信息構(gòu)成一個(gè)大的反饋回路，從而將大大提高機(jī)器人的工作精度。
控制系統(tǒng)有兩種方式。一種是集中式控制，即機(jī)器人的全部控制由一臺微型計(jì)算機(jī)完成。另一種是分散（級）式控制，即采用多臺微機(jī)來分擔(dān)機(jī)器人的控制，如當(dāng)采用上、下兩級微機(jī)共同完成機(jī)器人的控制時(shí)，主機(jī)常用于負(fù)責(zé)系統(tǒng)的管理、通訊、運(yùn)動(dòng)學(xué)和動(dòng)力學(xué)計(jì)算，并向下級微機(jī)發(fā)送指令信息；作為下級從機(jī)，各關(guān)節(jié)分別對應(yīng)一個(gè)CPU，進(jìn)行插補(bǔ)運(yùn)算和伺服控制處理，實(shí)現(xiàn)給定的運(yùn)動(dòng)，并向主機(jī)反饋信息。根據(jù)作業(yè)任務(wù)要求的不同，機(jī)器人的控制方式又可分為點(diǎn)位控制、連續(xù)軌跡控制和力（力矩）控制。
兩足步行機(jī)器人的機(jī)構(gòu)是所有部件的載體，也是設(shè)計(jì)兩足步行機(jī)器人最基本的和首要的工作。它必須能夠?qū)崿F(xiàn)機(jī)器人的前后左右以及爬斜坡和上樓梯等的基本功能，因此自由度的配置必須合理：首先分析一下步行機(jī)器人的運(yùn)動(dòng)過程(前向)和行走步驟：重心右移(先右腿支撐)、左腿抬起、左腿放下、重心移到雙腿中間、重心左移、右腿抬起、右腿放下、重心移到雙腿間，共分8個(gè)階段。從機(jī)器人步行過程可以看出：機(jī)器人向前邁步時(shí)，髓關(guān)節(jié)與踝關(guān)節(jié)必須各自配置有一個(gè)俯仰自由度以配合實(shí)現(xiàn)支撐腿和上軀體的移動(dòng)；要實(shí)現(xiàn)重心轉(zhuǎn)移，髖關(guān)節(jié)和踝關(guān)節(jié)的偏轉(zhuǎn)自由度是必不可少的；機(jī)器人要達(dá)到目標(biāo)位置，有時(shí)必須進(jìn)行轉(zhuǎn)彎，所以需要有髖關(guān)節(jié)上的轉(zhuǎn)體自由度。另外膝關(guān)節(jié)處配置一個(gè)俯仰自由度能夠調(diào)整擺動(dòng)腿的著地高度，使上下臺階成為可能，還能實(shí)現(xiàn)不同的步態(tài)。這樣最終決定髖關(guān)節(jié)配置3個(gè)自由度，包括轉(zhuǎn)體(roll)、俯仰(pitch)和偏轉(zhuǎn)(yaw)自由度，膝關(guān)節(jié)配置一個(gè)俯仰自由度，踝關(guān)節(jié)配置有俯仰和偏轉(zhuǎn)兩個(gè)自由度。這樣，每條腿配置6個(gè)自由度，兩條腿共12個(gè)自由度。髖關(guān)節(jié)、膝關(guān)節(jié)和踝關(guān)節(jié)的俯仰自由度共同協(xié)調(diào)動(dòng)作可完成機(jī)器人的在縱向平面(前進(jìn)方向)內(nèi)的直線行走功能；髖關(guān)節(jié)的轉(zhuǎn)體自由度可實(shí)現(xiàn)機(jī)器人的轉(zhuǎn)彎功能；髖關(guān)節(jié)和踝關(guān)節(jié)的偏轉(zhuǎn)自由度協(xié)調(diào)動(dòng)作可實(shí)現(xiàn)在橫向平面內(nèi)的重心轉(zhuǎn)移功能[4～6]。
2 研究兩足步行機(jī)器人的原因
世界著名機(jī)器人學(xué)專家，日本早稻田大學(xué)的加藤一郎教授說過：“機(jī)器人應(yīng)當(dāng)具有的最大特征之一是步行功能”。步行功能的具備為擴(kuò)大機(jī)器人的應(yīng)用領(lǐng)域開辟了無限廣闊的前景研究兩足步行機(jī)器人的原因，概括起來有如下4個(gè)：(1)我們希望研制出兩足步行機(jī)構(gòu)，使它們能在許多結(jié)構(gòu)性和非結(jié)構(gòu)性環(huán)境中行走，以代替人進(jìn)行作業(yè)或延伸和擴(kuò)大凡類的活動(dòng)領(lǐng)域。(2)我們希望更多地了解和掌握人類的步行特性，并利用這些特性為人類服務(wù)。(3)兩足步行系統(tǒng)具有非常豐富的動(dòng)力學(xué)特性，在這一方面的研究可以拓寬力學(xué)及機(jī)器人學(xué)的研究方向。(4)兩足步行機(jī)器人可以作為一種智能機(jī)器人在人工智能中發(fā)揮重要的作用[13]。
3 兩足步行機(jī)器人應(yīng)用前景
實(shí)用的兩足步行機(jī)器人由兩條腿和一個(gè)平臺(腰部)組成。腿的作用是為平臺提供移動(dòng)能力，而平臺的作用則是提供一個(gè)基礎(chǔ)，以便安裝機(jī)械手、CCD攝像機(jī)、機(jī)載計(jì)算機(jī)控制系統(tǒng)和蓄電池[9]。顯然，這種帶機(jī)械手的兩足步行機(jī)器人能非常靈活地從事較多的工作。但是，對于這種兩足步行機(jī)器人來說，平臺的穩(wěn)定性對于有效地控制機(jī)械手末端操作器的位置和姿態(tài)是至關(guān)重要的，而兩條腿的步態(tài)又對平臺的穩(wěn)定性起決定作用。因此，如何規(guī)劃好腿的步態(tài)，協(xié)調(diào)地控制兩條腿的運(yùn)動(dòng)以保持平臺及整個(gè)兩足步行機(jī)器人的穩(wěn)定就成為一個(gè)主要問題。
目前，兩足步行機(jī)器人的應(yīng)用領(lǐng)域主要是康復(fù)醫(yī)學(xué)。從長遠(yuǎn)來看，兩足步行機(jī)器人在無人工廠、核電站、海底開發(fā)、宇宙探索、康復(fù)醫(yī)學(xué)以及教育、藝術(shù)和大眾服務(wù)行業(yè)等領(lǐng)域都有著潛在而廣闊的應(yīng)用前景。
4 兩足步行機(jī)器人研究的現(xiàn)狀
4.1 國外的有關(guān)情況
1985年，美國的Hodgins和Raibert等人研制了一個(gè)用來進(jìn)行奔跑運(yùn)動(dòng)和表演體操動(dòng)作的平面型兩足步行機(jī)器人，這個(gè)機(jī)器人有3個(gè)自由度。1986年，他們用這個(gè)機(jī)器人進(jìn)行奔跑實(shí)驗(yàn)，著重研究奔跑過程中出現(xiàn)的彈射飛行狀態(tài)。在實(shí)驗(yàn)中，這個(gè)機(jī)器人的最大速度高達(dá)4.3米/秒。1988年和1990年，他們又用這個(gè)機(jī)器人進(jìn)行翻筋斗動(dòng)作實(shí)驗(yàn)。Hodgins和Raibert研究這兩種運(yùn)動(dòng)是因?yàn)樗鼈兒胸S富的動(dòng)力學(xué)內(nèi)容，尤其是兩者都具有彈射飛行狀態(tài)[7]。
在美國研究兩足步行機(jī)器人的科學(xué)家中，鄭元芳博士是一個(gè)非常杰出的人物。他在80年代初由中國去了美國，于1984年在俄亥俄州立大學(xué)獲博士學(xué)位，然后一直在克萊姆森大學(xué)工作，最近又回到俄亥俄州立大學(xué)任職。在克萊姆森大學(xué)期間，他主持研制了兩臺步行機(jī)器人，分別命名為SD1和SD2。SDl具有4個(gè)自由度，SD2則有8個(gè)自由度[10]。其中，SD2是美國第一臺真正擬人的兩足步行機(jī)器人。1986年，SD2機(jī)器人成功地實(shí)現(xiàn)了平地上前進(jìn)、后退以及左、右側(cè)行。1987年，這個(gè)機(jī)器人又成功地實(shí)現(xiàn)了動(dòng)態(tài)步行。鄭元芳博士也因他在機(jī)器人領(lǐng)域的突出貢獻(xiàn)而獲得美國1987年度“總統(tǒng)青年研究員”獎(jiǎng) 。
1984年，鄭元芳博士對兩足步行機(jī)器人與環(huán)境接觸時(shí)的碰撞效應(yīng)進(jìn)行了研究。1987年，他提出了一種用于兩足步行機(jī)器人運(yùn)動(dòng)控制的監(jiān)控系統(tǒng)。1989年，他研究了兩足步行機(jī)器人的擾動(dòng)抑制問題。1990年他首次提出了使兩足步行機(jī)器人能走斜坡的控制方案，利用SD2機(jī)器人進(jìn)行了成功的實(shí)驗(yàn)。此外，鄭元芳博士還從神經(jīng)生理學(xué)的角度對人類肌肉的多級傳感與多級驅(qū)動(dòng)原理進(jìn)行了研究，提出了采用這種原理設(shè)計(jì)兩足步行機(jī)器人的方法[12]。
4.2 國內(nèi)的研究情況
我國從80年代中期才開始研究兩足步行機(jī)器人，當(dāng)時(shí)主要的研究單位是哈爾濱工業(yè)大學(xué)和國防科技大學(xué)。
哈爾濱工業(yè)大學(xué)研制成功的第一臺兩足步行機(jī)器人重7Okg，高l10cm，有10個(gè)自由度，采用直流電機(jī)經(jīng)諧波減速驅(qū)動(dòng)，控制系統(tǒng)由一臺IBM—PC／XT計(jì)算機(jī)和l0個(gè)MCS 51單片機(jī)系統(tǒng)組成。1989年l0月，這個(gè)機(jī)器人實(shí)現(xiàn)了平地上的前進(jìn)，左、右側(cè)行以及上、下樓梯的運(yùn)動(dòng)，步幅可達(dá)45cm，步速為l0秒／步，為靜態(tài)步行[14]。
最近哈爾濱工業(yè)大學(xué)又研制了一臺l2自由度的兩足步行機(jī)器人，并正在進(jìn)行動(dòng)態(tài)步行的實(shí)驗(yàn)。
我們南京航空學(xué)院從1989年秋天起也開展了一個(gè)兩足步行機(jī)器人的研究計(jì)劃，現(xiàn)在已研制出一臺8自由度空間運(yùn)動(dòng)型的兩足步行機(jī)器人，命名為NAIWR—1[15]。目前，這一計(jì)劃正在實(shí)施中?？傆^起來，兩足步行機(jī)器人研究的現(xiàn)狀是：國外，主要是日本和美國，對兩足步行機(jī)器人的研究已經(jīng)達(dá)到了相當(dāng)高的水平，研制出了能靜態(tài)或動(dòng)態(tài)行走的多種樣機(jī)。國內(nèi)由于起步較晚，剛完成靜態(tài)穩(wěn)定步行的研究，目前，正處于準(zhǔn)動(dòng)態(tài)和動(dòng)態(tài)穩(wěn)定步行的研究階段[8]。雖然國內(nèi)的研究水平還不像國外那樣高，但在短短的五六年時(shí)間能達(dá)到今天的水平，已經(jīng)是相當(dāng)驚人的了！
5 兩足步行機(jī)器人研究的發(fā)展趨勢
概括起來，兩足步行機(jī)器人的發(fā)展趨勢包括如下l0個(gè)方面：(1)能動(dòng)態(tài)穩(wěn)定地高速步行。(2)能以自由步態(tài)全方位靈活行走。(3)具有良好的地形適應(yīng)性。(4)具有極強(qiáng)的越障和回避能力。(5)具有很高的載重／自重比。(6)可靠性高、工作壽命長。(7)具有豐富的內(nèi)感知和外感知系統(tǒng)。(8)控制系統(tǒng)和能源裝置機(jī)載化。(9)具有完全的自律能力。(10)具有靈活的操作能力(安裝一個(gè)或多個(gè)機(jī)械手) [11]。
6 結(jié)束語
本文較詳細(xì)地介紹了國內(nèi)外兩足步行機(jī)器人研究的主要情況。我們相信，隨著整個(gè)機(jī)器人技術(shù)及相關(guān)技術(shù)的發(fā)展，在不久的將來，兩足步行機(jī)器人一定能夠真正進(jìn)入實(shí)用化階段，在各行各業(yè)中發(fā)揮重要作用。
參考文獻(xiàn)
[1] 包志軍，馬培蓀．從兩足機(jī)器人到仿人形機(jī)器人的研究[J]．機(jī)器人，1999，7(4)：312·320．
[2] 宣孝英．并聯(lián)機(jī)器人運(yùn)動(dòng)規(guī)劃[D]．武漢：華中理工大學(xué)，1999.
[3] 白井良明著. 王棣棠譯. 機(jī)器人工程[M]. 北京：科學(xué)出版社，2001年2月.
[4] 熊有倫.機(jī)器人技術(shù)基礎(chǔ)[M].武漢：華中理工大學(xué)出版社，1996.
[5] 王志良.競賽機(jī)器人制作技術(shù)[M].北京：機(jī)械工業(yè)出版社，2007.
[6] 成大先.機(jī)械設(shè)計(jì)手冊（第4版）.北京：化學(xué)工業(yè)出版社，2002.
[7] 熊有倫.機(jī)器人技術(shù)基礎(chǔ)[M].武漢：華中理工大學(xué)出版社，1996.
[8] 機(jī)械設(shè)計(jì)手冊編委會(huì). 機(jī)械設(shè)計(jì)手冊[M]. 北京：機(jī)械工業(yè)出版社，2007年7月.
[9] 馬香峰. 機(jī)器人機(jī)構(gòu)學(xué)[M]. 北京: 機(jī)械工業(yè)出版社, 1991.
[10] 龔振邦等. 機(jī)器人機(jī)械設(shè)計(jì)[M]. 北京：電子工業(yè)出版社，1995年6月.
[11] 吳瑞祥. 機(jī)器人技術(shù)及應(yīng)用[M]. 北京：北京航空航天大學(xué)出版社，1994.
[12] 熊有倫.機(jī)器人技術(shù)基礎(chǔ)[M].武漢：華中理工大學(xué)出版社，1996.
[13] David Cook.機(jī)器人制作[M].北京：北京航空航天大學(xué)出版社，2005.
[14] 費(fèi)仁元等.機(jī)器人機(jī)械設(shè)計(jì)和分析.北京：北京工業(yè)大學(xué)出版社，1998.
[15] 趙曉軍,黃強(qiáng),彭朝琴,等. 基于人體運(yùn)動(dòng)的仿人型機(jī)器人動(dòng)作的運(yùn)動(dòng)學(xué)匹配[J]. 機(jī)器人, 2005.
畢 業(yè) 設(shè) 計(jì)（論 文）開 題 報(bào) 告
２．本課題要研究或解決的問題和擬采用的研究手段（途徑）：
本課題是設(shè)計(jì)兩足行走機(jī)器人—搖頭、擺大臂和擺小臂控制部分的設(shè)計(jì)。
主要設(shè)計(jì)有:
（1)確定兩足行走機(jī)器人執(zhí)行機(jī)構(gòu);
(2)確定兩足行走機(jī)器人的驅(qū)動(dòng)系統(tǒng);
(3)確定兩足行走機(jī)器人的控制系統(tǒng);
(4)確定兩足行走機(jī)器人運(yùn)動(dòng)動(dòng)作循環(huán)示意圖
畢 業(yè) 設(shè) 計(jì)（論 文）開 題 報(bào) 告
指導(dǎo)教師意見：
1．對“文獻(xiàn)綜述”的評語：
從文獻(xiàn)綜述中反映出該同學(xué)查閱了相關(guān)的文獻(xiàn)，結(jié)合畢業(yè)設(shè)計(jì)作了概要地介紹。思路清晰，表達(dá)準(zhǔn)確。
2．對本課題的深度、廣度及工作量的意見和對設(shè)計(jì)（論文）結(jié)果的預(yù)測：
本課題地深度、廣度及工作量適中，如果該生能力強(qiáng)的話，所從事的雙走機(jī)器人的設(shè)計(jì)能夠達(dá)到創(chuàng)新。
指導(dǎo)教師：
年 月 日
所在專業(yè)審查意見：
負(fù)責(zé)人：
年 月 日
南京理工大學(xué)泰州科技學(xué)院
畢業(yè)設(shè)計(jì)(論文)外文資料翻譯
系 部： 機(jī)械工程
專 業(yè)： 機(jī)械工程及自動(dòng)化
姓 名： 吳玉坤
學(xué) 號： 05010236
(用外文寫)
外文出處： Control and
Robotics(CRB) Technical Report
附 件：1.外文資料翻譯譯文；2.外文原文。
指導(dǎo)教師評語：
譯文比較正確地表達(dá)了原文的意義、概念描述基本符合漢語的習(xí)慣，語句較通暢，層次較清晰。
簽名：
年 月 日
附件1：外文資料翻譯譯文
輪式移動(dòng)機(jī)器人的導(dǎo)航與控制
摘要：本文研究了把幾種具有導(dǎo)航功能的方法運(yùn)用于不同的控制器開發(fā)，以實(shí)現(xiàn)在一個(gè)已知障礙物前面控制一個(gè)開環(huán)系統(tǒng)（例如：輪式移動(dòng)機(jī)器人）執(zhí)行任務(wù)。第一種方法是基于三維坐標(biāo)路徑規(guī)劃的控制方法。具有導(dǎo)航功能的控制器在自由配置的空間中生成一條從初始位置到目標(biāo)位置的路徑。位移控制器控制移動(dòng)機(jī)器人沿設(shè)置的路徑運(yùn)動(dòng)并停止在目標(biāo)位置。第二種方法是基于二維坐標(biāo)路徑規(guī)劃的控制方法。在二維平面坐標(biāo)系中建立導(dǎo)航函數(shù)，基于這種導(dǎo)航函數(shù)設(shè)計(jì)的微控制器是漸進(jìn)收斂控制系統(tǒng)。仿真結(jié)果被用來說明第二種控制方法的性能。
1介紹
很多研究者已經(jīng)提出不同算法以解決在障礙物雜亂的環(huán)境下機(jī)器人的運(yùn)動(dòng)控制問題。對與建立無碰撞路徑和傳統(tǒng)的路徑規(guī)劃算法，參考文獻(xiàn)[19]的第一章第九部分中提供了的全面總結(jié)。從Khatib在參考文獻(xiàn)[13]的開創(chuàng)性工作以來，很顯然控制機(jī)器人在已知障礙物下執(zhí)行任務(wù)的主流方法之一依然是構(gòu)建和應(yīng)用位函數(shù)?？傊缓瘮?shù)能夠提供機(jī)器人工作空間、障礙位置和目標(biāo)的位場。在參考文獻(xiàn)[19]中提供對于位函數(shù)的全面研究。應(yīng)用位函數(shù)的一個(gè)問題是局部極小化的情況可能發(fā)生以至于機(jī)器人無法到達(dá)目標(biāo)位置。不少研究人士提出了解決局部極小化錯(cuò)誤的方法（例如參考文獻(xiàn)[2], [3],[5], [14], [25]）。其中Koditschek在參考文獻(xiàn)[16]中提供了一種解決局部極小化錯(cuò)誤的方法，那是通過基于一種特殊的位函數(shù)的完整系統(tǒng)構(gòu)建導(dǎo)航函數(shù)，此函數(shù)有精確的數(shù)學(xué)結(jié)構(gòu)，它能夠保證存在唯一最小值。
在針對標(biāo)準(zhǔn)的 (完整的)系統(tǒng)的先前的結(jié)果的影響下, 面對更多的具有挑戰(zhàn)性的非完整系統(tǒng)，越來越多的研究集中于位函數(shù)方法的發(fā)展(例如.,機(jī)器人)。例如, Laumond 等人 [18] 用幾何路線策劃器構(gòu)建了一條忽略機(jī)器人非完全約束的無障礙路線, 然后把幾何線路分成更短的線路來滿足非完全限制,然后應(yīng)用最佳路線來減少路程。在 [10] 和 [11]中, Guldner 等人使用間斷變化的模式控制器迫使機(jī)器人的位置沿著位函數(shù)的負(fù)傾斜度變動(dòng)，及其定位與負(fù)傾斜度一致。在[1], [15], 和 [21]中,持續(xù)的位場控制器也保證了位函數(shù)的負(fù)傾斜度的位置追蹤和定位追蹤。在[9]中，面對目標(biāo)因?yàn)橹苓叺恼系K物而不能達(dá)到這一情況時(shí)，Ge和Cui 最近提出一種新的排斥的位函數(shù)的方法來解決這一問題。 在 [23]和[24]中, Tanner 等人采用[22] 中提出的導(dǎo)航函數(shù)研究和偶極位場概念為一個(gè)不完全移動(dòng)操縱器建立導(dǎo)航函數(shù)控制器。特別是, [23] 和 [24] 中的結(jié)果使用了間斷控制器來追蹤導(dǎo)航函數(shù)的負(fù)傾斜度, 在此過程中，一個(gè)不平坦的偶極位場使得機(jī)器人按照預(yù)想的定位拐入目標(biāo)位置。
本文介紹了為不完全系統(tǒng)達(dá)到導(dǎo)航目標(biāo)的兩種不同的方法。在第一個(gè)方法中, 產(chǎn)生了一個(gè)三維空間似導(dǎo)航函數(shù)的預(yù)想的軌道，它接近于機(jī)器人自由配置空間上的唯一最小值的目標(biāo)位置和定位。然后利用連續(xù)控制結(jié)構(gòu)使機(jī)器人沿著這條路線走，在目標(biāo)位置和定位點(diǎn)停下(例如,控制器解決一體化的追蹤和調(diào)節(jié)問題)。這種方法特別的地方是機(jī)器人根據(jù)預(yù)想的定位到達(dá)目標(biāo)位置，而不需要像許多先前的結(jié)果中一樣轉(zhuǎn)彎。正如 [4] 和 [20]中描述的一樣, 一些因素如光線降低現(xiàn)象，更有效處罰離開預(yù)期周線的機(jī)器人的能力，使執(zhí)行任務(wù)速度恒定的能力，以及達(dá)到任務(wù)協(xié)調(diào)性和同步性的能力提高等為按照目前位置和定位壓縮預(yù)期軌道提供動(dòng)機(jī)。至于即時(shí)的二維空間問題 設(shè)計(jì)一個(gè)連續(xù)控制器，沿著一個(gè)導(dǎo)航函數(shù)的負(fù)傾斜度駕駛機(jī)器人到達(dá)目標(biāo)位置。像許多先前的結(jié)果一樣，在線二維空間方法的定位需要進(jìn)一步發(fā)展 (例如, 一個(gè)單獨(dú)的調(diào)節(jié)控制器，一個(gè)偶極位場方法 [23], [24]; 或一個(gè)有效障礙物[9])來使機(jī)器人與預(yù)期的定位在一條線上。模擬結(jié)果闡明了第二種方法的效果。
2 運(yùn)動(dòng)學(xué)模型
本文所討論的不完全系統(tǒng)的種類可以作為運(yùn)動(dòng)轉(zhuǎn)輪的模型
這里定義為
在(1)中, 矩陣定義為
速度向量 定義為
其中vc(t), ωc(t) ∈ R 表示系統(tǒng)線速度和角速度。在(2)中, xc(t), yc(t),θ(t) ∈ R
分別表示位置和定位，xc(t),yc(t) 表示線速度的笛卡爾成分,θ(t) ∈ R 表示角速度。
3 控制目標(biāo)
本文的控制目標(biāo)是在一個(gè)有障礙物且混亂的環(huán)境下，沿著無碰撞軌道駕駛不完全系統(tǒng)（例如，機(jī)器人）到達(dá)不變的目標(biāo)位置和定位，用表示。 特別是從起始位置和定位沿著軌道控制不完全系統(tǒng)，q? ∈ D, 這里的 D 表示一個(gè)自由的配置空間。自由配置空間D是整個(gè)配置空間的子集，除去了所有含有障礙物碰撞的配置。使軌道計(jì)劃控制量化，實(shí)際笛卡爾位置和定位與預(yù)想的位置和定位之間的差異可表示為 ,定義為 如下
這里設(shè)計(jì)了預(yù)想的軌道，因此 qd(t) → q?.
[16]中，運(yùn)用導(dǎo)航函數(shù)方法, 利用似導(dǎo)航函數(shù)生成預(yù)期路線qd(t)。在本文中似導(dǎo)航函數(shù)有如下定義：
定義1 把D作為連接解析流形和邊界的紐帶, 把q? 當(dāng)作D內(nèi)部的目標(biāo)點(diǎn). 似導(dǎo)航函數(shù)?(q) :D →[0, 1] 是符合下列條件的函數(shù)：
1. ? (q(t)) 第一個(gè)命令和可辨第二個(gè)命令 (例如,存在與D中的和)。
2. ? (q(t)) 在D的邊界有最大變量。
3. ? (q(t)) 在 q (t) = q?上有唯一的全局最小值.
4. 如果 ，其中εz, εr ∈ R 是正常數(shù)。
5. 如果?(q(t))被ε限制,那么被εr 限制，其中 ε∈ R是正常數(shù)。
4 在線三維空間軌道計(jì)劃
4.1 軌道計(jì)劃
生成的預(yù)期的三維空間軌道如下：
其中?(q) ∈ R 表示定義1中定義的似導(dǎo)航函數(shù), 表示?(q)的傾斜向量, 是另加的限制條件。
假設(shè) 定義1中定義的似導(dǎo)航函數(shù)，沿著由(6)生成的預(yù)期軌道，確保了輔助條件N (·) ∈ R3, 表示為
滿足了下面的不等式
其中正函數(shù)ρ (·) 在和 中是不減少的。(8) 中給的不等式將在以后的穩(wěn)定性分析中用到。
4.2 模型轉(zhuǎn)換
為了達(dá)到控制目標(biāo)，控制器必須能夠追蹤預(yù)期軌道，停在目標(biāo)位置q?上. 最后, 使用[7] 中提到的統(tǒng)一追蹤和調(diào)節(jié)控制器。為了改進(jìn)[7]中的控制器,必須把 (5)中定義的開路錯(cuò)誤系統(tǒng)轉(zhuǎn)換為合適的形式。(5)中定義的位置和定位循跡誤差信號通過以下全應(yīng)可逆轉(zhuǎn)換[8]和輔助循跡誤差變量w(t) ∈ R 和有關(guān)。
??
運(yùn)用 (9)中的時(shí)間導(dǎo)數(shù)和 (1)-(5)及(9)后, 根據(jù)(9)定義的輔助變數(shù)，循跡誤差可表示為 [8]
其中表示不相稱矩陣，定義為
定義為
(10)中介紹的輔助控制輸入 根據(jù)
和定義如下
?.
4.3 控制發(fā)展
為了促進(jìn)控制發(fā)展, 一個(gè)輔助誤差信號, 用表示, 是后來設(shè)計(jì)的動(dòng)態(tài)似振蕩器信號 和轉(zhuǎn)換的變量z(t)之間的差別,
如下
根據(jù)(10)中開路運(yùn)動(dòng)系統(tǒng)和后來的穩(wěn)定性分析, 我們把 u(t)設(shè)計(jì)為[7]
其中 k2 ∈ R 是正的不變的控制增長率。(15)中介紹的輔助控制條件定義為
其中輔助信號zd(t)由下列微分方程式和初始條件決定
輔助條件Ω1(w, f, t) ∈ R and δd(t) ∈ R 分別為
和
, k1, α0, α1, ε1 ∈ R是正的不變的控制增長率, 在(12)中有定義。正如 [8]中描述的一樣, (17)和(19)中結(jié)構(gòu)是以以下事實(shí)為基礎(chǔ)的
根據(jù)(9), e (t) f能夠用, 和表示出來，如下
其中表示為
在隨后的穩(wěn)定性分析推動(dòng)下，附加的限制條件vr (t) 表示如下
其中 k3, k4 ∈ R 是正的不變的控制增長率, 正函數(shù)ρ1 (zd1, z1, qd, e),
ρ2 (zd1, z1, qd, e) ∈ R 表示為
4.4 閉環(huán)誤差系統(tǒng)
把(15)替換到(10)中后, 得到含有w(t) 如下的公式
這里利用了(14)和(11)中J的屬性。
第二次出現(xiàn) ua(t)時(shí)把(16)替換到(26)中，利用(20)和(11)中J的屬性, 最終得到的w(t)閉環(huán)誤差系統(tǒng)表達(dá)式如下
為了確定閉環(huán)誤差系統(tǒng), 我們運(yùn)用(14)中的時(shí)間導(dǎo)數(shù)，替換 (10) 和(17) 到最終表達(dá)式， 達(dá)到下面的表達(dá)式
替換(15)和(16)到(28), (28) 可以寫成
第二次出現(xiàn) Ω1 (t) 時(shí)，替換(18)到(29) ，然后刪去相同部分，得到表達(dá)式：
因?yàn)?30)中的相等條件和 (16)中定義的ua (t)是一樣的, 得到 閉環(huán)誤差系統(tǒng)的最終表達(dá)式 如下
備注1 根據(jù)(19)中δd (t )接近任意小常量，(16), (17),和(18)中禁止產(chǎn)生位奇點(diǎn)。
4.5 穩(wěn)定性分析
法則1 倘若qd (0) ∈ D, (6)中產(chǎn)生的預(yù)期軌道連同附加的限制條件vr (t) 保證了 和 ， 其中 εr在定義1中有解釋。
證明: 讓V (t) ∈ R 表示下面的函數(shù)
其中 k ∈ R 是一個(gè)正常數(shù), V1 (t) ∈ R 表示
下面的函數(shù)
V2 (qd) : D → R 表示下面的一個(gè)函數(shù)
運(yùn)用(33)中時(shí)間導(dǎo)數(shù)，替換 (27) 和(31) 到最終的表達(dá)式，刪去相同部分, 得到下面的表達(dá)式
運(yùn)用(34)中時(shí)間導(dǎo)數(shù)和(6), 得到下面的表達(dá)式
其中 N (·) 在(7)中有定義。 根據(jù) (8), V2 (t) 是上限，如下
替換 (21)到(37), 得到下面的不等式
其中向量表示如下
正函數(shù) ρ1 (zd1, z1, qd, e) 和ρ2 (zd1, z1, qd, e)在(25)中有所定義。替換 (24)到(38), V2 (t)可以重新寫成如下
根據(jù) (35) 和 (40), (32)中 V (t)的時(shí)間導(dǎo)數(shù)可以按下面的不等式得到上限
其中正常數(shù) 表示如下
.
案例 1: 如果,根據(jù)定義1中屬性4，得到
案例 2: 如果 ,根據(jù) (32), (33),(34), 和(41) 得到
其中 和 是正常數(shù). 根據(jù) (42), V (t)得到上限如下
因此
根據(jù) (32), (34), 和 (44),得到
如果 qd (0)不在D的邊界, ?(qd (0)) < 1， k 可以符合
根據(jù) (45) 和(46), ? (qd (t)) < 1, 因此從定義1得到qd (t) ∈ D， 從(43) 可以得出，?(qd) 最終被限制。
因此, 如果 , k4 則符合 , 其中 ε 在定義1中有解釋，進(jìn)而在定義1的屬性5中得到定義, 最終被εr限制。
法則2 (15)-(19)中運(yùn)動(dòng)學(xué)控制法保證全局統(tǒng)一最終限制的(GUUB) 位置和定位按下面公式追蹤
其中 ε1 在(19)中給定, , ε3 和 γ0 是正常數(shù).
證明: 根據(jù) (33) 和(35), V1 (t) 得到上限如下
根據(jù) (48), 得到下面的不等式
根據(jù) (33), (49) 可以被寫成
其中向量Ψ1 (t)在(39)中有定義。
根據(jù)(33) 和(49), 得到w (t) , ∈L∞. 根據(jù) (19)和(20), 我們可以得到zd (t) ∈ L∞. 根據(jù)(14) 和, zd (t) ∈ L∞, 得到z (t) ∈ L∞.因?yàn)閣 (t) , z (t) ∈L∞, 根據(jù)(9)中的逆轉(zhuǎn)換, e (t) ∈L∞. 根據(jù)法則1中qd (t) ∈ L∞ 和 e (t) ∈ L∞,得到q (t) ∈ L∞.由于(22)-(25), qd (t) , zd (t) , z (t) , e (t) ∈ L∞,及定義1中的性質(zhì), 我們得到vr (t), qd (t) ∈ L∞. 根據(jù) (12) 和q (t) , z (t) , qd (t) ∈ L∞, f (θ, z2, qd) ∈ L∞. 然后根據(jù)(18)得到 Ω1 (t) ∈ L∞. 根據(jù)(15)-(17)得到 u (t) , ua (t) , zd (t) ∈ L∞. 根據(jù) f (θ, z2, qd) , z (t) , u (t) ∈ L∞, 利用(10) 得到w(t) , z(t) ∈ L∞. 由于z (t) , zd (t) ∈ L∞ 得到∈ L∞.利用論據(jù)的標(biāo)準(zhǔn)信號可以得出控制之下的所有的剩余信號和系統(tǒng)在閉環(huán)試驗(yàn)中仍然被限定。
根據(jù) (19), (20), (39), 和(50), 把三元不等式應(yīng)用到(14)可以證明
利用(50)-(51), 根據(jù)(9)中的逆轉(zhuǎn)換得到(47)中的結(jié)果。
備注2 雖然qd (t) 是無碰撞軌道, 如果只確保實(shí)際機(jī)器人軌道在預(yù)期路線的附近，法則2的穩(wěn)定性結(jié)果保證了軌道的實(shí)際追蹤。根據(jù) (5) 和(47), 得到下面的限制
其中根據(jù)法則1的證明，qd (t) ∈ D .為了確保q (t) ∈ D, 自由配置空間需要處于(52)右邊的第二和第三條件共同作用。最后，障礙物的大小可以增加 。其中通過調(diào)節(jié)控制增加率，ε3ε1 可以任意小。為了使ε2的影響最小化, 起始條件w(0)和z(0) (因此, ) 要求足夠小來產(chǎn)生可行的路線到達(dá)目標(biāo)。
5 在線二維空間導(dǎo)航
先前的方法中，因?yàn)樗茖?dǎo)航函數(shù)用預(yù)期軌道表示，障礙物的尺寸要求增加。在下面的方法中, [22]提出的導(dǎo)航函數(shù)是根據(jù)現(xiàn)有位置反饋表示出來的,因此, 不需要在起始條件里添加限制，q (t) 就可以證明是D的一部分。
5.1 軌道編制
讓?(xc, yc) ∈ R 表示二維空間位置型導(dǎo)航函數(shù), 其中梯度向量?(xc, yc)定義如下
讓θd (xc, yc) ∈ R 表示預(yù)期定位，定義為一個(gè)二維空間導(dǎo)航函數(shù)的負(fù)梯度函數(shù)，如下
其中 arc tan 2 (·) : R2 → R 表示第四象限逆切線函數(shù) [26], 其中 θd (t) 在下面的定義域中
按照[21]規(guī)定,通過定義 ，沿著任何到達(dá)目標(biāo)位置的方向θd(t) 仍然是連續(xù)的。見附錄θd(t)的表達(dá)式， 根據(jù)先前的θd(t)連續(xù)定義。
備注3 正如[22]中討論的, 函數(shù) ?(q(t))的建立, 結(jié)合導(dǎo)航函數(shù), 滿足定義1的前三個(gè)性質(zhì) 因?yàn)榕懦收喜皇呛唵蔚膯栴}。事實(shí)上, 對與典型的故障排除來說，建立 ?(q(t))如只有當(dāng) q (t) = q?時(shí)，，是不大可能的。 這就是說, 如[22]所述, 內(nèi)部承受點(diǎn)的外觀(如不穩(wěn)定平衡 )好像不可避免; 可是, 這些不穩(wěn)定均衡不會(huì)真正 造成實(shí)踐中的困難。這就是說，如[22]所述可以建立? (q(t))，只有少數(shù)起始條件能夠真正受不穩(wěn)定均衡影響。
5.2 控制發(fā)展
根據(jù)(1)-(4)介紹的開路系統(tǒng)和后來的穩(wěn)定性分析, 線速度控制輸入vc (t)表示如下
其中 kv ∈ R 表示正的不變的控制增長率, 在(5)中有介紹。替換 (55) 到(1),得到下面的 閉環(huán)系統(tǒng)
運(yùn)用(5)中時(shí)間導(dǎo)數(shù)，得到開路定位追蹤誤差系統(tǒng)，如下 .
利用(1)，根據(jù) (57), 角速度控制輸入ωc (t)表示如下
其中 kω ∈ R 表示 正的不變的控制增長率,θd(t) 表示預(yù)期定位的時(shí)間導(dǎo)數(shù)。見附錄θd (t)外部表達(dá)式。替換 (58)到(57), 通過下面的線性關(guān)系，得到閉環(huán)定位追蹤誤差系統(tǒng)
線性分析技巧用來解決(59) 如下
替換 (60) 到(56)，得到下面的閉環(huán)誤差系統(tǒng)
5.3 穩(wěn)定性分析
法則3 (55)和(58)中的控制輸入和導(dǎo)航函數(shù) ?(xc (t) , yc (t)) 在下列條件下
保證了漸近導(dǎo)航
證明: 讓 V3 (xc, yc) : D → R 表示下面的非負(fù)函數(shù)
運(yùn)用(63)時(shí)間導(dǎo)數(shù)，利用 (1),(53), 和(56),得到下面的表達(dá)式
根據(jù)附錄的說明, 導(dǎo)航函數(shù)的梯度可表示為
替換 (65) 到(64), 得到下面的表達(dá)式
利用三角恒等式，(66) 可以寫成
其中 g(t) ∈ R 表示下面的正函數(shù)
根據(jù) (53)和導(dǎo)航函數(shù)的屬性(與定義1的屬性1相同), 可以得到。因此,根據(jù) (55)可以得出vc (t) ∈ L∞ . 附錄同樣證明了θd (t) ∈ L∞ on D;因此, 根據(jù)(58) 得出ωc (t)∈L∞ . 根據(jù)vc (t) ∈ L∞ , 利用(1)-(4) 可以知道xc (t), yc (t) ∈ L∞ .應(yīng)用(53)的時(shí)間導(dǎo)數(shù)，得到下面的表達(dá)式
因?yàn)?xc (t), yc (t) ∈ L∞ , 也因?yàn)楹谏仃嚨拿總€(gè)成分被導(dǎo)航函數(shù)的屬性限制 (與定義1的屬性1相同 ), 可以得到g(t) ∈ L∞. 根據(jù) (63), (67), (68), 和g(t) ∈ L∞ ,那么輔助定理[6]中的A.6可以用來證明
在D區(qū)域. 根據(jù)1 ,那么 (70) 可以用來證明 . 因此根據(jù)備注3中的分析，可以得到(62)中的結(jié)果。
備注4 這部分控制發(fā)展是以一個(gè)二維空間導(dǎo)航函數(shù)為基礎(chǔ)的. 為了達(dá)到目標(biāo), a 預(yù)期的定位
θd (t) 看作是二維空間導(dǎo)航函數(shù)的負(fù)梯度函數(shù). 先前的發(fā)展可以用來證明(62)的結(jié)果。如果一個(gè)導(dǎo)航函數(shù) ?(xc, yc) 能夠在θd|(x?c ,y?c ) = θ?中找到, 那么漸近導(dǎo)航可以通過(55) 和(58)中控制器達(dá)到; 否則, 根據(jù)θd|(x?c ,y?c ) → θ?一個(gè)標(biāo)準(zhǔn)的調(diào)節(jié)控制器 (如., 見[8] 中的候選控制器)可能用來調(diào)節(jié)機(jī)器人的定位。作為選擇, 偶極位場方法[23], [24] 或有效障礙物[9]可以用來使導(dǎo)航函數(shù)的梯度場與機(jī)器人的目標(biāo)定位成一行。
6 模擬結(jié)果
為了說明(55) 和(58)中控制器的成效, 用數(shù)值模擬駕駛機(jī)器人從q (xc (0) , yc (0) , θ (0)) 到 q? (x?c , y?c , θ?)。因?yàn)閷?dǎo)航函數(shù)的屬性是不變的under a diffeomorphism, a diffeomorphism 用來繪制機(jī)器人自由配置空間到模型空間 [17]. 正函數(shù) ? (xc, yc)如下
其中 κ 是正整數(shù)參量, 邊界函數(shù) β0 (xc, yc) ∈ R，障礙函數(shù)β1 (xc, yc) ∈ R 定義如下
在(72)中, (xr0, yr0 ) 和 (xr1, yr1 ) 分別是障礙物和分界線的中心, r0, r1 ∈ R 分別是障礙物和界面的半徑。
根據(jù)(71)和(72), 可以看出模型空間是一個(gè)排除障礙物函數(shù) β1 (xc, yc)形成的圓的單位圓. 如果 更多的障礙物出現(xiàn), 相應(yīng)的障礙物函數(shù)就能簡單的和導(dǎo)航函數(shù) [17]合成一體. 在[17]中, Koditschek 證明 ? (xc, yc) in (71) 是關(guān)于(xc (t) , yc (t))的導(dǎo)航函數(shù), 假設(shè)κ足夠大. 由于模擬, 模型空間配置選擇如下
其中起始位置和目標(biāo)配置為
利用(55) 和(58)中定義的控制輸入沿著負(fù)梯度角駕駛機(jī)器人到目標(biāo)點(diǎn)?？刂圃鲩L率kv 和 kω調(diào)整到下面的值來產(chǎn)生最好的效果
一旦機(jī)器人到達(dá)目標(biāo)位置, [8]中的調(diào)節(jié)控制器按照θd|(x?c ,y?c ) → θ?調(diào)節(jié)機(jī)器人。機(jī)器人的實(shí)際軌道如圖1所示。. 圖1中的外圓描述了障礙物自由空間外邊界，內(nèi)部的圓代表了障礙物周圍的邊界。機(jī)器人的最終位置和定位誤差如圖2所示, 其中轉(zhuǎn)動(dòng)誤差如圖2所示是實(shí)際定位和目標(biāo)定位之間的誤差。(55)和(58)分別定義的控制輸入速度vc(t) 和ωc(t)如圖3所示。值得注意的是角速度輸入 在 ±90[deg ·s?1]之間人為飽和。
7 結(jié)論
兩種方法都把導(dǎo)航函數(shù)方法合并到不同的控制器，在已知障礙物面前執(zhí)行任務(wù)。第一種方法利用 以3D 位置和定位信息為基礎(chǔ)的似導(dǎo)航函數(shù)。似導(dǎo)航函數(shù)生成一條軌道從自由配置空間里的初始配置到目標(biāo)配置. 一個(gè)可微的振蕩器型控制器使這個(gè)移動(dòng)式遙控裝置沿著這條路線走，在目標(biāo)位置停止.。利用這種方法, 機(jī)器人可以用一個(gè)任意的目標(biāo)定位產(chǎn)生統(tǒng)一最終綁定路線和調(diào)節(jié)目標(biāo)點(diǎn)(例如., 機(jī)器人不需要固定在目標(biāo)位置旋轉(zhuǎn)來達(dá)到預(yù)期的定位)。
第二種方法使用的是二維空間位置信息建立的導(dǎo)航函數(shù)。根據(jù)這個(gè)導(dǎo)航函數(shù)，使用一個(gè)可辨的控制器。這個(gè)方法的好處是產(chǎn)生了漸近位置收斂; 可是，機(jī)器人如果沒有附加的條件就不能在任意定位停止。模擬結(jié)果用來說明第二種方法的效果。
附錄
根據(jù)(54)中θd (t)的定義, θd (t) 可用自然對數(shù)表示的表達(dá)式如下 [26]
其中 ， 使用下面的恒等式 [26]
利用(74)得到下面的表達(dá)式
利用 (75)和(76), 得到下面的表達(dá)式
根據(jù)(74)中的表達(dá)式，θd (t)的時(shí)間導(dǎo)數(shù)可以寫成
其中，
·
替換 (1), (79), 和(80)到(78), 得到下面的表達(dá)式
替換 (55) 和(77)到(81), 得到下面的表達(dá)式
·
定義1的第一部分限制了黑森矩陣的每個(gè)元件，因此根據(jù) (82),直接得到úθd (t) ∈L∞.
附件2：外文原文（復(fù)印件）
Navigation and Control of a Wheeled Mobile Robot
Abstract: Several approaches for incorporating navigation function approach into different controllers are developed in this paper for task execution by a nonholonomic system (e.g., a wheeled mobile robot) in the presence of known obstacles. The first approach is a path planning-based control with planning a desired path based on a 3-dimensional position and orientation information. A navigation-like function yields a path from an initial configuration inside the free configuration space of the mobile robot to a goal configuration. A differentiable, oscillator-based controller is then used to enable the mobile robot to follow the path and stop at the goal position. A second approach is developed for a navigation function that is constructed using 2-dimensional position information. A differentiable controller is proposed based on this navigation function that yields asymptotic convergence. Simulation results are provided to illustrate the performance of the second approach.
1 Introduction
Numerous researchers have proposed algorithms to address the motion control problem associated with robotic task execution in an obstacle cluttered environment. A comprehensive summary of techniques that address the classic geometric problem of constructing a collision-free path and traditional path planning algorithms is provided in Section 9, .Literature Landmarks of Chapter 1 of [19]. Since the pioneering work by Khatib in [13], it is clear that the construction and use of potential functions has continued to be one of the mainstream approaches to robotic task execution among known obstacles. In short, potential functions produce a repulsive potential field around the robot workspace boundary and obstacles and an attractive potential Teld at the goal configuration. A comprehensive overview of research directed at potential functions is provided in [19]. One of criticisms of the potential function approach is that local minima can occur that can cause the robot to get stuck without reaching the goal position. Several researchers have proposed approaches to address the local minima issue (e.g., see [2],[3], [5], [14], [25]). One approach to address the local minima issue was provided by Koditschek in [16] for holonomic systems (see also [17] and [22]) that is based on a special kind of potential function, coined a navigation function, that has a refined mathematical structure which guarantees a unique minimum exists. By leveraging from previous results directed at classic (holonomic) systems, more recent research has focused on the development of potential function-based approaches for more challenging nonholonomic systems (e.g., wheeled mobile robots (WMRs)). For example, Laumond et al. [18] used a geometric path planner to generate a collision-free path that ignores the nonholonomic constraints of a WMR, and then divided the geometric path into smaller paths that satisfy the nonholonomic constraints, and then applied an optimization routine to reduce the path length. In [10] and [11], Guldner et al. use discontinuous, sliding mode controllers to force the position of a WMR to track the negative gradient of a potential function and to force the orientation to align with the negative gradient. In [1], [15], and [21], continuous potential field-based controllers are developed to also ensure position tracking of the negative gradient of a potential function, and orientation tracking of the negative gradient. More recently, Ge and Cui present a new repulsive potential function approach in [9] to address the case when the goal is non-reachable with obstacles nearby (GNRON). In [23] and [24], Tanner et al. exploit the navigation function research of [22] along with a dipolar potential field concept to develop a navigation function-based controller for a nonholonomic mobile manipulator. Specifically, the results in [23] and [24] use a discontinuous controller to track the negative gradient of the navigation function, where a nonsmooth dipolar potential field causes the WMR to turn in place at the goal position to align with a desired orientation. In this paper, two different methods are proposed to achieve a navigation objective for a nonholonomic system. In the first approach, a 3-dimensional (3D) navigation-like function-based desired trajectory is generated that is proven to ultimately approach to the goal position and orientation that is a unique minimum over the WMR free configuration space. A continuous control structure is then utilized that enables the WMR to follow the path and stop at the goal position and orientation set point (i.e., the controller solves the unified tracking and regulation problem). The unique aspect of this approach is that the WMR reaches the goal position with a desired orientation and is not required to turn in place as in many of the previous results. As described in [4] and [20], factors such as the radial reduction phenomena, the ability to more effectively penalize the robot for leaving the desired contour, the ability to incorporate invariance to the task execution speed, and the improved ability to achieve task coordination and synchronization provide motivation to encapsulate the desired trajectory in terms of the current position and orientation. For the on-line 2D problem, a continuous controller is designed to navigate the WMR along the negative gradient of a navigation function to the goal position. As in many of the previous results, the orientation for the on-line 2D approach requires additional development (e.g., a separate regulation controller; a dipolar potential field approach [23], [24]; or a virtual obstacle [9]) to align the WMR with a desired orientation. Simulation results are provided to illustrate the performance of the second approach.
2 Kinematic Model
The class of nonholonomic systems considered in this paper can be modeled as a kinematic wheel
where are defined as
In (1), the matrixis defined as follows
and the velocity vector is defined as
with vc(t), ωc(t) ∈ R denoting the linear and angular velocity of the system. In (2), xc(t), yc(t), and θ(t) ∈ R denote the position and orientation, respectively, xc(t), yc(t) denote the Cartesian components of the linear velocity, and θ(t) ∈ R denotes the angular velocity.
3 Control Objective
The control objective in this paper is to navigate a non-holonomic system (e.g., a wheeled mobile robot) along a collision-free path to a constant, goal position and orientation, denoted by , in an obstacle cluttered environment with known obstacles. Specifically, the objective is to control the non-holonomic system along a path from an initial position and orientation to q? ∈ D, where D denotes a free configuration space. The free configuration space D is a subset of the whole configuration space with all configurations removed that involve a collision with an obstacle. To quantify the path planning-based control objective, the difference between the actual Cartesian position and orientation and the desired position and orientation, denoted by, is defined as as follows
where the desired trajectory is designed so that qd(t) → q?. Motived by the navigation function approach in [16], a navigation-like function is utilized to generate the desired path qd(t). Specifically, the navigation-like function used in this paper is defined as follows
Definition 1 Let D be a compact connected analytic manifold with boundary, and let q? be a goal point in the interior of D. The navigation-like function ? (q): D → [0, 1], is a function satisfies the following properties:
1. ? (q(t)) is first order and second order differentiable (i.e., and ′exist on D).
2. ? (q(t)) obtains its maximum value on the boundary of D.
3. ? (q(t)) has unique global minimum at q (t) = q?.
4. If with εz, εr ∈ R being known positive constants.
5. If ? (q(t)) is ultimately bounded by ε, then is ultimately bounded by εr with ε∈ R being some known positive constant.
4 Online 3D Path Planner
4.1 Trajectory Planning
The 3D desired trajectory can be generated online as follows
where ?(q) ∈ R denotes a navigation-like function defined in Definition 1, denotes the gradient vector of ?(q), and is an additional control term to be designed. Assumption The navigation-like function defined in Definition 1 along with the desired trajectory generated by (6) ensures an auxiliary terms N (·) ∈ R3, defined as
satisfy the following inequality
where the positive function ρ (·) is nondecreasing in and . The inequality given by (8) will be used in the subsequent stability analysis.
4.2 Model Transformation
To achieve the control objective, a controller must be designed to track the desired trajectory developed in (6) and stop at the goal position q?. To this end, the unified tracking and regulation controller presented in [7] can be used. To develop the controller in [7], the open-loop error system defined in (5) must be transformed into a suitable form. Specifically, the position and orientation tracking error signals defined in (5) are related to the auxiliary tracking error variables w(t) ∈ R and through the following global invertible transformation [8]
??
After taking the time derivative of (9) and using (1)-(5) and (9), the tracking error dynamics can be expressed in terms of the auxiliary variables defined in (9) as follows [8]
wheredenotes a skew-symmetric matrix defined as
and is defined as
The auxiliary control inputintroduced in (10) is defined in terms of and as follows
4.3 Control Development
To facilitate the control development, an auxiliary error signal, denoted by, is defined as the difference between the subsequently designed dynamic oscillator-like signal and the transformed variable z(t), defined in (9), as follows
Based on the open-loop kinematic system given in (10) and the subsequent stability analysis, we design u(t) as follows [7]
where k2 ∈ R is a positive, constant control gain. The auxiliary control term introduced in (15) is defined as
where the auxiliary signal zd(t) is defined by the following differential equation and initial condition
The auxiliary terms Ω1 (w, f, t) ∈ R and δd(t) ∈ R are defined as
and
respectively, k1, α0, α1, ε1 ∈ R are positive, constant control gains, andwas defined in (12). As described in [8], motivation for the structure of (17) and (19) is based on
收藏