模塊化蛇形機(jī)器人無線控制器開發(fā)

陸招蘭， 王坤東， 金 軒(. 三明學(xué)院 現(xiàn)代教育技術(shù)中心，福建 365004; .上海交通大學(xué) 儀器工程系，上海 0040)

?

模塊化蛇形機(jī)器人無線控制器開發(fā)

陸招蘭1， 王坤東2， 金 軒2
(1. 三明學(xué)院 現(xiàn)代教育技術(shù)中心，福建 365004; 2.上海交通大學(xué) 儀器工程系，上海 200240)

基于無線控制技術(shù)和模塊化思想，開發(fā)出面向蛇形機(jī)器人的控制單元，以克服蛇形機(jī)器人龐大關(guān)節(jié)數(shù)量而帶來的通信控制困難。該控制器下位機(jī)采用ARM單片機(jī)作為內(nèi)核處理器，利用其PWM波實(shí)現(xiàn)兩路舵機(jī)的獨(dú)立速度控制，基于C1100無線收發(fā)芯片實(shí)現(xiàn)與上位機(jī)的通信，并由鋰電池供電。上位機(jī)采用ARM單片機(jī)與C1100芯片接收信息，并通過RS232串口連接至計(jì)算機(jī)。分析了蛇形蜿蜒、直線蠕動(dòng)步態(tài)，提出了實(shí)現(xiàn)這些步態(tài)的運(yùn)動(dòng)控制方法，進(jìn)行了實(shí)驗(yàn)測(cè)試。結(jié)果表明，該控制器可靠性、實(shí)時(shí)性高，便于集成，亦可應(yīng)用于其他冗余度機(jī)器人控制。

蛇形機(jī)器人； 控制器； 無線通信； 模塊化

0 引 言

蛇形機(jī)器人能適應(yīng)輪式牽引無法到達(dá)的地形，在救災(zāi)、反恐、偵查中多有應(yīng)用[1-4]。Hirose開發(fā)出第一臺(tái)蛇形機(jī)器人ACM(Active Cord Mechanism)后，連續(xù)推出系列機(jī)器人，最新一臺(tái)ACM R5為水陸兩棲[5-7]。Gavin從1997年進(jìn)行蛇形機(jī)器人研究，設(shè)計(jì)并制作了S1～S5五代蛇形機(jī)器人[8]。德國(guó)GMD國(guó)家實(shí)驗(yàn)室也很早進(jìn)行了蛇形機(jī)器人的研究，最近開發(fā)了GMD-Snake2[9]。美國(guó)NASA研究多關(guān)節(jié)蛇形機(jī)器人，在2000年推出第一代蛇形機(jī)器人[10]。國(guó)內(nèi)，上海交通大學(xué)開發(fā)了我國(guó)首臺(tái)微小型仿蛇機(jī)器人[11]。國(guó)防科大也研制了蛇形機(jī)器人，安裝有視頻監(jiān)測(cè)器[12]。中科院沈陽自動(dòng)化所利用可重構(gòu)的思想研制出了一種模塊化的蛇形機(jī)器人，能進(jìn)行三維運(yùn)動(dòng)[13-14]。

在蛇形機(jī)器人的研究中，靈巧、有效、可靠的運(yùn)動(dòng)機(jī)構(gòu)及相應(yīng)的控制算法是核心研究?jī)?nèi)容。但除此之外，構(gòu)建可靠性高、實(shí)時(shí)性好的驅(qū)動(dòng)控制系統(tǒng)對(duì)于提高機(jī)器人的運(yùn)動(dòng)可靠性、靈活性和環(huán)境適應(yīng)性也是非常關(guān)鍵的。為此，本文基于模塊化思想，利用無線通信技術(shù)開發(fā)出分布式、單元化的、獨(dú)立的無線控制模塊。

1 控制系統(tǒng)設(shè)計(jì)

1.1 總體控制方案

