畢業(yè)設(shè)計論文---基于手腳融合的多足步行機器人的運動精度研究

1、<p>　　本科畢業(yè)設(shè)計（論文）</p><p>　　題 目 基于手腳融合的多足步行機器</p><p><b>　　人的運動精度研究</b></p><p>　　基于手腳融合的多足步行機器人的運動精度研究</p><p><b>　　摘 要</b></p>&l

2、t;p>　　機器人運動誤差是衡量機器人性能的重要指標之一，直接影響到機器人的工作質(zhì)量，對多足步行機器人的運動精度研究是一項重要而富有意義的工作。本文以四足步行機器人為研究對象，通過分析機器人的正運動學和逆運動學運動方程和誤差方程，對步行機器人的精度分析問題進行了比較深入的理論研究。</p><p>　　首先，結(jié)合國內(nèi)外多足步行機器人現(xiàn)狀和誤差分析現(xiàn)狀以及多足步行機器人的機構(gòu)特點，分析了運動誤差的主要來源。&

3、lt;/p><p>　　其次，在多足步行機器人正逆運動學的求解過程的基礎(chǔ)上，運用微分的方法計算運動機器人正逆運動的誤差方程。</p><p>　　最后，在MATLAB環(huán)境下編制相應(yīng)的誤差分析程序，通過實例仿真驗證誤差分析的正確性。</p><p>　　關(guān)鍵詞： 多足步行機器人/正運動學/逆運動學/誤差分析</p><p>　　HAND-FOOT

4、-INTEGRATED </p><p>　　MECHANUSM THE MORE WALKING ROBOT </p><p>　　FUSION ACCURACY OF MOVEMENT</p><p><b>　　ABSTRACT</b></p><p>　　The motion error is one of t

5、he important indexes robot performances, which affect the working quality of the multilegged walking robot directly, for much of the motion precision walking robot research is an important and meaningful work. Based on f

6、our walking robot for research object, through the analysis of the robot kinematics and inverse kinematics is in error equations equation and the walking robot, precision analysis problem, deeply theoretical research.<

7、;/p><p>　　First, combined with the domestic and foreign many walking robot present situation and the error analysis, as well as the characteristics of the walking robot, the error analysis of movement error is

8、the main reason for the difference.</p><p>　　Secondly, in walking robot is the inverse kinematic solution process, using the differential method of inverse robot motion equation of movement error. </p>

9、<p>　　Finally, in the MATLAB environment corresponding error analysis program compiled by example to prove the correctness of the error analysis.</p><p>　　Keywords:multi-legged walking robot，forward

10、kinematics，inverse kinematics，Error analysis </p><p><b>　　目 錄</b></p><p><b>　　摘 要I</b></p><p>　　ABSTRACTII</p><p><b>　　1緒論1</b&g

11、t;</p><p><b>　　1.1引言1</b></p><p>　　1.2課題來源、目的及意義1</p><p>　　1.3國內(nèi)外研究現(xiàn)狀2</p><p>　　1.4本文研究內(nèi)容7</p><p>　　2多足步行機器人的正運動學分析和誤差分析9</p>

12、<p><b>　　2.1引言9</b></p><p>　　2.2研究對象的介紹10</p><p>　　2.3影響運動誤差的主要因素11</p><p>　　2.4機器人正運動學分析和誤差分析13</p><p>　　2.4.1串聯(lián)機械手的正運動學13</p><p&g

13、t;　　2.4.2機器人抓取時的正運動學分析16</p><p>　　2.4.3算例19</p><p>　　2.5本章小結(jié)21</p><p>　　3多足步行機器人的逆運動學分析和誤差分析22</p><p>　　3.1機器人的逆運動學分析和誤差分析22</p><p><b>　　3.2

14、算例26</b></p><p>　　3.3本章小結(jié)28</p><p><b>　　結(jié)論29</b></p><p><b>　　致謝30</b></p><p><b>　　參考文獻31</b></p><p><b&g

15、t;　　附 錄33</b></p><p><b>　　附錄133</b></p><p><b>　　附錄237</b></p><p><b>　　緒論</b></p><p><b>　　引言</b></p><

16、;p>　　在自然界和人類社會中,存在一些人類無法到達的地方和可能危及人類生命的特殊場合,如行星表面、災(zāi)難發(fā)生礦井、防災(zāi)救援和反恐斗爭等,對這些危險環(huán)境進行不斷地探索和研究,尋求一條解決問題的可行途徑成為科學技術(shù)發(fā)展和人類社會進步的需要。具有仿生特征的移動機器人，因為能夠代替人在一些非結(jié)構(gòu)性環(huán)境中作業(yè)而成為了學者們研究和關(guān)注的熱點。</p><p>　　傳統(tǒng)的移動機器人主要包括履帶式、足式、輪式、混合式等多種

17、運動形式。其中，履帶式和輪式機器人結(jié)構(gòu)較簡單，其運動能力受到環(huán)境因素的限制。相對于輪式、履帶式機器人而言，多足步行機器人在非結(jié)構(gòu)化、存在不確定性的環(huán)境內(nèi)移動雖具有較大的優(yōu)勢，但現(xiàn)有的多足步行機器人通常作為一種單純的移動平臺,或者配置特定的機械臂才能完成作業(yè)。如果能夠在腿/臂融合結(jié)構(gòu)基礎(chǔ)上，把多足機器人的腿設(shè)計成具有手腳融合功能的結(jié)構(gòu)形式，可使其能在在更多特殊環(huán)境和場合中使用,因而該類機器人具有廣闊的應(yīng)用前景。</p>&l

18、t;p>　　鑒于此，為了拓展多足步行機器人的實際應(yīng)用,在世界范圍內(nèi)的科研人員對多足步行機器人的結(jié)構(gòu)及所配工具開展了廣泛的研究，如日本東京工業(yè)大學開發(fā)了TITAN-IX型排雷四足步行機器人。</p><p>　　瞄準國內(nèi)外機器人技術(shù)的前沿，為了給我國步行機器人的研究提供理論平臺和關(guān)鍵技術(shù)，開展多足機器人的技術(shù)和相關(guān)理論研究具有重要的科學意義和應(yīng)用價值。</p><p>　　課題來源、目

19、的及意義</p><p>　　課題來源于國家自然科學基金（編號：50875246）：本文是分析多足步行機器人運動時誤差產(chǎn)生的原因，建立誤差分析的模型，對誤差參數(shù)經(jīng)行分析。</p><p>　　步行機器人(walking robot)或步行車輛(walking vehicle)簡稱步行機,是一種智能型機器人,它是涉及到生物科學、仿生學、機構(gòu)學、傳感技術(shù)及信息處理技術(shù)等的一門綜合性高科技。在崎

20、嶇路面上,步行機器人優(yōu)于輪式或履帶式車輛。步行機器人腿式系統(tǒng)具有很大的優(yōu)越性：較好的機動性,崎嶇路面上乘坐的舒適性,對地形的適應(yīng)能力強。所以,這類機器人在軍事運輸、海底探測、礦山開采、星球探測、殘疾人的輪椅、教育及娛樂等眾多行業(yè),有非常廣闊的應(yīng)用前景,多足步行機器人技術(shù)一直是國內(nèi)外機器人領(lǐng)域的研究熱點之一。</p><p>　　定位精度是衡量多足機器人性能的一個重要指標，因此，無論在理論上還是在實驗當中都受到了國

