模塊化仿生機(jī)器人設(shè)計(jì)

《模塊化仿生機(jī)器人設(shè)計(jì)》由會員分享，可在線閱讀，更多相關(guān)《模塊化仿生機(jī)器人設(shè)計(jì)（44頁珍藏版）》請?jiān)谘b配圖網(wǎng)上搜索。

1、模塊化仿生機(jī)器人設(shè)計(jì)摘要模仿人的形態(tài)和行為而設(shè)計(jì)制造的機(jī)器人就是仿人機(jī)器人，一般分別或同時(shí)具有仿人的四肢和頭部。仿生機(jī)器人的發(fā)展可以給國家科技，教育，經(jīng)濟(jì)等各個(gè)領(lǐng)域帶來很大 的進(jìn)步空間。本文是在對國內(nèi)外人形仿生機(jī)器人資料， 特別是連接鍵部分和控制資料進(jìn)行研讀的 基礎(chǔ)下，對人形仿生機(jī)器人的整體結(jié)構(gòu)、驅(qū)動(dòng)、控制和傳感器等方面進(jìn)行方案擬定。本 文對人形仿生機(jī)器人的結(jié)構(gòu)進(jìn)行詳細(xì)的設(shè)計(jì)，畫出總裝配圖、部件圖并完成相應(yīng)的設(shè)計(jì) 計(jì)算。此外，本文設(shè)計(jì)了仿生機(jī)器人的主控電路板以及控制程序。研究小型仿生機(jī)器人的目的就是為了便于普及仿生機(jī)器人研究，讓自然人與機(jī)器人能在同一個(gè)空間內(nèi)融洽相處。本文所設(shè)計(jì)的仿生機(jī)器人是采

2、用舵機(jī)實(shí)現(xiàn)運(yùn)動(dòng)，并且采用 單片機(jī)實(shí)現(xiàn)機(jī)器人的運(yùn)動(dòng)控制。本設(shè)計(jì)還對模塊化仿生機(jī)器人的結(jié)構(gòu)組成和控制部分進(jìn) 行了優(yōu)簡化的設(shè)計(jì)和詳細(xì)的分析。關(guān)鍵詞：仿生機(jī)器人，舵機(jī)，單片機(jī)模塊化仿生機(jī)器人設(shè)計(jì)AbstractThis paper is in the form of domestic and foreign bionic robot for data, especially the bond part and the control data were studied under the foundation, the humanoid robot structure, drive, control

3、and sensor of the plan. In this paper, structure of the humanoid robot were detailed design, drawing assembly diagram, parts diagram and complete the corresp onding desig n and calculati on. The desig n of the bionic robot adopts servo moti on, and using the MCU control the movement of the robot. Th

4、e design structure of the humanoid robot and con trol part of the detailed an alysis.Researchon bionic robot is designed to facilitate the popularization of bionic robot, let the natural human robot can be in the same space along. Bionic robot is designed in this paper is the actuator motion, and th

5、e motion control of the robotby single chip microcomputer. Structure the design of bionic robot of the moduleand control part of the desig n and simplified and an alyzed in detail.Keywords: bionic robot, steering engine the MCUfdf圖紙枉務(wù)書36 KEMi cros oft V?or i9.EOT14510-00-04 連接 件W4.7 KBRQT14510-00-Q1

6、 連接 件I74 KBROTI4510-00-06 連播 件¥185 KBROT 14510-00-03 連接 件III97 KB也 R0T14510-00-05 連接dwg人 R0T14S10-OO-O8 連接 件DWG彳1 ROT14510-02-00 手臂351 KBD 霜（jF Aut oCAD 團(tuán)形BDT14510-DO-07 件vnGO KBROT14S10-00-02 件II89 K6主桎原理圖2419 KBAutoCAD 團(tuán)形連接主控原理圖3466 KBAutoCAD 圖形ROTI 4510-01-00 軀干4&4 OAutoCAD 團(tuán)形主揑原理圉1634 K

7、BAuUCAD團(tuán)形ROT 14510-04-00 褪剖79S KBAutoCAB 團(tuán)盤ROT14EiO-ODO 機(jī)器人裝配盟 961 KE仿生設(shè)計(jì)說明書C論立）1,681 KBMieroEoft Word 9.模塊化仿生機(jī)器人設(shè)計(jì)目錄1緒論11.1仿生機(jī)器人的特點(diǎn)11.2國內(nèi)外仿生機(jī)器人的研究現(xiàn)狀 21.3課題技術(shù)要求52. 人形仿生機(jī)器人機(jī)構(gòu)設(shè)計(jì)分析62.1仿生機(jī)器人的結(jié)構(gòu)分析62.2 仿生機(jī)器人設(shè)計(jì)方案 62.3 驅(qū)動(dòng)方式的選擇92.4仿生機(jī)器人相關(guān)數(shù)據(jù)93. 人形仿生機(jī)器人控制系統(tǒng)硬件設(shè)計(jì) 113.1硬件系統(tǒng)的基本要求113.2硬件系統(tǒng)設(shè)計(jì)的技術(shù)路線和總體方案 114. 仿生機(jī)器人控制系

8、統(tǒng)軟件設(shè)計(jì) 174.1軟件系統(tǒng)的基本要求174.2軟件設(shè)計(jì)的總體方案 174.3 舵機(jī)與控制系統(tǒng) 194.4舵機(jī)的選擇205. 仿生機(jī)器人步行模式的建立 235.1 靜態(tài)步行模式設(shè)計(jì)與實(shí)現(xiàn)235.2姿態(tài)運(yùn)動(dòng)的軟件實(shí)現(xiàn)25結(jié)論28參考文獻(xiàn)29致謝30模塊化仿生機(jī)器人設(shè)計(jì)1緒論機(jī)器人是自動(dòng)控制機(jī)器（Robot）的俗稱，自動(dòng)控制機(jī)器包括一切模擬人類 行為或思想與模擬其他生物的機(jī)械（如機(jī)器狗，機(jī)器貓等）。狹義上對機(jī)器人的定義還有很多分類法及爭議，有些電腦程序甚至也被稱為機(jī)器人。在當(dāng)代工業(yè)中， 機(jī)器人指能自動(dòng)執(zhí)行任務(wù)的人造機(jī)器裝置，用以取代或協(xié)助人類工作。理想中的高仿真機(jī)器人是高級整合控制論、 機(jī)械電子

9、、計(jì)算機(jī)與人工智能、材料學(xué)和仿生 學(xué)的產(chǎn)物，目前科學(xué)界正在向此方向研究開發(fā)。仿生機(jī)器人，也稱仿制人或人型機(jī)器人等，指以模仿真人為目的制造的機(jī)器 人。但人型機(jī)器人也可以指英語中的 Humanoid （擬人機(jī)器人），可以大小和真人 差很遠(yuǎn)也沒有似人的外觀，但有人的四肢和頭等構(gòu)造?，F(xiàn)時(shí)仿生人仍然在試制階 段，是長期以來科幻和機(jī)器人學(xué)的一大主題。仿生人擬真的程度有很多，有些是可以從外觀上識別，也沒有真人的思想和感情 （如Chobits中的人型電腦）。相對 是稱為生物機(jī)器人，是使用一種真人或生物的活組織，但以機(jī)器為主體的類型， 是和機(jī)械化人有重疊的概念，也是完全刻意為了仿冒真人而制造的， 但行為不一 定