本研究采用分布式控制方法，每個(gè)模塊均具有獨(dú)立的控制單元，該控制單元均可接收、發(fā)送、處理數(shù)據(jù)以及控制各自關(guān)節(jié)的轉(zhuǎn)動(dòng)，克服了集中控制的負(fù)荷大、走線冗余等問題，具有控制單元負(fù)荷小，不存在模塊間通訊的走線問題，實(shí)時(shí)性高，并對(duì)于模塊的自由增減具有靈活性。控制系統(tǒng)組成框圖由圖1所示，系統(tǒng)包括由PC、ARM MCU、CC1101無線模塊構(gòu)成的上位發(fā)送端，以及由ARM MCU、CC1101無線模塊、舵機(jī)等構(gòu)成的下位控制端。下位控制端的電路板放置在每個(gè)執(zhí)行單元上，執(zhí)行單元通過CC1101無線模塊接收來自上位發(fā)送端的信號(hào)，在ARM MCU的控制下改變PWM波的占空比，從而控制舵機(jī)的轉(zhuǎn)動(dòng)方向和速度。

(a) 上位機(jī)

(b) 下位機(jī)

1.2 分布式下位機(jī)驅(qū)動(dòng)控制單元

下位機(jī)采用單片機(jī)控制，選用意法半導(dǎo)體的STM32F103RBT6，內(nèi)核為ARM Cortex-M3，用到單片機(jī)的SPI接口，2路PWM波輸出，其他資源可以作為后續(xù)添加視頻模塊、傳感器模塊的儲(chǔ)備。無線收發(fā)模塊采用CC1100，具有體積小、靈敏度高，可編程控制控制數(shù)據(jù)傳輸率，電流消耗較低，且只需要極少的外部元件就可以組成一個(gè)完整的無線傳輸模塊等特點(diǎn)，適合本蛇形機(jī)器人設(shè)計(jì)需要的無線芯片的要求。

驅(qū)動(dòng)單元主要由旋轉(zhuǎn)舵機(jī)和伸縮舵機(jī)組成，旋轉(zhuǎn)舵機(jī)產(chǎn)生關(guān)節(jié)轉(zhuǎn)動(dòng)，而伸縮電機(jī)經(jīng)齒輪齒條運(yùn)動(dòng)轉(zhuǎn)換后具有直線伸縮功能，分別采用Futaba S3003 180°舵機(jī)和春天SM-S4309R 360°舵機(jī)?？刂菩盘?hào)為50 Hz的PWM波，在ARM MCU的控制下改變PWM波的占空比，從而控制舵機(jī)的轉(zhuǎn)動(dòng)方向和速度。

整個(gè)蛇形機(jī)器人系統(tǒng)是由鋰電池供電。參考鋰電池的輸出功率以及儲(chǔ)電量和2個(gè)舵機(jī)的功率，可工作6 h左右，滿足實(shí)驗(yàn)設(shè)計(jì)要求。鋰離子電池輸出電壓為9 V，經(jīng)穩(wěn)壓后輸出4.8 V驅(qū)動(dòng)舵機(jī)，另一路穩(wěn)壓后為3.3 V，給單片機(jī)提供工作電壓。同時(shí)，為了判斷機(jī)器人模塊是否處于加電工作狀態(tài)，在芯片的輸出端放置了一個(gè)LED燈。

2 運(yùn)動(dòng)控制算法及程序

上位PC機(jī)界面采用C#編寫，主要功能是發(fā)送自定義的控制信號(hào)給上位機(jī)發(fā)送電路板，包括蛇形機(jī)器人的步態(tài)選擇，前進(jìn)方向以及速度控制等。機(jī)器人在每次運(yùn)動(dòng)開始前需要初始化：當(dāng)選擇蜿蜒運(yùn)動(dòng)時(shí)，需要將機(jī)器人的機(jī)體曲線初始化為蛇形曲線形式；當(dāng)選擇直線運(yùn)動(dòng)時(shí)，需要將機(jī)器人的每個(gè)執(zhí)行單元設(shè)置為自由伸長(zhǎng)狀態(tài)，以保證運(yùn)動(dòng)的可靠性和精確性。