21、內(nèi)外學者的廣泛關(guān)注。目前，由于工業(yè)機器人的廣泛應(yīng)用，針對其誤差的研究已經(jīng)受到了廣大學者的關(guān)注，而多足步行機器人尚未能像工業(yè)機器人那樣大規(guī)模的應(yīng)用,其基礎(chǔ)理論的研究比較滯后,關(guān)于其位姿誤差分析的研究自今很少涉及。</p><p>　　通過多足步行機器人的位姿誤差分析，可以得到各個誤差源對機器人機構(gòu)輸出位姿的影響程度，從而可以發(fā)現(xiàn)機構(gòu)中的關(guān)鍵環(huán)節(jié)，明確提高機器人精度的重點和方向，為改善機器人的設(shè)計質(zhì)量和提高機器人的設(shè)

22、計水平提供準確可靠的資料和依據(jù)。因此，在多足步行機器人領(lǐng)域?qū)冗M行研究是一項重要而富有實際意義的工作。</p><p>　　本課題的研究將介紹一種多足步行機器人的誤差分析的方法，以四足步行機器人為例，通過仿真驗證該方法的可行性。該課題的研究將會促進多足步行機器人向?qū)嵱没~進。</p><p><b>　　國內(nèi)外研究現(xiàn)狀</b></p><p>

23、;　　1.3.1多足步行機器人的研究現(xiàn)狀</p><p>　　多足步行機器人的發(fā)展最早可追溯到中國古代三國時的“木牛流馬”。有據(jù)可查的是在1893年Rygg設(shè)計的機械馬，歷經(jīng)一個多世紀的發(fā)展，特別是隨著20世紀后期計算機技術(shù)、電子技術(shù)、人工智能技術(shù)、生物工程的飛速發(fā)展，多足步行機器人的研究已經(jīng)取得了長足的進步。</p><p>　　20世紀60年代初，由美國的Shigley和Baldwin

24、設(shè)計出了比履帶車或輪式車更為靈活的步行機。比較典型的是由Mosher（美國）在1968年設(shè)計的“WalkingTruck”四足車[1]，如圖1-1所示。其四條腿采用液壓驅(qū)動，手臂和腳安裝有位置傳感器，具有步行和爬越障礙的功能，因此，“WalkingTruck”被視為步行機發(fā)展史上一個里程碑。</p><p>　　在1976年，日本的Shiego Hirose 成功研制了世界上第一臺四足步行機器人KUMO，如圖1-

25、2所示。它的外形像一個蜘蛛，有四條腿，能夠爬行[2]。</p><p>　　1983年由美國研制的 “ODEX-I” 六足步行機器人，6條腿沿圓周均布,且每條腿有3個自由度,適于在狹小空間里運動,還可以上下臺階。</p><p>　　1984-1986年東京大學的Shimoyama和Miura研制了Collie-l四足機器人，如圖l-3所示。在1986-1988又研制了Collie-2[3

26、]，如圖l-4所示。Collie-2每條腿有5個關(guān)節(jié)，且每個關(guān)節(jié)都裝有電位器。該機器人裝有實時操作系統(tǒng)，實現(xiàn)了trot和pace步態(tài)。</p><p>　　1984-1986年東京大學的Shimoyama和Miura研制了Collie-l四足機器人，如圖l-3</p><p>　　所示。在1986-1988又研制了Collie-2[3]，如圖l-4所示。Collie-2每條腿有5個關(guān)節(jié)，且

27、每個關(guān)節(jié)都裝有電位器。該機器人裝有實時操作系統(tǒng)，實現(xiàn)了trot和pace步態(tài)。</p><p>　　美國NASA研制的微型爬行機器人“Spider-bot”，如圖1-5所示,機器人外形象蜘蛛, 重量輕,體積只有人頭部的一半大小,可以在不規(guī)則的星球表面爬行。1990年初由美國MIT AI Lab完成的仿昆蟲有腿行走機器人Attila,如圖1-6所示。Attila采用了模塊化設(shè)計, 頭、腿、身體都有各自的驅(qū)動器、傳感

28、器和子處理器，有19個自由度。</p><p>　　S.Hirose等研制的TITAN系列四足步行機器人歷經(jīng)了八代。TITAN-III[4]，其足由形狀記憶合金組成，且裝有信號處理系統(tǒng)和傳感器，可以自動檢測與地面接觸的狀態(tài)。1994年研制了TITAN-VII，其能夠躲避障礙和在陡峭和崎嶇的地方步行。1996年研制的四足機器人TITAN-VIII，如圖1-7所示，它具有很高的地面適應(yīng)能力，腿能夠作為工作臂，用于排雷

29、和探測地雷[5]。</p><p>　　加拿大McGill大學研制了四足機器人Scout-I [6]，如圖1-8所示，機器人只有四個自由度，每條腿有一個轉(zhuǎn)動關(guān)節(jié)。能轉(zhuǎn)彎、步行和跨臺階，但可靠性較差。Scout-II [7]，如圖1-9所示，能完成奔跑和步行等運動。</p><p>　　1995年，日本的安達、小谷內(nèi)等研究了手腳統(tǒng)一型步行機器人MELMANTIS[8],能將腳的移動和手臂的操

30、作統(tǒng)一起來。該機器人可進行地雷探測、森林采伐和拆除作業(yè)等。</p><p>　　1998年由德國開發(fā)的四足機器人BISAM[9]，如圖1-10所示。該機器人4條腿完全相同，每條腿之間由3個轉(zhuǎn)動關(guān)節(jié)相連，另一個轉(zhuǎn)動關(guān)節(jié)連接軀干和腿部。該機器人實現(xiàn)了實時控制。</p><p>　　西班牙開發(fā)的四足機器人SIL04，如圖1-11所示。機器人每條腿有3個回轉(zhuǎn)關(guān)節(jié)，并裝有傾角器、編碼器、力傳感器和電

31、位器。能在不平地面上行走，并能躲避障礙物。</p><p>　　2005年由大阪大學的新井健生、田窪明仁等研制成功的新型手腳統(tǒng)一型步行機器人ASTERISK[8]，如圖1-12所示。該機器人有6條腿, 且每條腿有4個自由度，具有用手搬運物品及用腳移動或進行作業(yè)的雙重機能，具有全方向移動的機能和全方位均等的作業(yè)空間，可懸吊于天花板進行作業(yè)或在不平地面上移動。采用電機驅(qū)動，有6個CCD攝像機和11個傳感器。</

32、p><p>　　國內(nèi)從20世紀80年代末90年代初開始研究步行機[8]。 近年來,對多足步行機器人相關(guān)技術(shù)的研究取得了一系列成果。</p><p>　　1980年,中國科學院研制成功了八足步行機器人。1989年,北京航空航天大學研究成功了四足步行機器人。1990年,中國科學院沈陽自動化研究所研制出了六足步行機器人[10]。同年,清華大學也研制成功了全方位三足步行機器人DTWN。1991年,上海