10、似真人。而有時(shí)把女性型的仿生人稱為機(jī)娘（Gy no id），如機(jī)械女仆。反過來說 亦有開發(fā)外觀不似人，但能夠有似真人行為的機(jī)器人，如在2001年美國麻省理工 學(xué)院，研發(fā)了號稱世界上第一個(gè)有類似人類感情的機(jī)器人。2013年1月，英國的機(jī)器人專家設(shè)計(jì)師宣稱展示了世界上第一個(gè)完整的、迄今為止最復(fù)雜的仿生人， 其包括人造器官以及健全的四肢。1.1仿生機(jī)器人的特點(diǎn)研究仿生機(jī)器人，以代替人類在核電站、太空、海底及其它危害人類身心健 康的復(fù)雜極端環(huán)境中工作，將大大拓展人類的活動(dòng)空間。仿生機(jī)器人是近年來興起的類人小型機(jī)器人系統(tǒng)，是機(jī)器人領(lǐng)域一個(gè)新的方 向，人形機(jī)器人就是按照人體的一定比例進(jìn)行微縮的機(jī)器人。這種

11、機(jī)器人從外形 上看據(jù)有人的特征，依賴雙足行走；能像人一樣站立、行走、跳舞、運(yùn)動(dòng)，具有 人一樣的行為，能像人類一樣地生活、學(xué)習(xí)，并且為人類服務(wù)。研究小型人形機(jī) 器人的目的就是為了便于普及人形機(jī)器人研究， 讓自然人與機(jī)器人能在同一個(gè)空 間內(nèi)融洽相處。模仿人的形態(tài)和行為而設(shè)計(jì)制造的機(jī)器人就是仿人機(jī)器人，一般分別或同時(shí) 具有仿人的四肢和頭部。中國科技大學(xué)陳小平教授介紹，機(jī)器人一般根據(jù)不同應(yīng) 用需求被設(shè)計(jì)成不同形狀，如運(yùn)用于工業(yè)的機(jī)械臂、輪椅機(jī)器人、步行機(jī)器人等。 而仿人機(jī)器人研究集機(jī)械，電子，計(jì)算機(jī)，材料，傳感器，控制技術(shù)等多門科學(xué) 于一體，代表著一個(gè)國家的高科技發(fā)展水平。仿生機(jī)器人的發(fā)展可以給國家科

12、技，教育，經(jīng)濟(jì)等各個(gè)領(lǐng)域帶來很大的進(jìn)步空間 0本課題主要解決了模塊化仿生機(jī)器人各個(gè)模塊之間連接件的設(shè)計(jì)，以及通過C語言編程，對于伺服電機(jī)模塊進(jìn)行精確地控制。 從而使得整個(gè)系統(tǒng)至少能夠搭 接10種模型，包括變形金剛、機(jī)器貓、機(jī)器狗、機(jī)器兔等造型。而這樣的一個(gè)仿生機(jī)器人它的意義不僅在教學(xué)上可以給我們帶來實(shí)體的展 示和實(shí)驗(yàn)，學(xué)生通過制作仿人機(jī)器人來實(shí)踐機(jī)械結(jié)構(gòu)和復(fù)雜控制軟件模塊的設(shè) 計(jì)。學(xué)生用仿人機(jī)器人進(jìn)行實(shí)驗(yàn)來增強(qiáng)動(dòng)手能力和解決新問題的能力。而且在生活中也可以進(jìn)行推廣，可以成為自閉癥兒童的開導(dǎo)工具等等。對于這樣的仿生機(jī)器人的進(jìn)一步研究和學(xué)習(xí)，我相信在未來它所具有的經(jīng)濟(jì) 價(jià)值和市場需求是非常可觀的。

13、I1.2國內(nèi)外仿生機(jī)器人的研究現(xiàn)狀1.2.1國內(nèi)狀況我國在仿人形機(jī)器人方面做了大量研究，并取得了很多成果。比如長沙國防 科技大學(xué)研制成了雙足步行機(jī)器人， 北京航空航天大學(xué)研制成了多指靈巧手， 哈 爾濱工業(yè)大學(xué)、北京科技大學(xué)也在這方面做了大量深入的工作。在張啟先院士的主持下，北京航空航天大學(xué)機(jī)器人研究所于80年代末開始靈巧手的研究與開發(fā)，最初研究出來的 BH -1型靈巧手功能相對簡單，但填補(bǔ) 了當(dāng)時(shí)國內(nèi)空白。在隨后的幾年中又不斷改進(jìn)，現(xiàn)在的靈巧手已能靈巧地抓持和 操作不同材質(zhì)、不同形狀的物體。它配在機(jī)器人手臂上充當(dāng)靈巧末端執(zhí)行器可擴(kuò) 大機(jī)器人的作業(yè)范圍，完成復(fù)雜的裝配、搬運(yùn)等操作。比如它可以用來

14、抓取雞蛋， 既不會使雞蛋掉下，也不會捏碎雞蛋。靈巧手在航空航天、醫(yī)療護(hù)理等方面有應(yīng) 用前景。靈巧手有三個(gè)手指，每個(gè)手指有3個(gè)關(guān)節(jié)，3個(gè)手指共9個(gè)自由度，微電機(jī) 放在靈巧手的內(nèi)部，各關(guān)節(jié)裝有關(guān)節(jié)角度傳感器，指端配有三維力傳感器，采用 兩級分布式計(jì)算機(jī)實(shí)時(shí)控制系統(tǒng)。上海交通大學(xué)于1999年研制的仿人形機(jī)器人 SFHR,腿部和手臂分別有12 和10個(gè)自由度，身體上有2個(gè)自由度。共有24個(gè)自由度，實(shí)現(xiàn)了周期3.8s,步 長10cm的步行運(yùn)動(dòng)。機(jī)器人本體上裝有 2個(gè)單軸陀螺和一個(gè)三軸傾斜計(jì)，用于 檢測機(jī)器人的姿態(tài)信息，并配備了富士通公司的主動(dòng)視覺系統(tǒng)， 是研究通用機(jī)器 人學(xué)、多傳感器集成以及控制算法良好

15、的實(shí)驗(yàn)平臺18 0北京理工大學(xué)在歸國博士黃強(qiáng)教授的帶領(lǐng)下， 高起點(diǎn)地進(jìn)行仿人形機(jī)器人研 究，于2002年12月通過驗(yàn)收的仿人形機(jī)器人 BHR-1，高158cm,重76kg, 32 個(gè)自由度，步幅0.33m,步速每小時(shí)1公里。能夠根據(jù)自身力覺、平衡覺等感知 機(jī)器人自身的平衡狀態(tài)和地面高度的變化， 實(shí)現(xiàn)未知地面的穩(wěn)定行走和太極拳表 演，使中國成為繼日本之后，第二個(gè)研制出無外接電纜行走，集感知、控制、驅(qū) 動(dòng)、電源和機(jī)構(gòu)于一體的高水平仿人形機(jī)器人國家。此外，清華大學(xué)正在研制仿人形機(jī)器人 THBIP- I,高1.7m，重130kg, 32 個(gè)自由度，在清華大學(xué)985計(jì)劃的支持下，項(xiàng)目也在不斷取得進(jìn)展。南

16、京航空航 天大學(xué)曾研制了一臺8自由度空間型雙足步行機(jī)器人，實(shí)現(xiàn)靜態(tài)步行功能。2007年7月7日，由哈爾濱工程大學(xué)研制開發(fā)的仿生機(jī)器人螃蟹，經(jīng)過近 百次試驗(yàn)獲得成功。該仿生機(jī)器人螃蟹長60厘米，寬35厘米，厚度為25厘米， 體重12公斤，時(shí)速540米/小時(shí)。這只仿生螃蟹配備有衛(wèi)星定位系統(tǒng)，能潛入 4 米深水下進(jìn)行搜救、探測、錄像等任務(wù)。目前，我國仿人形機(jī)器人研究與世界先進(jìn)水平相比還有差距。 我國科技工作 者正在努力向前，我們熱切地期盼著我們自己水平更高的、 功能更強(qiáng)的仿人型機(jī) 器人與大家見面。1.2.2國外狀況在2005年愛知世博會上，大阪大學(xué)展出了一臺名叫ReplieeQ1expo的女性機(jī)器人