控制信息的長(zhǎng)度為15 Byte，字節(jié)0為狀態(tài)選擇位，分別對(duì)應(yīng)下位機(jī)的定時(shí)器時(shí)間設(shè)置、蜿蜒運(yùn)動(dòng)、直線運(yùn)動(dòng)、蜿蜒運(yùn)動(dòng)初始化、直線運(yùn)動(dòng)初始化以及停止6種狀態(tài)。若前導(dǎo)碼為0xFF，則對(duì)應(yīng)為定時(shí)器時(shí)間設(shè)置，用以設(shè)置機(jī)器蛇運(yùn)動(dòng)速度的快慢，具體分析見蜿蜒運(yùn)動(dòng)的運(yùn)動(dòng)控制部分，此時(shí)字節(jié)1、2為定時(shí)器3設(shè)置位，用以控制直線運(yùn)動(dòng)單步之間間隔的時(shí)間，字節(jié)3、4為定時(shí)器2設(shè)置位，用以控制蜿蜒運(yùn)動(dòng)兩轉(zhuǎn)角之間PWM占空比轉(zhuǎn)換時(shí)間；若前導(dǎo)碼為0x01，則為蜿蜒運(yùn)動(dòng)初始化控制指令，其中需要控制搖擺關(guān)節(jié)回到零位，并將直線關(guān)節(jié)收縮；若前導(dǎo)碼為0x1C，則為蜿蜒運(yùn)動(dòng)開始標(biāo)志，則字節(jié)1、2對(duì)應(yīng)模塊1搖擺關(guān)節(jié)初始化角度，字節(jié)3、4對(duì)應(yīng)模塊2搖擺關(guān)節(jié)初始化角度，……；同理，前導(dǎo)碼為0x0A，0x3B，0x4F分別為機(jī)器蛇直線運(yùn)動(dòng)初始化、直線運(yùn)動(dòng)開始以及運(yùn)動(dòng)結(jié)束控制指令，控制字節(jié)格式如圖2所示，其存儲(chǔ)在RxBuf中。

圖2 控制字節(jié)格式

2.1 蛇形蜿蜒運(yùn)動(dòng)

動(dòng)態(tài)情況下，在任意時(shí)間t，機(jī)器人每個(gè)搖擺關(guān)節(jié)的關(guān)節(jié)角函數(shù)[8]：

φi(t)=Asin[ωt+(i-1)β]

(1)

式中：ω=bk，決定關(guān)節(jié)角的頻率大?。籄=-2αsinb1幅值控制參數(shù)；β=2b1為周期控制參數(shù)。蜿蜒運(yùn)動(dòng)的速度由舵機(jī)轉(zhuǎn)速?zèng)Q定，改變PWM脈寬時(shí)間，用以改變轉(zhuǎn)速。當(dāng)機(jī)器人搖擺關(guān)節(jié)轉(zhuǎn)角變化時(shí)，對(duì)應(yīng)著PWM波占空比的變化；當(dāng)PWM波從上一個(gè)狀態(tài)的占空比到下一個(gè)狀態(tài)的占空比持續(xù)的時(shí)間不同時(shí)，就會(huì)使得轉(zhuǎn)角的平均轉(zhuǎn)速不同，從而使整個(gè)蛇形機(jī)器人的前進(jìn)速度不同?？刂贫鏅C(jī)的PWM信號(hào)時(shí)基為20 ms，意味著最少需要20 ms的時(shí)間才能使舵機(jī)的轉(zhuǎn)角發(fā)生變化。實(shí)際工作狀態(tài)下，蛇形機(jī)器人關(guān)節(jié)轉(zhuǎn)角值在時(shí)間上不可能連續(xù)，只能是一些離散值，離散點(diǎn)越多，運(yùn)動(dòng)越逼近真實(shí)運(yùn)動(dòng)，造成的代價(jià)是控制的復(fù)雜性。但是，離散點(diǎn)過少會(huì)造成機(jī)器人運(yùn)動(dòng)的卡頓。綜合考慮，將關(guān)節(jié)轉(zhuǎn)角函數(shù)離散成7個(gè)值，每個(gè)離散點(diǎn)間相位差為60°。在單片機(jī)的控制上，固化一個(gè)離散表(此表為離散的關(guān)節(jié)轉(zhuǎn)角函數(shù)值，分別對(duì)應(yīng)不同占空比的PWM波，采用定時(shí)器4捕獲/比較寄存器2作為蜿蜒運(yùn)動(dòng)PWM波寄存器)，每過一段時(shí)間，讀取表中的值用以產(chǎn)生占空比不同的PWM波，控制搖擺關(guān)節(jié)的轉(zhuǎn)動(dòng)。