33、交通大學研制了四足步行機器人JTUWM系列[11]。2000年,上海交通大學研制了微型雙三足步行機器人MDTWR。2002年,上海交通大學研制了微型六足仿生機器人[12]。華中科技大學研制的4+2多足步行機器人[13]。</p><p>　　從目前國內(nèi)外多足步行機器人的研究現(xiàn)狀可看出，多足步行機器人多作為一種移動平臺，很難實現(xiàn)復(fù)雜的操作功能。對有手腳融合功能的多足步行機器人的研究極少涉及。</p>

34、<p>　　2005年由大阪大學的新井健生、田窪明仁等研制成功的新型手腳統(tǒng)一型步行機器人ASTERISK[8]，如圖1-12所示。該機器人有6條腿, 且每條腿有4個自由度，具有用手搬運物品及用腳移動或進行作業(yè)的雙重機能，具有全方向移動的機能和全方位均等的作業(yè)空間，可懸吊于天花板進行作業(yè)或在不平地面上移動。采用電機驅(qū)動，有6個CCD攝像機和11個傳感器。</p><p>　　國內(nèi)從20世紀80年代末90年

35、代初開始研究步行機[8]。 近年來,對多足步行機器人相關(guān)技術(shù)的研究取得了一系列成果。</p><p>　　1980年,中國科學院研制成功了八足步行機器人。1989年,北京航空航天大學研究成功了四足步行機器人。1990年,中國科學院沈陽自動化研究所研制出了六足步行機器人。同年,清華大學也研制成功了全方位三足步行機器人DTWN。1991年,上海交通大學研制了四足步行機器人JTUWM系列。2000年,上海交通大學研制了

36、微型雙三足步行機器人MDTWR。2002年,上海交通大學研制了微型六足仿生機器人。華中科技大學研制的4+2多足步行機器人[14]。</p><p>　　從目前國內(nèi)外多足步行機器人的研究現(xiàn)狀可看出，多足步行機器人多作為一種移動平臺，很難實現(xiàn)復(fù)雜的操作功能。對有手腳融合功能的多足步行機器人的研究極少涉及。</p><p>　　1.3.2行機器人誤差研究的現(xiàn)狀</p><p&

37、gt;　　機器人的實到位姿與理論位姿之間的偏差，稱為機器人的位姿誤差，這個指標直接影響到多足步行機器人定位精度。在很多應(yīng)用場合，多足步行機器人機身可作為作業(yè)平臺搭載儀器設(shè)備，因此其定位精度直接影響到機器人的工作質(zhì)量。目前，有很多學者對并聯(lián)機器人誤差進行了研究，由于多足步行機器人在瞬時類似于具有冗余驅(qū)動的并聯(lián)機構(gòu)，因此，對并聯(lián)機器人的誤差分析理論也可用于多足步行機器人的誤差研究中。</p><p>　　在國外，已有

38、不少學者對機器人誤差建模進行了研究。早在1978年，K J Waldron和A Kuman就提出了操作機器人的位置誤差問題。次年，他們又對機器人位置精度提出了機器人位姿誤差建模的矩陣法，在D-H坐標系中，采用兩個3×3旋轉(zhuǎn)變換矩陣和一個3維平移列矢量作為相鄰構(gòu)件之間的轉(zhuǎn)換矩陣，并假設(shè)結(jié)構(gòu)參數(shù)已知，且不存在任何誤差，建立了機器人末端執(zhí)行器的位置誤差表達式。后來，A Kuman和S Prakash引入結(jié)構(gòu)參數(shù)誤差，導(dǎo)出了綜合考慮運

39、動變量誤差和結(jié)構(gòu)參數(shù)誤差的機器人末端執(zhí)行器的位置誤差表達式。Chi-haur Wu將機器人機構(gòu)運動速度分析方法應(yīng)用到靜態(tài)誤差分析中來，導(dǎo)出了由于構(gòu)件結(jié)構(gòu)參數(shù)誤差和關(guān)節(jié)運動變量誤差引起的末端執(zhí)行器位置誤差變化規(guī)律。Wang S M和Ehmann利用坐標轉(zhuǎn)換方法，針對并聯(lián)機構(gòu)驅(qū)動器誤差、鉸鏈自身誤差及鉸鏈定位誤差建立可以直接微分的輸入輸出方程然后進行直接微分，進行誤差建模。Timo提出一種分析機器人精度的方法，根據(jù)輸入輸出方程微分推導(dǎo)求得輸

40、出誤差與驅(qū)動誤差與尺寸誤差的關(guān)系方程。Han S Kim對Stewart平臺的并聯(lián)機器人運動誤差范圍作了分析與綜合,通</p><p>　　在國內(nèi)，關(guān)于并聯(lián)機器人的誤差理論已成為學者的研究熱點[15-20]。黃真教授[21]采用螺旋理論對并聯(lián)機器人位姿誤差進行了分析，其研究內(nèi)容是分析已知尺寸誤差，控制誤差以及運動副間隙對末端位姿誤差的影響。汪勁松教授[22]將Stewart平臺的各分支作為假想的單開鏈，利用串聯(lián)機

41、器人運動學D-H方法，結(jié)合從運動學方程微分得到的結(jié)論，推導(dǎo)出Stewart平臺并聯(lián)機器人終端運動誤差和鉸鏈間隙誤差間的映射關(guān)系。徐衛(wèi)良[23]則通過直接對各個原始誤差的微小位移矢量進行合成，建立了機器人手部位姿誤差的數(shù)學模型。利用蒙特卡洛技術(shù)模擬服從某種概率分布的原始誤差，抽樣計算機器人手部位姿誤差，然后在數(shù)值上完成了機器人在其可達工作空間內(nèi)的位姿誤差的各種概率分析。在誤差概率分析的基礎(chǔ)上，建立了以連桿參數(shù)公差為設(shè)計變量、公差制造成本為

42、目標函數(shù)、絕對位姿誤差滿足設(shè)計精度為約束條件的機器人機構(gòu)精度優(yōu)化設(shè)計的數(shù)學模型。洪林[24]從典型結(jié)構(gòu)Stewart平臺出發(fā)，運用并聯(lián)機器人輸入輸出微分關(guān)系，建立了機器人輸出位姿誤差正解的數(shù)學模型，全面分析了結(jié)構(gòu)參數(shù)和位姿參數(shù)對輸出位姿誤差的影響問題，研究了不同參數(shù)下奇異位形和機器人</p><p><b>　　本文研究內(nèi)容</b></p><p>　　本文以四足步行

43、機器人為研究對象，在討論其運動學的基礎(chǔ)上，提出了誤差建模與分析的方法，并結(jié)合實驗驗證該方法的可行性.本文的研究對于提高多足步行機器人的定位精度，運動穩(wěn)定性和優(yōu)化多足步行機器人的設(shè)計具有重要意義。</p><p>　　根據(jù)機器人的理論模型設(shè)計一條直線步態(tài)，通過對機器人在該步態(tài)下實際運動中機體軌跡誤差數(shù)據(jù)的測量，通過機器人的誤差模型，計算出站立腿驅(qū)動關(guān)節(jié)參數(shù)誤差值。將該誤差值的負值作為驅(qū)動關(guān)節(jié)參數(shù)的補償量，按補償后的

