模塊化仿生機(jī)器人設(shè)計
《模塊化仿生機(jī)器人設(shè)計》由會員分享,可在線閱讀,更多相關(guān)《模塊化仿生機(jī)器人設(shè)計(44頁珍藏版)》請在裝配圖網(wǎng)上搜索。
1、模塊化仿生機(jī)器人設(shè)計 摘要 模仿人的形態(tài)和行為而設(shè)計制造的機(jī)器人就是仿人機(jī)器人, 一般分別或同時具有仿 人的四肢和頭部。仿生機(jī)器人的發(fā)展可以給國家科技,教育,經(jīng)濟(jì)等各個領(lǐng)域帶來很大 的進(jìn)步空間。 本文是在對國內(nèi)外人形仿生機(jī)器人資料, 特別是連接鍵部分和控制資料進(jìn)行研讀的 基礎(chǔ)下,對人形仿生機(jī)器人的整體結(jié)構(gòu)、驅(qū)動、控制和傳感器等方面進(jìn)行方案擬定。本 文對人形仿生機(jī)器人的結(jié)構(gòu)進(jìn)行詳細(xì)的設(shè)計,畫出總裝配圖、部件圖并完成相應(yīng)的設(shè)計 計算。此外,本文設(shè)計了仿生機(jī)器人的主控電路板以及控制程序。 研究小型仿生機(jī)器人的目的就是為了便于普及仿生機(jī)器人研究, 讓自然人與機(jī)器人 能在同一個空間內(nèi)融洽
2、相處。本文所設(shè)計的仿生機(jī)器人是采用舵機(jī)實現(xiàn)運動,并且采用 單片機(jī)實現(xiàn)機(jī)器人的運動控制。本設(shè)計還對模塊化仿生機(jī)器人的結(jié)構(gòu)組成和控制部分進(jìn) 行了優(yōu)簡化的設(shè)計和詳細(xì)的分析。 關(guān)鍵詞:仿生機(jī)器人,舵機(jī),單片機(jī) 模塊化仿生機(jī)器人設(shè)計 Abstract This 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
3、structure, drive, control 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
4、 movement of the robot. The 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
5、 the actuator motion, and the 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 MCU fdf圖紙 枉務(wù)書 36 KE Mi cros oft V?or i 9.
6、.. EOT14510-00-04 連接 件W 4.7 KB RQT14510-00-Q1 連接 件I 74 KB ROTI4510-00-06 連播 件¥1 85 KB ROT 14510-00-03 連接 件III 97 KB 也 R0T14510-00-05 連接 dwg 人 R0T14S10-OO-O8 連接 件⑷ DWG彳 1 ROT14510-02-00 手臂 351 KB D 霜(jF Aut oCAD 團(tuán)形 BDT14510-DO-07 件vn GO KB ROT14S10-00-02 件II 89 K6 主桎原理圖2 419
7、 KB AutoCAD 團(tuán)形 連接 主控原理圖3 466 KB AutoCAD 圖形 ROTI 4510-01-00 軀干 4&4 O AutoCAD 團(tuán)形 主揑原理圉1 634 KB AuUCAD團(tuán)形 ROT 14510-04-00 褪剖 79S KB AutoCAB 團(tuán)盤 ROT14EiO-OD^O 機(jī)器人裝配盟 961 KE 仿生 設(shè)計說明書C論立) 1,681 KB MieroEoft Word 9... 模塊化仿生機(jī)器人設(shè)計 目錄 1緒論 1 1.1仿生機(jī)器人的特點 1 1.2國內(nèi)外仿生機(jī)器人的研究現(xiàn)狀 2
8、1.3課題技術(shù)要求 5 2. 人形仿生機(jī)器人機(jī)構(gòu)設(shè)計分析 6 2.1仿生機(jī)器人的結(jié)構(gòu)分析 6 2.2 仿生機(jī)器人設(shè)計方案 6 2.3 驅(qū)動方式的選擇 9 2.4仿生機(jī)器人相關(guān)數(shù)據(jù) 9 3. 人形仿生機(jī)器人控制系統(tǒng)硬件設(shè)計 11 3.1硬件系統(tǒng)的基本要求 11 3.2硬件系統(tǒng)設(shè)計的技術(shù)路線和總體方案 11 4. 仿生機(jī)器人控制系統(tǒng)軟件設(shè)計 17 4.1軟件系統(tǒng)的基本要求 17 4.2軟件設(shè)計的總體方案 17 4.3 舵機(jī)與控制系統(tǒng) 19 4.4舵機(jī)的選擇 20 5. 仿生機(jī)器人步行模式的建立 23 5.1 靜態(tài)步行模式設(shè)計與實現(xiàn) 23 5.2姿態(tài)運動
9、的軟件實現(xiàn) 25 結(jié)論 28 參考文獻(xiàn) 29 致謝 30 模塊化仿生機(jī)器人設(shè)計 1緒論 機(jī)器人是自動控制機(jī)器(Robot)的俗稱,自動控制機(jī)器包括一切模擬人類 行為或思想與模擬其他生物的機(jī)械(如機(jī)器狗,機(jī)器貓等) 。狹義上對機(jī)器人的 定義還有很多分類法及爭議,有些電腦程序甚至也被稱為機(jī)器人。在當(dāng)代工業(yè)中, 機(jī)器人指能自動執(zhí)行任務(wù)的人造機(jī)器裝置, 用以取代或協(xié)助人類工作。理想中的 高仿真機(jī)器人是高級整合控制論、 機(jī)械電子、計算機(jī)與人工智能、材料學(xué)和仿生 學(xué)的產(chǎn)物,目前科學(xué)界正在向此方向研究開發(fā)。 仿生機(jī)器人,也稱仿制人或人型機(jī)器人等,指以模仿真人為目的制造的機(jī)器 人。但人型
10、機(jī)器人也可以指英語中的 Humanoid (擬人機(jī)器人),可以大小和真人 差很遠(yuǎn)也沒有似人的外觀,但有人的四肢和頭等構(gòu)造?,F(xiàn)時仿生人仍然在試制階 段,是長期以來科幻和機(jī)器人學(xué)的一大主題。 仿生人擬真的程度有很多,有些是 可以從外觀上識別,也沒有真人的思想和感情 (如Chobits中的人型電腦)。相對 是稱為生物機(jī)器人,是使用一種真人或生物的活組織,但以機(jī)器為主體的類型, 是和機(jī)械化人有重疊的概念,也是完全刻意為了仿冒真人而制造的, 但行為不一 定似真人。而有時把女性型的仿生人稱為機(jī)娘(Gy no id),如機(jī)械女仆。反過來說 亦有開發(fā)外觀不似人,但能夠有似真人行為的機(jī)器人,如在2001年美國
11、麻省理工 學(xué)院,研發(fā)了號稱世界上第一個有類似人類感情的機(jī)器人。 2013年1月,英國的 機(jī)器人專家設(shè)計師宣稱展示了世界上第一個完整的、迄今為止最復(fù)雜的仿生人, 其包括人造器官以及健全的四肢。 1.1仿生機(jī)器人的特點 研究仿生機(jī)器人,以代替人類在核電站、太空、海底及其它危害人類身心健 康的復(fù)雜極端環(huán)境中工作,將大大拓展人類的活動空間。 仿生機(jī)器人是近年來興起的類人小型機(jī)器人系統(tǒng),是機(jī)器人領(lǐng)域一個新的方 向,人形機(jī)器人就是按照人體的一定比例進(jìn)行微縮的機(jī)器人。這種機(jī)器人從外形 上看據(jù)有人的特征,依賴雙足行走;能像人一樣站立、行走、跳舞、運動,具有 人一樣的行為,能像人類一樣地生活、學(xué)習(xí),并且
12、為人類服務(wù)。研究小型人形機(jī) 器人的目的就是為了便于普及人形機(jī)器人研究, 讓自然人與機(jī)器人能在同一個空 間內(nèi)融洽相處。 模仿人的形態(tài)和行為而設(shè)計制造的機(jī)器人就是仿人機(jī)器人,一般分別或同時 具有仿人的四肢和頭部。中國科技大學(xué)陳小平教授介紹,機(jī)器人一般根據(jù)不同應(yīng) 用需求被設(shè)計成不同形狀,如運用于工業(yè)的機(jī)械臂、輪椅機(jī)器人、步行機(jī)器人等。 而仿人機(jī)器人研究集機(jī)械,電子,計算機(jī),材料,傳感器,控制技術(shù)等多門科學(xué) 于一體,代表著一個國家的高科技發(fā)展水平。仿生機(jī)器人的發(fā)展可以給國家科技, 教育,經(jīng)濟(jì)等各個領(lǐng)域帶來很大的進(jìn)步空間 ⑻0 本課題主要解決了模塊化仿生機(jī)器人各個模塊之間連接件的設(shè)計, 以及通過
13、 C語言編程,對于伺服電機(jī)模塊進(jìn)行精確地控制。 從而使得整個系統(tǒng)至少能夠搭 接10種模型,包括變形金剛、機(jī)器貓、機(jī)器狗、機(jī)器兔等造型。 而這樣的一個仿生機(jī)器人它的意義不僅在教學(xué)上可以給我們帶來實體的展 示和實驗,學(xué)生通過制作仿人機(jī)器人來實踐機(jī)械結(jié)構(gòu)和復(fù)雜控制軟件模塊的設(shè) 計。學(xué)生用仿人機(jī)器人進(jìn)行實驗來增強(qiáng)動手能力和解決新問題的能力。 而且在生 活中也可以進(jìn)行推廣,可以成為自閉癥兒童的開導(dǎo)工具等等。 對于這樣的仿生機(jī)器人的進(jìn)一步研究和學(xué)習(xí),我相信在未來它所具有的經(jīng)濟(jì) 價值和市場需求是非??捎^的。I 1.2國內(nèi)外仿生機(jī)器人的研究現(xiàn)狀 1.2.1國內(nèi)狀況 我國在仿人形機(jī)器人方面做了大量研
14、究,并取得了很多成果。比如長沙國防 科技大學(xué)研制成了雙足步行機(jī)器人, 北京航空航天大學(xué)研制成了多指靈巧手, 哈 爾濱工業(yè)大學(xué)、北京科技大學(xué)也在這方面做了大量深入的工作。 在張啟先院士的主持下,北京航空航天大學(xué)機(jī)器人研究所于 80年代末開始 靈巧手的研究與開發(fā),最初研究出來的 BH -1型靈巧手功能相對簡單,但填補(bǔ) 了當(dāng)時國內(nèi)空白。在隨后的幾年中又不斷改進(jìn),現(xiàn)在的靈巧手已能靈巧地抓持和 操作不同材質(zhì)、不同形狀的物體。它配在機(jī)器人手臂上充當(dāng)靈巧末端執(zhí)行器可擴(kuò) 大機(jī)器人的作業(yè)范圍,完成復(fù)雜的裝配、搬運等操作。比如它可以用來抓取雞蛋, 既不會使雞蛋掉下,也不會捏碎雞蛋。靈巧手在航空航天、醫(yī)療護(hù)理等
15、方面有應(yīng) 用前景。 靈巧手有三個手指,每個手指有3個關(guān)節(jié),3個手指共9個自由度,微電機(jī) 放在靈巧手的內(nèi)部,各關(guān)節(jié)裝有關(guān)節(jié)角度傳感器,指端配有三維力傳感器,采用 兩級分布式計算機(jī)實時控制系統(tǒng)。 上海交通大學(xué)于1999年研制的仿人形機(jī)器人 SFHR,腿部和手臂分別有12 和10個自由度,身體上有2個自由度。共有24個自由度,實現(xiàn)了周期3.8s,步 長10cm的步行運動。機(jī)器人本體上裝有 2個單軸陀螺和一個三軸傾斜計,用于 檢測機(jī)器人的姿態(tài)信息,并配備了富士通公司的主動視覺系統(tǒng), 是研究通用機(jī)器 人學(xué)、多傳感器集成以及控制算法良好的實驗平臺[18] 0 北京理工大學(xué)在歸國博士黃強(qiáng)教授的帶領(lǐng)下,
16、 高起點地進(jìn)行仿人形機(jī)器人研 究,于2002年12月通過驗收的仿人形機(jī)器人 BHR-1,高158cm,重76kg, 32 個自由度,步幅0.33m,步速每小時1公里。能夠根據(jù)自身力覺、平衡覺等感知 機(jī)器人自身的平衡狀態(tài)和地面高度的變化, 實現(xiàn)未知地面的穩(wěn)定行走和太極拳表 演,使中國成為繼日本之后,第二個研制出無外接電纜行走,集感知、控制、驅(qū) 動、電源和機(jī)構(gòu)于一體的高水平仿人形機(jī)器人國家。 此外,清華大學(xué)正在研制仿人形機(jī)器人 THBIP- I,高1.7m,重130kg, 32 個自由度,在清華大學(xué)985計劃的支持下,項目也在不斷取得進(jìn)展。南京航空航 天大學(xué)曾研制了一臺8自由度空間型雙足步行機(jī)器
17、人,實現(xiàn)靜態(tài)步行功能。 2007年7月7日,由哈爾濱工程大學(xué)研制開發(fā)的仿生機(jī)器人螃蟹,經(jīng)過近 百次試驗獲得成功。該仿生機(jī)器人螃蟹長60厘米,寬35厘米,厚度為25厘米, 體重12公斤,時速540米/小時。這只仿生螃蟹配備有衛(wèi)星定位系統(tǒng),能潛入 4 米深水下進(jìn)行搜救、探測、錄像等任務(wù)。 目前,我國仿人形機(jī)器人研究與世界先進(jìn)水平相比還有差距。 我國科技工作 者正在努力向前,我們熱切地期盼著我們自己水平更高的、 功能更強(qiáng)的仿人型機(jī) 器人與大家見面。 1.2.2國外狀況 在2005年愛知世博會上,大阪大學(xué)展出了一臺名叫 ReplieeQ1expo的女性機(jī) 器人。該機(jī)器人的外形復(fù)制自日本新聞女
18、主播藤井雅子, 動作細(xì)節(jié)與人極為相似。 參觀者很難在較短時間內(nèi)發(fā)現(xiàn)這其實是一個機(jī)器人。 由日本本田公司研制的仿人機(jī)器人 ASIMO,是目前最先進(jìn)的仿人行走機(jī)器 人。ASIMO身高1.2米,體重52公斤。它的行走速度是0-1.6km/h。早期的機(jī)器人 如果直線行走時突然轉(zhuǎn)向,必須先停下來,看起來比較笨拙。而 ASIMO就靈活 得多,它可以實時預(yù)測下一個動作并提前改變重心, 因此可以行走自如,進(jìn)行諸 如“8”字形行走、下臺階、彎腰等各項“復(fù)雜”動作。此外, ASIMO還可以握 手、揮手,甚至可以隨著音樂翩翩起舞[9]。 在仿人機(jī)器人領(lǐng)域,日本和美國的研究最為深入。日本方面?zhèn)戎赜谕庑畏抡妫?/p>
19、 美國則側(cè)重用計算機(jī)模擬人腦的研究。 由于仿人型機(jī)器人集機(jī)、電、材料、計算機(jī)、傳感器、控制技術(shù)等多門學(xué)科 于一體,是一個國家高科技實力和發(fā)展水平的重要標(biāo)志, 因此,世界發(fā)達(dá)國家都 不惜投入巨資進(jìn)行開發(fā)研究。日、美、英等國都在研制仿人形機(jī)器人方面做了大 量的工作,并已取得突破性的進(jìn)展。日本本田公司于1997年 10月推出了仿人形機(jī) 器人P3,美國麻省理工學(xué)院研制出了仿人形機(jī)器人科戈(COG),德國和澳洲共 同研制出了裝有52個汽缸,身高2米、體重150公斤的大型機(jī)器人。本田公司最新 開發(fā)的新型機(jī)器人“阿西莫”,身高120厘米,體重43公斤,它的走路方式更加 接近人。 在2013年舉行的機(jī)器
20、人奧運會上,日本 Schaft公司機(jī)器人HRP-2拿到第一。 而美國NASA花了 300萬美元打造的Valkyrie人形機(jī)器人也同時展現(xiàn)在了世人面 刖。 日本機(jī)械學(xué)院的S -Kajita等針對一臺具有4臺前向驅(qū)動電機(jī)且全部安裝在機(jī) 器人的上體的五連桿平面型雙足步行機(jī)器人 Meltran I,研究其動態(tài)行走的控制 方法。他根據(jù)機(jī)器人機(jī)構(gòu)質(zhì)量幾乎完全集中在上體的事實,為使雙足步行機(jī)器人 實現(xiàn)穩(wěn)定、周期性的動態(tài)行走,對機(jī)器人上體采用了約束控制方法, 提出了一種 理想的線性倒立擺模型。同時又提出了機(jī)構(gòu)軌道能量守恒的概念, 來求解各個關(guān) 節(jié)運動軌跡及輸入力矩,實現(xiàn)了在已知不平整地面上的穩(wěn)定動態(tài)步
21、行。1996年他 們又在此樣機(jī)的基礎(chǔ)上加載了超聲波視覺傳感器以實現(xiàn)實時提供地面信息的功 能。將視覺傳感器系統(tǒng)與針對線性倒立擺所提出的控制模式相結(jié)合構(gòu)成自適應(yīng)步 態(tài)控制系統(tǒng),使Meltran U成功地實現(xiàn)了在未知路面上的動態(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” 相比,實
22、現(xiàn)了小型輕量化,使其更容易適應(yīng)人類的生活空間,通過提高雙腳步行技術(shù) 使其更接近人類的步行方式。雙腳步行技術(shù)方面采用了新開發(fā) “ l-WALK(lntelligent Real-time Flexible Walk) ”。l-WALK 是在過去的步行技術(shù) 的基礎(chǔ)上組合了新的“預(yù)測運動控制功能”,它可以實時預(yù)測以后的動作,并且 據(jù)此事先移動重心來改變步調(diào)。過去由于不能進(jìn)行預(yù)測運動控制,當(dāng)從直行改為 轉(zhuǎn)彎時,必須先停止直行動作后才可以轉(zhuǎn)彎[13]。 索尼公司于2000年 11月21 日在四足娛樂機(jī)器人 AIBO的基礎(chǔ)上推出了人形 娛樂型機(jī)器人SDR-3X(Sony Dream Robot-3X)
23、。SDR-3X :頭部2個自由度、軀干 2個自由度、手臂4 X 2個自由度、下肢和足部6 X 2個自由度,共計24個自由 度。2002年又推出SDR-4X,采用64位RISC處理器,64MBDRAM,共有38個自 由度(頭部4個,身體2個,胳膊5X 2=10個,腿部6X2=12個,獨立的5個手指5 X 2=10個)O 2003年 12月18日,索尼公司通過對控制系統(tǒng)和ISA(Intelligent Servo Actuator)的改進(jìn)、增加輸出力矩等方法,使 QRIO在世界上第一次實現(xiàn)了雙足行 走機(jī)器人的跑動,QRIO可以在跑步時滯空6ms,雙腳跳躍時滯空10ms。 2005年 1月 12日
24、,由日本產(chǎn)業(yè)技術(shù)綜合研究所的比留川博等人開發(fā)出一臺取 名“ HRP-2”雙足擬人機(jī)器人亮相東京。該機(jī)器人身高 154em,體重58kg。研究 人員先請民間藝術(shù)家跳舞,用特殊攝像機(jī)拍攝后將畫面輸入電腦,并對手、腳、 頭、腰等32個部位的動作進(jìn)行解析,然后把有關(guān)解析數(shù)據(jù)輸入給機(jī)器人, 最后利 用這些數(shù)據(jù)來控制機(jī)器人手的動作和腳步等,使“ HRP-2 ”可以和人一樣動作連 貫,翩翩起舞[14] O 1.3課題技術(shù)要求 模塊化可拼裝,結(jié)構(gòu)件可更換; 采用伺服電機(jī)驅(qū)動; 具有紅外避障,光敏傳感器; USB下載程序 藍(lán)牙無線,紅外遙控; 電池可在線充電; 連接簡單、方便、耐用; 16個自由度,1
25、0種以上造型; 設(shè)計機(jī)械結(jié)構(gòu)三維模型,提交零件圖和裝配圖 采用單片機(jī)設(shè)計控制系統(tǒng) 5 模塊化仿生機(jī)器人設(shè)計 2. 人形仿生機(jī)器人機(jī)構(gòu)設(shè)計分析 機(jī)構(gòu)設(shè)計是仿生機(jī)器人的重要的部分,在這個部分中,主要設(shè)計機(jī)器人的驅(qū) 動傳動機(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個雙作用式促進(jìn)器的多變量系統(tǒng)是 不可能的,因此,在設(shè)計步行機(jī)械時,人
26、們只考慮移動的基本功能。例如,只考 慮在平地或者具有已知障礙物的情況下的步行。 按照設(shè)計參數(shù)的要求,從仿人外形和仿人運動功能要求出發(fā), 設(shè)計要求機(jī)器 人自由度具有16個自由度。 其中下肢8個自由度。每條腿包括髖部轉(zhuǎn)動1個自由度。膝部前向1個自由 度。踝部前向、轉(zhuǎn)動各1個自由度。上肢8個自由度。每個手臂包括肩部肘部各 2個自由度。 2.2仿生機(jī)器人設(shè)計方案 機(jī)器人的機(jī)械安裝示意圖如圖2.1所示,機(jī)器人有一個傳感器模塊(即頭部), 一個主控制器(即胸部),16個舵機(jī)模塊(各個關(guān)節(jié)),通過機(jī)械連接件由螺絲和 卡扣連接而成。 通過上面所述和查閱相關(guān)機(jī)器人行走的視屏,我們設(shè)計了一個16自由度的
27、機(jī) 器人模型,如圖2.1所示。顯示的結(jié)構(gòu)特征就是采用多關(guān)節(jié)型結(jié)構(gòu)。動力源采用 舵機(jī)直接驅(qū)動。這樣不但可以實現(xiàn)結(jié)構(gòu)緊湊、傳動精度高以及大大增加關(guān)節(jié)所能 達(dá)到的最大角度,而且驅(qū)動源全為干電池,便于集中控制和程序化控制。 Front View Rear View 圖2.1 仿生機(jī)器人模型 圖2.1人形機(jī)器人,頭部和身體相連接(圖2.2) o肩關(guān)節(jié)、大臂和小臂各一個 自由度(圖2.3,圖2.4),髖關(guān)節(jié)一個自由度,大腿(圖2.5,圖2.6) 2個自由度, 小腿和腳步各一個自由度。各個關(guān)節(jié)的活動范圍理論上是 180度 (由于零件之間 互相干涉,關(guān)節(jié)之間活動范圍以實際為準(zhǔn))。 8 模
28、塊化仿生機(jī)器人設(shè)計 # 模塊化仿生機(jī)器人設(shè)計 圖2.2 機(jī)器人頭部和身體 # 模塊化仿生機(jī)器人設(shè)計 9 模塊化仿生機(jī)器人設(shè)計 圖2.4 機(jī)器人右手臂 圖2.5 機(jī)器人左腿 10 模塊化仿生機(jī)器人設(shè)計 圖2.6 機(jī)器人右腿
29、 2.3驅(qū)動方式的選擇 由于此次設(shè)計的仿生機(jī)器人只是達(dá)到簡單運動,而且為了使機(jī)器人行走穩(wěn) 定,所以對機(jī)器人的各個關(guān)節(jié)旋轉(zhuǎn)的角度和配合都需要比較精確的控制, 所以所 有的驅(qū)動都是由舵機(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 螺栓螺帽 M3 x 11(mm) 145 兩足機(jī)器人的相關(guān)尺寸,如表2.2 表2.2總體尺寸 名稱 尺寸(高x寬mm) 總體 348 x 195
30、手臂 189 x 49 腿部 198 x 49 舵機(jī)的相關(guān)參數(shù),如表2.3 表2.3舵機(jī)參數(shù) 型號 重量k 軸承 減速比 馬達(dá) 6V 7.4V 墻轉(zhuǎn)扭距 (kg-crfl) 空m電 流(mA) s/BQa 堵萍掃拒 空戢工柞電 SR51& 75 230 空業(yè)杯 0JS 141.4 J00J3 021 17 J3 2^7 12 模塊化仿生機(jī)器人設(shè)計 3. 人形仿生機(jī)器人控制系統(tǒng)硬件設(shè)計 控制系統(tǒng)是用于控制機(jī)器人的運動、傳感器數(shù)據(jù)采集,機(jī)器人與人的交互等。 控制系統(tǒng)有一個主控制器來實現(xiàn),主控
31、制器對每個機(jī)器人的模塊分別控制,機(jī)器 人的運動控制算法是在主控制器中設(shè)計,每個模塊上的舵機(jī)里有 CPU通過232 或485總線跟主控制器進(jìn)行通信。 在這部分要設(shè)計主控制器,編寫程序,設(shè)定與每個模塊的通信協(xié)議,實現(xiàn)機(jī) 器人的整體協(xié)調(diào)動作。 3.1硬件系統(tǒng)的基本要求 雙足行走機(jī)器人是對人類的模仿。但人類的結(jié)構(gòu)極其復(fù)雜,對人類步行原理 的研究至今仍有許多未解決的問題。 所以在設(shè)計雙足行走機(jī)器人機(jī)械結(jié)構(gòu)時, 會 對人類步行的結(jié)構(gòu)進(jìn)行減化,只會考慮基本的步行功能。所以雙足行走機(jī)器人通 常腿部只具有8至12個自由度,胯部具有0至3個自由度。本課題設(shè)計的機(jī)器 人共有16個自由度,驅(qū)動器為微型直流伺
32、服電機(jī),簡稱舵機(jī)。 本文設(shè)計的控制系統(tǒng)在硬件上至少滿足如下 5個基本要求: (1) 產(chǎn)生不少于16路獨立的高精度單邊沿PWM&號,用來控制作為機(jī)器人 關(guān)節(jié)驅(qū)動器的16個舵機(jī); (2) 具有調(diào)試接口; (3) 具有一個與PC機(jī)通信的接口; (4) 具有多路A/D轉(zhuǎn)換電路,用來擴(kuò)展傳感器; (5) 具有獨立而穩(wěn)定的電源。 我們設(shè)計的機(jī)器人所用的高精度直流伺服電機(jī),控制信號為 0.5ms?2.5ms 高電平的PWM&號,對應(yīng)轉(zhuǎn)角為0度到300度,電機(jī)精度為0.1度,則控制信號 的精度應(yīng)該高于(2.5ms?0.5ms)/1800 =1.11卩s。 3.2硬件系統(tǒng)設(shè)計的技
33、術(shù)路線和總體方案 3.2.1處理器選型 智能仿生機(jī)器人系統(tǒng)主要由伺服電機(jī)模塊、傳感器模塊、主控制器模塊及結(jié) 構(gòu)連接件構(gòu)成。 主控制器模塊為機(jī)器人的大腦,總體協(xié)調(diào)各個部分的運動、感知等功能。 伺服電機(jī)模塊為機(jī)器人的運動系統(tǒng), 每個自由度采用一個伺服電機(jī)模塊。伺 服電機(jī)模塊標(biāo)有不同的ID號,通過串行總線與主控制器通信。 傳感器模塊包含幾種傳感器,為機(jī)器人的感覺系統(tǒng)。傳感器模塊唯一的 ID 號,通過串行總線與主控制器通信。 結(jié)構(gòu)連接件具有多種形狀,可以搭接成不同形式的機(jī)器人。 在機(jī)器人控制系統(tǒng)中常用的處理器有: TI C2000和C6000系列DSR 8051 和AVR單片機(jī)、A
34、RM系列、STM32系列、PC104和PowerPC單板計算機(jī)等。它們 各自具有鮮明的特點,通常都是為了特殊的應(yīng)用而設(shè)計,如表 3.1所示。 表3.1 機(jī)器人控制系統(tǒng)中常用處理器 機(jī)器人控制系統(tǒng)中常 用的處理器 處理器的特點 在機(jī)器人控制系統(tǒng)中的應(yīng)用 具有很強(qiáng)的數(shù)字信號處理能力,適合運動控 運動控制、語音處理。尤其適合 C2000 系歹y DSP 制,硬件設(shè)計方便。 執(zhí)行針對單個或一對直流(無刷)電 機(jī)的復(fù)雜算法。 具有極強(qiáng)的數(shù)字信號處理能力, 具有專門的 高級的視覺處理和模式識別 C6000 系歹y DSP 操作系統(tǒng),硬件設(shè)計非常復(fù)雜。 8
35、051和AVR系列單片 結(jié)構(gòu)和指令簡單;運算能力較低,通常不支 簡單的運動控制和信號處理,在 機(jī) 持操作系統(tǒng):幾乎全部芯片都己經(jīng)單片化,硬件 復(fù)雜的控制系統(tǒng)中作為局部控制器。 設(shè)計非常方便。 典型的RISC處理器,運算能力較強(qiáng),支持 小型機(jī)器人主控制器,常用于運 ARM7系列 多種操作系統(tǒng):部分型號芯片己經(jīng)單片化,硬件 動控制和傳感器信號處理。 設(shè)計較方便。 專為要求高性能、低成本、低功耗設(shè)計,運 機(jī)器人主控制器,同以進(jìn)行視覺 STM32系列系列 算能力很強(qiáng),支持多種操作系統(tǒng);幾乎沒有單片 處理、語音處理和模式識別。 化,硬件設(shè)計
36、較復(fù)雜。 PC104, PowerPC 等單 由PC演化而來,通用性很強(qiáng),功耗大,硬 復(fù)雜的擬人機(jī)器人的主控制器。 板計算機(jī) 件設(shè)計非常復(fù)雜。 DSP處理器在譜分析、FFT變換、數(shù)字濾波等方面得到非常廣泛地應(yīng)用。 TI公司的02000系列DSP主要用來進(jìn)行運動控制,適合用于執(zhí)行針對單個或少 量電機(jī)的高級控制算法。雖然C2000在桌面型兩足機(jī)器人中也有應(yīng)用,但C2000 對操作系統(tǒng)的支持能力有限,一般不使用操作系統(tǒng),所以如果作為主控制器會帶 來軟件設(shè)計上的局限性。 C6000系列具有很高的主頻、豐富的硬件資源、特殊的系統(tǒng)結(jié)構(gòu),數(shù)字信號 處理能力非常強(qiáng)大,并且 TI公司特地
37、為 C6000(和C5000)系列開發(fā)了專用 DSP/BIOS操作系統(tǒng)。DSP/BIOS操作系統(tǒng)使C6000如虎添翼,成為了高級視覺 處理應(yīng)用的主流處理器。但使用 C6000作為處理器時電路復(fù)雜,通常只在大型 擬人機(jī)器人中作為高級的視覺處理器,小型的機(jī)器人中應(yīng)用很少。 8051和AVR系列單片機(jī)通常在其內(nèi)部集成了 CPU、存儲器、總線邏輯、看 門狗、1/0、以及其他接口,單片化的特性使其體積和功耗都大大減小,在雙足 行走機(jī)器人中得到了廣泛使用。 ARM7系列處理器是ARM處理器中使用很多的一款。ARM7處理器是典型 的RISC處理器,對操作系統(tǒng)的支持能力很強(qiáng),適合運行多種操作系統(tǒng)。 單板
38、計算機(jī)由通用計算機(jī)演化而來,常見的有PC104 PowerPC、MIPS>68000 等。單板計算機(jī)具有良好的通用性,對操作系統(tǒng)具有極強(qiáng)的支持能力。 但其設(shè)計 和開發(fā)比較復(fù)雜,功耗較大,在擬人機(jī)器人等大型機(jī)器人中經(jīng)常被用作主控制器。 本文結(jié)合控制系統(tǒng)設(shè)計的基本要求和常用處理器,高性能、低功耗的 8位 STM32F103RCT6處理器,指令執(zhí)行時間為單個時鐘周期,速度快,控制精度高、 I/O 口驅(qū)動能力更強(qiáng),優(yōu)于 AT51、STC51系列單片機(jī)。 3.2.2舵機(jī)的控制特性 舵機(jī)又稱為直流伺服電機(jī),是一種位置伺服驅(qū)動器,適用于角度不斷變化并 可以保持的控制系統(tǒng)。我們設(shè)計的仿生機(jī)器人的
39、直流伺服電機(jī)使用 +7V至+12V 電源,內(nèi)部基準(zhǔn)信號為周期為20ms的PWM周期信號,輸入的控制信號也必須 是周期為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個舵機(jī),所以在設(shè)計控制系統(tǒng)硬 件電路時,除了需要提供9V至12V的電源外,還必須提供至少16路4V至6V 的PWM信號。 3.2.3硬件設(shè)計總體方案 對應(yīng)于控制系統(tǒng)硬件設(shè)計的基本要求,作了如下的設(shè)計方案 : (1) 核心電路包括STM32核心處理器、
40、調(diào)試接口、串口驅(qū)動電路和A/D轉(zhuǎn)換 基準(zhǔn)電壓電路,原理如圖3.2所示。 圖3.2 核心電路原理圖 58K (2) 控制系統(tǒng)需要控制16個舵機(jī),使機(jī)器人完成相應(yīng)的動作??刂浦绷魉?服電機(jī)的PWM&號的周期為20ms高電平持續(xù)時間為0. 5ms至2. 5ms占空比 較小,最大僅為1/8,所以可以進(jìn)行多路分時復(fù)用。控制系統(tǒng)是用于控制機(jī)器人 的運動、傳感器數(shù)據(jù)采集,機(jī)器人與人的交互等。控制系統(tǒng)有一個主控制器來實 現(xiàn),主控制器對每個機(jī)器人的模塊分別控制,機(jī)器人的運動控制算法是在主控制 器中設(shè)計,每個模塊上的舵機(jī)里有 CPU通過232或485總線跟主控制器進(jìn)行通 信。 在這部分要設(shè)計主
41、控制器,編寫程序,設(shè)定與每個模塊的通信協(xié)議,實現(xiàn)機(jī) 器人的整體協(xié)調(diào)動作。 其舵機(jī)PWM&號控制電路原理如圖3.3所示。 lAfr 1-fiMD 銘口 B9-217zH6C^>:K^T 芮陽 £ H-PI 7zRSC-^L 0?z5T 圖3.3 PWM信號控制原理圖 324電源設(shè)計 為了增加機(jī)器人的靈活性,機(jī)器人使用高性能充電電池供電。 直流伺服電機(jī) 的電源要求為9V至12V,本文選用了電壓為10V的高性能電池,直接作為直流 伺服電機(jī)的電源。 由于基于STM32的處理器和外設(shè)均使用3. 3V電源電壓,所以需要選用電 源電壓轉(zhuǎn)換器進(jìn)行電壓轉(zhuǎn)換。我們使用了
42、一個直流電壓轉(zhuǎn)換芯片 SWDM02將電 池的直流電源轉(zhuǎn)換為相應(yīng)的電流。如圖 3.4所示是機(jī)器人電源部分的控制圖: 18 模塊化仿生機(jī)器人設(shè)計 19 模塊化仿生機(jī)器人設(shè)計 STD_3RS4_3TM_I 3rg_2*?&4_JTH_j SFD_M54 占El 圖3.4 電源控制原理圖 # 模塊化仿生機(jī)器人設(shè)計 4. 仿生機(jī)器人控制系統(tǒng)軟件設(shè)計 STM3系列單片機(jī)通常在其內(nèi)部集成了 CPU存
43、儲器、總線邏輯、I/O、以及 其他接口,單片化的特性使其體積和功耗都大大減小, 在雙足行走機(jī)器人中得到 了廣泛使用,現(xiàn)在在操作系統(tǒng)下設(shè)計并實現(xiàn)了模塊化仿生機(jī)器人控制系統(tǒng)的多個 應(yīng)用軟件,構(gòu)成了一個完整的控制系統(tǒng)軟件框架;最后改進(jìn)了常見的多路 PW產(chǎn) 生方法,具有很高的PW信號的精度和系統(tǒng)的實時性,并對模塊化仿生機(jī)器人進(jìn) 行了關(guān)節(jié)調(diào)試。 4.1軟件系統(tǒng)的基本要求 根據(jù)機(jī)器人控制系統(tǒng)的功能需求和硬件電路的特點,軟件系統(tǒng)至少需要滿足 以下4個要求: (1) 軟件模塊化,具有很好的可維護(hù)和可擴(kuò)展性。 (2) 實現(xiàn)PW信號的分時復(fù)用,并要保證PW信號的高精度。并且通過軟件, 能夠及時地改變P
44、W的輸出。 (3) 通過RS23接口能和PCM通信。 (4) 接收上位機(jī)的運動列表,串口和 USB程序下載,能夠從上位機(jī)更新固 件程序。 4.2軟件設(shè)計的總體方案 CPU STM32F103 軟件開發(fā)平臺:Keil-C 功能要求:接收上位機(jī)的運動列表,串口和 US程序下載,能夠從上位機(jī)更 新固件程序。 方式:與上位機(jī)統(tǒng)一運動列表格式,控制其他模塊時采用串口通信,封裝標(biāo) 準(zhǔn)API函數(shù)。 函數(shù)列表: (1) 伺服電機(jī)初始化Motor」nit 函數(shù)功能:電機(jī)初始化 入口參數(shù):nModule 模塊序號 = 模塊ID 出口參數(shù):1 成功 0 失敗 函數(shù)原型:BOOL Mot
45、or」nit(ui nt8 n Module ) (2) 伺服電機(jī)驅(qū)動Motor_Drive 函數(shù)功能:電機(jī)驅(qū)動 入口參數(shù):nM odule 模塊序號 =模塊ID Velocity 運行速度,單位:百分比,數(shù)值為正時朝前;數(shù)值為負(fù)時朝后。 Degree 旋轉(zhuǎn)角度,單位:度,數(shù)值為正時順時針;數(shù)值為負(fù)時逆時針, 0 時停止 出口參數(shù):1 成功 0 失敗 函數(shù)原型:BOOL Motor_Drive(ui nt8 n Module , ui nt32 Velocity, ui nt8 Degree ) (3) 伺服電機(jī)停止Motor_Stop 函數(shù)功能:電機(jī)停止 入口參數(shù):n
46、Module 模塊序號 = 模塊ID 出口參數(shù):1 成功 0 失敗 函數(shù)原型:BOOL Motor_Stop(ui nt8 nM odule ) (4) 讀取電機(jī)溫度Motor_ReadTemp 函數(shù)功能:讀取電機(jī)模塊溫度 入口參數(shù):nModule 模塊序號 = 模塊ID temp 溫度值 出口參數(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 模塊序號 = 模塊ID t
47、emp 溫度值 出口參數(shù):1 成功 0 失敗 函數(shù)原型:BOOL Module_ReadID(ui nt8 nM odule ) (6) 讀取紅外數(shù)值Sensor_Read 函數(shù)功能:讀取傳感器數(shù)值 入口參數(shù):nModule 模塊序號 = 模塊ID nSensor 紅外序號,0=前,1=左, 2=右;光敏=4;聲音=5 value 參數(shù)值 出口參數(shù):1 成功 0 失敗 函數(shù)原型:BOOlMotor_PWMSet(uint8 nModule , uint8 nSensor , uint32 temp) (7) 讀取模塊 ID號Module_ReadlD 函數(shù)功能:設(shè)
48、置PW值,調(diào)整電機(jī)速度 入口參數(shù):nMotor 電機(jī)序號 =模塊ID temp 溫度值 出口參數(shù):1 成功 0 失敗 函數(shù)原型:BOOL Module_ReadID(ui nt8 nM otor) 4.3舵機(jī)與控制系統(tǒng) 4.3.1工作模式 主控制器模塊為機(jī)器人的大腦,總體協(xié)調(diào)各個部分的運動、感知等功能。 舵機(jī)模塊為機(jī)器人的運動系統(tǒng),每個自由度采用一個伺服電機(jī)模塊。 伺服電 機(jī)模塊標(biāo)有不同的ID號,通過串行總線與主控制器通信。 傳感器模塊包含幾種傳感器,為機(jī)器人的感覺系統(tǒng)。傳感器模塊唯一的 ID 號,通過串行總線與主控制器通信。 主控制器分別與十六個伺服電機(jī)以及傳感器相連
49、,主控制器負(fù)責(zé)向各個舵機(jī) 發(fā)送命令,而舵機(jī)則反饋信息給主控制器。 4.3.2通信原理圖 主控制器負(fù)責(zé)向各個舵機(jī) 主控制器分別與十六個伺服電機(jī)以及傳感器相連, 發(fā)送命令,而舵機(jī)則反饋信息給主控制器。 23 模塊化仿生機(jī)器人設(shè)計 24 模塊化仿生機(jī)器人設(shè)計 圖4.5 通信示意圖 # 模塊化仿生機(jī)器人設(shè)計 4.4舵機(jī)的選擇 舵機(jī)在無線電業(yè)余愛好者的航?;顒又惺褂靡延泻荛L一段歷史, 而且應(yīng)用最 為廣泛,國內(nèi)亦稱之為“舵機(jī)”,含義為:“掌舵人操縱的機(jī)器”。舵機(jī)是一種 位置伺服的驅(qū)動器。它是機(jī)器人、機(jī)電系統(tǒng)和航模的重要執(zhí)行機(jī)構(gòu)。
50、它接收一定 的控制信號,輸出一定的角度,適用于那些需要角度不斷變化并可以保持的控制 系統(tǒng)。標(biāo)準(zhǔn)的舵機(jī)有3條導(dǎo)線:電源線(紅)、地線(黑或灰)、控制線(白或 橙黃)??刂凭€的輸入是一個寬度可調(diào)的周期性方波脈沖信號( PWM),方波 脈沖信號的周期為20 ms(即頻率為50Hz),當(dāng)方波的脈沖寬度改變時,舵機(jī)轉(zhuǎn)軸 的角度發(fā)生改變,角度變化與脈沖寬度的變化成正比,也就是利用占空比的變化 來改變舵機(jī)的位置??梢?,其主要用作運動方向的控制部件。因此,機(jī)器人模型 中也常用到它作為可控的運動關(guān)節(jié),這些活動關(guān)節(jié)在機(jī)械原理中常稱它為自由 度。 4.4.1舵機(jī)的選型 本設(shè)計選用的舵機(jī)為“春天” SR518舵
51、機(jī),其圖和參數(shù)如圖4.11和表4.1所 示。 圖4.11 “春天” SR518舵機(jī) 根據(jù)機(jī)器人手臂部分受力分析計算出肩部舵機(jī)應(yīng)承受扭矩: T=F? L=0.79*7.05=5.57kg ? cm 根據(jù)機(jī)器人腿部受力分析計算出胯部舵機(jī)應(yīng)承受扭矩: T'=F' ? L'=1.004*9.1425=9.18kg ? cm 表4.1 “春天” SR518舵機(jī)參數(shù) 尺寸 重量 速度 扭力 使用電壓 45.9*35.7*41.6mm 75g 0.25sec/60 度 17.3千克/厘米 6V?12V 442所選舵機(jī)的控制特性 通訊
52、類型: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ī)器人設(shè)計 方式二:通過專用控制器控制 Controller 圖4.13專用控制器調(diào)試控制 用于舵機(jī)通訊的接口必須進(jìn)行如圖4.14處理: 匕匚丨! MU TKEM 麗CU TXD a 7 & SP435 VCC.5V 孑 C6 ND 1
53、 GND 圖4.14 UART接口原理圖 “春天” SR518舵機(jī)全轉(zhuǎn)角為0-300度,它的對應(yīng)的控制關(guān)系如表4.2所示 PW波脈寬 舵機(jī)轉(zhuǎn)角 對應(yīng)轉(zhuǎn)角簡圖 0.5ms 0度 口 0.9ms 45度 表4.2 PWM波脈寬與舵機(jī)轉(zhuǎn)角關(guān)系 # 模塊化仿生機(jī)器人設(shè)計 1.5ms 90度 2.1ms 135度 2.5ms 180度 i 27 模塊化仿生機(jī)器人設(shè)計 5. 仿生機(jī)器人步行模式的建立 有的機(jī)器人行走時質(zhì)心在地面上的投影始終在腳的支撐多邊形內(nèi), 這種步行 方式被稱為靜態(tài)步行;在人的日常行
54、走中,質(zhì)心在地面上的投影經(jīng)常會超越支撐 多邊形的范圍,這種步行方式被稱為動態(tài)步行。靜態(tài)步行模式在設(shè)計步態(tài)時需要 計算機(jī)器人的重心位置,以防止重心在地面上的投影超出了支撐多邊形范圍。 靜 態(tài)步行通常是在行走前離線設(shè)計好各個步行中的姿態(tài)和姿態(tài)切換的方法, 在行走 的過程中不能改變,一般只能在平地上行走。 本設(shè)計中的機(jī)器人的機(jī)械結(jié)構(gòu),它具有16個自由度,驅(qū)動器為微型直流伺服 電機(jī)。該機(jī)械結(jié)構(gòu)左右對稱,每條腿具有 5個自由度,分別為踝2個、膝I個、髖2 個;每個手臂具有3個自由度,分別為肩2個、肘1個。而我的主要任務(wù)是分析雙 腿的運動模式,研究10個舵機(jī)的轉(zhuǎn)動角度以及相互的協(xié)調(diào)工作的關(guān)系, 建立一
55、個 完整的運動模型。 在正確的把整個機(jī)器人完整的組裝起來后,我們要把機(jī)器人腿部的每個舵機(jī) 都標(biāo)注起來,以便后來的調(diào)試,腿部10個舵機(jī)的分布如圖5.1所示。 5.1靜態(tài)步行模式設(shè)計與實現(xiàn) 仿生機(jī)器人控制系統(tǒng)中使用了靜態(tài)步行模式線設(shè)計。靜態(tài)步行模式分為 8個 靜態(tài)姿勢及其切換順序如圖5.1所示。 其中直立是初始狀態(tài);起步是為步行做準(zhǔn)備,重心移到右腳;抬后腳 (左)、 邁步(左)和前腳著地(左)都是右腿支撐左腿擺動的姿態(tài);重心前移 (左)是兩腿支 撐,將重心從后面的右腳轉(zhuǎn)移到前面的左腳;抬后腳(右)、邁步(右)和前腳著地(右) 都是左腿支撐右腿擺動的姿態(tài);重心前移(右)是兩腿支撐,將重心
56、從后面由左腳 再次轉(zhuǎn)移到前面的右腳。重心在左右腳之間反復(fù)轉(zhuǎn)移,左右腳的前后關(guān)系也反復(fù) 轉(zhuǎn)換,實現(xiàn)機(jī)器人的步行。 28 模塊化仿生機(jī)器人設(shè)計 6 7 8 9 10 圖5.1 腿部舵機(jī)的分布 圖5.2 機(jī)器人行走步行模式 29 模塊化仿生機(jī)器人設(shè)計 5.2姿態(tài)運動的軟件實現(xiàn) 機(jī)器人的以上10個姿態(tài)按圖所示切換,就可以讓機(jī)器人在平地上步行。根 據(jù)腿部運動的模式,我們根據(jù)腿步各關(guān)節(jié)完成的角度可以輸入給每個舵機(jī)的 PWM 脈寬值,再反饋到舵機(jī)控制軟件 keil中,其完成從靜止開始起步的過程的偽代 碼指令如下: mai n() { RightArm
57、1(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) } LeftLeg1(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(u
58、p,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) { Motor1(dow n,40) Motor2(0,0) Motor3(0,0) } LeftArm1(up,40) { Motor9(up,40) Moto
59、r10(0,0) Motor11(0,0) } Reset() } 上述完成機(jī)器人向前運動一步然后靜止的一個過程,既從直立形態(tài)開始到抬 右手左腿起步再到直立靜止,然后我們再點擊如圖 5.3中的“激活循環(huán)控制”就 可以完成仿生機(jī)器人持續(xù)交替行走的動作了 圖5.3 激活循環(huán)控制 結(jié)論 仿生機(jī)器人是個廣泛應(yīng)用在教學(xué)、科研、比賽和娛樂等方面的機(jī)器人,集機(jī) 械學(xué)、電子學(xué)、控制科學(xué)、計算機(jī)、數(shù)學(xué)等于一體。本文根據(jù)當(dāng)前仿生機(jī)器人控 制系統(tǒng)中常用的處理器和操作系統(tǒng)各自的特點, 選用STM32微處理器,指令執(zhí)行 時間為單個時鐘周期,速度快,控制精度高、I/O 口驅(qū)動能力更強(qiáng),優(yōu)于A
60、T51、 STC5係列單片機(jī)。根據(jù)機(jī)器人的扭矩要求選擇了“春天” SR518舵機(jī)。并對仿 生機(jī)器人進(jìn)行了運動學(xué)分析和靜態(tài)步行設(shè)計,實現(xiàn)在機(jī)器人在平面上的穩(wěn)定行 動。 在本設(shè)計課題中,本文基本完成了仿生機(jī)器人機(jī)構(gòu)的結(jié)構(gòu)設(shè)計, 也理論上完 成了機(jī)器人的控制系統(tǒng),但是由于選擇的較為有難度的 16自由度機(jī)器人,所以 對于機(jī)器人結(jié)構(gòu)的選用材料、力學(xué)處理、控制系統(tǒng)處理器等客觀條件有了更高的 要求。所以該課題在以后還有很多要進(jìn)一步改進(jìn)和研究的地方: (1) 機(jī)器人使用更為先進(jìn)的處理器。 (2) 機(jī)器人腳底安裝力傳感器,用來感知機(jī)器人腳和地面接觸時的受力情 況,使用ZMF理論對機(jī)器人進(jìn)行步態(tài)控制。
61、 機(jī)器人增加視覺系統(tǒng),使機(jī)器人可以識別簡單的目標(biāo)。 33 模塊化仿生機(jī)器人設(shè)計 參考文獻(xiàn) [1] 柳洪義,宋偉剛?機(jī)器人技術(shù)基礎(chǔ)[M].北京:冶金工業(yè)出版社,2002 [2] 蔣新松主編.機(jī)器人學(xué)導(dǎo)論[M].沈陽:遼寧科學(xué)技術(shù)出版社,1994. [3] 孫富春,朱紀(jì)洪,劉國棟等?機(jī)器人學(xué)導(dǎo)論-分析、系統(tǒng)及應(yīng)用[M].北京: 電子工業(yè)出版社,2004. [4] 周遠(yuǎn)清,張再興等編著.智能機(jī)器人系統(tǒng)[M].北京:清華大學(xué)出版社,1989. ⑸ 方建軍,何廣平.智能機(jī)器人[M].北京:化學(xué)工業(yè)出版社,2004. [6] 胡凌云,孫增沂.雙足機(jī)器人步態(tài)控制研究方法綜述[J].
62、計算機(jī)研究與發(fā) 展,2005. [7] 李開生,張慧慧,費仁元.機(jī)器人控制器體系結(jié)構(gòu)研究的現(xiàn)狀和發(fā)展[J]. 機(jī)器人,May 2000,22(3):235-240. [8] 劉森,慕春棣,趙明國.基于ARM嵌入式系統(tǒng)的擬人機(jī)器人控制器的設(shè)計[J]. 北京:清華大學(xué)學(xué)報(自然科學(xué)版),2008,48⑷:482-485. [9] 棍田秀司著,管貽生譯,仿人機(jī)器人.北京:清華大學(xué)出版社,2007. [10] 日本機(jī)器人學(xué)會著,宗光華等譯,機(jī)器人技術(shù)手冊.北京:科學(xué)出版社,2007 [11] 宏緒,張彭,張良起,雙足步行機(jī)器人動態(tài)步行姿態(tài)穩(wěn)定性及姿態(tài)控制機(jī)器 人,19(3): 180 一 1
63、86,1997 [12] 湯卿,仿人機(jī)器人設(shè)計及步行控制方法【博士論文】杭州 :浙江大學(xué),2009. [13] 王超,類人機(jī)器人上肢體的設(shè)計與動力學(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è)計與實現(xiàn)[碩士學(xué)位論文].杭州:浙江大學(xué), 2009. [17] 丁樹模.機(jī)械工程學(xué)[M].北京:機(jī)械工業(yè)出
64、版社,2000. [18] S. H. Lu and C. C. Lee, “InterferometryMeasurement of Gauge Block Using 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
65、up 致謝 本論文是在老師的綜合指導(dǎo)下,并通過自己的學(xué)習(xí)和親自查閱有關(guān)資料下完 成的。畢業(yè)設(shè)計是大學(xué)本科的最后一門必修的課程, 也是最綜合的一門課,它用 到了幾乎所有在大學(xué)學(xué)到的知識,能綜合的考查學(xué)生設(shè)計能力和對機(jī)械知識的掌 握和運用程度,是對我們四年來所學(xué)到知識大總結(jié)。 雖然這次設(shè)計只有僅僅的三 個月,但是我的分析問題的能力、解決問題的能力及獨立思考問題的能力和查閱 資料的能力卻明顯得到提高,這些能力的培養(yǎng)將是我以后走上工作崗位造就人生 的一筆財富,奠定了基礎(chǔ)。 在設(shè)計過程中,指導(dǎo)老師對我們都極度關(guān)注,我忠心的感謝老師的熱心、耐 心,以及細(xì)致的指導(dǎo)。在默默奉獻(xiàn)的老師們的指導(dǎo)下,我們達(dá)不
66、到預(yù)期的效果 ? 在此再次的表示忠心的感謝和誠摯的問候。 37 模塊化仿生機(jī)器人設(shè)計 38 模塊化仿生機(jī)器人設(shè)計 r L3m IroH fw 上律電機(jī)于險 主竝樁原風(fēng)陽 39 模塊化仿生機(jī)器人設(shè)計 40 模塊化仿生機(jī)器人設(shè)計 UPM 3U &ddFal±^ 郞UA I學(xué)雪 上籟電機(jī)學(xué)隔 主禪樁更風(fēng)陽1 41
- 溫馨提示:
1: 本站所有資源如無特殊說明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請下載最新的WinRAR軟件解壓。
2: 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
3.本站RAR壓縮包中若帶圖紙,網(wǎng)頁內(nèi)容里面會有圖紙預(yù)覽,若沒有圖紙預(yù)覽就沒有圖紙。
4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
5. 裝配圖網(wǎng)僅提供信息存儲空間,僅對用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對任何下載內(nèi)容負(fù)責(zé)。
6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請與我們聯(lián)系,我們立即糾正。
7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時也不承擔(dān)用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。
最新文檔
- 2023年六年級數(shù)學(xué)下冊6整理和復(fù)習(xí)2圖形與幾何第7課時圖形的位置練習(xí)課件新人教版
- 2023年六年級數(shù)學(xué)下冊6整理和復(fù)習(xí)2圖形與幾何第1課時圖形的認(rèn)識與測量1平面圖形的認(rèn)識練習(xí)課件新人教版
- 2023年六年級數(shù)學(xué)下冊6整理和復(fù)習(xí)1數(shù)與代數(shù)第10課時比和比例2作業(yè)課件新人教版
- 2023年六年級數(shù)學(xué)下冊4比例1比例的意義和基本性質(zhì)第3課時解比例練習(xí)課件新人教版
- 2023年六年級數(shù)學(xué)下冊3圓柱與圓錐1圓柱第7課時圓柱的體積3作業(yè)課件新人教版
- 2023年六年級數(shù)學(xué)下冊3圓柱與圓錐1圓柱第1節(jié)圓柱的認(rèn)識作業(yè)課件新人教版
- 2023年六年級數(shù)學(xué)下冊2百分?jǐn)?shù)(二)第1節(jié)折扣和成數(shù)作業(yè)課件新人教版
- 2023年六年級數(shù)學(xué)下冊1負(fù)數(shù)第1課時負(fù)數(shù)的初步認(rèn)識作業(yè)課件新人教版
- 2023年六年級數(shù)學(xué)上冊期末復(fù)習(xí)考前模擬期末模擬訓(xùn)練二作業(yè)課件蘇教版
- 2023年六年級數(shù)學(xué)上冊期末豐收園作業(yè)課件蘇教版
- 2023年六年級數(shù)學(xué)上冊易錯清單十二課件新人教版
- 標(biāo)準(zhǔn)工時講義
- 2021年一年級語文上冊第六單元知識要點習(xí)題課件新人教版
- 2022春一年級語文下冊課文5識字測評習(xí)題課件新人教版
- 2023年六年級數(shù)學(xué)下冊6整理和復(fù)習(xí)4數(shù)學(xué)思考第1課時數(shù)學(xué)思考1練習(xí)課件新人教版