17、。該機(jī)器人的外形復(fù)制自日本新聞女主播藤井雅子， 動(dòng)作細(xì)節(jié)與人極為相似。 參觀者很難在較短時(shí)間內(nèi)發(fā)現(xiàn)這其實(shí)是一個(gè)機(jī)器人。由日本本田公司研制的仿人機(jī)器人 ASIMO，是目前最先進(jìn)的仿人行走機(jī)器 人。ASIMO身高1.2米，體重52公斤。它的行走速度是0-1.6km/h。早期的機(jī)器人 如果直線行走時(shí)突然轉(zhuǎn)向，必須先停下來，看起來比較笨拙。而ASIMO就靈活得多，它可以實(shí)時(shí)預(yù)測下一個(gè)動(dòng)作并提前改變重心，因此可以行走自如，進(jìn)行諸如“8”字形行走、下臺階、彎腰等各項(xiàng)“復(fù)雜”動(dòng)作。此外，ASIMO還可以握手、揮手，甚至可以隨著音樂翩翩起舞9。在仿人機(jī)器人領(lǐng)域，日本和美國的研究最為深入。日本方面?zhèn)戎赜谕庑畏抡?/p>

18、， 美國則側(cè)重用計(jì)算機(jī)模擬人腦的研究。由于仿人型機(jī)器人集機(jī)、電、材料、計(jì)算機(jī)、傳感器、控制技術(shù)等多門學(xué)科 于一體，是一個(gè)國家高科技實(shí)力和發(fā)展水平的重要標(biāo)志，因此，世界發(fā)達(dá)國家都不惜投入巨資進(jìn)行開發(fā)研究。日、美、英等國都在研制仿人形機(jī)器人方面做了大 量的工作，并已取得突破性的進(jìn)展。日本本田公司于1997年 10月推出了仿人形機(jī) 器人P3,美國麻省理工學(xué)院研制出了仿人形機(jī)器人科戈（COG）,德國和澳洲共 同研制出了裝有52個(gè)汽缸，身高2米、體重150公斤的大型機(jī)器人。本田公司最新 開發(fā)的新型機(jī)器人“阿西莫”，身高120厘米，體重43公斤，它的走路方式更加 接近人。在2013年舉行的機(jī)器人奧運(yùn)會上，

19、日本 Schaft公司機(jī)器人HRP-2拿到第一。 而美國NASA花了 300萬美元打造的Valkyrie人形機(jī)器人也同時(shí)展現(xiàn)在了世人面 刖。日本機(jī)械學(xué)院的S -Kajita等針對一臺具有4臺前向驅(qū)動(dòng)電機(jī)且全部安裝在機(jī) 器人的上體的五連桿平面型雙足步行機(jī)器人Meltran I,研究其動(dòng)態(tài)行走的控制方法。他根據(jù)機(jī)器人機(jī)構(gòu)質(zhì)量幾乎完全集中在上體的事實(shí)，為使雙足步行機(jī)器人 實(shí)現(xiàn)穩(wěn)定、周期性的動(dòng)態(tài)行走，對機(jī)器人上體采用了約束控制方法，提出了一種理想的線性倒立擺模型。同時(shí)又提出了機(jī)構(gòu)軌道能量守恒的概念，來求解各個(gè)關(guān)節(jié)運(yùn)動(dòng)軌跡及輸入力矩，實(shí)現(xiàn)了在已知不平整地面上的穩(wěn)定動(dòng)態(tài)步行。1996年他 們又在此樣機(jī)的基

20、礎(chǔ)上加載了超聲波視覺傳感器以實(shí)現(xiàn)實(shí)時(shí)提供地面信息的功 能。將視覺傳感器系統(tǒng)與針對線性倒立擺所提出的控制模式相結(jié)合構(gòu)成自適應(yīng)步 態(tài)控制系統(tǒng)，使Meltran U成功地實(shí)現(xiàn)了在未知路面上的動(dòng)態(tài)行走15。代表擬人機(jī)器人研究最高水平的是本田公司和索尼公司。他們代表了當(dāng)今擬人型機(jī)器人發(fā)展的最高水平。本田公司從 1986年至今己經(jīng)推出了 P系列1, 2, 3 型機(jī)器人。并且于2000年11月20日，推出了新型雙足步行機(jī)器人“ASIMO(Advaneed Step in Innovative Mobility) ”，“ASIMO ”和“ P3” 相比，實(shí) 現(xiàn)了小型輕量化，使其更容易適應(yīng)人類的生活空間，通過提

21、高雙腳步行技術(shù) 使其更接近人類的步行方式。雙腳步行技術(shù)方面采用了新開發(fā)“ l-WALK(lntelligent Real-time Flexible Walk) ”。l-WALK 是在過去的步行技術(shù) 的基礎(chǔ)上組合了新的“預(yù)測運(yùn)動(dòng)控制功能”，它可以實(shí)時(shí)預(yù)測以后的動(dòng)作，并且 據(jù)此事先移動(dòng)重心來改變步調(diào)。過去由于不能進(jìn)行預(yù)測運(yùn)動(dòng)控制，當(dāng)從直行改為 轉(zhuǎn)彎時(shí)，必須先停止直行動(dòng)作后才可以轉(zhuǎn)彎13。索尼公司于2000年 11月21 日在四足娛樂機(jī)器人 AIBO的基礎(chǔ)上推出了人形 娛樂型機(jī)器人SDR-3X(Sony Dream Robot-3X)。SDR-3X :頭部2個(gè)自由度、軀干 2個(gè)自由度、手臂4 X

22、2個(gè)自由度、下肢和足部6 X 2個(gè)自由度，共計(jì)24個(gè)自由 度。2002年又推出SDR-4X，采用64位RISC處理器，64MBDRAM，共有38個(gè)自 由度(頭部4個(gè)，身體2個(gè)，胳膊5X 2=10個(gè)，腿部6X2=12個(gè)，獨(dú)立的5個(gè)手指5 X 2=10個(gè))O 2003年 12月18日，索尼公司通過對控制系統(tǒng)和ISA(Intelligent Servo Actuator)的改進(jìn)、增加輸出力矩等方法，使 QRIO在世界上第一次實(shí)現(xiàn)了雙足行 走機(jī)器人的跑動(dòng)，QRIO可以在跑步時(shí)滯空6ms,雙腳跳躍時(shí)滯空10ms。2005年 1月 12日，由日本產(chǎn)業(yè)技術(shù)綜合研究所的比留川博等人開發(fā)出一臺取 名“ HRP-

23、2”雙足擬人機(jī)器人亮相東京。該機(jī)器人身高154em，體重58kg。研究人員先請民間藝術(shù)家跳舞，用特殊攝像機(jī)拍攝后將畫面輸入電腦，并對手、腳、 頭、腰等32個(gè)部位的動(dòng)作進(jìn)行解析，然后把有關(guān)解析數(shù)據(jù)輸入給機(jī)器人，最后利用這些數(shù)據(jù)來控制機(jī)器人手的動(dòng)作和腳步等，使“ HRP-2 ”可以和人一樣動(dòng)作連 貫，翩翩起舞14 O1.3課題技術(shù)要求模塊化可拼裝，結(jié)構(gòu)件可更換； 采用伺服電機(jī)驅(qū)動(dòng)； 具有紅外避障，光敏傳感器；USB下載程序 藍(lán)牙無線，紅外遙控； 電池可在線充電； 連接簡單、方便、耐用； 16個(gè)自由度，10種以上造型； 設(shè)計(jì)機(jī)械結(jié)構(gòu)三維模型，提交零件圖和裝配圖 采用單片機(jī)設(shè)計(jì)控制系統(tǒng)5模塊化仿生機(jī)器