44、關(guān)節(jié)參數(shù)重新驅(qū)動多足步行機器人運動該步態(tài)實驗結(jié)果表明：機器人機體軌跡的運動精度顯著提高。</p><p><b>　　本文主要結(jié)構(gòu)如下：</b></p><p><b>　　緒論。</b></p><p>　　簡述步行機器人發(fā)展現(xiàn)狀及機器人誤差分析的研究現(xiàn)狀。</p><p>　　多足步行機器人的運

45、動學介紹。計算手腳融合狀態(tài)下的正運動學和逆運動學的誤差，建立機器人誤差分析模型。</p><p>　　利用Matlab開發(fā)機器人的運動誤差分析程序。</p><p>　　將以前述的誤差分析為基礎(chǔ)，對由多種因素引起的機器人的綜合位姿誤差進行探討，并對實例進行實驗,驗證了誤差分析方法的正確性</p><p>　　多足步行機器人的正運動學分析和誤差分析</p>

46、<p><b>　　引言</b></p><p>　　多足步行機器人的運動學計算是求解機器人的輸入變量與輸出構(gòu)件（機身平臺）之間的位置關(guān)系，是機器人運動分析最基本的任務(wù)，也是機器人速度、加速度、受力分析、工作空間分析、誤差分析、動力分析等的基礎(chǔ)。在多足步行機器人運動過程中，各條腿按順序抬起和放下，從瞬時性角度來看，多足步行機器人就是一個具有冗余自由度的并聯(lián)機構(gòu)。由于多足步行機器

47、人結(jié)構(gòu)復(fù)雜，對其進行運動學計算要比一般的移動機器人的運動學計算要復(fù)雜的多。已知機器人主動件的位置，求解機器人輸出件的位置和姿態(tài)稱為正運動學求解，若已知輸出件的位置和姿態(tài)，求解機器人輸入件的位置稱逆運動學求解。類似于并聯(lián)機器人，多足步行機器人的正運動求解比逆運動學求解要復(fù)雜得多。本文將對正運動學和逆運動學分別求解。</p><p>　　并聯(lián)機器人運動學分析主要有數(shù)值法和解析法。數(shù)值法的優(yōu)點是它可以應(yīng)用于任何結(jié)構(gòu)的并

48、聯(lián)機器人，計算方法簡單，但不能保證獲得全部解，存在局部極小點問題，計算時間較長。</p><p>　　本章將以四足步行機器人為研究對象介紹一種解析法求解多足步行機器人正運動學的方法。</p><p>　　圖 2.1 步行機器人MiniQuad的關(guān)節(jié)布置示意圖</p><p><b>　　研究對象的介紹</b></p><p&

49、gt;　　MiniQuad是由鄭州輕工業(yè)學院開發(fā)的四足機器人樣機,它是一種具有腿臂融合、模塊化特征的小型多足步行機器人。MiniQuad由機體和四條腿組成。機器人機體是一個矩形平臺。每條腿通過一個旋轉(zhuǎn)關(guān)節(jié)與矩形平臺相連。為了保證機器人的機動性，旋轉(zhuǎn)關(guān)節(jié)的軸線與矩形平臺垂直。圖2.1給出了MiniQuad的一般簡圖。其腿類似于同一機器人機體上的四個機械手。每條腿由一個平面連桿機構(gòu)、一個旋轉(zhuǎn)機構(gòu)和一只腳組成。通常，除了一些自由或被動關(guān)節(jié)以外

50、，每條腿還有三個執(zhí)行關(guān)節(jié)，其中代表旋轉(zhuǎn)關(guān)節(jié)，而和代表平面連桿機構(gòu)中的關(guān)節(jié)。</p><p>　　如圖2.1所示,每條腿上的活動關(guān)節(jié)通常都由直流電機驅(qū)動。由于機器人的重量都集中在其機體上，旋轉(zhuǎn)機構(gòu)的關(guān)節(jié)支撐連接著腿和機體，所以可以根據(jù)幾何對稱性假設(shè)機器人的重心與其幾何中心近似一致。當一條腿與地面接觸時，該腿定義為站立腿，并假設(shè)該接觸點是不可動的。如果腿處于擺動狀態(tài)，該腿就被定義為擺動腿。將腿與地面通過運動學耦合，從

51、而該機構(gòu)系統(tǒng)就相當于一個并聯(lián)機械手。</p><p>　　對于多足機器人靜態(tài)穩(wěn)定的步行運動，最基本的步行模式是三條腿同時支撐于地面上，其余的腿向前擺動。機器人步行時它的運動機構(gòu)可以看作一個是由機器人機體（運動平臺）、地面（固定平臺）和三條站立腿構(gòu)成的并聯(lián)機械手和擺動腿組合而成。圖2.2給出了其中一條腿處于擺動狀態(tài)時四足機器人的結(jié)構(gòu)簡圖。</p><p>　　圖 2.2 四足機器人瞬時步行

52、狀態(tài)</p><p>　　其中代表參考坐標系，在這里我們選定自然坐標系作為參考坐標系，代表固定在機器人機體上、原點與機器人幾何中心重合的坐標系，機器人矩形機體的兩邊尺寸為和。</p><p>　　影響運動誤差的主要因素</p><p>　　多足步行機器人的運動學D-H參數(shù)法坐標變換中坐標變換矩陣及平臺位姿變換矩陣都是不考慮各運動學參數(shù)誤差的理想變換，但在實際應(yīng)用中，

53、無論機器人制造精度多高，都會由于各種原因引起機器人運動學參數(shù)誤差，影響運動平臺定位精度。機器人的位姿精度取決于很多因素，其因素主要包括機器人零部件的加工制造誤差，機器人的安裝，傳動機構(gòu)的誤差，機器人連桿和關(guān)節(jié)的柔性及機器人工作環(huán)境等因素。</p><p>　　影響多足步行機器人位姿精度的因素可分為靜態(tài)因素和動態(tài)因素。所謂靜態(tài)因素是在機器人運動過程中始終保持不變的因素，所謂動態(tài)因素是指在機器人運動過程中隨時間變化的

54、因素。靜態(tài)因素包括：1.多足步行機器人連桿結(jié)構(gòu)參數(shù)和運動變量誤差。由于制造及裝配的誤差使機器人腿關(guān)節(jié)的實際參數(shù)與其名義值之間產(chǎn)生偏差,從而引起機器人位姿誤差；2.環(huán)境因素。如工作環(huán)境溫度的變化將導(dǎo)致機器人連桿的長度尺寸誤差；3.關(guān)節(jié)誤差、位置傳感器誤差、控制系統(tǒng)的誤差等；4.環(huán)境變化所引起的立足點位置誤差。動態(tài)因素主要包括：由自重、外力、慣性力等引起的腿部連桿和關(guān)節(jié)的彈性變形及振動。</p><p>　　其中，對