運(yùn)動(dòng)控制程序的流程圖如圖3所示，單片機(jī)設(shè)置一個(gè)定時(shí)器用以控制PWM波占空比的變化間隔。程序中設(shè)置了一個(gè)函數(shù)TM4_Config(u16 pwm1,u16 pwm2)，其中pwm1和pwm2分別為180°舵機(jī)和360°舵機(jī)的PWM控制值。在蜿蜒運(yùn)動(dòng)中，只關(guān)心180°舵機(jī)的值，而將360°舵機(jī)的值設(shè)置為0x00。由圖2所示，每個(gè)pwm1變量由高低字節(jié)2 Byte組成，每個(gè)循環(huán)周期遍歷一遍控制字節(jié)(除前導(dǎo)碼)。在開始進(jìn)行蜿蜒運(yùn)動(dòng)前，首先需要將直線平移關(guān)節(jié)收縮，然后每個(gè)模塊將固化表中對(duì)應(yīng)的值寫入TM4_Config()函數(shù)，使機(jī)器人身體形成蜿蜒曲線。當(dāng)啟動(dòng)蜿蜒運(yùn)動(dòng)時(shí)，定時(shí)器開始工作，定時(shí)時(shí)間到時(shí)，判斷標(biāo)志位是否是控制字節(jié)的末尾(此處將標(biāo)志位設(shè)為status，判斷status是否等于7，若是7，在遍歷到了末尾)，若不是，則將status+1，繼續(xù)定時(shí)，并同時(shí)將得到的高低字節(jié)寫入TM4_Config()函數(shù)，改變PWM波占空比。若遍歷到了末尾，則將status設(shè)置為0，重新開始新一輪的遍歷，同時(shí)也將得到的字節(jié)寫入函數(shù)，控制PWM波的變化。

圖3 蛇形蜿蜒運(yùn)動(dòng)控制流程圖

2.2 直線運(yùn)動(dòng)