24、人設(shè)計(jì)2. 人形仿生機(jī)器人機(jī)構(gòu)設(shè)計(jì)分析機(jī)構(gòu)設(shè)計(jì)是仿生機(jī)器人的重要的部分，在這個(gè)部分中，主要設(shè)計(jì)機(jī)器人的驅(qū) 動(dòng)傳動(dòng)機(jī)構(gòu)、連接件等。主控制器作為電源子系統(tǒng)和控制子系統(tǒng)的機(jī)載化安裝空間。2.1仿生機(jī)器人的結(jié)構(gòu)分析人形仿生走機(jī)器人是對人類自身的模仿，但是人類總共有上肢52對，下肢62對，背部112對，胸部52對，腰部8對，頸部16對，頭部25對之多的肌肉。 從目前的科學(xué)發(fā)展情況來看，要控制具有400個(gè)雙作用式促進(jìn)器的多變量系統(tǒng)是 不可能的，因此，在設(shè)計(jì)步行機(jī)械時(shí)，人們只考慮移動(dòng)的基本功能。例如，只考 慮在平地或者具有已知障礙物的情況下的步行。按照設(shè)計(jì)參數(shù)的要求，從仿人外形和仿人運(yùn)動(dòng)功能要求出發(fā)， 設(shè)計(jì)

25、要求機(jī)器 人自由度具有16個(gè)自由度。其中下肢8個(gè)自由度。每條腿包括髖部轉(zhuǎn)動(dòng)1個(gè)自由度。膝部前向1個(gè)自由 度。踝部前向、轉(zhuǎn)動(dòng)各1個(gè)自由度。上肢8個(gè)自由度。每個(gè)手臂包括肩部肘部各 2個(gè)自由度。2.2仿生機(jī)器人設(shè)計(jì)方案機(jī)器人的機(jī)械安裝示意圖如圖2.1所示，機(jī)器人有一個(gè)傳感器模塊（即頭部）， 一個(gè)主控制器（即胸部），16個(gè)舵機(jī)模塊（各個(gè)關(guān)節(jié)），通過機(jī)械連接件由螺絲和 卡扣連接而成。通過上面所述和查閱相關(guān)機(jī)器人行走的視屏，我們設(shè)計(jì)了一個(gè)16自由度的機(jī) 器人模型，如圖2.1所示。顯示的結(jié)構(gòu)特征就是采用多關(guān)節(jié)型結(jié)構(gòu)。動(dòng)力源采用 舵機(jī)直接驅(qū)動(dòng)。這樣不但可以實(shí)現(xiàn)結(jié)構(gòu)緊湊、傳動(dòng)精度高以及大大增加關(guān)節(jié)所能 達(dá)到的最

26、大角度，而且驅(qū)動(dòng)源全為干電池，便于集中控制和程序化控制。Front ViewRear View圖2.1 仿生機(jī)器人模型圖2.1人形機(jī)器人，頭部和身體相連接（圖2.2） o肩關(guān)節(jié)、大臂和小臂各一個(gè) 自由度（圖2.3,圖2.4）,髖關(guān)節(jié)一個(gè)自由度，大腿（圖2.5,圖2.6） 2個(gè)自由度, 小腿和腳步各一個(gè)自由度。各個(gè)關(guān)節(jié)的活動(dòng)范圍理論上是 180度 （由于零件之間 互相干涉，關(guān)節(jié)之間活動(dòng)范圍以實(shí)際為準(zhǔn)）。8模塊化仿生機(jī)器人設(shè)計(jì)#模塊化仿生機(jī)器人設(shè)計(jì)圖2.2 機(jī)器人頭部和身體#模塊化仿生機(jī)器人設(shè)計(jì)9模塊化仿生機(jī)器人設(shè)計(jì)圖2.4機(jī)器人右手臂圖2.5機(jī)器人左腿10模塊化仿生機(jī)器人設(shè)計(jì)圖2.6機(jī)器人右腿2

27、.3驅(qū)動(dòng)方式的選擇由于此次設(shè)計(jì)的仿生機(jī)器人只是達(dá)到簡單運(yùn)動(dòng)，而且為了使機(jī)器人行走穩(wěn)定，所以對機(jī)器人的各個(gè)關(guān)節(jié)旋轉(zhuǎn)的角度和配合都需要比較精確的控制，所以所有的驅(qū)動(dòng)都是由舵機(jī)來完成如圖2.7 。圖2.7 舵機(jī)2.4仿生機(jī)器人相關(guān)數(shù)據(jù)兩足機(jī)器人所有零部件清單，如表2.1表2.1 零部件清單名稱型號數(shù)量舵機(jī)12(NX m)16鋁制零件52螺栓螺帽M3x 11(mm)145兩足機(jī)器人的相關(guān)尺寸，如表2.2表2.2總體尺寸名稱尺寸(高x寬mm)總體348x 195手臂189x 49腿部198x 49舵機(jī)的相關(guān)參數(shù)，如表2.3表2.3舵機(jī)參數(shù)型號重量k軸承減速比馬達(dá)6V7.4V墻轉(zhuǎn)扭距(kg-crfl)空m

28、電 流(mA)s/BQa堵萍掃拒空戢工柞電SR51&75230空業(yè)杯0JS141.4J00J302117 J32712模塊化仿生機(jī)器人設(shè)計(jì)3. 人形仿生機(jī)器人控制系統(tǒng)硬件設(shè)計(jì)控制系統(tǒng)是用于控制機(jī)器人的運(yùn)動(dòng)、傳感器數(shù)據(jù)采集，機(jī)器人與人的交互等。 控制系統(tǒng)有一個(gè)主控制器來實(shí)現(xiàn)，主控制器對每個(gè)機(jī)器人的模塊分別控制，機(jī)器 人的運(yùn)動(dòng)控制算法是在主控制器中設(shè)計(jì)，每個(gè)模塊上的舵機(jī)里有CPU通過232或485總線跟主控制器進(jìn)行通信。在這部分要設(shè)計(jì)主控制器，編寫程序，設(shè)定與每個(gè)模塊的通信協(xié)議，實(shí)現(xiàn)機(jī) 器人的整體協(xié)調(diào)動(dòng)作。3.1硬件系統(tǒng)的基本要求雙足行走機(jī)器人是對人類的模仿。但人類的結(jié)構(gòu)極其復(fù)雜，對人類步

29、行原理 的研究至今仍有許多未解決的問題。 所以在設(shè)計(jì)雙足行走機(jī)器人機(jī)械結(jié)構(gòu)時(shí)，會對人類步行的結(jié)構(gòu)進(jìn)行減化，只會考慮基本的步行功能。所以雙足行走機(jī)器人通 常腿部只具有8至12個(gè)自由度，胯部具有0至3個(gè)自由度。本課題設(shè)計(jì)的機(jī)器 人共有16個(gè)自由度，驅(qū)動(dòng)器為微型直流伺服電機(jī)，簡稱舵機(jī)。本文設(shè)計(jì)的控制系統(tǒng)在硬件上至少滿足如下 5個(gè)基本要求：(1) 產(chǎn)生不少于16路獨(dú)立的高精度單邊沿PWM&號，用來控制作為機(jī)器人 關(guān)節(jié)驅(qū)動(dòng)器的16個(gè)舵機(jī)；(2) 具有調(diào)試接口；(3) 具有一個(gè)與PC機(jī)通信的接口；(4) 具有多路A/D轉(zhuǎn)換電路，用來擴(kuò)展傳感器；(5) 具有獨(dú)立而穩(wěn)定的電源。我們設(shè)計(jì)的機(jī)器人所用的高