55、多足步行機器人定位精度影響最大的誤差因素包括：</p><p>　?。?）機器人的連桿參數(shù)誤差</p><p>　　多足步行機器人腿部各關(guān)節(jié)都是旋轉(zhuǎn)關(guān)節(jié)，對于旋轉(zhuǎn)關(guān)節(jié)有3個結(jié)構(gòu)參數(shù),即D-H參數(shù),和,其誤差主要是由于機器人在制造和安裝過程中產(chǎn)生的，或則體現(xiàn)為步行機器人連桿（腿）的長度尺寸。機器人腿部連桿長度尺寸誤差可導(dǎo)致機器人平臺的位姿誤差。通常引起連桿長度誤差（）的因素主要有連桿的加工誤

56、差及因周圍環(huán)境溫度變化而引起的連桿長度尺寸誤差，則表述為</p><p>　　式中為機器人連桿的加工誤差，它由機械加工水平所決定。為環(huán)境溫度所引起的連桿的長度變化，對于長度為的連桿，當環(huán)境溫度變化量為時，其引起連桿長度變化量為</p><p>　　式中為連桿材料的熱延伸系數(shù)。對于多足步行機器人，由于工作環(huán)境的不同，環(huán)境溫度所引起的桿長變化量亦不同，在溫差較大的環(huán)境中，該變化量可成為桿長誤差

57、的主要因素，在恒溫狀態(tài)下工作的機器人，該變化量則可以忽略。</p><p>　?。?）立足點位置誤差</p><p>　　由于工作環(huán)境的非結(jié)構(gòu)化，機器人立足點的位置會偏離預(yù)期的位置，立足點位置誤差（）也會造成機器人機體位姿誤差，還會對機器人的穩(wěn)定性造成影響。立足點位置誤差可表示為</p><p>　?。?）機器人的關(guān)節(jié)運動變量誤差</p><p&

58、gt;　　機器人腿部轉(zhuǎn)動關(guān)節(jié)的運動變量（）誤差使機器人平臺的位姿產(chǎn)生誤差。導(dǎo)致關(guān)節(jié)的運動變量產(chǎn)生誤差的主要靜態(tài)因素有：1.電機控制系統(tǒng)的工作誤差；2.傳動機構(gòu)的運動誤差；3.傳動機構(gòu)的間隙。因此，由靜態(tài)因素引起的機器人關(guān)節(jié)的運動變量誤差可表示為</p><p>　　式中，為電機控制系統(tǒng)的誤差；為傳動機構(gòu)的誤差；為傳動機構(gòu)的間隙。</p><p>　?。?）機器人關(guān)節(jié)柔性誤差</p&g

59、t;<p>　　機器人的關(guān)節(jié)一般存在一定的柔性，在機器人自身重力、外力、及慣性力作用下，使機器人平臺產(chǎn)生位姿誤差。機器人支撐腿各關(guān)節(jié)的柔性實際上將導(dǎo)致關(guān)節(jié)產(chǎn)生相應(yīng)的運動變量誤差（）表示，由關(guān)節(jié)的柔性所造成的運動變量誤差的計算公式</p><p>　　式中：為關(guān)節(jié)的剛度系數(shù)；為作用于機器人支撐腿上的外力矢量沿、、軸上的分量；為外力矢量的作用位置矢量。為作用于機器器人腿上的外力矢量數(shù)目。</p&g

60、t;<p>　　將支撐腿關(guān)節(jié)的柔性對機器人位姿誤差的影響歸結(jié)為機器人腿部關(guān)節(jié)運動變量誤差可通過機器人靜態(tài)位姿誤差分析模型來計算由關(guān)節(jié)柔性引起的機器人平臺的位置誤差。</p><p>　?。?）支撐腿連桿柔性誤差</p><p>　　焦國太[51]介紹了分析腿部連桿柔性所引起的機器人位姿誤差的結(jié)構(gòu)矩陣分析方法。應(yīng)用該方法可求得機器人平臺由腿部連桿所引起的位置和姿態(tài)誤差，需要注意

61、其姿態(tài)誤差按照固定坐標系分別繞、、軸的微小轉(zhuǎn)角給出，為統(tǒng)一使用歐拉角來表示機器人末端的姿態(tài)誤差，必須對其進行變換。</p><p>　　假定在某時刻由機器人支撐腿連桿柔性所引起的機器人平臺位姿誤差為：，則由微分變化算子可得</p><p>　　從而得到機器人機身的坐標系和固定坐標系之間的相對變換矩陣</p><p>　　根據(jù)上式,求得考慮連桿柔性時機器人平臺的實際位

62、置和姿態(tài)，實際位姿和名義位姿的差即為經(jīng)過變換后由腿部連桿柔性所引起的機器人平臺位姿誤差：</p><p>　　將支撐腿連桿柔性所引起的機器人平臺位姿誤差進行轉(zhuǎn)換后即可和由靜態(tài)誤差和關(guān)節(jié)柔性引起的機器人平臺的誤差進行迭加,得到機器人平臺的綜合位姿誤差。</p><p>　　由上述分析可知,多足步行機器人平臺的位姿誤差由很多因素引起,如果將這些因素作為孤立的因素,分別加以考慮,會使位姿誤差的分

63、析變得十分的復(fù)雜。可行的方法就是將所有因素引起的位姿誤差都歸結(jié)為支撐腿各連桿的運動變量誤差引起的位姿誤差、各組成連桿的結(jié)構(gòu)參數(shù)誤差引起的位姿誤差以及立足點誤差所引起的機器人位姿誤差。從誤差分析和傳遞的情況分析，機器人平臺的位姿誤差與支撐腿各組成連桿的運動變量、結(jié)構(gòu)參量和立足點之間存在函數(shù)關(guān)系，就是將各因素引起的平臺位姿誤差歸結(jié)為各組成連桿的D-H參數(shù)誤差和立足點誤差引起的，這樣將簡化多足步行機器人誤差分析的模型，為誤差分析帶來方便。&l

64、t;/p><p>　　機器人正運動學分析和誤差分析</p><p>　　2.4.1串聯(lián)機械手的正運動學</p><p>　　具有手腳融合功能的機械手由4 個回轉(zhuǎn)關(guān)節(jié)組成，包括：髖關(guān)節(jié)、大腿關(guān)節(jié)、小腿關(guān)節(jié)和腕關(guān)節(jié)。其關(guān)節(jié)結(jié)構(gòu)簡圖如圖2.3所示。</p><p>　　機械手的正運動學就是已知機械手連桿參數(shù)和關(guān)節(jié)變量，求末端執(zhí)行器相對于參考坐標系的位置

