四足機器人設(shè)計報告

1、四足機器人設(shè)計報告摘要：本文介紹了四足機器人（walking dog）的設(shè)計過程，其中包括控制系統(tǒng)軟硬件的 設(shè)計、傳感器的應(yīng)用以及機器人步態(tài)的規(guī)劃。一、本體設(shè)計：walking dog的單腿設(shè)置髖關(guān)節(jié)和踝關(guān)節(jié)兩自由度，能在一個平面內(nèi)自由運動（見圖1.1）。 采用舵機作為機器人的關(guān)節(jié)驅(qū)動器，其單腿結(jié)構(gòu)圖見（圖1.2）。為了便于步態(tài)規(guī)劃，設(shè)計上 下肢L1、L2長均為65mm。四肢間用鋁合金框架連接，完成后照片見（圖1.3）。walking dog 的每只腳底均有一個光電傳感器，能有效檢測腳底環(huán)境的變化。walking dog的頭部為一個 舵機，攜帶光電反射式傳感器，能探測前方180度75cm內(nèi)的障

2、礙物。瞌關(guān)節(jié)圖1.1四足機器人模型圖1.3：完成后照片二、控制系統(tǒng)設(shè)計為了使機器人能靈活地搭載各種傳感器以及實現(xiàn)不同的步態(tài)，將底層驅(qū)動單元與上層 步態(tài)算法平臺分開。因為walking dog的各關(guān)節(jié)均為舵機，特設(shè)計了 16路舵機驅(qū)動器作為底 層驅(qū)動單元，用來驅(qū)動機器人全身各關(guān)節(jié)。并設(shè)計了上層算法平臺，將各關(guān)節(jié)參數(shù)通過UART 實時地發(fā)送到底層驅(qū)動單元。圖2.1為系統(tǒng)框圖。上算法平臺義部傳妙底層驅(qū)幼單元腳底傳感器圖2.1：系統(tǒng)框圖1、底層驅(qū)動單元設(shè)計圖2.2給出了舵機的工作原理框圖，電動機驅(qū)動減速齒輪組,并帶動一個線性的電位器作 位置檢測，控制電路將反饋電壓與輸入的控制脈沖信號作比較,產(chǎn)生偏差并

3、驅(qū)動直流電動機 正向或反向轉(zhuǎn)動，使齒輪組的輸出位置與期望值相符?？刂葡渡駡D2.2：舵機工作原理框圖針對舵機這一特性，設(shè)計底層驅(qū)動器的系統(tǒng)結(jié)構(gòu)圖見圖2.3。Mage8的16位定時器分時 產(chǎn)生16次定時中斷，中斷子程序產(chǎn)生移位脈沖，通過4N25光偶隔離輸入到移位寄存器， 實現(xiàn)各路PWM信號高電平部分的分時產(chǎn)生。圖2.4為定時產(chǎn)生脈沖的中斷處理流程，圖 2.5例舉了產(chǎn)生4路PWM信號的波形圖。實際電路原理圖見附錄1。I. T-光偶GSARTATtiifXciSi. DdUJUb右臉密牯 觸發(fā)I勺&”ihl 器74HC 眺移位寄存一器圖2.3： 16路舵機驅(qū)動器結(jié)構(gòu)圖進入中斷|ATiuoaB 輸出卜-

4、路叫M高 電F部分定j7459501 端y砂用晚9知端移位寄存器/夏位 /74IlCSy5Q3y；ii退出中斷74由;界，用 圖2.4:定時中斷服務(wù)流程圖2.5:產(chǎn)生4路PWM的波形信號2、算法平臺的設(shè)計步態(tài)機器人要求對各個關(guān)節(jié)實施快速準(zhǔn)確的位置控制，因此對控制系統(tǒng)提出了比較高的 要求：1、具有大量數(shù)據(jù)存儲能力用來存儲大量的步態(tài)數(shù)據(jù)。2、實時地采集、處理傳感器的數(shù)據(jù)，以便在控制系統(tǒng)的信號綜合中使用。3、具有良好的控制結(jié)構(gòu)和接口，便于高層控制軟件的開發(fā)。4、有一定的預(yù)留接口、良好的兼容性和擴展性，以便進行功能擴展和二次開發(fā)根據(jù)以上要求，采用ATmega16作為控制核心，將規(guī)劃好的步態(tài)參數(shù)存入單片