30、精度直流伺服電機(jī)，控制信號為 0.5ms2.5ms 高電平的PWM&號，對應(yīng)轉(zhuǎn)角為0度到300度，電機(jī)精度為0.1度，則控制信號 的精度應(yīng)該高于(2.5ms0.5ms)/1800 =1.11卩s。3.2硬件系統(tǒng)設(shè)計(jì)的技術(shù)路線和總體方案3.2.1處理器選型智能仿生機(jī)器人系統(tǒng)主要由伺服電機(jī)模塊、傳感器模塊、主控制器模塊及結(jié) 構(gòu)連接件構(gòu)成。主控制器模塊為機(jī)器人的大腦，總體協(xié)調(diào)各個(gè)部分的運(yùn)動(dòng)、感知等功能。伺服電機(jī)模塊為機(jī)器人的運(yùn)動(dòng)系統(tǒng)， 每個(gè)自由度采用一個(gè)伺服電機(jī)模塊。伺 服電機(jī)模塊標(biāo)有不同的ID號，通過串行總線與主控制器通信。傳感器模塊包含幾種傳感器，為機(jī)器人的感覺系統(tǒng)。傳感器模塊唯一的ID

31、號，通過串行總線與主控制器通信。結(jié)構(gòu)連接件具有多種形狀，可以搭接成不同形式的機(jī)器人。在機(jī)器人控制系統(tǒng)中常用的處理器有：TI C2000和C6000系列DSR 8051和AVR單片機(jī)、ARM系列、STM32系列、PC104和PowerPC單板計(jì)算機(jī)等。它們 各自具有鮮明的特點(diǎn)，通常都是為了特殊的應(yīng)用而設(shè)計(jì)，如表3.1所示。表3.1 機(jī)器人控制系統(tǒng)中常用處理器機(jī)器人控制系統(tǒng)中常用的處理器處理器的特點(diǎn)在機(jī)器人控制系統(tǒng)中的應(yīng)用具有很強(qiáng)的數(shù)字信號處理能力，適合運(yùn)動(dòng)控運(yùn)動(dòng)控制、語音處理。尤其適合C2000 系歹y DSP制，硬件設(shè)計(jì)方便。執(zhí)行針對單個(gè)或一對直流（無刷）電機(jī)的復(fù)雜算法。具有極強(qiáng)的數(shù)字信號處理

32、能力，具有專門的高級的視覺處理和模式識別C6000 系歹y DSP操作系統(tǒng)，硬件設(shè)計(jì)非常復(fù)雜。8051和AVR系列單片結(jié)構(gòu)和指令簡單；運(yùn)算能力較低，通常不支簡單的運(yùn)動(dòng)控制和信號處理，在機(jī)持操作系統(tǒng)：幾乎全部芯片都己經(jīng)單片化，硬件復(fù)雜的控制系統(tǒng)中作為局部控制器。設(shè)計(jì)非常方便。典型的RISC處理器，運(yùn)算能力較強(qiáng)，支持小型機(jī)器人主控制器，常用于運(yùn)ARM7系列多種操作系統(tǒng)：部分型號芯片己經(jīng)單片化，硬件動(dòng)控制和傳感器信號處理。設(shè)計(jì)較方便。專為要求高性能、低成本、低功耗設(shè)計(jì)，運(yùn)機(jī)器人主控制器，同以進(jìn)行視覺STM32系列系列算能力很強(qiáng)，支持多種操作系統(tǒng)；幾乎沒有單片處理、語音處理和模式識別。化，硬件設(shè)計(jì)較復(fù)

33、雜。PC104, PowerPC 等單由PC演化而來，通用性很強(qiáng)，功耗大，硬復(fù)雜的擬人機(jī)器人的主控制器。板計(jì)算機(jī)件設(shè)計(jì)非常復(fù)雜。DSP處理器在譜分析、FFT變換、數(shù)字濾波等方面得到非常廣泛地應(yīng)用。TI公司的02000系列DSP主要用來進(jìn)行運(yùn)動(dòng)控制，適合用于執(zhí)行針對單個(gè)或少 量電機(jī)的高級控制算法。雖然C2000在桌面型兩足機(jī)器人中也有應(yīng)用，但C2000 對操作系統(tǒng)的支持能力有限，一般不使用操作系統(tǒng)，所以如果作為主控制器會帶 來軟件設(shè)計(jì)上的局限性。C6000系列具有很高的主頻、豐富的硬件資源、特殊的系統(tǒng)結(jié)構(gòu)，數(shù)字信號 處理能力非常強(qiáng)大，并且 TI公司特地為 C6000（和C5000）系列開發(fā)了專用

34、 DSP/BIOS操作系統(tǒng)。DSP/BIOS操作系統(tǒng)使C6000如虎添翼，成為了高級視覺 處理應(yīng)用的主流處理器。但使用 C6000作為處理器時(shí)電路復(fù)雜，通常只在大型 擬人機(jī)器人中作為高級的視覺處理器，小型的機(jī)器人中應(yīng)用很少。8051和AVR系列單片機(jī)通常在其內(nèi)部集成了 CPU、存儲器、總線邏輯、看 門狗、1/0、以及其他接口，單片化的特性使其體積和功耗都大大減小，在雙足 行走機(jī)器人中得到了廣泛使用。ARM7系列處理器是ARM處理器中使用很多的一款。ARM7處理器是典型 的RISC處理器，對操作系統(tǒng)的支持能力很強(qiáng)，適合運(yùn)行多種操作系統(tǒng)。單板計(jì)算機(jī)由通用計(jì)算機(jī)演化而來，常見的有PC104 Powe

35、rPC、MIPS>68000 等。單板計(jì)算機(jī)具有良好的通用性，對操作系統(tǒng)具有極強(qiáng)的支持能力。 但其設(shè)計(jì) 和開發(fā)比較復(fù)雜，功耗較大，在擬人機(jī)器人等大型機(jī)器人中經(jīng)常被用作主控制器。本文結(jié)合控制系統(tǒng)設(shè)計(jì)的基本要求和常用處理器，高性能、低功耗的8位STM32F103RCT6處理器，指令執(zhí)行時(shí)間為單個(gè)時(shí)鐘周期，速度快，控制精度高、 I/O 口驅(qū)動(dòng)能力更強(qiáng)，優(yōu)于 AT51、STC51系列單片機(jī)。3.2.2舵機(jī)的控制特性舵機(jī)又稱為直流伺服電機(jī)，是一種位置伺服驅(qū)動(dòng)器，適用于角度不斷變化并 可以保持的控制系統(tǒng)。我們設(shè)計(jì)的仿生機(jī)器人的直流伺服電機(jī)使用+7V至+12V電源，內(nèi)部基準(zhǔn)信號為周期為20ms的PWM

36、周期信號，輸入的控制信號也必須 是周期為20ms的PWM周期信號，電壓為+4V至+6V。電機(jī)輸出轉(zhuǎn)角與輸入的 控制信號的脈沖寬度有如圖3.1所示的線性關(guān)系。圖3.1 舵機(jī)輸出轉(zhuǎn)角與輸入 PWMW號寬度的關(guān)系本文中的雙足行走機(jī)器人機(jī)械結(jié)構(gòu)共有 16個(gè)舵機(jī)，所以在設(shè)計(jì)控制系統(tǒng)硬 件電路時(shí)，除了需要提供9V至12V的電源外，還必須提供至少16路4V至6V 的PWM信號。3.2.3硬件設(shè)計(jì)總體方案對應(yīng)于控制系統(tǒng)硬件設(shè)計(jì)的基本要求，作了如下的設(shè)計(jì)方案：(1) 核心電路包括STM32核心處理器、調(diào)試接口、串口驅(qū)動(dòng)電路和A/D轉(zhuǎn)換 基準(zhǔn)電壓電路，原理如圖3.2所示。圖3.2 核心電路原理圖58K(2) 控制