65、和姿態(tài)。</p><p>　　采用D-H法建立機械手坐標系，該方法通過在每個連桿上固定一個坐標系，用４階的齊次變換矩陣描述兩個桿件的空間關(guān)系（位置和姿態(tài)），從而推導(dǎo)出機械手末端坐標系相對于參考系的等價齊次變換矩陣．</p><p>　　D-H坐標系規(guī)定：在機械手的各個主要構(gòu)件上固定坐標系。坐標系的Z軸可與運動副的軸線重合，而X軸則沿著相鄰兩個Z軸的公垂線，至于Y軸可由右手坐標系法則來確定[

66、58-59]。</p><p>　　對回轉(zhuǎn)連接的兩桿件,在 D-H方法中連桿構(gòu)件坐標系的選擇及參數(shù)的規(guī)定如下：</p><p>　　由原點Oi和坐標軸Xi、Yi、Zi定義的坐標系Fi，F(xiàn)i被固結(jié)在第i-1個連桿上，其中i=1,2,…,n+1。</p><p>　　1)Zi坐標軸是沿著i+1關(guān)節(jié)方向的運動軸。</p><p>　　2)Xi軸是沿

67、著Zi-1和Zi的公垂線方向的坐標軸，方向是前者指向后者(見圖2.4a)，如果Zi-1和Zi相交,Xi的正方向就不確定,可以任意指定。如果Zi-1和Zi平行(見圖2.4c),Xi的位置就不確定。為保證定義唯一,規(guī)定Xi通過第i-1個坐標系的原點。</p><p>　　3)公垂線ai是Zi-1和Zi兩軸間的最小距離，一般ai稱為連桿長度。</p><p>　　4)兩公垂線ai-1和ai之間的

68、距離di，di稱為連桿距離。</p><p>　　5)Zi-1和Zi之間的夾角定義為,以繞Xi軸右旋為正, 稱為扭轉(zhuǎn)角。</p><p>　　6)Xi-1和Xi之間的夾角定義為θi,以繞Zi-1軸右旋為正,一般稱θi為連桿的夾角。</p><p>　　根據(jù)圖2.3的關(guān)節(jié)布置及D-H法則，建立各連桿的坐標系，如圖2.5所示。這里的參考坐標系固定在髖關(guān)節(jié)上， 為固連于機

69、械手手部的坐標系，根據(jù)以下原則確定的：</p><p>　　取手部中心點為原點，關(guān)節(jié)軸方向的單位矢量為軸，手指連線方向的單位矢量為軸，軸則按右手法則來確定。</p><p>　　根據(jù)所建立的連桿坐標系，可以確定連桿坐標參數(shù)，如表2-1所示。</p><p>　　表2-1 連桿參數(shù)</p><p>　　為求解運動學方程式，用齊次變換矩陣描述

70、第i坐標系相對于第（i-1）坐標系的位置和方位，即連桿變換通式：</p><p><b>　?。?-1） </b></p><p>　　由連桿變換通式及連桿參數(shù)可得到各連桿變換矩陣。為書寫方便，令。各連桿變換矩陣為：</p><p>　　根據(jù)圖4-6，將各連桿變換矩陣相乘可得到末端執(zhí)行器坐標系相對于的齊次變換陣。 </p>

71、<p>　　將各連桿變換矩陣代入，可求得</p><p><b>　?。?-2）</b></p><p><b>　　式中</b></p><p>　　2.4.2機器人抓取時的正運動學分析</p><p>　　建立機器人在抓取物體時的整體坐標系，如圖2.6所示。其中為參考坐標系，為固定在機

72、器人機體上、原點與機器人幾何中心重合的坐標系，為機身與髖關(guān)節(jié)連接處的坐標系，為末端執(zhí)行器坐標系。</p><p>　　由所建立的坐標系可以得到各坐標系的相對齊次變換矩陣。</p><p>　　由圖2.6可以得到各坐標系的相對齊次變換矩陣。</p><p><b>　　(2-3)</b></p><p><b>

73、　　(2-4)</b></p><p>　　末端執(zhí)行器相對于的齊次變換陣，即機器人在抓取物體時的運動學方程為：</p><p><b>　　（2-5）</b></p><p>　　根據(jù)所建立的坐標系可以求得末端執(zhí)行器坐標系相對地面坐標系的齊次變換矩陣，該矩陣描述了末端執(zhí)行器在地面坐標系的位置和姿態(tài)。即機器人在抓取物體時的運動學方程為

74、：</p><p><b>　　（2-6）</b></p><p>　　將（2-2）、（2-3）、（2-4）代入（2-6）式，可以求得末端執(zhí)行器在地面坐標系的位姿。</p><p><b>　　(2-7)</b></p><p><b>　　式中</b></p>

75、<p>　　通過對正運動學分析所得的方程微分求出誤差方程為：</p><p><b>　　2.4.3算例</b></p><p>　　在此我們在MATLAB中調(diào)用名為forward_hand的M文件，其中Theta，il，Rc，dRc，m，n，d4，d_Theta，P_0_c，d_P_0_c，dm,dn，idl為輸入?yún)?shù)，其中</p><

76、p>　　Theta為連桿夾角</p><p>　　il是一個的矩陣，表示多足步行機器人腿長的理論值；</p><p>　　Rc是一個的矩陣，表示多足步行機器人機體動平臺的狀態(tài)，其意義式為</p><p><b>　　m,n為機體尺寸</b></p><p>　　d4表示第四根桿的距離</p><

77、p>　　P_0_c是一個的矩陣，表示多足步行機器人質(zhì)心點的理論位置，意義為；</p><p>　　下面用一組數(shù)據(jù)為例，并以此做為誤差分析的一種在理論上的證明：</p><p>　　調(diào)用附錄1中的M文件中的函數(shù)，其輸出參數(shù)的結(jié)果會出現(xiàn)在命令窗體中，輸入如下參數(shù)：</p><p>　　Theta=[0,0,0;0,-30,90;0,0,0;0,0,0];</

78、p><p>　　il=[65,200,266];</p><p><b>　　d4=180;</b></p><p>　　Rc=[1,0,0;0,1,0;0,0,1];</p><p>　　dRc=[0.30,0,0;0,0.50,0;0,0,0.20];</p><p>　　d_Theta=[0,0

79、,0.40,0];</p><p>　　P_0_c=[-40,80,266];</p><p>　　m=197;n=140;</p><p>　　d_P_0_c=[0,0,0.20];</p><p>　　idl=[0,0.75,0];</p><p>　　dm=2;dn=1;</p><p>

80、　　forward_hand(Theta,il,Rc,dRc,m,n,d4,d_Theta,P_0_c,d_P_0_c,dm,dn,idl);</p><p><b>　　得出的結(jié)果如下：</b></p><p><b>　　解得的手的位置如下</b></p><p>　　0.4268 -0.8515 -0.304

81、8 171.7707</p><p>　　0 0 0 220.0000</p><p>　　0.1366 -0.2725 0.9524 716.9482</p><p>　　0 0 0 1.0000</p><p>　　機械臂正運動學誤差d_F=</p

82、><p><b>　　d_F =</b></p><p>　　0.0734 -0.4017 -0.4724 54.0373</p><p>　　0 0 0 0</p><p>　　0 0.2861 0.0686 52.6028</p>