5、機，單片 機根據(jù)定時器產(chǎn)生的時鐘將相應(yīng)關(guān)節(jié)數(shù)據(jù)發(fā)送到底層驅(qū)動單元。同時單片機通過傳感器返回 的信號感知周圍環(huán)境，并及時對運動狀態(tài)進行調(diào)整。三、步態(tài)參數(shù)化設(shè)計1、離線軌跡規(guī)劃為了使機器人行走平緩，要求足底軌跡有二階光滑度，即有二階連續(xù)導(dǎo)數(shù)。數(shù)學(xué)上的三 次樣條插值曲線即可滿足上述條件。設(shè)步長人=40，擺動腿離地最高H=20，可求得：踝關(guān)節(jié)的軌跡函數(shù)y = f(X )f一金K+ 60X2 一 8*103)X e -20,0f =(-2X3 + 60 x2 8*103) Xe0,20(x)8*102由踝關(guān)節(jié)的軌跡函數(shù)可得踝關(guān)節(jié)關(guān)于時間的函數(shù)： 人 x( ) = t, y( ) = f (x(其中：人為

6、步長髖關(guān)節(jié)關(guān)于時間的函數(shù)：人*2（）一 2T*，y2 Hk Hk為髖關(guān)節(jié)離地高度，取122.6用MATLAB仿真得到：圖3.1：踝關(guān)節(jié)軌跡坐標(biāo)圖3.2:踝關(guān)節(jié)一階導(dǎo)數(shù)圖3.3:踝關(guān)節(jié)二階導(dǎo)數(shù)由以上仿真結(jié)果可知，在行走過程中機器人的踝關(guān)節(jié)軌跡、踝關(guān)節(jié)軌跡的一階導(dǎo)數(shù)和踝 關(guān)節(jié)軌跡的二階導(dǎo)數(shù)都是連續(xù)的。而且擺動腿著地時的速度為零，大大減小了沖擊，保證了 機器人行走的穩(wěn)定性。根據(jù)上述髖關(guān)節(jié)和踝關(guān)節(jié)關(guān)于時間的軌跡函數(shù)，可求得各關(guān)節(jié)角度關(guān)于時間的函數(shù)： = arcsin 巫H!蟲三EiL *2=arccos .尤f 一匕 + 生：(x - X2)2 + (y -七)22 22、步序規(guī)劃目前主要有兩類步態(tài)機

7、器人的穩(wěn)定性：靜態(tài)穩(wěn)定性和動態(tài)穩(wěn)定性。靜態(tài)穩(wěn)定性忽略機器 人的動態(tài)性能，采用重心（COG ）作為穩(wěn)定性標(biāo)準(zhǔn)，適用于移動較慢的機器人。而動態(tài)穩(wěn)定性 一般采用零力矩點（ZMP）作為穩(wěn)定性判定標(biāo)準(zhǔn)，即考慮重力、慣性力及地面反力三者合力矢 的延長線與地面的交點。在對角小跑（Trot）、溜蹄（Pace）、跳躍（bounding）等有較多 應(yīng)用。由于舵機性能及機械加工精度等方面的限制，WALKING DOG采用靜態(tài)穩(wěn)定性作為約束 步態(tài)的條件。靜態(tài)穩(wěn)定性約束的步態(tài)任一時刻至少應(yīng)有3條腿與地面接觸支撐機體，且機體的中心必 須落在3足支撐點構(gòu)成的三角形區(qū)域內(nèi)，據(jù)此設(shè)計步態(tài)圖如下：左血腿左曰腿在前腿右后腿圖3.4 :四足一周期內(nèi)的步態(tài)圖 實驗結(jié)果表明這種步序能使機器人連續(xù)穩(wěn)定地行走。四、結(jié)論采用模塊化設(shè)計