直線運(yùn)動(dòng)多為蚯蚓等仿生生物所采用，本研究中引入直線關(guān)節(jié)后，蛇形機(jī)器人的運(yùn)動(dòng)步態(tài)亦可包含該步態(tài)[15]。圖4(a)為一種單駐波運(yùn)動(dòng)示意圖，其中紅色加深單元為正在運(yùn)動(dòng)的模塊，具體運(yùn)動(dòng)過程描述如下：假設(shè)向右為機(jī)器人前進(jìn)方向，在第0步為初態(tài)；t1時(shí)刻，向執(zhí)行單元1的舵機(jī)(此處為360°舵機(jī)，以下敘述無特殊說明均為360°舵機(jī))輸入占空比為0.15，頻率為50 Hz PWM波，其余執(zhí)行單元舵機(jī)加電，但是處于停止?fàn)顟B(tài)。執(zhí)行單元1舵機(jī)正轉(zhuǎn)，帶動(dòng)齒條產(chǎn)生位移，從而使執(zhí)行單元1前進(jìn)一個(gè)步距，此時(shí)機(jī)器人處在第1步；在t2時(shí)刻，向執(zhí)行單元1的舵機(jī)輸入占空比為0.05的PWM波，同時(shí)向執(zhí)行單元2的舵機(jī)輸入占空比為0.15的PWM波，其余執(zhí)行單元舵機(jī)加電，但是處于停止?fàn)顟B(tài)。執(zhí)行單元1舵機(jī)反轉(zhuǎn)，執(zhí)行單元2舵機(jī)正轉(zhuǎn)，此時(shí)執(zhí)行單元1保持在原位不動(dòng)，而執(zhí)行單元2向前前進(jìn)1個(gè)步距，機(jī)器人處在第2步；在t3、t4，…，t9時(shí)刻，每個(gè)執(zhí)行單元中舵機(jī)的控制與前述相同。定義向舵機(jī)輸入占空比為0.15，頻率為50 Hz PWM波，使舵機(jī)正轉(zhuǎn)，以正電平表示；向舵機(jī)輸入占空比為0.05，頻率為50 Hz PWM波，使舵機(jī)反轉(zhuǎn)，以負(fù)電平表示，上述運(yùn)動(dòng)過程如圖4(b)。從第0～第7步，機(jī)器人完成一個(gè)前進(jìn)步態(tài)，步距等于每個(gè)單元前進(jìn)距離。重復(fù)這個(gè)過程，機(jī)器人就能完成連續(xù)前進(jìn)運(yùn)動(dòng)。通過調(diào)節(jié)輸入PWM波的占空比，即可以控制機(jī)器人的前進(jìn)方向以及前進(jìn)速度。

(a) 運(yùn)動(dòng)過程

(b) 舵機(jī)時(shí)序

單駐波運(yùn)動(dòng)的控制流程圖如圖5所示。首先直線運(yùn)動(dòng)前開始初始化，主要是搖擺關(guān)節(jié)回到零位，直線平移關(guān)節(jié)伸長(zhǎng)?，F(xiàn)以模塊1的軟件控制為例，flag初始值為0，直線運(yùn)動(dòng)開始時(shí)，打開定時(shí)器3，flag加1，當(dāng)定時(shí)時(shí)間到時(shí)，判斷flag是否為1，若為1，則將PWM波占空比設(shè)置為1 ms，使360°舵機(jī)反轉(zhuǎn)，相應(yīng)的直線平移關(guān)節(jié)收縮。剛開始運(yùn)動(dòng)時(shí)，模塊1的flag++后flag值為1，則直線平移關(guān)節(jié)收縮；然后等待第二次定時(shí)時(shí)間到，flag再次加1，判斷flag是否等于2，若為2(此時(shí)為2)，則將PWM波占空比設(shè)置為2 ms，使360°舵機(jī)正轉(zhuǎn)，相應(yīng)的直線平移關(guān)節(jié)伸長(zhǎng)；然后第三次定時(shí)到時(shí)，flag為3，PWM波占空比設(shè)置為1.5 ms，舵機(jī)停轉(zhuǎn)，直線平移關(guān)節(jié)靜止。至此，模塊1的直線平移關(guān)節(jié)在一個(gè)運(yùn)動(dòng)周期內(nèi)運(yùn)動(dòng)結(jié)束，當(dāng)定時(shí)器第8次定時(shí)時(shí)間到時(shí)，將flag設(shè)置為0，繼續(xù)開始另一個(gè)周期的運(yùn)動(dòng)。后面的其他模塊跟模塊1的控制流程相同。

圖5 單駐波直線運(yùn)動(dòng)控制流程圖

3 運(yùn)動(dòng)控制測(cè)試與分析

3.1 蛇形蜿蜒運(yùn)動(dòng)

利用前面確定的數(shù)值A(chǔ)=0.7,ω=1,β=0.9，計(jì)算各關(guān)節(jié)的轉(zhuǎn)角數(shù)據(jù)，分為7個(gè)離散值，求出各個(gè)模塊控制電路板ARM芯片定時(shí)器4捕獲比較寄存器1需要遍歷的值，固化轉(zhuǎn)角數(shù)據(jù)表如表1所示。