37、系統(tǒng)需要控制16個(gè)舵機(jī)，使機(jī)器人完成相應(yīng)的動(dòng)作?？刂浦绷魉?服電機(jī)的PWM&號的周期為20ms高電平持續(xù)時(shí)間為0. 5ms至2. 5ms占空比 較小，最大僅為1/8，所以可以進(jìn)行多路分時(shí)復(fù)用?？刂葡到y(tǒng)是用于控制機(jī)器人 的運(yùn)動(dòng)、傳感器數(shù)據(jù)采集，機(jī)器人與人的交互等?？刂葡到y(tǒng)有一個(gè)主控制器來實(shí) 現(xiàn)，主控制器對每個(gè)機(jī)器人的模塊分別控制，機(jī)器人的運(yùn)動(dòng)控制算法是在主控制 器中設(shè)計(jì)，每個(gè)模塊上的舵機(jī)里有 CPU通過232或485總線跟主控制器進(jìn)行通 信。在這部分要設(shè)計(jì)主控制器，編寫程序，設(shè)定與每個(gè)模塊的通信協(xié)議，實(shí)現(xiàn)機(jī) 器人的整體協(xié)調(diào)動(dòng)作。其舵機(jī)PWM&號控制電路原理如圖3.3所示。lAfr

38、 1-fiMD銘口B9-217zH6C：KT芮陽 £ H-PI 7zRSC-L 0?z5T圖3.3 PWM信號控制原理圖324電源設(shè)計(jì)為了增加機(jī)器人的靈活性，機(jī)器人使用高性能充電電池供電。 直流伺服電機(jī) 的電源要求為9V至12V，本文選用了電壓為10V的高性能電池，直接作為直流 伺服電機(jī)的電源。由于基于STM32的處理器和外設(shè)均使用3. 3V電源電壓，所以需要選用電源電壓轉(zhuǎn)換器進(jìn)行電壓轉(zhuǎn)換。我們使用了一個(gè)直流電壓轉(zhuǎn)換芯片SWDM02將電池的直流電源轉(zhuǎn)換為相應(yīng)的電流。如圖 3.4所示是機(jī)器人電源部分的控制圖：18模塊化仿生機(jī)器人設(shè)計(jì)19模塊化仿生機(jī)器人設(shè)計(jì)STD_3RS4_3TM_I3

39、rg_2*?&4_JTH_jSFD_M54占El圖3.4 電源控制原理圖#模塊化仿生機(jī)器人設(shè)計(jì)4. 仿生機(jī)器人控制系統(tǒng)軟件設(shè)計(jì)STM3系列單片機(jī)通常在其內(nèi)部集成了 CPU存儲器、總線邏輯、I/O、以及 其他接口，單片化的特性使其體積和功耗都大大減小，在雙足行走機(jī)器人中得到了廣泛使用，現(xiàn)在在操作系統(tǒng)下設(shè)計(jì)并實(shí)現(xiàn)了模塊化仿生機(jī)器人控制系統(tǒng)的多個(gè) 應(yīng)用軟件，構(gòu)成了一個(gè)完整的控制系統(tǒng)軟件框架；最后改進(jìn)了常見的多路PW產(chǎn)生方法，具有很高的PW信號的精度和系統(tǒng)的實(shí)時(shí)性，并對模塊化仿生機(jī)器人進(jìn) 行了關(guān)節(jié)調(diào)試。4.1軟件系統(tǒng)的基本要求根據(jù)機(jī)器人控制系統(tǒng)的功能需求和硬件電路的特點(diǎn)，軟件系統(tǒng)至少需要滿足

40、以下4個(gè)要求：(1) 軟件模塊化，具有很好的可維護(hù)和可擴(kuò)展性。(2) 實(shí)現(xiàn)PW信號的分時(shí)復(fù)用，并要保證PW信號的高精度。并且通過軟件， 能夠及時(shí)地改變PW的輸出。(3) 通過RS23接口能和PCM通信。(4) 接收上位機(jī)的運(yùn)動(dòng)列表，串口和 USB程序下載，能夠從上位機(jī)更新固 件程序。4.2軟件設(shè)計(jì)的總體方案CPU STM32F103軟件開發(fā)平臺：Keil-C功能要求：接收上位機(jī)的運(yùn)動(dòng)列表，串口和 US程序下載，能夠從上位機(jī)更 新固件程序。方式：與上位機(jī)統(tǒng)一運(yùn)動(dòng)列表格式，控制其他模塊時(shí)采用串口通信，封裝標(biāo) 準(zhǔn)API函數(shù)。函數(shù)列表：(1) 伺服電機(jī)初始化Motornit函數(shù)功能：電機(jī)初始化入口參數(shù)

41、：nModule 模塊序號 = 模塊ID出口參數(shù)：1成功0失敗函數(shù)原型：BOOL Motornit(ui nt8 n Module )(2) 伺服電機(jī)驅(qū)動(dòng)Motor_Drive函數(shù)功能：電機(jī)驅(qū)動(dòng)入口參數(shù)：nM odule 模塊序號 =模塊IDVelocity運(yùn)行速度，單位：百分比，數(shù)值為正時(shí)朝前；數(shù)值為負(fù)時(shí)朝后。Degree 旋轉(zhuǎn)角度，單位：度，數(shù)值為正時(shí)順時(shí)針；數(shù)值為負(fù)時(shí)逆時(shí)針，0時(shí)停止出口參數(shù)：1成功0失敗函數(shù)原型：BOOL Motor_Drive(ui nt8 n Module , ui nt32 Velocity, ui nt8 Degree )(3) 伺服電機(jī)停止Motor_Stop

42、函數(shù)功能：電機(jī)停止入口參數(shù)：nModule 模塊序號 = 模塊ID出口參數(shù)：1成功0失敗函數(shù)原型：BOOL Motor_Stop(ui nt8 nM odule )(4) 讀取電機(jī)溫度Motor_ReadTemp函數(shù)功能：讀取電機(jī)模塊溫度入口參數(shù)：nModule 模塊序號 = 模塊IDtemp 溫度值出口參數(shù)：1成功0失敗函數(shù)原型：BOOL Motor_PWMSet(ui nt8 n Module , ui nt32 temp)(5) 讀取模塊 ID號Module_ReadID函數(shù)功能：設(shè)置PW值，調(diào)整電機(jī)速度入口參數(shù)：nModule 模塊序號 = 模塊IDtemp 溫度值出口參數(shù)：1成功0失

43、敗函數(shù)原型：BOOL Module_ReadID(ui nt8 nM odule )(6) 讀取紅外數(shù)值Sensor_Read函數(shù)功能：讀取傳感器數(shù)值入口參數(shù)：nModule 模塊序號 = 模塊IDnSensor紅外序號，0=前，1=左, 2=右；光敏=4；聲音=5value 參數(shù)值出口參數(shù)：1成功0失敗函數(shù)原型：BOOlMotor_PWMSet(uint8 nModule , uint8 nSensor, uint32temp)(7) 讀取模塊 ID號Module_ReadlD函數(shù)功能：設(shè)置PW值，調(diào)整電機(jī)速度入口參數(shù)：nMotor電機(jī)序號 =模塊IDtemp 溫度值出口參數(shù)：1成功0失敗函