83、<p>　　以上結(jié)果顯示了正運動學方程在MATLAB的計算中的誤差的正確性</p><p><b>　　本章小結(jié)</b></p><p>　　本章首先對基于手腳融合的多足步行機器人做了簡單的介紹，并分析了多足步行機器人的誤差產(chǎn)生的原因主要包括機器人零部件的加工制造誤差，機器人的安裝，傳動機構(gòu)的誤差，機器人連桿和關(guān)節(jié)的柔性及機器人工作環(huán)境等因素。詳細介紹了幾種

84、對多足步行機器人運動精度影響最大的誤差因素。最后我們介紹了機器人串聯(lián)手的正運動學，對機器人抓取時的正運動學分析做了詳細分析，導(dǎo)出機器人正運動學誤差方程，并通過實例驗證誤差方程的正確性。</p><p>　　多足步行機器人的逆運動學分析和誤差分析</p><p>　　機器人的逆運動學分析和誤差分析</p><p>　　在第2章中我們介紹了機器人正運動學的運動學分析和誤

85、差分析的推導(dǎo)方程，從工程應(yīng)用角度來說，運動學逆解更為重要，它是機器人運動規(guī)劃和軌跡控制的基礎(chǔ)。正向運動學是唯一確定的，即各個關(guān)節(jié)變量給定之后，足端的位姿是唯一確定的；然而運動學逆解往往是很多種解，也可能不存在解。該機器人的逆運動學分析是根據(jù)機器手所抓取物體的位姿，求機器人的機體的位姿、各站立腿足端的位置，以及機器手與站立腿各關(guān)節(jié)轉(zhuǎn)角。本章我們將介紹逆運動學的運動學分析和誤差方程的推導(dǎo)方法。</p><p>　　當

86、給定機械手所抓取物體的位姿，求機器人機體的位姿、各站立腿足端的位置，以及機器手與站立腿各關(guān)節(jié)轉(zhuǎn)角時，將有眾多解。在實際設(shè)計中，可以根據(jù)規(guī)劃的步態(tài)軌跡，事先確定該機器人機體的位姿和，以及機器人立足點的位置，求機械手各關(guān)節(jié)轉(zhuǎn)角。</p><p>　　運動學逆問題求解方法是：將運動學方程式的兩端依次左乘各矩陣的逆矩陣，并使兩端相等矩陣的對應(yīng)元素相等，就可求得各關(guān)節(jié)變量。具體求解步驟如下：</p><

87、p>　　用逆變換左乘方程（2-6）兩邊得：</p><p><b>　?。?-1）</b></p><p><b>　?。?-2）</b></p><p><b>　　（3-3）</b></p><p><b>　?。?-4）</b></p&g

88、t;<p><b>　?。?-5）</b></p><p>　　把(3-2)(3-3)(3-4)(3-5)代入方程（3-1）左端可得：</p><p><b>　　式中</b></p><p>　　方程（3-1）右端為</p><p><b>　　式中</b>&l

89、t;/p><p><b>　　求解和</b></p><p>　　根據(jù)方程（3-1）兩邊元素（3，4）對應(yīng)相等，可得</p><p><b>　　利用三角代換</b></p><p><b>　?。?-6）</b></p><p><b>　　式中

90、：</b></p><p>　　式中： </p><p>　　由以上可知： </p><p><b>　　進行三角代換后可得</b></p><p>　　所以： </p><p>　　式中： </p>&l

91、t;p>　　對（3-6）兩邊求導(dǎo)可得到</p><p><b>　?。?-7）</b></p><p><b>　　式中： </b></p><p><b>　　2）求解和</b></p><p>　　根據(jù)方程（3-1）兩邊元素（2，3）對應(yīng)相等，可求得：<

92、;/p><p><b>　　(3-8)</b></p><p><b>　　(3-9)</b></p><p><b>　　式中</b></p><p>　　對（3-9）兩邊求導(dǎo)可得：</p><p><b>　　(3-10)</b>&

93、lt;/p><p><b>　　3）求解和</b></p><p>　　根據(jù)方程（3-1）兩邊元素（2，4對應(yīng)相等，可得）：</p><p><b>　　（3-11）</b></p><p>　　聯(lián)立（3-8）代入（3-11）可得</p><p><b>　?。?-12

94、）</b></p><p><b>　?。?-13）</b></p><p><b>　?。?-14）</b></p><p>　　對（3-12）兩邊求導(dǎo)可得：</p><p><b>　　(3-15)</b></p><p><b&g

95、t;　　4）求解和</b></p><p>　　把式（3-14）代入（3-9）可得：</p><p><b>　　(3-16)</b></p><p><b>　　5）求解和</b></p><p>　　根據(jù)方程（3-1）兩邊元素（3，1）（3，2）對應(yīng)相等，可得：</p>

96、<p><b>　?。?-17）</b></p><p><b>　　式中</b></p><p><b>　　(3-18)</b></p><p>　　式中 </p><p><b>　　算例</b></p>

97、<p>　　如圖3-1所示，一個四足機器人沿軸方向步行，其機體與地面保持平行。假定中</p><p>　　的軸與中的軸平行。四條腿標記為,，及。其中腿設(shè)計為機械手， ，，，，，。根據(jù)步態(tài)設(shè)計，機器人機體的位置。手部的位姿為：。</p><p>　　id_P_0_A是一個的矩陣，表示多足步行機器人足端在利用MATLAB編輯程序計算機器人逆運動學的過程，我采用編輯M文件，建立主函數(shù)的

98、方法。</p><p>　　在此我們以liuboni為函數(shù)名的M文件，其中il，P_0_c，Rc，zq_T，d4，m，n，P_0_A，d_Rc，d_P_0_c，d_d4，id_l，d_ZqT，dm，dn為輸入?yún)?shù)，其中</p><p>　　il是一個的矩陣，表示多足步行機器人腿長的理論值；</p><p>　　P_0_c是一個的矩陣，表示多足步行機器人質(zhì)心點的理論位

99、置，意義為；</p><p><b>　　m,n為機體尺寸</b></p><p>　　Rc是一個的矩陣，表示多足步行機器人機體動平臺的狀態(tài)，其意義式為</p><p>　　zq_T為的表達是為</p><p>　　下面用一組數(shù)據(jù)為例，并以此做為誤差分析的一種在理論上的證明：</p><p>　　

100、調(diào)用附錄2中的M文件中的函數(shù)，其輸出參數(shù)的結(jié)果會出現(xiàn)在命令窗體中，輸入如下參數(shù)：</p><p>　　il=[0.03,0.10,0.25];</p><p><b>　　d4=0.10;</b></p><p>　　Rc=[1,0,0;0,1,0;0,0,1];</p><p>　　d_Rc=[0,0,0;0,0,0;

101、0,0,0];</p><p>　　zq_T=[0,1,0,0.3;1,0,0,0.45;0,0,-1,0.07;0,0,0,1];</p><p>　　d_ZqT=[0.01,0,0,0;0,0,0,0;0,0,0,0;0,0,0,0];</p><p>　　P_0_A=[0.35 0.20 0.07];</p><p>　　P_0_c=[

102、0,0.25,0.25];</p><p>　　d_P_0_c=[0.05 0.05 0.05];</p><p>　　d_d4=0.05;</p><p>　　m=0.1;n=0.2;</p><p>　　id_l=[0.05,0.05,0.05];</p><p>　　dm=0;dn=0;</p>&