表1 實(shí)驗(yàn)條件下各關(guān)節(jié)初始轉(zhuǎn)角

固化轉(zhuǎn)角數(shù)據(jù)表內(nèi)編號(hào)為1～7寄存器的值分別對(duì)應(yīng)1～7模塊初始化時(shí)，需要寫入捕獲比較寄存器1的值。蛇形機(jī)器人每個(gè)模塊均會(huì)遍歷表1內(nèi)的寄存器值，蜿蜒運(yùn)動(dòng)PWM波占空比變化規(guī)律為每7個(gè)單位時(shí)間循環(huán)1次。即蛇形機(jī)器人每一個(gè)模塊相比與前一個(gè)模塊的轉(zhuǎn)角滯后1位，同時(shí)也都隨著時(shí)間的推移，每隔單位時(shí)間(200 ms)相應(yīng)向后循環(huán)把寄存器數(shù)據(jù)寫入定時(shí)器4捕獲比較寄存器1中改變180°舵機(jī)的脈沖占空比(到達(dá)第7位后繼續(xù)回到第1位取值)，從而形成完整的蜿蜒運(yùn)動(dòng)過程。

只要舵機(jī)原始的轉(zhuǎn)角速度與單位時(shí)間內(nèi)通過脈沖占空比改變而得到的轉(zhuǎn)角速度平均值大致相同或成一定比例，就可以保證蛇形機(jī)器人運(yùn)動(dòng)的整體平滑性。舉例說明如下：我們?cè)O(shè)置單位時(shí)間為200 ms，表1內(nèi)相鄰2位寄存器的值造成的PWM波占空比變化對(duì)應(yīng)的轉(zhuǎn)角差為60°，則實(shí)際舵機(jī)轉(zhuǎn)速為375～300°/s，蛇形機(jī)器人雖然每一步運(yùn)行時(shí)間與舵機(jī)實(shí)際轉(zhuǎn)速有些許出入，但整體上不會(huì)有明顯的卡頓現(xiàn)象。在前述數(shù)據(jù)下，我們進(jìn)行了蜿蜒運(yùn)動(dòng)的實(shí)驗(yàn)，如圖6所示。在蜿蜒運(yùn)動(dòng)中，機(jī)器人的運(yùn)動(dòng)曲線準(zhǔn)確，由于機(jī)體與地板表面的摩擦系數(shù)縱向與軸向幾乎一致，機(jī)器人運(yùn)動(dòng)時(shí)會(huì)有些打滑。分析原因是研制的蛇形機(jī)器人外殼不具有真實(shí)蛇類皮膚表面摩擦系數(shù)各向異性的特點(diǎn)。通過在機(jī)器人底部增加被動(dòng)輪的經(jīng)典方式，可以有效防止打滑出現(xiàn)。

圖6 蜿蜒運(yùn)動(dòng)實(shí)驗(yàn)

3.2 直線運(yùn)動(dòng)

在直線運(yùn)動(dòng)過程中，綜合考慮舵機(jī)運(yùn)行速度、齒輪齒條模數(shù)比、齒條長(zhǎng)度以及模塊各部分干涉問題，將一個(gè)加電周期設(shè)置為1.4 s。實(shí)驗(yàn)時(shí)在狹窄通道中機(jī)器人運(yùn)行平穩(wěn)，采用圖4運(yùn)動(dòng)學(xué)分析的步態(tài)時(shí)，機(jī)器人運(yùn)動(dòng)速度約為4.3 mm/s。通過在一個(gè)運(yùn)動(dòng)周期內(nèi)增加多個(gè)駐波的形式，可以有效提高機(jī)器人的前進(jìn)速度，采用2個(gè)駐波時(shí)，速度可以達(dá)到約8.6 mm/s。在平坦地面上直線運(yùn)動(dòng)與在狹窄通道中運(yùn)動(dòng)狀態(tài)參數(shù)類似。直線運(yùn)動(dòng)的實(shí)驗(yàn)結(jié)果如圖7所示，運(yùn)動(dòng)方向?yàn)閺淖笙蛴乙苿?dòng)，駐波在圖中用白色方框圈出?？梢钥闯?，右邊第1個(gè)模塊開始運(yùn)動(dòng)，駐波隨后相繼向左傳遞，當(dāng)駐波到達(dá)左邊第一個(gè)模塊，1個(gè)周期并未結(jié)束時(shí)，右邊第1個(gè)模塊繼續(xù)開始運(yùn)動(dòng)，從而構(gòu)成了多駐波直線運(yùn)動(dòng)。