44、數(shù)原型：BOOL Module_ReadID(ui nt8 nM otor)4.3舵機(jī)與控制系統(tǒng)4.3.1工作模式主控制器模塊為機(jī)器人的大腦，總體協(xié)調(diào)各個(gè)部分的運(yùn)動(dòng)、感知等功能。舵機(jī)模塊為機(jī)器人的運(yùn)動(dòng)系統(tǒng)，每個(gè)自由度采用一個(gè)伺服電機(jī)模塊。 伺服電 機(jī)模塊標(biāo)有不同的ID號，通過串行總線與主控制器通信。傳感器模塊包含幾種傳感器，為機(jī)器人的感覺系統(tǒng)。傳感器模塊唯一的ID號，通過串行總線與主控制器通信。主控制器分別與十六個(gè)伺服電機(jī)以及傳感器相連，主控制器負(fù)責(zé)向各個(gè)舵機(jī) 發(fā)送命令，而舵機(jī)則反饋信息給主控制器。4.3.2通信原理圖主控制器負(fù)責(zé)向各個(gè)舵機(jī)主控制器分別與十六個(gè)伺服電機(jī)以及傳感器相連, 發(fā)送命令

45、，而舵機(jī)則反饋信息給主控制器。23模塊化仿生機(jī)器人設(shè)計(jì)24模塊化仿生機(jī)器人設(shè)計(jì)圖4.5通信示意圖#模塊化仿生機(jī)器人設(shè)計(jì)4.4舵機(jī)的選擇舵機(jī)在無線電業(yè)余愛好者的航?；顒?dòng)中使用已有很長一段歷史，而且應(yīng)用最為廣泛，國內(nèi)亦稱之為“舵機(jī)”，含義為：“掌舵人操縱的機(jī)器”。舵機(jī)是一種 位置伺服的驅(qū)動(dòng)器。它是機(jī)器人、機(jī)電系統(tǒng)和航模的重要執(zhí)行機(jī)構(gòu)。它接收一定 的控制信號，輸出一定的角度，適用于那些需要角度不斷變化并可以保持的控制 系統(tǒng)。標(biāo)準(zhǔn)的舵機(jī)有3條導(dǎo)線：電源線（紅）、地線（黑或灰）、控制線（白或 橙黃）。控制線的輸入是一個(gè)寬度可調(diào)的周期性方波脈沖信號（PWM），方波脈沖信號的周期為20 ms（即頻率為50H

46、z），當(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ī)械原理中常稱它為自由 度。4.4.1舵機(jī)的選型本設(shè)計(jì)選用的舵機(jī)為“春天”SR518舵機(jī)，其圖和參數(shù)如圖4.11和表4.1所示。圖4.11“春天” SR518舵機(jī)根據(jù)機(jī)器人手臂部分受力分析計(jì)算出肩部舵機(jī)應(yīng)承受扭矩:T=F L=0.79*7.05=5.57kg cm根據(jù)機(jī)器人腿部受力分析計(jì)算出胯部舵機(jī)應(yīng)承受扭矩：T'=F' L'=1.004*9.

47、1425=9.18kg cm表4.1“春天” SR518舵機(jī)參數(shù)尺寸重量速度扭力使用電壓45.9*35.7*41.6mm75g0.25sec/60 度17.3千克/厘米6V12V442所選舵機(jī)的控制特性通訊類型：485半雙工異步串行總線；通訊協(xié)議： Roboris Dyn amixel只要符合協(xié)議的半雙工UAR異步串行接口都可以和舵機(jī)進(jìn)行通訊，對舵機(jī)進(jìn)行各種控制。主要有以下兩種方式:方式一：通過調(diào)試器進(jìn)行控制圖4.12 PC調(diào)試控制26模塊化仿生機(jī)器人設(shè)計(jì)#模塊化仿生機(jī)器人設(shè)計(jì)方式二：通過專用控制器控制Controller圖4.13專用控制器調(diào)試控制用于舵機(jī)通訊的接口必須進(jìn)行如圖4.14處理:

48、匕匚丨!MU TKEM 麗CU TXDa7&SP435VCC.5V孑 C6ND1GND圖4.14 UART接口原理圖“春天” SR518舵機(jī)全轉(zhuǎn)角為0-300度，它的對應(yīng)的控制關(guān)系如表4.2所示PW波脈寬舵機(jī)轉(zhuǎn)角對應(yīng)轉(zhuǎn)角簡圖0.5ms0度口0.9ms45度表4.2 PWM波脈寬與舵機(jī)轉(zhuǎn)角關(guān)系#模塊化仿生機(jī)器人設(shè)計(jì)1.5ms90度2.1ms135度2.5ms180度i27模塊化仿生機(jī)器人設(shè)計(jì)5. 仿生機(jī)器人步行模式的建立有的機(jī)器人行走時(shí)質(zhì)心在地面上的投影始終在腳的支撐多邊形內(nèi)，這種步行方式被稱為靜態(tài)步行；在人的日常行走中，質(zhì)心在地面上的投影經(jīng)常會超越支撐 多邊形的范圍，這種步行方式被稱為

49、動(dòng)態(tài)步行。靜態(tài)步行模式在設(shè)計(jì)步態(tài)時(shí)需要 計(jì)算機(jī)器人的重心位置，以防止重心在地面上的投影超出了支撐多邊形范圍。 靜 態(tài)步行通常是在行走前離線設(shè)計(jì)好各個(gè)步行中的姿態(tài)和姿態(tài)切換的方法，在行走的過程中不能改變，一般只能在平地上行走。本設(shè)計(jì)中的機(jī)器人的機(jī)械結(jié)構(gòu)，它具有16個(gè)自由度，驅(qū)動(dòng)器為微型直流伺服 電機(jī)。該機(jī)械結(jié)構(gòu)左右對稱，每條腿具有 5個(gè)自由度，分別為踝2個(gè)、膝I個(gè)、髖2 個(gè)；每個(gè)手臂具有3個(gè)自由度，分別為肩2個(gè)、肘1個(gè)。而我的主要任務(wù)是分析雙 腿的運(yùn)動(dòng)模式，研究10個(gè)舵機(jī)的轉(zhuǎn)動(dòng)角度以及相互的協(xié)調(diào)工作的關(guān)系， 建立一個(gè) 完整的運(yùn)動(dòng)模型。在正確的把整個(gè)機(jī)器人完整的組裝起來后，我們要把機(jī)器人腿部的每個(gè)

50、舵機(jī) 都標(biāo)注起來，以便后來的調(diào)試，腿部10個(gè)舵機(jī)的分布如圖5.1所示。5.1靜態(tài)步行模式設(shè)計(jì)與實(shí)現(xiàn)仿生機(jī)器人控制系統(tǒng)中使用了靜態(tài)步行模式線設(shè)計(jì)。靜態(tài)步行模式分為8個(gè)靜態(tài)姿勢及其切換順序如圖5.1所示。其中直立是初始狀態(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ī)器人的步行。

51、28模塊化仿生機(jī)器人設(shè)計(jì)678910圖5.1腿部舵機(jī)的分布圖5.2機(jī)器人行走步行模式29模塊化仿生機(jī)器人設(shè)計(jì)5.2姿態(tài)運(yùn)動(dòng)的軟件實(shí)現(xiàn)機(jī)器人的以上10個(gè)姿態(tài)按圖所示切換，就可以讓機(jī)器人在平地上步行。根據(jù)腿部運(yùn)動(dòng)的模式，我們根據(jù)腿步各關(guān)節(jié)完成的角度可以輸入給每個(gè)舵機(jī)的PWM脈寬值，再反饋到舵機(jī)控制軟件keil中，其完成從靜止開始起步的過程的偽代碼指令如下：mai n()RightArm1(up,20)Motor1(up,20)Motor2(0,0)Motor3(0,0)LeftArm1(dow n,20)Motor9(dow n, 20)Motor10(0,0)Motor11(0,0)LeftLe