103、lt;p>　　liuboni(il,P_0_c,Rc,zq_T,d4,m,n,P_0_A,d_Rc,d_P_0_c,d_d4,id_l,d_ZqT,dm,dn);</p><p><b>　　得出的結(jié)果如下：</b></p><p>　　抓取髖關(guān)節(jié)角度:s1=-45.0000</p><p>　　抓取臂大腿關(guān)節(jié)角度:s2=-53.1301

104、</p><p>　　抓取臂小腿關(guān)節(jié)角度:s3=53.1301</p><p>　　抓取臂小腿旋轉(zhuǎn)關(guān)節(jié)角度:s4=45</p><p>　　d_Theta1 =-0.2255</p><p>　　d_Theta2 =1.1809</p><p>　　d_Theta3 =-1.1809</p><p&

105、gt;　　d_Theta4 =-0.0100</p><p>　　以上結(jié)果顯示了逆運動學方程在MATLAB的計算中的誤差的正確性</p><p><b>　　本章小結(jié)</b></p><p>　　本章主要分析多足步行機器人的逆運動學方程最后導(dǎo)出逆運動學的誤差方程。并通過實例驗證所導(dǎo)出的逆運動學誤差方程的正確性。</p><p

106、><b>　　結(jié)論</b></p><p>　　步行機器人需要根據(jù)機器人機體與參考基礎(chǔ)之間復(fù)雜的非線性幾何關(guān)系求得關(guān)節(jié)角。然后，通過關(guān)節(jié)電機伺服，驅(qū)動關(guān)節(jié)至相應(yīng)的位置。然而，關(guān)節(jié)之間名義的幾何參數(shù)(包括結(jié)構(gòu)參數(shù)和運動輸入變量)，由于制造裝配誤差、環(huán)境溫度變化、電機控制系統(tǒng)的誤差、傳動機構(gòu)的運動誤差等原因，很可能是不精確的。這樣，機器人控制器所使用的運動學模型與真實的運動學模型不一致，按

107、理想的運動學模型驅(qū)動關(guān)節(jié)電機獲得的實際機器人機體的位姿將有可能偏離要求的位姿。</p><p>　　步行機器人機體位姿的運動誤差也會受到非幾何參數(shù)誤差的影響。如關(guān)節(jié)和連桿的彈性變形、振動、回差等。在本文中，主要研究驅(qū)動關(guān)節(jié)變量的誤差對機器人機體位姿誤差的影響。實際上，驅(qū)動關(guān)節(jié)變量的誤差可以含蓋測量系統(tǒng)的誤差、制造裝配誤差、環(huán)境溫度變化、電機控制系統(tǒng)的誤差、傳動機構(gòu)的運動誤差、傳動機構(gòu)的間隙、關(guān)節(jié)和連桿的彈性變形、

108、振動、回差等的影響。根據(jù)希望的步態(tài)軌跡確定機器人各驅(qū)動關(guān)節(jié)控制變量的過程是機器人運動學計算中的逆運動學問題。本文中，在論述多足步行機器人逆運動學計算過程的基礎(chǔ)上，研究了多足步行機器人軌跡精度與驅(qū)動關(guān)節(jié)變量運動精度之間的關(guān)系。依據(jù)機器人的結(jié)構(gòu)及運動約束關(guān)系，獲得了機器人的誤差表達式，包含機器人腿的站立點在機體坐標系及臂關(guān)節(jié)坐標系中的運動誤差、方向矩陣的運動誤差、站立腿驅(qū)動關(guān)節(jié)參數(shù)誤差表達等。導(dǎo)出了表示驅(qū)動關(guān)節(jié)參數(shù)誤差、結(jié)構(gòu)參數(shù)、機器人軌跡

109、誤差相互關(guān)系的方程組。</p><p>　　在本文的實驗中，根據(jù)機器人的理論模型設(shè)計一條直線步態(tài)，通過對機器人在該步態(tài)下實際運動中機體軌跡誤差數(shù)據(jù)的測量，通過機器人的誤差模型，計算出站立腿驅(qū)動關(guān)節(jié)參數(shù)誤差值。將該誤差值的負值作為驅(qū)動關(guān)節(jié)參數(shù)的補償量，按補償后的關(guān)節(jié)參數(shù)重新驅(qū)動多足步行機器人運動該步態(tài)，實驗結(jié)果表明：機器人機體軌跡的運動精度顯著提高。</p><p><b>　　致

110、謝</b></p><p>　　本文的研究工作是在導(dǎo)師xx教授的悉心指導(dǎo)和親切關(guān)懷下完成的，導(dǎo)師嚴謹?shù)膶W風，淵博的學識，和一絲不茍的工作態(tài)度使我在工作、學習、做人等方面深受啟迪和教誨，這將使我終身受益。在此，謹向?qū)煴硎局孕牡母兄x和崇高的敬意。</p><p>　　在整個畢業(yè)設(shè)計過程中，xx老師給我提出了明確的思路，使我在整個設(shè)計過程中少走了許多彎路，為畢業(yè)設(shè)計的順利完成奠定了

111、堅實的基礎(chǔ)。在整個畢業(yè)設(shè)計的過程中，我也從中學到了很多的東西，特別是對誤差結(jié)果的分析，解決實驗過程中出現(xiàn)的問題等使我受益良多。</p><p>　　最后，要深深地感謝我深愛的父母以及家人，是他們在精神上、經(jīng)濟上給予的莫大鼓勵與支持，使我順利完成本科學習階段的學習工作。感謝朋友、同學們在本科學習階段給予我莫大的關(guān)心與支持。</p><p>　　謹以此文獻給所有關(guān)心、幫助和支持過我的人們！&l

112、t;/p><p><b>　　參考文獻</b></p><p>　　黃俊軍，葛世榮，曹為. 多足步行機器人研究狀況及展望[J] . 機床與液壓，2008，(5) .</p><p>　　S. Hirose, Y. Umetani. Some Consideration on a Feasible Walking Mechanism as a Ter

113、rain Vehicle[C]. Pcocs. of 3rd RoManSy Symp. Udine, Italy, 1978. 357-375</p><p>　　H.Kimura,I.Shimoyama and H.Miura，＂Criteria for Dynamic　Walk of the QuadruPed＂[C].19th　Intemational SymPosium of lndustrial Ro

114、bot，Sydney，1988:595-600</p><p>　　S. Hirose, T. Masui, H. Kikuchi. TITAN-III: A Quadruped Walking Vehicle – Its Structure and Basic Characteristic[C]. Robotic Research (2nd Int. Symp.), The MIT Press, 1985.

115、325-331</p><p>　　S. Hirose, K. Yoneda, H. Tsukagoshi. TITAN-VII: Quadruped Walking and Manipulating Robot on a Steep Slope[C]. Proc. Int. Conf. on robotics and automation. Albuquerque, New Mexico, 1997. 494-