圖7 直線運(yùn)動(dòng)實(shí)驗(yàn)

4 結(jié) 語

超冗余度蛇形機(jī)器人控制系統(tǒng)的難點(diǎn)之一就是其龐大的控制系統(tǒng)，模塊化分布式控制方式是其發(fā)展的必然趨勢(shì)。本研究基于模塊化思想，開發(fā)上位機(jī)、下位機(jī)及其控制驅(qū)動(dòng)模塊的軟硬件系統(tǒng)。研究開發(fā)了電源穩(wěn)壓、無線收發(fā)、舵機(jī)控制等電路，開發(fā)了上位機(jī)PC程序、無線收發(fā)程序以及舵機(jī)控制程序。對(duì)蛇形蜿蜒運(yùn)動(dòng)及直線蠕動(dòng)的運(yùn)動(dòng)控制進(jìn)行了算法分析，并實(shí)現(xiàn)了這兩種運(yùn)動(dòng)形式。運(yùn)動(dòng)測(cè)試表明，本研究構(gòu)建的無線控制與驅(qū)動(dòng)系統(tǒng)切實(shí)可行、穩(wěn)定性高。但是，目前各個(gè)關(guān)節(jié)模塊之間仍然沒有橫向信息傳遞，沒有完全發(fā)揮分布式控制系統(tǒng)的優(yōu)勢(shì)，另外，一旦其中某一模塊單片機(jī)宕機(jī)，則會(huì)產(chǎn)生運(yùn)動(dòng)的不協(xié)調(diào)，且不利于機(jī)器人的自主運(yùn)動(dòng)，這些需要在后續(xù)的開發(fā)中予以改進(jìn)。

[1] Maruyama H, Ito K. Semi-autonomous snake-like robot for search and rescue[C]//Safety Security and Rescue Robotics (SSRR). 2010 IEEE International Workshop on. Bremen: IEEE, 2010: 1-6.

[2] Meister E, Stepanenko S, Kernbach S. Dynamics and Control of Modular and Self-Reconfigurable Robotic Systems[J]. International Journal on Advances in Intelligent Systems. 2013, 6(1): 66-78.

[3] Fukushima H, Satomura S,Kawai T,etal. Modeling and Control of a Snake-Like Robot Using the Screw-Drive Mechanism[J]. IEEE Transactions on Robotics, 2012, 28(3): 541-554.

[4] 魏 武, 朱紅山. 蛇形機(jī)器人在纜索檢測(cè)中螺旋滾動(dòng)步態(tài)的研究[J]. 計(jì)算機(jī)工程與設(shè)計(jì), 2011, 32(2): 700-702.

[5] Kouno K, Yamada H, Hirose S. Development of Active-Joint Active-Wheel High Traversability Snake-Like Robot ACM-R4. 2[J]. Journal of Robotics and Mechatronics, 2013, 25(3): 559-566.

[6] Hirose S. Biologically Inspired Robots: Snake-Like Locomotors and Manipulators[M]. London: Oxford University Press, 1993.

