兩足行走機(jī)器人行走控制系統(tǒng)設(shè)計(jì)含開題

兩足行走機(jī)器人行走控制系統(tǒng)設(shè)計(jì)含開題,行走,機(jī)器人,控制系統(tǒng),設(shè)計(jì),開題 XXXXXX XX設(shè)計(jì)(論文)前期工作材料 學(xué)生姓名: 學(xué) 號(hào)： 系　部: 專 業(yè): 設(shè)計(jì)(論文)題目: 兩足行走機(jī)器人 —行走控制部分設(shè)計(jì) 指導(dǎo)教師: 材 料 目 錄 序號(hào) 名 稱 數(shù)量 備 注 1 畢業(yè)設(shè)計(jì)(論文)選題、審題表 1 2 畢業(yè)設(shè)計(jì)(論文)任務(wù)書 1 3 畢業(yè)設(shè)計(jì)(論文)開題報(bào)告〔含文獻(xiàn)綜述〕 1 4 畢業(yè)設(shè)計(jì)(論文)外文資料翻譯〔含原文〕 1 5 畢業(yè)設(shè)計(jì)（論文）中期檢查表 1 20XX年5月 XX設(shè)計(jì)說明書（X）中文摘要 兩足步行機(jī)器人不僅在教學(xué)、比賽和娛樂等方面應(yīng)用廣泛，并且也可以作為兩足步行研究的平臺(tái)。本文在“KONDO”兩足步行機(jī)器人的機(jī)械結(jié)構(gòu)的基礎(chǔ)上，設(shè)計(jì)了基于AVR處理器的兩足步行機(jī)器人控制系統(tǒng)，包括硬軟件設(shè)計(jì)及其實(shí)現(xiàn)；設(shè)計(jì)了兩足步行機(jī)器人的步行模式，實(shí)現(xiàn)了在平面上的穩(wěn)定步行。在硬件電路的處理器中，移植了u C/OS-II操作系統(tǒng)，實(shí)現(xiàn)了兩足步行機(jī)器人控制系統(tǒng)的各項(xiàng)功能，建立了完整的兩足步行機(jī)器人控制系統(tǒng)軟件框架；改進(jìn)了通常的多路PWM信號(hào)產(chǎn)生方法，使控制信號(hào)的精度達(dá)到了lus以上，解決了由于中斷嵌套影響控制信號(hào)精度，從而引發(fā)機(jī)器人抖動(dòng)的問題；并對(duì)機(jī)器人進(jìn)行了關(guān)節(jié)調(diào)試。 關(guān)鍵詞 機(jī)器人 處理器 操作系統(tǒng) XX設(shè)計(jì)說明書（XX）外文摘要 Title The Biped Walking Robot Designs Abstract The Biped walking desktop-robot is not only applied widely in teaching, competitions and entertainments, but also treated as a research tool of biped walking. In this thesis, a control system for biped walking desktop-robot is designed, which is based on AVR, and works well in the mechanism of the KONDO biped walking desktop-robot. A walking astern for the biped robot is presented, and the robot can walk stably on the flat. The open-code operating system, uC/OS-II is explanted to the processor of the circuit. Under the operating system, several tasks and interrupt service routines are resigned to accomplish the functions of the control system for the biped working boot. The frame of software is completed, which is for the control system for biped asking desktop-robot. A improved method of producing multiple PWM signals is resented, and the precision of the control signal can be improved to 111 s, and the problem that the robot shakes because of the interrupt-nesting is solved. A test to the articulations of the robot is done. Keywords Robot Processor Control System 設(shè) 計(jì)（XX）開 題 報(bào) 告 1．結(jié)合畢業(yè)設(shè)計(jì)（論文）課題情況，根據(jù)所查閱的文獻(xiàn)資料，每人撰寫 2000字左右的文獻(xiàn)綜述： 文 獻(xiàn) 綜 述 摘要 兩足行走機(jī)器人是當(dāng)前機(jī)器人研究領(lǐng)域最活躍的研究方向之一，引起了許多科研工作者的注意。本文介紹了兩足行走機(jī)器人與其他移動(dòng)機(jī)器人相比的主要優(yōu)點(diǎn)，對(duì)國內(nèi)外兩足行走機(jī)器人的研制工作做了綜述，并對(duì)將來的研究方向和工作重點(diǎn)做出了展望。 關(guān)鍵詞 機(jī)器人 智能控制 兩足行走 1 兩足行走機(jī)器人的一般情況 兩足機(jī)器人是模擬人類用兩條腿走路的機(jī)器人[1]。兩足步行機(jī)器人適于在凸凹不平或有障礙的地面行走作業(yè)，比一般移動(dòng)機(jī)器人靈活性強(qiáng)，機(jī)動(dòng)性好。1972年，日本早稻田大學(xué)研制出第一臺(tái)功能較全的兩足步行機(jī)器人。美國、南斯拉夫等學(xué)者也研制出各種兩足走行機(jī)器人模型。兩足步行模型是一個(gè)變結(jié)構(gòu)機(jī)構(gòu)，單腳支撐為開式鏈，雙腳支撐為閉式鏈。支撐點(diǎn)的固定靠摩擦力來保證，質(zhì)量分布和重量大小都直接影響靜態(tài)和動(dòng)態(tài)的穩(wěn)定性。為保證行走過程中姿態(tài)的穩(wěn)定性，對(duì)行走步態(tài)應(yīng)加嚴(yán)格的約束[2]，[4]。 如圖1中示出了具有11個(gè)動(dòng)力關(guān)節(jié)的兩足步行模型的自由度分配。這些關(guān)節(jié)以旋轉(zhuǎn)軸的方向分為縱搖軸、橫搖軸和偏航軸?？v搖軸實(shí)現(xiàn)前進(jìn)方向的重心移動(dòng)，橫搖軸實(shí)現(xiàn)左右方向的重心擺動(dòng)，偏航軸轉(zhuǎn)換方向。在行走過程中，通過縱搖軸的髖關(guān)節(jié)、膝關(guān)節(jié)和踝關(guān)節(jié)的協(xié)調(diào)動(dòng)作，在前進(jìn)方向上移動(dòng)重心；通過上驅(qū)體關(guān)節(jié)使上身左傾或右傾，移動(dòng)上身塔載調(diào)節(jié)重心；通過偏航軸的腰關(guān)節(jié)轉(zhuǎn)換方向。關(guān)節(jié)的驅(qū)動(dòng)能源主要有氣壓、液壓和電動(dòng)三種。氣壓式重量輕、安全便宜，但因空氣的可縮性，在變負(fù)載情況下，穩(wěn)定性差。液壓式輸出功率大、快速性好，但需配備動(dòng)力組件。例如，日本早稻田大學(xué)加藤一郎教授研制的WD-10RD,是具有12個(gè)自由度的液壓驅(qū)動(dòng)機(jī)器人。電動(dòng)式結(jié)構(gòu)簡(jiǎn)單、控制容易。但功率密度低、價(jià)格較高[6]。 圖1 兩足步行機(jī)器人自由度的配置 2 兩足行走機(jī)器人的組成 機(jī)器人主要由以下6個(gè)部分組成。 (1)手臂 手臂是機(jī)器人的一部分。該部位由手（手爪）、手臂（手的姿勢(shì)）和手腕組成。手臂通過各關(guān)節(jié)來實(shí)現(xiàn)動(dòng)作的完成。 (2)操作機(jī)構(gòu) 該部位是驅(qū)動(dòng)機(jī)械人關(guān)節(jié)的驅(qū)動(dòng)機(jī)構(gòu)。被用于關(guān)節(jié)部位的操作機(jī)構(gòu)幾乎都是帶有減速器的伺服電動(dòng)機(jī)，但是對(duì)于可以放入手腕和腿中的小型高扭矩的直接驅(qū)動(dòng)式電動(dòng)機(jī)的要求則較高。 (3)傳感器 傳感器作為用來檢測(cè)視覺、觸覺、動(dòng)作姿勢(shì)控制等部位，包括用于測(cè)定手腕位置和速度等的內(nèi)置傳感器和用于識(shí)別機(jī)器人作業(yè)對(duì)象的外部傳感器。 (4)移動(dòng)機(jī)構(gòu) 移動(dòng)機(jī)構(gòu)就機(jī)器人的腳，它是用來移動(dòng)的部位，以實(shí)現(xiàn)機(jī)器人的抬腿跨步，以及關(guān)節(jié)的旋轉(zhuǎn)擺動(dòng)，從而完成一些較為復(fù)雜的動(dòng)作。 (5)控制器（控制裝置） 控制器是用來控制一系列動(dòng)作的部位[8]，[9]。為了使機(jī)器人的手腕和腿部位活動(dòng)起來，需要控制器（控制裝置）來向安裝在這些部位的操作機(jī)構(gòu)和傳感器發(fā)送信號(hào)指令，使其接受位置信號(hào)?？刂破鲿?huì)把人類所要求的作業(yè)命令記錄起來，通過開始質(zhì)量那個(gè)讓其激活，再把必要的動(dòng)作指令傳送給手腕和腿部位。 (6)操作機(jī)構(gòu)的驅(qū)動(dòng)源 操作機(jī)構(gòu)的驅(qū)動(dòng)源主要有液壓式、電動(dòng)式和啟動(dòng)式。 3 兩足行走機(jī)器人的特性體現(xiàn) (1)兩足行走機(jī)器人能適應(yīng)各種地面且具有較高的逾越障礙的能力，能夠方便的上下臺(tái)階及通過不平整、不規(guī)則或較窄的路面，它的移動(dòng)“盲區(qū)”很小。 (2) 兩足行走機(jī)器人的能耗很小，因?yàn)樵摍C(jī)器人可具有獨(dú)立的能源裝置，因此在設(shè)計(jì)時(shí)就應(yīng)充分考慮其能耗問題。機(jī)器人力學(xué)計(jì)算也表明，足式機(jī)器人的能耗通常低于輪式和履帶式[7～9]。 (3) 兩足行走機(jī)器人具有廣闊的工作空間。由于行走系統(tǒng)的占地面積小，而活動(dòng)范圍很大，所以為其配置的機(jī)械手提供了更大的活動(dòng)空間，同時(shí)也可使機(jī)械手臂設(shè)計(jì)得較為短小緊湊。 (4)兩足行走是生物界難度最高的步行動(dòng)作。但其步行性能卻是其它步行結(jié)構(gòu)所無法比擬的。所以，仿人機(jī)器人的研制勢(shì)必要求并促進(jìn)機(jī)器人結(jié)構(gòu)的革命性的變化同時(shí)有力推進(jìn)機(jī)器人學(xué)及其它相關(guān)學(xué)科的發(fā)展[12]。 兩足機(jī)器人對(duì)機(jī)器人的機(jī)械結(jié)構(gòu)及驅(qū)動(dòng)裝置提出了許多特殊要求，這將導(dǎo)致傳統(tǒng)機(jī)械的重大變革。兩足機(jī)器人是工程上少有的高階、非線性、非完整約束的多自由度系統(tǒng)。這對(duì)機(jī)器人的運(yùn)動(dòng)學(xué)、動(dòng)力學(xué)及控制理論的研究提供了一個(gè)非常理想的實(shí)驗(yàn)平臺(tái)。在對(duì)其研究的過程中很可能導(dǎo)致力學(xué)及控制領(lǐng)域中新理論、新方法的產(chǎn)生，另外，仿兩足機(jī)器人的研究還可以推動(dòng)仿生學(xué)、人工智能、計(jì)算機(jī)圖形、通信等相關(guān)學(xué)科的發(fā)展。因此，兩足步行機(jī)器人的研制具有十分重大的價(jià)值和意義。 4 兩足行走機(jī)器人的研制展望 兩足行走機(jī)器人與輪式、履帶式機(jī)器人相比有許多突出的優(yōu)點(diǎn)和它們無法比擬的優(yōu)越性。但是由于受到機(jī)構(gòu)學(xué)、材料科學(xué)、計(jì)算機(jī)技術(shù)、控制技術(shù)、微電子學(xué)、通訊技術(shù)、傳感技術(shù)、人工智能、數(shù)學(xué)方法、仿生學(xué)等相關(guān)學(xué)科發(fā)展的制約。至今基本上仍處于實(shí)驗(yàn)室研制的階段，尤其是雙足行走的速度、穩(wěn)定性及自適應(yīng)能力仍不是十分理想。只有在走穩(wěn)走好之后再加上臂部執(zhí)行機(jī)構(gòu)和智能結(jié)構(gòu)，才談得上真正的仿人[12]。當(dāng)然，仿人不能僅僅局限于這些。還應(yīng)該模仿人類的視覺、觸覺、語言，甚至情感等功能。仿人機(jī)器人是許多技術(shù)的綜合、集成和提高。目前，主要的攻關(guān)項(xiàng)目還是行走功能的進(jìn)一步提高。日本本田公司生產(chǎn)的仿人機(jī)器人雖已走向市場(chǎng)化。但是，它的功能還很有限，離實(shí)際意義上的擬人化還有相當(dāng)?shù)囊欢尉嚯x，所以仿人機(jī)器人給科研工作者提供了廣闊的研究空間，提出了一個(gè)又一個(gè)新的挑戰(zhàn)!同時(shí)也促進(jìn)了許多相關(guān)學(xué)科的發(fā)展，導(dǎo)致了一些新理論，新方法的出現(xiàn)。越來越多的科研工作者投入了這一新興的前沿學(xué)科。 5 總結(jié) 兩足步行是步行方式中自動(dòng)化程度最高、最為復(fù)雜的動(dòng)態(tài)系統(tǒng)[13]。兩足步行系統(tǒng)具有非常豐富的動(dòng)力學(xué)特性，對(duì)步行的環(huán)境要求很低，既能在平地上行走，也能在非結(jié)構(gòu)性的復(fù)雜地面上行走，對(duì)環(huán)境有很好的適應(yīng)性。與其它足式機(jī)器人相比，雙足機(jī)器人具有支撐面積小，支撐面的形狀隨時(shí)間變化較大，質(zhì)心的相對(duì)位置高的特點(diǎn)。是其中最復(fù)雜，控制難度最大的動(dòng)態(tài)系統(tǒng)。但由于雙足機(jī)器人比其它足式機(jī)器人具有更高的靈活性，因此具有自身獨(dú)特的優(yōu)勢(shì)，更適合在人類的生活或工作環(huán)境中與人類協(xié)同工作，而不需要專門為其對(duì)這些環(huán)境進(jìn)行大規(guī)模改造。例如代替危險(xiǎn)作業(yè)環(huán)境中(如核電站內(nèi))的工作人員，在不平整地面上搬運(yùn)貨物等等。此外將來社會(huì)環(huán)境的變化使得雙足機(jī)器人在護(hù)理老人、康復(fù)醫(yī)學(xué)以及一般家務(wù)處理等方面也有很大的潛力。 參 考 文 獻(xiàn) [1] 馬香峰. 機(jī)器人機(jī)構(gòu)學(xué)[M]. 北京: 機(jī)械工業(yè)出版社, 1991. [2] 王曉明．電動(dòng)機(jī)的單片機(jī)控制．北京航空航天大學(xué)出版社，2003. [3] 吳瑞祥. 機(jī)器人技術(shù)及應(yīng)用[M]. 北京：北京航空航天大學(xué)出版社，1994. [4] 熊有倫. 機(jī)器人技術(shù)基礎(chǔ)[M].武漢：華中理工大學(xué)出版社，1996. [5] 王志良. 競(jìng)賽機(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. Mallet. Robotics: A User-Friendly Introduction [M]. New York: CBS College Publishing, 1985. [10] Yore Koran. Robotics for Engineers [M].McGraw-Hill Book Company, 1985. [11] 張建民. 機(jī)電一體化原理與應(yīng)用[M]．國防科技大學(xué)出版社，1992.1 [12] 曲家騏. 伺服控制系統(tǒng)中的傳感器[M]．北京：機(jī)械工業(yè)出版社，1998. [13] 秦志強(qiáng). 基礎(chǔ)機(jī)器人制作與編程[M]. 北京： 電子工業(yè)出版社，2007. [14] 高鐘毓. 機(jī)電一體化系統(tǒng)設(shè)計(jì)[M]．北京：機(jī)械工業(yè)出版社，1997.2 [15] 陳繼榮. 智能電子創(chuàng)新制作[M]. 北京：科技出版社，2007. [16] 張建民．機(jī)電一體化系統(tǒng)設(shè)計(jì)[M]．北京：北京理工大學(xué)出版社，1997. 畢 業(yè) 設(shè) 計(jì)（論 文）開 題 報(bào) 告 ２．本課題要研究或解決的問題和擬采用的研究手段（途徑）： 1 課題目的與預(yù)期目標(biāo) 微機(jī)原理及接口技術(shù)在各科領(lǐng)域有很廣泛的應(yīng)用，通過該課題的研究使學(xué)生掌握微機(jī)在控制系統(tǒng)中的應(yīng)用方法，行走電路的設(shè)計(jì)、對(duì)電動(dòng)機(jī)驅(qū)動(dòng)與控制設(shè)計(jì)。同時(shí)使學(xué)生掌握工程設(shè)計(jì)的一般方法以及獨(dú)立分析問題和解決問題的能力，最終使學(xué)生的綜合素質(zhì)得以提高。 2主要研究的問題 (1) 設(shè)計(jì)了兩足步行機(jī)器人的硬件電路 選用高性能、低功耗的 8 位AVR微處理器，指令執(zhí)行時(shí)間為單個(gè)時(shí)鐘周期，速度快，控制精度高、I/O口驅(qū)動(dòng)能力更強(qiáng)，優(yōu)于AT51、STC51系列單片機(jī)。 (2) 選擇設(shè)計(jì)了兩足步行機(jī)器人的控制軟件系統(tǒng) 在操作系統(tǒng)下設(shè)計(jì)了應(yīng)用程序，實(shí)現(xiàn)了兩足機(jī)器人控制系統(tǒng)的各項(xiàng)功能，搭建了完整的兩足機(jī)器人控制系統(tǒng)軟件框架 (3) 搭建了17自由度機(jī)器人雙腿的運(yùn)動(dòng)模式 靜態(tài)步行模式分為10個(gè)靜態(tài)姿勢(shì)及其切換順序如圖2所示。 圖2 兩足機(jī)器人行走步行模式 畢 業(yè) 設(shè) 計(jì)（論 文）開 題 報(bào) 告 指導(dǎo)教師意見： 1．對(duì)“文獻(xiàn)綜述”的評(píng)語： 該生的文獻(xiàn)綜述結(jié)合所要研究地課題比較緊密，從文中可以看出該生對(duì)所要做地工作進(jìn)行了較深入地學(xué)習(xí)。 2．對(duì)本課題的深度、廣度及工作量的意見和對(duì)設(shè)計(jì)（論文）結(jié)果的預(yù)測(cè)： 本課題要做什么步驟敘述很清楚，設(shè)計(jì)思路正確，工作量合理，預(yù)計(jì)該生能順利并很好地完成該課題。 指導(dǎo)教師： 年 月 日 所在專業(yè)審查意見： 負(fù)責(zé)人： 年 月 日 總結(jié) 畢業(yè)設(shè)計(jì)已經(jīng)結(jié)束，兩足機(jī)器人這個(gè)課題給我們留下了很深刻的印象，通過這么幾個(gè)月的設(shè)計(jì)工作，又兩足機(jī)器人的結(jié)構(gòu)設(shè)計(jì)到控制器系統(tǒng)的設(shè)計(jì)，我們對(duì)機(jī)器人這個(gè)項(xiàng)目有了一定的了解。兩足步行機(jī)器人是指可以使用兩只腳交替地抬起和放下，以適當(dāng)?shù)牟椒ミ\(yùn)動(dòng)的機(jī)器人，可分為擬人機(jī)器人和桌面型兩足機(jī)器人。對(duì)于兩足機(jī)器人的發(fā)展，主要是由少自由度到多自由度這樣的一個(gè)發(fā)展歷程，我們?cè)谶@個(gè)設(shè)計(jì)中設(shè)計(jì)的是一款17自由度的機(jī)器人，通過我們的理論設(shè)計(jì)，可以完成兩足交替行走和平移等一些簡(jiǎn)單的動(dòng)作。但是在設(shè)計(jì)的最后，我們發(fā)現(xiàn)了很多問題，由于我們的技術(shù)，時(shí)間等客觀問題，機(jī)器人沒能走動(dòng)起來，所以我總結(jié)了一些見解： 1．17自由度機(jī)器人選擇對(duì)于我們來說，具有較大的難度，可以選擇一些低自由度機(jī)器人的設(shè)計(jì)，比如腿部，由原來10個(gè)舵機(jī)減少到6個(gè)。 2．設(shè)計(jì)合適的控制硬件和軟件系統(tǒng)，可以參考這個(gè)買的舵機(jī)控制器，了解PWM的原理和如何產(chǎn)生極其調(diào)控方式。 3．對(duì)于控制軟件，可以C語言或者匯編語言進(jìn)行編程，然后在燒錄到單片機(jī)中。 4．機(jī)器人使用更為先進(jìn)的處理器，如的ARM系列處理器。 5．本課題難度較大，選擇此課題者，請(qǐng)視能力而為之。 目 錄 1 緒論…………………………………………………………………………………1 1.1 課題的研究背景和意義…………………………………………………………1 1.2 國內(nèi)外研究現(xiàn)狀…………………………………………………………………2 1.3 本文的主要工作…………………………………………………………………4 1.4 本文組織結(jié)構(gòu)……………………………………………………………………5 2 兩足步行機(jī)器人控制系統(tǒng)硬件設(shè)計(jì)與實(shí)現(xiàn)………………………………………6 2.1 硬件系統(tǒng)的基本要求……………………………………………………………6 2.2 硬件系統(tǒng)設(shè)計(jì)的技術(shù)路線和總體方案…………………………………………7 2.3 舵機(jī)控制器的使用方法…………………………………………………………13 3 兩足步行機(jī)器人控制系統(tǒng)軟件設(shè)計(jì)………………………………………………15 3.1 軟件系統(tǒng)的基本要求……………………………………………………………15 3.2 軟件設(shè)計(jì)的技術(shù)路線與總體方案………………………………………………16 3.3 伺服電機(jī)控制軟件操作方法……………………………………………………17 3.4 微型伺服電機(jī)（舵機(jī)）的選擇………………………………………………20 4 兩足步行機(jī)器人步行模式的建立…………………………………………………22 4.1 本章任務(wù)…………………………………………………………………………22 4.2 靜態(tài)步行模式設(shè)計(jì)與實(shí)現(xiàn)………………………………………………………23 4.3 姿態(tài)運(yùn)動(dòng)的軟件實(shí)現(xiàn)……………………………………………………………24 結(jié)束語……………………………………………………………………………………26 致謝………………………………………………………………………………………27 參考文獻(xiàn)…………………………………………………………………………………28 XXXXXX XXX設(shè)計(jì)（X）選題、審題表 系　　部 指導(dǎo) 教師 姓 名 專業(yè)技術(shù)職 務(wù) 課題名稱 兩足行走機(jī)器人——行走控制部分設(shè)計(jì) 適用專業(yè) 機(jī)械工程及自動(dòng)化 課題性質(zhì) A B C D E 課題來源 A B C D √ √ 課題預(yù)計(jì) 工作量大小 大 適中 小 課題預(yù)計(jì) 難易程度 難 適中 易 √ √ 課題簡(jiǎn)介 本課題源于“第一屆全國大學(xué)生機(jī)械創(chuàng)新設(shè)計(jì)大賽”中兩足行走機(jī)器人。目前，機(jī)器人大多以輪子的形式實(shí)現(xiàn)行走功能階段。真正模仿人類用腿走路的機(jī)器人還不多，雖有一些六足、四足機(jī)器人涌現(xiàn)，但是兩足機(jī)器人還是鳳毛麟角。在機(jī)器人研究領(lǐng)域處于國際領(lǐng)先水平的日本，推出了諸如舞蹈機(jī)器人等雙足行走機(jī)器人，但成千上萬的傳感器和復(fù)雜的控制系統(tǒng)使這類機(jī)器人造價(jià)非常昂貴。我們這個(gè)課題，探索設(shè)計(jì)僅靠巧妙的機(jī)械裝置和簡(jiǎn)單的控制系統(tǒng)就能實(shí)現(xiàn)模擬人類行走的機(jī)器人。其分功能有：交替邁腿、搖頭、擺大臂、擺小臂。 課題應(yīng)完成的任務(wù)和對(duì)學(xué)生的要求 1、課題調(diào)研、查閱資料，撰寫開題報(bào)告及外文翻譯； 2、總體方案論證及選擇； 3、完成機(jī)器人交替邁腿的控制部分設(shè)計(jì)； 4、撰寫設(shè)計(jì)說明書。 所在專業(yè)審定意見： 專業(yè)負(fù)責(zé)人(簽名)： 年 月 日 注：本課題由 同學(xué)選定，學(xué)號(hào)： 注：1．該表由指導(dǎo)教師填寫，經(jīng)所在專業(yè)負(fù)責(zé)人簽名后生效，作為該專業(yè)學(xué)生畢業(yè)設(shè)計(jì)（論文）選題使用； 2．有關(guān)內(nèi)容的填寫見背面的填表說明，并在表中相應(yīng)欄內(nèi)打“√”； 3．課題一旦被學(xué)生選定，此表須放在學(xué)生“畢業(yè)設(shè)計(jì)（論文）資料袋”中存檔。  XX設(shè)計(jì)說明書（X）中文摘要 兩足步行機(jī)器人不僅在教學(xué)、比賽和娛樂等方面應(yīng)用廣泛，并且也可以作為兩足步行研究的平臺(tái)。本文在“KONDO”兩足步行機(jī)器人的機(jī)械結(jié)構(gòu)的基礎(chǔ)上，設(shè)計(jì)了基于AVR處理器的兩足步行機(jī)器人控制系統(tǒng)，包括硬軟件設(shè)計(jì)及其實(shí)現(xiàn)；設(shè)計(jì)了兩足步行機(jī)器人的步行模式，實(shí)現(xiàn)了在平面上的穩(wěn)定步行。在硬件電路的處理器中，移植了u C/OS-II操作系統(tǒng)，實(shí)現(xiàn)了兩足步行機(jī)器人控制系統(tǒng)的各項(xiàng)功能，建立了完整的兩足步行機(jī)器人控制系統(tǒng)軟件框架；改進(jìn)了通常的多路PWM信號(hào)產(chǎn)生方法，使控制信號(hào)的精度達(dá)到了lus以上，解決了由于中斷嵌套影響控制信號(hào)精度，從而引發(fā)機(jī)器人抖動(dòng)的問題；并對(duì)機(jī)器人進(jìn)行了關(guān)節(jié)調(diào)試。 關(guān)鍵詞 機(jī)器人 處理器 操作系統(tǒng) XX設(shè)計(jì)說明書（XX）外文摘要 Title The Biped Walking Robot Designs Abstract The Biped walking desktop-robot is not only applied widely in teaching, competitions and entertainments, but also treated as a research tool of biped walking. In this thesis, a control system for biped walking desktop-robot is designed, which is based on AVR, and works well in the mechanism of the KONDO biped walking desktop-robot. A walking astern for the biped robot is presented, and the robot can walk stably on the flat. The open-code operating system, uC/OS-II is explanted to the processor of the circuit. Under the operating system, several tasks and interrupt service routines are resigned to accomplish the functions of the control system for the biped working boot. The frame of software is completed, which is for the control system for biped asking desktop-robot. A improved method of producing multiple PWM signals is resented, and the precision of the control signal can be improved to 111 s, and the problem that the robot shakes because of the interrupt-nesting is solved. A test to the articulations of the robot is done. Keywords Robot Processor Control System 目 錄 1 緒論…………………………………………………………………………………1 1.1 課題的研究背景和意義…………………………………………………………1 1.2 國內(nèi)外研究現(xiàn)狀…………………………………………………………………2 1.3 本文的主要工作…………………………………………………………………4 1.4 本文組織結(jié)構(gòu)……………………………………………………………………5 2 兩足步行機(jī)器人控制系統(tǒng)硬件設(shè)計(jì)與實(shí)現(xiàn)………………………………………6 2.1 硬件系統(tǒng)的基本要求……………………………………………………………6 2.2 硬件系統(tǒng)設(shè)計(jì)的技術(shù)路線和總體方案…………………………………………7 2.3 舵機(jī)控制器的使用方法…………………………………………………………13 3 兩足步行機(jī)器人控制系統(tǒng)軟件設(shè)計(jì)………………………………………………15 3.1 軟件系統(tǒng)的基本要求……………………………………………………………15 3.2 軟件設(shè)計(jì)的技術(shù)路線與總體方案………………………………………………16 3.3 伺服電機(jī)控制軟件操作方法……………………………………………………17 3.4 微型伺服電機(jī)（舵機(jī)）的選擇………………………………………………20 4 兩足步行機(jī)器人步行模式的建立…………………………………………………22 4.1 本章任務(wù)…………………………………………………………………………22 4.2 靜態(tài)步行模式設(shè)計(jì)與實(shí)現(xiàn)………………………………………………………23 4.3 姿態(tài)運(yùn)動(dòng)的軟件實(shí)現(xiàn)……………………………………………………………24 結(jié)束語……………………………………………………………………………………26 致謝………………………………………………………………………………………27 參考文獻(xiàn)…………………………………………………………………………………28 1 緒論 兩足步行機(jī)器人是指可以使用兩只腳交替地抬起和放下，以適當(dāng)?shù)牟椒ミ\(yùn)動(dòng)的機(jī)器人，可分為擬人機(jī)器人和桌面型兩足機(jī)器人 (仿人機(jī)器人)大小和人相似，不僅具有擬人的步行功能，而且通常還具有視覺、語音、觸覺等一系列擬人的功能；桌面型兩足機(jī)器人通常指體積較小，只具有步行功能及其他少數(shù)特定功能的兩足機(jī)器人，例如具有步行功能和視覺功能的自主踢足球機(jī)器人。與擬人機(jī)器人相比，桌面型兩足步行機(jī)器人的成本較低，除了具有科研性外，還具有廣泛地娛樂性，也可以應(yīng)用在教學(xué)和比賽中。國內(nèi)外的機(jī)器人大賽中，常常可以看到桌面型兩足步行機(jī)器人的身影[1]。 1.1 課題的研究背景和意義 于兩足步行機(jī)器人的擬人性和對(duì)環(huán)境良好的適應(yīng)性等特點(diǎn)，受到各國政府和研究者的廣泛重視，是當(dāng)今世界的高新技術(shù)的代表之一。它在科研、教學(xué)、比賽和娛樂等方面都很到了很好的應(yīng)用。 江蘇省大學(xué)生機(jī)器人大賽和全國大學(xué)生機(jī)器人大賽中經(jīng)常有兩足步行機(jī)器人，它可以參加舞蹈機(jī)器人比賽、兩足競(jìng)走機(jī)器人比賽、Robocop類人組機(jī)器人踢足球[10]器人創(chuàng)新比賽、Robocop救援組比賽等。舞蹈機(jī)器人比賽時(shí)使用了日本“KONDO”兩足步行機(jī)器人，性能出眾，發(fā)揮穩(wěn)定，獲得了舞蹈機(jī)器人比賽的冠軍。但是該機(jī)器人是集成度很高的商業(yè)產(chǎn)品，它的控制系統(tǒng)不開放底層代碼，難以進(jìn)行二次開發(fā)和步態(tài)研究。 所以本文基于機(jī)器人控制系統(tǒng)中常用的眾多處理器和操作系統(tǒng)各自的特點(diǎn)，并結(jié)合“KONDO”機(jī)器人機(jī)械結(jié)構(gòu)的特性，選用了高性能、低功耗的 8 位AVR? 微處理器內(nèi)核處理器ATMega8P來實(shí)現(xiàn)對(duì)機(jī)器人的控制來。設(shè)計(jì)的控制系統(tǒng)控制指令精簡(jiǎn)，控制轉(zhuǎn)角精度高，波特率可以實(shí)時(shí)更改，體積小，重量輕，其可作為類人型機(jī)器人、仿生機(jī)器人、多自由度機(jī)械手的主控制器。隨著中國機(jī)械產(chǎn)業(yè)的不斷進(jìn)步，各高校相繼開設(shè)機(jī)械類創(chuàng)新課程和比賽，學(xué)生可將其應(yīng)用在各類機(jī)械創(chuàng)新作品中，優(yōu)化控制系統(tǒng)參加比賽。日本“KONDO”機(jī)器人如圖1.1所示。 圖1.1 日本“KONDO”跳舞機(jī)器人 1.2 國內(nèi)外研究現(xiàn)狀 步行是人與大多數(shù)動(dòng)物所具有的移動(dòng)方式，其中兩足直立行走是人類特有的步行方式，是所有步行方式中自動(dòng)化程度最高，最為復(fù)雜的動(dòng)態(tài)系統(tǒng)。最早從工程角度研究雙足機(jī)器人并獲得成功的是早稻田大學(xué)的加藤一郎。1972年，加藤實(shí)驗(yàn)室推出了wL-5雙足步行機(jī)器人，這是世界上第一臺(tái)雙足機(jī)器人。 1996年11月本田((HONDA)公司展示了一個(gè)有兩腿兩臂的仿人[2]型機(jī)器人P2,能在平地上行走、轉(zhuǎn)彎、上下樓梯和跨越障礙，并可提5公斤的重物和使用扳手等簡(jiǎn)單工作;在此基礎(chǔ)上，本田公司又連續(xù)開發(fā)了第二代仿人機(jī)器人P3，第三代仿人機(jī)器人Asimo, Asimo高120cm，行走質(zhì)量很高，非常接近人類。Sony公司也推出了能歌善舞的機(jī)器人Qrio，不但具有非常出色的步行穩(wěn)定性，而且具有很強(qiáng)的自行辨認(rèn)能力，甚至能在狹隘道路上行走并繞過障礙物。這兩個(gè)機(jī)器人代表了當(dāng)前世界上兩足步行機(jī)器人研制的最高水平。 Asimo和Qrio都是擬人機(jī)器人，它們除了具有兩足步行功能之外，還具有非常強(qiáng)大的視覺功能和語音功能，能辨認(rèn)很多目標(biāo)，并能和人進(jìn)行很好的語言及肢體交流。而桌面型的兩足機(jī)器人也一直受到研究者的重視，研究的重點(diǎn)是兩足步行功能。如圖1.2所示。 圖1.2 Asimo(左)和Sony的Qrio(右) 2006年，日本神奈川大學(xué)設(shè)計(jì)的WABIAN-2LL機(jī)器人，身高120cm，重40Kg,在步行中通過膝關(guān)節(jié)改變腿長(zhǎng)，通過腰關(guān)節(jié)的運(yùn)動(dòng)來減少腿部運(yùn)動(dòng)對(duì)身體重心的影響。2007年，大阪大學(xué)的Koh Hosoda等人研究了人類行走過程中的腿、腰、頭、手臂等各部分的協(xié)同作用，在兩足機(jī)器人中引入了三維極限環(huán)協(xié)同理論，設(shè)計(jì)的機(jī)器人Pneumat-BT[6]，[7]。 隨著集成電路的發(fā)展，小型機(jī)器人可以具有功能越來越強(qiáng)大的嵌入式計(jì)算系統(tǒng)，甚至可以使用運(yùn)算能力很強(qiáng)的圖像處理和模式識(shí)別系統(tǒng)。這使得桌面型兩足步行機(jī)器人和擬人機(jī)器人之間并沒有嚴(yán)格的區(qū)分標(biāo)準(zhǔn)。2007年，東京Denki大南京師范大學(xué)碩士學(xué)位論文學(xué)的Hideto SHIMIZU等人設(shè)計(jì)了小型兩足步行機(jī)器人HOAP-3，身高60cm，重8. 8Kg，共有28個(gè)自由度，有一個(gè)強(qiáng)大的視覺處理系統(tǒng)。如圖1.3所示。 圖1.3 WABIAN-2LL(左)、Pneumat-BT(中)和HOAP-3(右) 2006年，西班牙Politecnica de Valencia大學(xué)的Albero和Blanes等人設(shè)計(jì)了具有高性能分布式控制系統(tǒng)的桌面型兩足機(jī)器人YABIRO，高55cm，重4Kg，共27個(gè)自由度，具有獨(dú)特的腰部三自由度結(jié)構(gòu)，如圖所示。該機(jī)器人使用了多個(gè)嵌入式系統(tǒng)，主控制系統(tǒng)使用了嵌入式個(gè)人計(jì)算機(jī)和實(shí)時(shí)Linux操作系統(tǒng)，具有非常強(qiáng)大的數(shù)據(jù)處理能力；主、從控制系統(tǒng)以及傳感器之間使用dual-CAN總線通信。 2006年，韓國國立釜山大學(xué)開發(fā)了腳底安裝有力傳感器的桌面型兩足機(jī)器人，該機(jī)器人身高28cm，重3.2Kg，如圖所示。同年，韓國Sung KyunKwan大學(xué)也開發(fā)了一個(gè)桌面型兩足步行機(jī)器人，身高45cm，重4.3Kg，共24個(gè)自由度，如圖所示。該機(jī)器人使用了TI公司的DSP TMS320F2407作為控制器，使用直流無刷電機(jī)作為驅(qū)動(dòng)器，在兩足步態(tài)設(shè)計(jì)中引入了遺傳算法。如圖1.4所示。 圖1.4 YABIRO-2（左）、釜山大學(xué)機(jī)器人和Sung Kuhn Kwan 大學(xué)機(jī)器人（右） 我國從80年代中期才開始研究?jī)勺悴叫袡C(jī)器人[20，21] ，國防科技大學(xué)1988年研制成功我國第一臺(tái)平面型六自由度的兩足機(jī)器人，能實(shí)現(xiàn)前進(jìn)、后退和上下樓梯；之后又現(xiàn)了實(shí)驗(yàn)室環(huán)境中的全方位行走，1995年，實(shí)現(xiàn)了動(dòng)態(tài)步行。 2000年11月，國防科技大學(xué)又研制出了我國第一臺(tái)具有人類外觀特征、可以模擬人類行走與基本操作功能的擬人兩足步行機(jī)器人Pioneero。 2002年，清華大學(xué)精密儀器系、機(jī)械工程系和自動(dòng)化系組成的研究小組開始研究開發(fā)擬人機(jī)器人THBIP，共32個(gè)自由度，可以步行、上下樓梯、打太極拳等，并具有視覺及語音識(shí)別功能[3]。 兩足機(jī)器人的研制發(fā)展過程，是由少自由度到多自由度、由實(shí)現(xiàn)簡(jiǎn)單動(dòng)作到復(fù)雜動(dòng)作、由靜態(tài)步行到動(dòng)態(tài)步行、由僅從簡(jiǎn)單功能到仿生功能的研制過程。 1.3 本文的主要工作 本文設(shè)計(jì)的主要內(nèi)容是兩足行走機(jī)器人的行走控制系統(tǒng)部分，我選用8 位AVR 微處理器內(nèi)核處理器ATMega8P，設(shè)計(jì)了兩足行走機(jī)器人的控制系統(tǒng)。主要工作包括： (1) 設(shè)計(jì)了兩足步行機(jī)器人的硬件電路。選用高性能、低功耗的 8 位AVR微處理器，指令執(zhí)行時(shí)間為單個(gè)時(shí)鐘周期，速度快，控制精度高、I/O口驅(qū)動(dòng)能力更強(qiáng)，優(yōu)于AT51、STC51系列單片機(jī)。 (2) 選擇設(shè)計(jì)了兩足步行機(jī)器人的控制軟件系統(tǒng)。在AVR微處理器中移植了u C/OS-II操作系統(tǒng)；在操作系統(tǒng)下設(shè)計(jì)了應(yīng)用程序，實(shí)現(xiàn)了兩足機(jī)器人控制系統(tǒng)的各項(xiàng)功能，搭建了完整的兩足機(jī)器人控制系統(tǒng)軟件框架[12]，[13]。 (3) 搭建了17自由度機(jī)器人雙腿的運(yùn)動(dòng)模式，通過17個(gè)舵機(jī)同時(shí)協(xié)調(diào)運(yùn)作，以實(shí)現(xiàn)機(jī)器人完成相應(yīng)的動(dòng)作。 (4) 完成畢業(yè)設(shè)計(jì)的同時(shí)，提出本設(shè)計(jì)的不足，指出需要改進(jìn)的地方。 1.4 本文組織結(jié)構(gòu) 第一章介紹了兩足步行機(jī)器人的國內(nèi)外研究現(xiàn)狀 [26] ，由別人設(shè)計(jì)的機(jī)器人總結(jié)對(duì)自己的啟發(fā)提出本設(shè)計(jì)的主要任務(wù)點(diǎn)。 第二章介紹了控制系統(tǒng)中常用的處理器和操作系統(tǒng)、以及兩足步行機(jī)器人的機(jī)械結(jié)構(gòu)，并說明了本文設(shè)計(jì)兩足步行機(jī)器人控制系統(tǒng)的目的。使用Prote199設(shè)計(jì)了兩足步行機(jī)器人控制系統(tǒng)的硬件，包括核心電路圖和PWM脈沖信號(hào)控制原理圖。 第三章介紹了使用實(shí)現(xiàn)機(jī)器人控制系統(tǒng)的具體軟件，這里我們使用了Servo Control Software,是實(shí)現(xiàn)伺服電機(jī)控制器通訊協(xié)議PC機(jī)上專用WINDOWS控制軟件，可以簡(jiǎn)便的實(shí)現(xiàn)復(fù)雜動(dòng)作的操控。 第四章建立兩足步行機(jī)器人步行模式建立，對(duì)機(jī)器人的雙腿運(yùn)動(dòng)進(jìn)行了分析，對(duì)10個(gè)微型伺服直流電機(jī)的轉(zhuǎn)角角度進(jìn)行了逐個(gè)分析。 第五章對(duì)本文的工作進(jìn)行了總結(jié)，并對(duì)今后的深入研究提出了建議。 2 兩足步行機(jī)器人控制系統(tǒng)硬件設(shè)計(jì)與實(shí)現(xiàn) 在以比賽、娛樂、教學(xué)和研究為目的的兩足步行機(jī)器人控制系統(tǒng)中，單板計(jì)算機(jī)作為控制系統(tǒng)雖然運(yùn)算速度快，但體積大、成本高，而且功耗大；有此而選用高性能、低功耗的 8 位AVR? 微處理器，指令執(zhí)行時(shí)間為單個(gè)時(shí)鐘周期，速度快，控制精度高、I/O口驅(qū)動(dòng)能力更強(qiáng)，優(yōu)于AT51、STC51系列單片機(jī)，所以能夠解決一些較為復(fù)雜的控制指令。 2.1 硬件系統(tǒng)的基本要求 兩足步行機(jī)器人是對(duì)人類的模仿[15]。但人類的結(jié)構(gòu)極其復(fù)雜，對(duì)人類步行原理的研究至今仍有許多未解決的問題。所以在設(shè)計(jì)兩足步行機(jī)器人機(jī)械結(jié)構(gòu)時(shí)，會(huì)對(duì)人類步行的結(jié)構(gòu)進(jìn)行減化，只會(huì)考慮基本的步行功能。人類的僅下肢就具有62對(duì)肌肉，腰部8對(duì)肌肉，在設(shè)計(jì)兩足步行機(jī)器人時(shí)，要控制具有這么多自由度的多變量系統(tǒng)幾乎是不可能的事情，所以兩足步行機(jī)器人通常腿部只具有8至12個(gè)自由度，腰部具有0至3個(gè)自由度。本課題設(shè)計(jì)的機(jī)器人共有17個(gè)自由度，驅(qū)動(dòng)器為微型直流伺服電機(jī)，簡(jiǎn)稱舵機(jī)。其機(jī)械結(jié)構(gòu)如圖2.1所示。 圖2.1 機(jī)器人機(jī)械實(shí)物 該機(jī)器人的機(jī)械結(jié)構(gòu)具有如下特點(diǎn)： (1) 該機(jī)器人的機(jī)械設(shè)計(jì)具有很高的穩(wěn)定性，國外的一些類似機(jī)器人曾獲得機(jī)器人比賽冠軍； (2) 該機(jī)器人踝關(guān)節(jié)和髖關(guān)節(jié)各具有兩個(gè)自由度，這種機(jī)械結(jié)構(gòu)設(shè)計(jì)可以使機(jī)器人在不平地面站立； (3) 該機(jī)器人膝關(guān)節(jié)具有一個(gè)自由度； (4) 該機(jī)器人肩關(guān)節(jié)具有兩個(gè)自由度，肘關(guān)節(jié)具有一個(gè)自由度，可以實(shí)現(xiàn)簡(jiǎn)單的擺臂功能，用以配合腿部的運(yùn)動(dòng)，抑制擺腿時(shí)產(chǎn)生的左右扭轉(zhuǎn)趨勢(shì)。 (5) 該機(jī)器人的機(jī)械結(jié)構(gòu)也具有一個(gè)缺點(diǎn):沒有腰部扭轉(zhuǎn)自由度，使兩足步行機(jī)器人在行走中不能使用腰部關(guān)節(jié)進(jìn)行姿態(tài)平衡，但這并不阻礙機(jī)器人在平地上的行走。 本文在“KONDO”機(jī)器人[9]機(jī)械結(jié)構(gòu)的基礎(chǔ)上，設(shè)計(jì)控制系統(tǒng)，用來替換其自帶的控制系統(tǒng)。本文設(shè)計(jì)的控制系統(tǒng)在硬件上至少滿足如下5個(gè)基本要求： (1) 產(chǎn)生不少于17路獨(dú)立的高精度單邊沿PWM信號(hào)，用來控制作為機(jī)器人關(guān)節(jié)驅(qū)動(dòng)器的17個(gè)直流伺服電機(jī)； (2) 具有調(diào)試接口； (3) 具有一個(gè)與PC機(jī)通信的接口； (4) 具有多路A/D轉(zhuǎn)換電路，用來擴(kuò)展傳感器； (5) 具有獨(dú)立而穩(wěn)定的電源。 我們?cè)O(shè)計(jì)的機(jī)器人所用的高精度直流伺服電機(jī)，控制信號(hào)為0.5ms～2.5ms高電平的PWM信號(hào)，對(duì)應(yīng)轉(zhuǎn)角為0度到180度，電機(jī)精度為0.1度，則控制信號(hào)的精度應(yīng)該高于(2.5ms～0.5ms) /1800 =1.11μs。 2.2 硬件系統(tǒng)設(shè)計(jì)的技術(shù)路線和總體方案 2.2.1 處理器選型 二十年前，只有少數(shù)的幾個(gè)科研機(jī)構(gòu)在研究?jī)勺悴叫袡C(jī)器人，現(xiàn)在卻不勝枚舉，這其中很重要的一個(gè)原因就是嵌入式計(jì)算機(jī)的高速發(fā)展[24]，[25]。嵌入式計(jì)算機(jī)由于其體積小、功耗低、硬件資源豐富，非常適合應(yīng)用在對(duì)體積和功耗都有較高要求的小型機(jī)器人系統(tǒng)中。 在機(jī)器人控制系統(tǒng)中常用的處理器有：TI C2000和C6000系列DSP、8051和AVR單片機(jī)、ARM7和ARM9系列、PC104和PowerPC單板計(jì)算機(jī)等。它們各自具有鮮明的特點(diǎn)，通常都是為了特殊的應(yīng)用而設(shè)計(jì)，如表2.1所示。 表2.1 機(jī)器人控制系統(tǒng)中常用處理器 機(jī)器人控制系統(tǒng)中常用的處理器 處理器的特點(diǎn) 在機(jī)器人控制系統(tǒng)中的應(yīng)用 C2000系列DSP 具有很強(qiáng)的數(shù)字信號(hào)處理能力,適合運(yùn)動(dòng)控制,硬件設(shè)計(jì)方便。 運(yùn)動(dòng)控制、語音處理。尤其適合執(zhí)行針對(duì)單個(gè)或一對(duì)直流（無刷）電機(jī)的復(fù)雜算法。 C6000系列DSP 具有極強(qiáng)的數(shù)字信號(hào)處理能力，具有專門的操作系統(tǒng)，硬件設(shè)計(jì)非常復(fù)雜。 高級(jí)的視覺處理和模式識(shí)別 8051和AVR系列單片機(jī) 結(jié)構(gòu)和指令簡(jiǎn)單;運(yùn)算能力較低，通常不支持操作系統(tǒng)：幾乎全部芯片都己經(jīng)單片化，硬件設(shè)計(jì)非常方便。 簡(jiǎn)單的運(yùn)動(dòng)控制和信號(hào)處理，在復(fù)雜的控制系統(tǒng)中作為局部控制器。 ARM7系列 典型的RISC處理器，運(yùn)算能力較強(qiáng)，支持多種操作系統(tǒng)：部分型號(hào)芯片己經(jīng)單片化，硬件設(shè)計(jì)較方便。 小型機(jī)器人主控制器，常用于運(yùn)動(dòng)控制和傳感器信號(hào)處理。 ARM9系列 典型的RISC處理器，運(yùn)算能力很強(qiáng)，支持多種操作系統(tǒng);幾乎沒有單片化，硬件設(shè)計(jì)較復(fù)雜。 機(jī)器人主控制器，同以進(jìn)行視覺處理、語音處理和模式識(shí)別。 PC104, PowerPC等單板計(jì)算機(jī) 由PC演化而來，通用性很強(qiáng)，功耗大，硬件設(shè)計(jì)非常復(fù)雜。 復(fù)雜的擬人機(jī)器人的主控制器。 DSP處理器在譜分析、FFT變換、數(shù)字濾波等方面得到非常廣泛地應(yīng)用。TI公司的02000系列DSP主要用來進(jìn)行運(yùn)動(dòng)控制，適合用于執(zhí)行針對(duì)單個(gè)或少量電機(jī)的高級(jí)控制算法。雖然C2000在桌面型兩足機(jī)器人中也有應(yīng)用，但C2000對(duì)操作系統(tǒng)的支持能力有限，一般不使用操作系統(tǒng)，所以如果作為主控制器會(huì)帶來軟件設(shè)計(jì)上的局限性。 C6000系列具有很高的主頻、豐富的硬件資源、特殊的系統(tǒng)結(jié)構(gòu)，數(shù)字信號(hào)處理能力非常強(qiáng)大，并且TI公司特地為C6000(和C5000)系列開發(fā)了專用DSP/BIOS操作系統(tǒng)。DSP/BIOS操作系統(tǒng)使C6000如虎添翼，成為了高級(jí)視覺處理應(yīng)用的主流處理器。但使用C6000作為處理器時(shí)電路復(fù)雜，通常只在大型擬人機(jī)器人中作為高級(jí)的視覺處理器，小型的機(jī)器人中應(yīng)用很少。 8051和AVR系列單片機(jī)通常在其內(nèi)部集成了CPU、存儲(chǔ)器、總線邏輯、看門狗、I/0、以及其他接口，單片化的特性使其體積和功耗都大大減小，在兩足步行機(jī)器人中得到了廣泛使用。 ARM7系列處理器是ARM處理器中使用很多的一款。ARM7處理器是典型的RISC處理器，對(duì)操作系統(tǒng)的支持能力很強(qiáng)，適合運(yùn)行多種操作系統(tǒng)。 ARM9系列處理器在ARM7的基礎(chǔ)上進(jìn)一步地提高了運(yùn)算能力，增加了更多的硬件資源。ARM9對(duì)操作系統(tǒng)的支持能力同樣地強(qiáng)大。ARM9適合作為兩足機(jī)器人控制系統(tǒng)的主控制器，同時(shí)還可以作視覺處理、語音處理和模式識(shí)別。但ARM9系列處理器幾乎沒有能實(shí)現(xiàn)單片化的，硬件設(shè)計(jì)較為復(fù)雜。 單板計(jì)算機(jī)由通用計(jì)算機(jī)演化而來，常見的有PC104、PowerPC、MIPS、68000等。單板計(jì)算機(jī)具有良好的通用性，對(duì)操作系統(tǒng)具有極強(qiáng)的支持能力。但其設(shè)計(jì)和開發(fā)比較復(fù)雜，功耗較大，在擬人機(jī)器人等大型機(jī)器人中經(jīng)常被用作主控制器。 本文結(jié)合控制系統(tǒng)設(shè)計(jì)的基本要求和常用處理器[19]，高性能、低功耗的 8 位AVR微處理器，指令執(zhí)行時(shí)間為單個(gè)時(shí)鐘周期，速度快，控制精度高、I/O口驅(qū)動(dòng)能力更強(qiáng)，優(yōu)于AT51、STC51系列單片機(jī)。 2.2.2 直流伺服電機(jī)的控制特性 直流伺服電機(jī)又稱為舵機(jī)，是一種位置伺服驅(qū)動(dòng)器，適用于角度不斷變化并可以保持的控制系統(tǒng)[22]。我們?cè)O(shè)計(jì)的兩足行走機(jī)器人的直流伺服電機(jī)使用+7V至+12V電源，內(nèi)部基準(zhǔn)信號(hào)為周期為20ms的PWM周期信號(hào)，輸入的控制信號(hào)也必須是周期為20ms的PWM周期信號(hào)，電壓為+4V至+6V。電機(jī)輸出轉(zhuǎn)角與輸入的控制信號(hào)的脈沖寬度有如圖2.2所示的線性關(guān)系。 圖2.2 直流伺服電機(jī)輸出轉(zhuǎn)角與輸入PWM信號(hào)寬度的關(guān)系 本文中的兩足步行機(jī)器人機(jī)械結(jié)構(gòu)共有17個(gè)直流伺服電機(jī)，所以在設(shè)計(jì)控制系統(tǒng)硬件電路時(shí)，除了需要提供9V至12V的電源外，還必須提供至少17路4V至6V的PWM信號(hào)。 2.2.3 硬件設(shè)計(jì)總體方案 對(duì)應(yīng)于控制系統(tǒng)硬件設(shè)計(jì)的基本要求，作了如下的設(shè)計(jì)方案: (1) 核心電路包括AVR[11]核心處理器、JTAG調(diào)試接口、串口驅(qū)動(dòng)電路和A/D轉(zhuǎn)換基準(zhǔn)電壓電路[19]，原理如圖2.3所示。 圖2.3 核心電路原理圖 (2) 控制系統(tǒng)需要控制17個(gè)直流伺服電機(jī)，使兩足步行機(jī)器人完成相應(yīng)的動(dòng)作。控制直流伺服電機(jī)的PWM信號(hào)的周期為20ms，高電平持續(xù)時(shí)間為0. 5ms至2. 5ms，占空比較小，最大僅為1/8，所以可以進(jìn)行多路分時(shí)復(fù)用。本文使用了4個(gè)三態(tài)鎖存器74HC595D PWM信號(hào)進(jìn)行4路分時(shí)復(fù)用，一共可以得到32路獨(dú)立的單邊沿PWM信號(hào)，這樣可以滿足控制系統(tǒng)的要求。使用高性能電池供電，增加了機(jī)器人的靈活性.其舵機(jī)PWM信號(hào)控制電路原理如圖2.4所示。 圖2.4 PWM信號(hào)控制原理圖 2.2.4 電源設(shè)計(jì) 為了增加機(jī)器人的靈活性，兩足步行機(jī)器人使用高性能電池供電。直流伺服電機(jī)的電源要求為9V至12V，本文選用了電壓為9V的高性能電池，直接作為直流伺服電機(jī)的電源。 由于基于AVR的處理器和外設(shè)均使用3. 3V電源電壓，所以需要選用電源電壓轉(zhuǎn)換器進(jìn)行電壓轉(zhuǎn)換。我們使用了一個(gè)直流電壓轉(zhuǎn)換芯片L78M05將電池的直流電源轉(zhuǎn)換為相應(yīng)的電流。 2.2.5 舵機(jī)控制器PCB電路板的設(shè)計(jì) 32路伺服電機(jī)控制器是一套最具性價(jià)比的伺服電機(jī)控制器?？梢钥刂贫噙_(dá)32個(gè)伺服電機(jī)協(xié)調(diào)動(dòng)作的軟硬件結(jié)合系統(tǒng)，它不但能實(shí)現(xiàn)位置控制和速度控制，還具有時(shí)間延時(shí)斷點(diǎn)發(fā)送指令功能。其主要由上位機(jī)軟件和伺服電機(jī)驅(qū)動(dòng)控制器組成。通過PC機(jī)操作上位機(jī)軟件給控制器傳遞控制指令信號(hào)，即可實(shí)現(xiàn)多路伺服電機(jī)單獨(dú)控制或同時(shí)控制，控制指令精簡(jiǎn)，控制轉(zhuǎn)角精度高，波特率可以實(shí)時(shí)更改，體積小，重量輕，其可作為類人型機(jī)器人、仿生機(jī)器人、多自由度機(jī)械手的主控制器。此外還可以配合其他功能模塊實(shí)現(xiàn)無線控制、傳感器反饋，構(gòu)建閉環(huán)控制系統(tǒng)。隨著國內(nèi)外機(jī)械產(chǎn)業(yè)的不斷進(jìn)步，各大高校相繼開設(shè)機(jī)械類創(chuàng)新課程和比賽[11]，學(xué)生可將其應(yīng)用在各類機(jī)械創(chuàng)新作品中，起到優(yōu)化控制系統(tǒng)作用，其電路板界面如圖2.5所示。 圖2.5 兩足行走機(jī)器人控制系統(tǒng)電路板 2.3 舵機(jī)控制器的使用方法 2.3.1 伺服電機(jī)控制板接口功能 圖2.6 控制電路板各部分標(biāo)識(shí) 舵機(jī)器控制器面板主要有電源接口、串口通訊接口、伺服電機(jī)借口、TIL通訊借口以及上位機(jī)擴(kuò)展口、電源開關(guān)等部分組成，各部分詳細(xì)的位置分布如圖2.6所示，其中每個(gè)部分的詳細(xì)說明如下： ①DC5V直流電源接口 此接口用于接插控制器控制部分供電電源，為了方便長(zhǎng)時(shí)間調(diào)試，可以用套裝中為用戶提供的USB取電線，直接插筆記本電腦或臺(tái)式電腦USB接口。也可接插符合下面要求的外置電源適配器（注意電源極性！）。 ②控制部分電源端子接口 此接口用于接插控制器控制部分供電電源，為增大用戶選擇電源電壓范圍，特設(shè)此接口。工作電壓范圍：＋7V～＋12V。注意端子接口正負(fù)標(biāo)識(shí)符！正確接線，避免損壞控制器。為用戶調(diào)試方便提供9V電池扣接線一條，可接9V電池使用。 ③伺服電機(jī)供電電源端子接口 此接口用于接插伺服電機(jī)供電電源（由于伺服電機(jī)在重負(fù)載的情況下，會(huì)將放大器電壓拉低，為防止影響控制器部分電壓突變，應(yīng)該將兩部分分別供電），工作電壓：＋4V～＋6V（普通伺服電機(jī)）。一般上，伺服電機(jī)啟動(dòng)和滿負(fù)載的時(shí)候耗電達(dá)1A～1.5A，而沒有負(fù)載時(shí)候只有約150mA耗電，所以請(qǐng)均衡考慮，根據(jù)同時(shí)運(yùn)動(dòng)的伺服電機(jī)數(shù)量，來考慮電源的功率選擇。為防止意外，請(qǐng)確保不要使用功率小于設(shè)計(jì)里面。一半數(shù)目的電機(jī)滿功率運(yùn)行時(shí)功耗的電源。為用戶調(diào)試方便提供的5號(hào)四節(jié)/4位電池盒一個(gè)，裝上電池可作為伺服電機(jī)調(diào)試電源使用。 ④外擴(kuò)上位機(jī)系統(tǒng)供電接口 此接口供電來源控制部分端子接口電源，可為自主開發(fā)的上位機(jī)（51系列、AVR系列、DSP、ARM等）板供電。 ⑤串口通訊接頭 此端口使用標(biāo)準(zhǔn)RS232串口電平進(jìn)行通訊，可以接插為用戶提供的串口通訊線和計(jì)算機(jī)進(jìn)行通訊，接收實(shí)時(shí)控制指令。 ⑥TTL通訊接口 若使用此功能請(qǐng)將跳線帽取下，此接口可用于伺服電機(jī)控制器與其他單片機(jī)開發(fā)的上位機(jī)BS2(Basic Stamp 2)通訊。注意接口標(biāo)識(shí)符，TX、RX左側(cè)排針分別聯(lián)接伺服電機(jī)控制板微控器TXD、RXD引腳。 ⑦波特率設(shè)置撥碼開關(guān) 通過設(shè)置撥碼開關(guān)，波特率可以在2400 960038.4k 115.2k四種數(shù)值中轉(zhuǎn)換。注意：1代表ON，0代表OFF。控制器波特率默認(rèn)設(shè)置為115200。每次更改波特率數(shù)值后，都要給控制器重新上電啟動(dòng)，才會(huì)生效。 ⑧伺服電機(jī)通道接口和⑨標(biāo)識(shí)符 此接口可接插國際標(biāo)準(zhǔn)接口的伺服電機(jī)，包括模擬式和數(shù)字式兩種。接口側(cè)方有1～32通道的標(biāo)注符，表示伺服電機(jī)受哪一通道信號(hào)控制。每一行可以接插一個(gè)伺服電機(jī)。整行接口上面有S/ + /-的標(biāo)注，其中“-”表示接插伺服電機(jī)的地線（一般為黑色）；“＋”表示接插伺服電機(jī)的電源線（一般為紅色）；“S”表示signal（信號(hào)）接插伺服電機(jī)的控制信號(hào)線（一般為黃色或白色）。支持的伺服電機(jī)：Futabaor Hitec 以及國產(chǎn)品牌（如輝盛）等。 ⑩電源開關(guān) 此開關(guān)控制伺服電機(jī)和控制電路兩部分電源通斷。開關(guān)撥向標(biāo)有ON一端為接通電源；開關(guān)撥向OFF一端為切斷整個(gè)系統(tǒng)供電。 3 兩足步行機(jī)器人控制系統(tǒng)軟件設(shè)計(jì) AVR系列單片機(jī)通常在其內(nèi)部集成了CPU、存儲(chǔ)器、總線邏輯、看門狗、I/0、以及其他接口，單片化的特性使其體積和功耗都大大減小，在兩足步行機(jī)器人中得到了廣泛使用，現(xiàn)在在操作系統(tǒng)下設(shè)計(jì)并實(shí)現(xiàn)了兩足步行機(jī)器人控制系統(tǒng)的多個(gè)應(yīng)用軟件，構(gòu)成了一個(gè)完整的控制系統(tǒng)軟件框架；最后改進(jìn)了常見的多路PWM產(chǎn)生方法，具有很高的PWM信號(hào)的精度和系統(tǒng)的實(shí)時(shí)性，并對(duì)兩足步行機(jī)器人進(jìn)行了關(guān)節(jié)調(diào)試。 3.1 軟件系統(tǒng)的基本要求 根據(jù)機(jī)器人控制系統(tǒng)的功能需求和硬件電路的特點(diǎn)，軟件系統(tǒng)至少需要滿足以下5個(gè)要求： (1) 軟件模塊化，具有很好的可維護(hù)和可擴(kuò)展性。 (2) 實(shí)現(xiàn)PWM信號(hào)的分時(shí)復(fù)用，并要保證PWM信號(hào)的高精度。并且通過軟件，能夠及時(shí)地改變PWM的輸出。 (3) 通過RS232接口能和PC機(jī)通信。 (4) 通過I℃接口記錄關(guān)鍵的信息到E2PROM存儲(chǔ)器。 (5) 通過3路10位A/D轉(zhuǎn)換器讀取傳感器的值并預(yù)處理。 3.2 軟件設(shè)計(jì)的技術(shù)路線與總體方案 在機(jī)器人控制系統(tǒng)中常見的操作系統(tǒng)有:TI的DSP/BIOS, Microsoft的WinCE, u C/OS-II, Wind River的VxWorks, uC-Linux和RT-Linux等，它們各自的特點(diǎn)和應(yīng)用如下所述： (1) DSP/BIOS操作系統(tǒng)不但具有很好的實(shí)時(shí)性[23]，而且與DSP外圍的數(shù)據(jù)庫兼容并且內(nèi)建于DSP專用的交互式集成開發(fā)環(huán)境CCS。但DSP/BIOS操作系統(tǒng)只適合在TI的C6000和C5000 DSP處理器上使用。 (2) WinCE操作系統(tǒng)由Windows95精簡(jiǎn)而成，不開放源碼，實(shí)時(shí)性不好。但從內(nèi)核到GUI的整個(gè)體系比較完善，并且Microsoft公司具有強(qiáng)大的軟件研發(fā)和技術(shù)支持能力。WinCE適合在功能復(fù)雜但對(duì)內(nèi)核體積的實(shí)時(shí)性都沒有太高要求的大型機(jī)器人主控制系統(tǒng)中使用，或者在圖像監(jiān)控系統(tǒng)中使用。 (3) uC/OS-II由世界著名的嵌入式專家Jean J. Lacrosse編寫，它具有源碼開放、體積小、可移植性強(qiáng)、可剪裁、可靠性高等特點(diǎn)，但GUI部分不完善。它非常適合在高實(shí)時(shí)性小型嵌入式系統(tǒng)中使用，經(jīng)常應(yīng)用在小型機(jī)器人控制系統(tǒng)中。 (4) VxWorks由美國Wind River公司開發(fā)，具有極高的可靠性和實(shí)時(shí)性，但是它不開放源碼，而且價(jià)格非常昂貴，通常應(yīng)用在軍用機(jī)器人和航天機(jī)器人中。 (5) uC-Linux和RT-Linux都是由Linux演化而來，繼承了Linux的一系列優(yōu)點(diǎn)，比如高可靠性和具有完善的網(wǎng)絡(luò)功能。它們結(jié)構(gòu)復(fù)雜，對(duì)開發(fā)人員的技術(shù)要求較高，通常應(yīng)用在比較復(fù)雜的機(jī)器人控制系統(tǒng)中。 本文根據(jù)控制系統(tǒng)硬件的特點(diǎn)和機(jī)器人的功能需要，選用了以C語言為基礎(chǔ)編寫而成的操作系統(tǒng)“Servo Control Software”。其軟件的操作界面如圖3.1所示。 圖3.1 Servo Control Software操作界面 Servo Control Software是實(shí)現(xiàn)伺服電機(jī)控制器通訊協(xié)議PC機(jī)上的專用WINDOWS控制軟件，本軟件操作控制簡(jiǎn)便，該軟件有以下功能： (1) 速度控制設(shè)定功能 可以調(diào)試出任意速度，多路電機(jī)不同速度運(yùn)行穩(wěn)定，實(shí)時(shí)性好，速度精準(zhǔn)，加速減速任意設(shè)。 (2) 循環(huán)控制功能 讓您不必費(fèi)心點(diǎn)擊鼠標(biāo)啦，反復(fù)調(diào)試更加易用，可作為小型工業(yè)機(jī)械手主控板，功能循環(huán)執(zhí)行，提供作業(yè)效率。 (3) 指令保存功能 可以將您調(diào)試好的指令集保存，自動(dòng)生成指令文檔，日期時(shí)間準(zhǔn)確，例如robotcode20090107_1550, 您也可以個(gè)性化自命名，避免讀取指令文檔錯(cuò)誤或者重新編輯。 (4) 指令讀取功能 只要輕松點(diǎn)擊“打開指令”按鍵，會(huì)進(jìn)入指令集文檔，選擇您要讀取的以往指令文檔，恢復(fù)當(dāng)前功能設(shè)置。 (5) 控制動(dòng)作完成時(shí)間功能 只要發(fā)送指令時(shí)間大于動(dòng)作完成時(shí)間，您就可以任意設(shè)置動(dòng)作的完成時(shí)間，軟件備有自動(dòng)調(diào)整功能，可將電機(jī)轉(zhuǎn)動(dòng)平滑過渡，避免了機(jī)器人定格控制缺陷。 3.3 伺服電機(jī)控制軟件操作方法 3.3.1 串口設(shè)置 在熟悉了該軟件后，我們開始調(diào)試軟件。首先我們要做好前提工作，把舵機(jī)接線按照要求插在控制板上，再把串口接線插到電腦上，開通電源，打開操作軟件，點(diǎn)擊軟件操作界面里的串口設(shè)置，選擇合適的波特率，然后點(diǎn)確定，其操作方法如圖3.2、圖3.3、圖3.4所示： 圖3.2 串口設(shè)置第一步 圖3.3 串口設(shè)置第二步 圖3.4 串口設(shè)置第三步 3.3.2 控制通道設(shè)置 控制通道序號(hào)與控制板上的序號(hào)一一對(duì)應(yīng)，根據(jù)設(shè)計(jì)需要可選擇多路調(diào)控，伺服電機(jī)接線一定要與控制軟件通道對(duì)應(yīng)，避免出現(xiàn)控制無效現(xiàn)象。將硬件設(shè)備接好，如圖3.5所示。 圖3.5 控制板接線示意圖 單擊鼠標(biāo)左鍵軟件與硬件連接,如圖3.6所示。 圖3.6 串口連接設(shè)置圖 當(dāng)串口設(shè)置完成后,開始設(shè)置控制通道,單擊鼠標(biāo)左鍵以激活控制通道,本設(shè)計(jì)中的機(jī)器人一共17個(gè)自由度,其中腿部10個(gè),也就是一共17個(gè)直流伺服電機(jī),在調(diào)試過程中,我們一共要激活17個(gè)通道,從1～17通道, 按照?qǐng)D3.7所示。 圖3.7 控制通道設(shè)置示意圖 3.3.3 操作設(shè)置 在控制軟件的操作設(shè)置區(qū)域有“添加指令”、“指令修改”、“刪除指令”、“運(yùn)行指令”等按鈕，分別實(shí)現(xiàn)不同的功能，具體實(shí)現(xiàn)功能如圖3.8所示。 圖3.8 操作設(shè)置功能圖 3.3.4 控制指令回顯區(qū) 調(diào)整好合適指令點(diǎn)擊添加后，將會(huì)出現(xiàn)在回顯區(qū)中。如圖3.9所示。 圖3.9 指令回顯區(qū) 3.3.5 發(fā)送指令時(shí)間設(shè)置 拉動(dòng)指令間隔時(shí)間滑桿可以調(diào)節(jié)發(fā)送指令間隔時(shí)間,以實(shí)現(xiàn)各舵機(jī)的協(xié)調(diào)工作,來完成復(fù)雜的動(dòng)作,如圖3.10所示。 圖3.10 發(fā)送指令間隔時(shí)間控制區(qū) 3.4 微型伺服電機(jī)（舵機(jī)）的選擇 微型的伺服電機(jī)在無線電業(yè)余愛好者的航?；顒?dòng)中使用已有很長(zhǎng)一段歷史，而且應(yīng)用最為廣泛，國內(nèi)亦稱之為“舵機(jī)”，含義為：“掌舵人操縱的機(jī)器”。舵機(jī)是一種位置伺服的驅(qū)動(dòng)器。它是機(jī)器人、機(jī)電系統(tǒng)和航模的重要執(zhí)行機(jī)構(gòu)。它接收一定的控制信號(hào)，輸出一定的角度，適用于那些需要角度不斷變化并可以保持的控制系統(tǒng)。標(biāo)準(zhǔn)的舵機(jī)有3條導(dǎo)線：電源線（紅）、地線（黑或灰）、控制線（白或橙黃）。控制線的輸入是一個(gè)寬度可調(diào)的周期性方波脈沖信號(hào)（PWM），方波脈沖信號(hào)的周期為20 ms（即頻率為50Hz)，當(dāng)方波的脈沖寬度改變時(shí)，舵機(jī)轉(zhuǎn)軸的角度發(fā)生改變，角度變化與脈沖寬度的變化成正比，也就是利用占空比的變化來改變舵機(jī)的位置。可見，其主要用作運(yùn)動(dòng)方向的控制部件。因此，機(jī)器人模型中也常用到它作為可控的運(yùn)動(dòng)關(guān)節(jié)，這些活動(dòng)關(guān)節(jié)在機(jī)械原理中常稱它為自由度。 3.4.1 舵機(jī)的選型 本設(shè)計(jì)選用的舵機(jī)為“輝盛”MG945 12公斤全金屬齒大扭力舵機(jī)，其圖和參數(shù)如圖3.11和表3.1所示。 圖3.11 “輝盛”MG945舵機(jī) 表3.1 “輝盛”MG945舵機(jī)參數(shù) 尺寸 重量 速度 扭力 使用電壓 40.8*19.9*37.3mm 56.3g 0.24sec/60度 12公斤/厘米 4.8V～7.2V 3.4.2 輝盛MG945舵機(jī)的控制特性 “輝盛”MG945 12公斤全金屬齒大扭力舵機(jī)全轉(zhuǎn)角為180度，它的對(duì)應(yīng)的控制關(guān)系如表3.2所示。 表3.2 PWM波脈寬與舵機(jī)轉(zhuǎn)角關(guān)系 PWM波脈寬 舵機(jī)轉(zhuǎn)角 對(duì)應(yīng)轉(zhuǎn)角簡(jiǎn)圖 0.5ms 0度 0.9ms 45度 1.5ms 90度 2.1ms 135度 2.5ms 180度 4 兩足步行機(jī)器人步行模式的建立 有的機(jī)器人行走時(shí)質(zhì)心在地面上的投影始終在腳的支撐多邊形內(nèi)，這種步行方式被稱為靜態(tài)步行；在人的日常行走中，質(zhì)心在地面上的投影經(jīng)常會(huì)超越支撐多邊形的范圍，這種步行方式被稱為動(dòng)態(tài)步行。靜態(tài)步行模式在設(shè)計(jì)步態(tài)時(shí)需要計(jì)算機(jī)器人的重心位置，以防止重心在地面上的投影超出了支撐多邊形范圍。靜態(tài)步行通常是在行走前離線設(shè)計(jì)好各個(gè)步行中的姿態(tài)和姿態(tài)切換的方法，在行走的過程中不能改變，一般只能在平地上行走。 4.1 本章任務(wù) 本設(shè)計(jì)中的機(jī)器人的機(jī)械結(jié)構(gòu)，它具有17個(gè)自由度，驅(qū)動(dòng)器為微型直流伺服電機(jī)。該機(jī)械結(jié)構(gòu)左右對(duì)稱，每條腿具有5個(gè)自由度，分別為踝2個(gè)、膝l個(gè)、髖2個(gè)；每個(gè)手臂具有3個(gè)自由度，分別為肩2個(gè)、肘1個(gè)；頸部具有一個(gè)自由度。而我的主要任務(wù)是分析雙腿的運(yùn)動(dòng)模式，研究10個(gè)舵機(jī)的轉(zhuǎn)動(dòng)角度以及相互的協(xié)調(diào)工作的關(guān)系，建立一個(gè)完整的運(yùn)動(dòng)模型。首先要把機(jī)器人組裝起來，其腿部圖片如圖4.1所示。 圖4.1 單腿的實(shí)物圖片 在正確的把整個(gè)機(jī)器人完整的組裝起來后，我們要把機(jī)器人腿部的每個(gè)舵機(jī)都標(biāo)注起來，以便后來的調(diào)試，腿部10個(gè)舵機(jī)的分布如圖4.2所示。 圖4.2 腿部舵機(jī)的分布 4.2 靜態(tài)步行模式設(shè)計(jì)與實(shí)現(xiàn) 兩足步行機(jī)器人控制系統(tǒng)中使用了靜態(tài)步行模式[4][5]線設(shè)計(jì)。靜態(tài)步行模式分為10個(gè)靜態(tài)姿勢(shì)及其切換順序如圖4.2所示。 圖4.2 兩足機(jī)器人行走步行模式 其中直立是初始狀態(tài)；起步是為步行做準(zhǔn)備，重心移到右腳；抬后腳(左)、邁步(左)和前腳著地(左)都是右腿支撐左腿擺動(dòng)的姿態(tài)；重心前移(左)是兩腿支撐，將重心從后面的右腳轉(zhuǎn)移到前面的左腳；抬后腳(右)、邁步(右)和前腳著地(右)都是左腿支撐右腿擺動(dòng)的姿態(tài)；重心前移(右)是兩腿支撐，將重心從后面由左腳再次轉(zhuǎn)移到前面的右腳。重心在左右腳之間反復(fù)轉(zhuǎn)移，左右腳的前后關(guān)系也反復(fù)轉(zhuǎn)換，實(shí)現(xiàn)兩足機(jī)器人的步行。 4.3 姿態(tài)運(yùn)動(dòng)的軟件實(shí)現(xiàn) 機(jī)器人的以上10個(gè)姿態(tài)按圖4.2所示切換，就可以讓機(jī)器人在平地上步行。根據(jù)腿部運(yùn)動(dòng)的模式，我們根據(jù)腿步各關(guān)節(jié)完成的角度可以計(jì)算輸入給每個(gè)舵機(jī)的PWM脈寬值，再反饋到舵機(jī)控制軟件Servo Control Software中，點(diǎn)擊“添加指令”按鈕，其控制回顯區(qū)出現(xiàn)指令如下： T1000 #0P1500#1P1500#2P1500#3P1500#4P1500#5P1500#6P1500#7P1500#8P1500#9P1500 T1000 #0P1444#1P1500#2P1500#3P1500#4P1444#5P1500#6P1500#7P1500#8P1500#9P1500 T1000 #0P1444#1P1500#2P1500#3P1500#4P1444#5P1500#6P1500#7P1833#8P1833#9P1500 T1000 #0P1500#1P1450#2P1500#3P1500#4P1500#5P1500#6P1500#7P1833#8P1833#9P1500 T1000 #0P1500#1P1500#2P1500#3P1500#4P1500#5P1500#6P1500#7P1500#8P1500#9P1500 T1000 #0P1500#1P1500#2P1500#3P1500#4P1500#5P1500#6P1500#7P1500#8P1500#9P1500 T1000 #0P1444#1P1500#2P1500#3P1500#4P1444#5P1500#6P1500#7P1500#8P1500#9P1500 T1000 #0P1444#1P1500#2P1500#3P1500#4P1444#5P1500#6P1500#7P1167#8P1167#9P1500 T1000 #0P1500#1P1450#2P1500#3P1500#4P1500#5P1500#6P1500#7P1167#8P1167#9P1500 T1000 #0P1500#1P1500#2P1500#3P1500#4P1500#5P1500#6P1500#7P1500#8P1500#9P1500 上述完成機(jī)器人腿部運(yùn)動(dòng)的一個(gè)循環(huán)，既從直立到抬左腿起步再到抬右腿起步，然后我們?cè)冱c(diǎn)擊如圖4.3中的“激活循環(huán)控制”就可以完成兩足行走機(jī)器人兩腿間持續(xù)左右腳交替行走的動(dòng)作了。 圖4.3 激活循環(huán)控制 結(jié) 束 語 兩足步行機(jī)器人是個(gè)廣泛應(yīng)用在教學(xué)、科研、比賽和娛樂等方面的機(jī)器人，集機(jī)械學(xué)、電子學(xué)、控制科學(xué)、計(jì)算機(jī)、數(shù)學(xué)等于一體。本文根據(jù)當(dāng)前兩足步行機(jī)器人控制系統(tǒng)中常用的處理器和操作系統(tǒng)各自的特點(diǎn)，選用8 位AVR微處理器，指令執(zhí)行時(shí)間為單個(gè)時(shí)鐘周期，速度快，控制精度高、I/O口驅(qū)動(dòng)能力更強(qiáng)，優(yōu)于AT51、STC51系列單片機(jī)。并對(duì)兩足步行機(jī)器人進(jìn)行了運(yùn)動(dòng)學(xué)分析和靜態(tài)步行設(shè)計(jì)，實(shí)現(xiàn)在機(jī)器人在平面上的穩(wěn)定行走。 在本設(shè)計(jì)課題中，我及我們小組，基本完成了兩足行走機(jī)器人的結(jié)構(gòu)設(shè)計(jì)，也理論上完成了機(jī)器人的控制系統(tǒng)，但是由于選擇的較為有難度的17自由度機(jī)器人，所以對(duì)于機(jī)器人結(jié)構(gòu)的選用材料、平衡力學(xué)處理、控制系統(tǒng)處理器等客觀條件有了更高的要求。在本課題中，由于條件有限，我們沒有使機(jī)器人在地面上實(shí)現(xiàn)兩腿交替運(yùn)動(dòng)。在我負(fù)責(zé)的控制系統(tǒng)這一塊中，我理論設(shè)計(jì)了一套控制方案，我使用的是核心為8位的AVR微處理器控制器，在設(shè)計(jì)過程中就發(fā)現(xiàn)的它的缺陷，由于我們?cè)O(shè)計(jì)的17自由度機(jī)器人，也就是有17個(gè)微型直流伺服電機(jī)，相應(yīng)的要同時(shí)提供17路的PWM脈沖信號(hào)，這就對(duì)處理器有了比較高的要求，而這時(shí)8位處理器則達(dá)不到使用要求。所以該課題在以后還有很多要進(jìn)一步改進(jìn)和研究的地方： (1) 機(jī)器人使用更為先進(jìn)的處理器，如表2.1中的ARM系列處理器和PC104, PowerPC等單板計(jì)算機(jī)。 (2) 機(jī)器人腳底安裝力傳感器，用來感知機(jī)器人腳和地面接觸時(shí)的受力情況，使用ZMP理論對(duì)機(jī)器人進(jìn)行步態(tài)控制。 (3) 機(jī)器人增加視覺系統(tǒng)，使機(jī)器人可以識(shí)別簡(jiǎn)單的目標(biāo)。桌面型的兩足機(jī)器人由于受到體積和成本的限制，大多不具備視覺系統(tǒng)或只有很簡(jiǎn)單的視覺系統(tǒng)。但隨著技術(shù)的進(jìn)步，桌面型的兩足機(jī)器人也會(huì)具有復(fù)雜的視覺系統(tǒng)。這在足球機(jī)器人中尤其重要。 致 謝 本文的研究工作是在劉艷老師的精心指導(dǎo)下完成的。在整個(gè)課題研究過程中，老師在各方面給予了我無盡的關(guān)心、幫助和教誨，使本論文的研究工作得以順利完成。老師學(xué)識(shí)淵博，經(jīng)驗(yàn)豐富，思維敏捷，時(shí)時(shí)給我熱情的鼓勵(lì)和不倦的教誨，在研究思想和研究方法上給了我諸多啟示，解答了許多難題，從課程學(xué)習(xí)、論文選題、課題研究到論文撰寫無不凝聚著老師們的心血和汗水。老師待人誠懇，心胸寬大，精深的知識(shí)令我受益匪淺。在此向劉艷表示無盡的感謝，同時(shí)此課題能夠順利完成也離不開同學(xué)給我的幫助和指導(dǎo)，在此也特別向他們表示深深的謝意！ 參 考 文 獻(xiàn) [1] 包志軍，馬培蓀. 兩足機(jī)器人到仿人型機(jī)器人的研究歷史及其問題[J].機(jī)器人, 1999(4):312-319. [2] 龜田秀司. 仿人機(jī)器人[M]. 管貽生譯. 北京:清華大學(xué)出版社, 2007. [3] 徐凱. 仿人機(jī)器人步態(tài)規(guī)劃算法及其實(shí)現(xiàn)研究[D]. 北京:清華大學(xué)工學(xué)碩士學(xué)位論文, 2006. [4] 胡凌云，孫增沂. 雙足機(jī)器人步態(tài)控制研究方法綜述[J]. 計(jì)算機(jī)研究與發(fā)展，2005. [5] 石宗英，徐文立，馮元餛等. 仿人型機(jī)器人動(dòng)態(tài)步行控制方法[J]. 機(jī)器人, 2001. [6] 胡洪志. 仿人步行機(jī)器人的運(yùn)動(dòng)規(guī)劃方法研究[D]. 國防科技大學(xué)研究生院學(xué)位論文, 2002. [7] 王勇. 基于被動(dòng)動(dòng)力式的兩足機(jī)器人研究現(xiàn)狀[J]. 機(jī)械工程師，2005. [8] 付成龍，陳懇. 雙足機(jī)器人穩(wěn)定性與控制策略研究進(jìn)展[J]. 高技術(shù)通訊, 2006. [9] 劉森，慕春棣，趙明國. 基于AVR式系統(tǒng)的擬人機(jī)器人控制器的設(shè)計(jì)[J].北京:清華大學(xué)學(xué)報(bào)(自然科學(xué)版),2008. [10] 楊晶東，黃慶成，洪炳銘. 雙足足球機(jī)器人實(shí)時(shí)避障導(dǎo)航系統(tǒng)研究[J].機(jī)器人, 2005. [11] 江海波. 深入淺出AVR單片機(jī)[M]. 北京:中國電力出版社，2008 [12] 徐亮，徐中偉. u C/OS-II實(shí)時(shí)系統(tǒng)任務(wù)調(diào)度優(yōu)化[J]. 計(jì)算機(jī)工程，Oct 200733 (19):57-59. [13] 吳平. u C /OS-II中任務(wù)調(diào)度算法的改進(jìn)[J]. 單片機(jī)與嵌入式系統(tǒng)應(yīng)用, Mar 2006(3):23-25. [14] 吳偉國, 李小寧, 王瑜. 類人機(jī)器人腰部關(guān)節(jié)平衡作用研究與仿真[J].機(jī)械設(shè)計(jì)與制造，May 2005,(5):112-114. [15] 黃燕平. u C/OS-II ARM移植要點(diǎn)詳解[M]. 北京:北京航空航天大學(xué)出版社，Nov2005. [16] 劉森，慕春棣，趙明國. 基于ARM嵌入式系統(tǒng)的擬人機(jī)器人控制器的設(shè)計(jì)[J]. 北京:清華大學(xué)學(xué)報(bào)(自然科學(xué)版),2008,48(4):482-485. [17] 施華, 薛廣濤. 機(jī)器人控制系統(tǒng)實(shí)時(shí)性的研究[J]. 計(jì)算機(jī)工程，Jan2003,29(l):91-92. [18] 李開生, 張慧慧, 費(fèi)仁元. 機(jī)器人控制器體系結(jié)構(gòu)研究的現(xiàn)狀和發(fā)展[J]. 機(jī)器人, May 2000,22(3):235-240. [19] 顏永軍, 李梅. Portal 99電路設(shè)計(jì)與應(yīng)用[M]，北京:國防工業(yè)出版社，2001. [20] 施華, 陳一民，李超. 基于RT-Linux的實(shí)時(shí)機(jī)器人控制器研究[J].計(jì)算機(jī)工程與科學(xué)，2002,24(6):91-95. [21] 徐青，申忠宇, 趙瑾等. 基于ARM的兩足步行機(jī)器人系統(tǒng)設(shè)計(jì)[J]. 儀器儀表學(xué)報(bào)(增刊)，Aug 2007,28(8):499-501. [22] 姜培玉. 兩足機(jī)器人動(dòng)態(tài)步行研究[D]. 西北工業(yè)大學(xué)碩士學(xué)位論文，Mar2004. [23] 萬松峰, 黃惟公. 基于WinCE&AVR的嵌入式工業(yè)監(jiān)控系統(tǒng)的開發(fā)[J]，西華大學(xué)學(xué)報(bào)(自然科學(xué)版)，Nov 2005,24(6):26-29. [24] 李紅征，周烽，王永. 基于DSP的雙足步行機(jī)器人設(shè)計(jì)[J]. 機(jī)械與電子，2007 (11):55-58. 南京師范大學(xué)碩士學(xué)位論文. [25] 張福學(xué). 機(jī)器人技術(shù)及其應(yīng)用[M]. 北京: 電子工業(yè)出版社， 2000. [26] 蔣新松. Robotics[M]. 沈陽: 遼寧科學(xué)技術(shù)出版社， 1994.