52、g1(up,18)Motor13(up,18)Motor15(dow n,18)Motor16(0,0)RightLeg2(revolve,5)Motor4(revolve,5)LeftLeg1(dow n,18)Motor13(dow n,18)Motor15(up,18)Motor16(0,0)LeftLeg1(revolve,5)Motor12(revolve,5)RightLeg2(up,18)Motor5(dow n,18)Motor7(up,18)Motor8(0,0)RightLeg2(revolveB,5)Motor4(revolveB,5)RightArm1(dow n,40

53、)Motor1(dow n,40)Motor2(0,0)Motor3(0,0)LeftArm1(up,40)Motor9(up,40)Motor10(0,0)Motor11(0,0)Reset()上述完成機(jī)器人向前運(yùn)動(dòng)一步然后靜止的一個(gè)過程，既從直立形態(tài)開始到抬右手左腿起步再到直立靜止，然后我們再點(diǎn)擊如圖 5.3中的“激活循環(huán)控制”就可以完成仿生機(jī)器人持續(xù)交替行走的動(dòng)作了圖5.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)，選用STM32微處

54、理器，指令執(zhí)行時(shí)間為單個(gè)時(shí)鐘周期，速度快，控制精度高、I/O 口驅(qū)動(dòng)能力更強(qiáng)，優(yōu)于AT51、 STC5係列單片機(jī)。根據(jù)機(jī)器人的扭矩要求選擇了“春天”SR518舵機(jī)。并對仿生機(jī)器人進(jìn)行了運(yùn)動(dòng)學(xué)分析和靜態(tài)步行設(shè)計(jì)，實(shí)現(xiàn)在機(jī)器人在平面上的穩(wěn)定行 動(dòng)。在本設(shè)計(jì)課題中，本文基本完成了仿生機(jī)器人機(jī)構(gòu)的結(jié)構(gòu)設(shè)計(jì)，也理論上完成了機(jī)器人的控制系統(tǒng)，但是由于選擇的較為有難度的16自由度機(jī)器人，所以對于機(jī)器人結(jié)構(gòu)的選用材料、力學(xué)處理、控制系統(tǒng)處理器等客觀條件有了更高的 要求。所以該課題在以后還有很多要進(jìn)一步改進(jìn)和研究的地方：(1) 機(jī)器人使用更為先進(jìn)的處理器。(2) 機(jī)器人腳底安裝力傳感器，用來感知機(jī)器人腳和地面接

55、觸時(shí)的受力情 況，使用ZMF理論對機(jī)器人進(jìn)行步態(tài)控制。機(jī)器人增加視覺系統(tǒng)，使機(jī)器人可以識別簡單的目標(biāo)。33模塊化仿生機(jī)器人設(shè)計(jì)參考文獻(xiàn)1 柳洪義，宋偉剛機(jī)器人技術(shù)基礎(chǔ)M.北京：冶金工業(yè)出版社，20022 蔣新松主編.機(jī)器人學(xué)導(dǎo)論M.沈陽：遼寧科學(xué)技術(shù)出版社，1994.3 孫富春，朱紀(jì)洪，劉國棟等機(jī)器人學(xué)導(dǎo)論-分析、系統(tǒng)及應(yīng)用M.北京： 電子工業(yè)出版社，2004.4 周遠(yuǎn)清，張?jiān)倥d等編著.智能機(jī)器人系統(tǒng)M.北京：清華大學(xué)出版社，1989. 方建軍，何廣平.智能機(jī)器人M.北京：化學(xué)工業(yè)出版社,2004.6 胡凌云，孫增沂.雙足機(jī)器人步態(tài)控制研究方法綜述J.計(jì)算機(jī)研究與發(fā) 展，2005.7 李開生，

56、張慧慧，費(fèi)仁元.機(jī)器人控制器體系結(jié)構(gòu)研究的現(xiàn)狀和發(fā)展J. 機(jī)器人,May 2000,22(3)：235-240.8 劉森，慕春棣，趙明國.基于ARM嵌入式系統(tǒng)的擬人機(jī)器人控制器的設(shè)計(jì)J. 北京：清華大學(xué)學(xué)報(bào)(自然科學(xué)版),2008,48:482-485.9 棍田秀司著，管貽生譯，仿人機(jī)器人.北京：清華大學(xué)出版社,2007.10 日本機(jī)器人學(xué)會著，宗光華等譯，機(jī)器人技術(shù)手冊.北京：科學(xué)出版社,200711 宏緒,張彭，張良起,雙足步行機(jī)器人動(dòng)態(tài)步行姿態(tài)穩(wěn)定性及姿態(tài)控制機(jī)器 人,19(3): 180 一 186,199712 湯卿,仿人機(jī)器人設(shè)計(jì)及步行控制方法【博士論文】杭州 ：浙江大學(xué),2009

57、.13 王超,類人機(jī)器人上肢體的設(shè)計(jì)與動(dòng)力學(xué)仿真碩士學(xué)位論文.上海:上海交通大學(xué),2007.14 馬錫琪,基于ZMp的雙足步行機(jī)器人步態(tài)規(guī)劃研究工碩士學(xué)位論文.西安： 西北工業(yè)大學(xué),2005.15 謝濤,徐建峰,張永學(xué),張文義,仿人機(jī)器人的研究歷史、現(xiàn)狀及展望.機(jī) 器人,24:367 一 374,2002.16 舒暢,服務(wù)機(jī)器人機(jī)械系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)碩士學(xué)位論文.杭州:浙江大學(xué)，2009.17 丁樹模.機(jī)械工程學(xué)M.北京：機(jī)械工業(yè)出版社,2000.18 S. H. Lu and C. C. Lee, “InterferometryMeasurement of Gauge Block Using

58、External Cavity Diode Laser ” l,ernational Symposium on Precision Mechanica Measureme nt, Aug. 12-22, (2002), Hefei-Ji nan, Chi na.19 JIS T9255-2007 Chairs and seats with electrical mechanisms assist standing up致謝本論文是在老師的綜合指導(dǎo)下，并通過自己的學(xué)習(xí)和親自查閱有關(guān)資料下完 成的。畢業(yè)設(shè)計(jì)是大學(xué)本科的最后一門必修的課程， 也是最綜合的一門課，它用 到了幾乎所有在大學(xué)學(xué)到的知識，能

59、綜合的考查學(xué)生設(shè)計(jì)能力和對機(jī)械知識的掌 握和運(yùn)用程度，是對我們四年來所學(xué)到知識大總結(jié)。 雖然這次設(shè)計(jì)只有僅僅的三 個(gè)月，但是我的分析問題的能力、解決問題的能力及獨(dú)立思考問題的能力和查閱 資料的能力卻明顯得到提高，這些能力的培養(yǎng)將是我以后走上工作崗位造就人生 的一筆財(cái)富，奠定了基礎(chǔ)。在設(shè)計(jì)過程中，指導(dǎo)老師對我們都極度關(guān)注，我忠心的感謝老師的熱心、耐 心，以及細(xì)致的指導(dǎo)。在默默奉獻(xiàn)的老師們的指導(dǎo)下，我們達(dá)不到預(yù)期的效果 在此再次的表示忠心的感謝和誠摯的問候。37模塊化仿生機(jī)器人設(shè)計(jì)38模塊化仿生機(jī)器人設(shè)計(jì)r L3mIroH fw上律電機(jī)于險(xiǎn) 主竝樁原風(fēng)陽39模塊化仿生機(jī)器人設(shè)計(jì)40模塊化仿生機(jī)器人設(shè)計(jì)UPM 3U&ddFal±郞UA I學(xué)雪上籟電機(jī)學(xué)隔主禪樁更風(fēng)陽141