[7] Mori M, Hirose S. Three-dimensional serpentine motion and lateral rolling by active cord mechanism ACM-R3[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems, Lausanne, Switzerland, 2002: 829-834.

[8] Miller G S. 13 Snake Robots for Search and Rescue[J]. Neurotechnology for Biomimetic Robots, 2002, 30(2): 271-275.

[9] Klaassen B, Paap K L. GMD-SNAKE2: a snake-like robot driven by wheels and a method for motion control[C]//IEEE International Conference on Robotics and Automation, Detroit, Michigan, 1999: 3014-3019.

[10] John B. Nasa Developing "SNAKEBOT" to Explore and Build in Space[EB/OL]. (2000-10-03) http://www.nasa.gov/centers/ames/news/releases/2000/00_66AR.html

[11] Liu H, Yan G, Ding G. Research on the locomotion mechanism of snake-like robot[C]//Proceedings of 2001 International Symposium on Micromechatronics and Human Science, Nagoya, Japan, 2001: 183-188.

[12] 周旭升, 潘獻(xiàn)飛, 譚紅力. 一種蛇形機(jī)器人的研制[J]. 機(jī)器人, 2002, 24(7): 684-687.

[13] 郁樹梅, 馬書根, 李 斌. 蛇形機(jī)器人步態(tài)產(chǎn)生及步態(tài)分析[J]. 機(jī)器人, 2011, 33(3): 371-378.

[14] Wang Z, Ma S, Li B,etal. Experimental study of passive creeping for a snake-like robot[C]//IEEE/ICME International Conference on Complex Medical Engineering, 2011: 382-387.

[15] 簡(jiǎn)小剛, 王葉鋒, 楊鵬春, 基于蚯蚓蠕動(dòng)機(jī)理的仿生機(jī)器人研究進(jìn)展[J]. 中國(guó)工程機(jī)械學(xué)報(bào), 2012, 10(3): 359-363.

法治是實(shí)現(xiàn)教育現(xiàn)代化的可靠保障。全面深化改革、全面依法治教如車之兩輪，共同推動(dòng)教育現(xiàn)代化不斷向前發(fā)展。

社會(huì)主義核心價(jià)值觀是興國(guó)之魂。我們要實(shí)現(xiàn)的教育現(xiàn)代化是具有中國(guó)特色的現(xiàn)代化，社會(huì)主義核心價(jià)值觀是中國(guó)特色的內(nèi)核，是培養(yǎng)社會(huì)主義建設(shè)者和接班人的核心要義。

摘自《教育部袁貴仁部長(zhǎng)在2015年全國(guó)教育工作會(huì)議上的講話》

Development of Modularized Wireless Controller for Snake-like Robot

LUZhao-lan1,WANGKun-dong2,JINXuan2
(1. Modem Education Technology Center, Sanming University, Sanming 365004, China; 2. Department of Instrument Engineering, Shanghai Jiaotong University, Shanghai 200240, China)

This research developed a controller for snake-like robot based on wireless technology and modularization. This design overcame the communication difficulty come from its large number of articulations. ARM MCU was used as kernel processor with PWM module to control two steering engine. C1100 chip realized the wireless communication with the upper computer composed of ARM MCU, C1100. The upper computer was connected with the PC by RS232. Snake-like serpentine, linear peristalsis were analyzed. The control methods were proposed to realize these gaits, and the tests were performed to verify these methods. It was demonstrated that this controller had a high reliability, and it was easy to integrated into the robot. Wireless technology and modularization design have made a foundation for the multi-gaits of the snake-like robot, and these could be implemented into the other redundant robots.

snake-like robot; controller; wireless communication; modularizing

2014-04-21

上?？萍紗⒚餍怯?jì)劃項(xiàng)目(13QA1402200)資助

陸招蘭(1966-)，女，上海人，實(shí)驗(yàn)師，主要研究方向?yàn)橥ㄐ排c網(wǎng)絡(luò)技術(shù)。Tel.:13960568830；E-mail:csc5711@163.com

王坤東(1978-)，男，陜西長(zhǎng)安人，副教授，主要從事仿生機(jī)器人技術(shù)研究。Tel.:021-34207229；E-mail: kdwang@sjtu.edu.cn

TP 242

A

1006-7167(2015)02-0062-05