【正文】 tri135no[j]。 l=channelno[k]。 SendPacket(s*3, l, backwardposi[k])。 }注：6腳與5類似，略去。} 因為SendPacket函數(shù)涉及到三個變量：速度、舵機(jī)號、舵機(jī)位置，所以利用變量l、k分別提取舵機(jī)號及其對應(yīng)的數(shù)組號。為使機(jī)器人行走時滿足運動周期要求，則需要設(shè)定不同速度，經(jīng)調(diào)試，當(dāng)s=7，著地移動速度為21時滿足行走要求。為使機(jī)器人動作到位，每次發(fā)送指令后必須要延遲，其延遲關(guān)系近似為舵機(jī)位置變化值的五分之一，即Delayms=stride/5=150/5。四腳步態(tài)與三腳步態(tài)類似，由于有四只腳同時著地，則顯得更穩(wěn)定。以前進(jìn)為例，其行走路徑為：一、5腳上抬；二、5腳前進(jìn)；三、5腳落地；四、5腳后退；五、234腳同上。當(dāng)34腳落地時，15腳正好抬起，同樣需要通過改變步態(tài)速度來實現(xiàn)。在編程之前，需聲明如下三個數(shù)組：quar15no[6] = {1,2,13,14,0,12}。 quar26no[6] = {4,5,16,17,3,15}。 quar34no[6] = {7,8,10,11,6,9}。 程序則為：void quarforward(int time){ int i,j,k,l=0。 for(i=0。itime。i++) { for(j=0。j4。j++) //5腳上抬 { k=quar15no[j]。 //獲取數(shù)組序號 l=channelno[k]。 //獲取端口號 SendPacket(s, l, raiseposi[k])。 } delay_ms(Delayms)。 for(j=4。j6。j++) //5腳前進(jìn) { k=quar15no[j]。 l=channelno[k]。 SendPacket(s, l, forwardposi[k])。 } delay_ms(Delayms)。 for(j=0。j4。j++) //5腳下降至初位 { k=quar15no[j]。 l=channelno[k]。 SendPacket(s, l, initposi1[k])。 } delay_ms(Delayms)。 for(j=4。j6。j++) //5腳后退至初位 { k=quar15no[j]。 l=channelno[k]。 SendPacket(s*3, l, backwardposi[k])。 注：6；4與5的一致，只要將數(shù)組換掉即可 }由于四腳步態(tài)的穩(wěn)定性，后續(xù)的其它涉及到行走的程序，均調(diào)用的是四腳步態(tài)的前進(jìn)后退。（波動）步態(tài)單腳步態(tài)由于每次只移動一只腳，看起來動作較快，實際上走一步花的時間較長，總體上看行走較慢，只適合表演一下。其行走步驟為：一、1腳上抬；二、1腳前進(jìn)；三、1腳落地；四、1腳后退；五、按6腳的順序依次完成與1腳相同的動作。為實現(xiàn)6腳落地時，1腳抬起，則動作速度設(shè)置為28。首先定義六個數(shù)組，與前述功能一致：int single1no[3] = {0,1,2}。int single2no[3] = {3,4,5}。int single3no[3] = {6,7,8}。int single4no[3] = {9,10,11}。int single5no[3] = {12,13,14}。int single6no[3] = {15,16,17}。然后編寫程序，同樣以前進(jìn)程序為例。void singleforward(int time){ int i,j,k,l=0。 for(i=0。itime。i++) { for(j=1。j3。j++) //1腳上抬 { k=single1no[j]。 //獲取數(shù)組序號 l=channelno[k]。 //獲取端口號 SendPacket(s, l, raiseposi[k])。 } delay_ms(Delayms)。 //1腳前進(jìn) k=single1no[0]。 l=channelno[k]。 SendPacket(s, l, forwardposi[k])。 delay_ms(Delayms)。 for(j=1。j3。j++) //1腳下降至初位 { k=single1no[j]。 l=channelno[k]。 SendPacket(s, l, initposi1[k])。 } delay_ms(Delayms)。 //1腳后退至初位 k=single1no[0]。 l=channelno[k]。 SendPacket(s*4, l, backwardposi[k])。 注：其它腳的程序略去，與1腳一致}相對于上面兩個程序，單腳步態(tài)的程序作了一定簡化，因為數(shù)組中只有三個值，有時便不需要用到for循環(huán)。機(jī)器人不光要回直行，如果遇到障礙物，還要學(xué)會轉(zhuǎn)彎避讓，或者采用類似螃蟹一樣的橫爬方式也可。右轉(zhuǎn)，與四腳步態(tài)相同，只是每一對腳起步時，左腳起腳前邁，而右腳起腳后擺。順序為：左腳：抬腿——前擺——下落——后擺右腳：抬腿——后擺——下落——前擺其余動作時間等均與四腳步態(tài)相同。左轉(zhuǎn)，與右轉(zhuǎn)相反。順序為：左腳：抬腿——后擺——下落——前擺右腳：抬腿——前擺——下落——后擺從上面的動作順序可見，舵機(jī)左右運動方向恰好相反，反應(yīng)在數(shù)值變化符號上則是正好一致，所以程序中無需用到forward[18]等數(shù)組。以右轉(zhuǎn)為例，具體程序為：void rotateright(int time){ int i,j,k,l=0。 Initservo1()。 for(i=0。itime。i++) { for(j=0。j4。j++) //5腳上抬 { k=quar15no[j]。 l=channelno[k]。 SendPacket(s, l, raiseposi[k])。 } delay_ms(Delayms1)。 for(j=4。j6。j++) //1腳前進(jìn)、5腳后退 { k=quar15no[j]。 l=channelno[k]。 SendPacket(s, l, initposi1[k]Stride1)。 } delay_ms(Delayms1)。 for(j=0。j4。j++) //5腳下降至初位 { k=quar15no[j]。 l=channelno[k]。 SendPacket(s, l, initposi1[k])。 } delay_ms(Delayms1)。 for(j=4。j6。j++) //1腳后退、5腳前進(jìn) { k=quar15no[j]。 l=channelno[k]。 SendPacket(s*3, l, initposi1[k]+Stride1)。 }注：6與4程序與上述一致，略去}其中Stride1為舵機(jī)變動幅度，其值為45，低于直行，避免幅度過大，行走不穩(wěn)。而橫爬程序就不那么容易了，它的值需要重新設(shè)定。關(guān)節(jié)號（數(shù)組號）初值抬腿前擺下落后擺0（0）900+00+001（1）655+100140+15+1252（2）685+100向內(nèi)15175+1903（6）655+00+004（4）710+100140+15+1255（5）720+10015175+1906（6）680+00+007（7）614+100140+15+1258（8）820+10015175+19031（9）645+0+0+0030（10）850100+125+1514029（11）815100向內(nèi)+1901751528（12）785+0+0+0027（13）850100+125+1514026（14）855100+1901751525（15）890+0+0+0024（16）925100+125+1514023（17）915100+19017515 右移舵機(jī)數(shù)值從上表中可以看出，數(shù)據(jù)不再具備規(guī)律性，那么在書寫程序時，便要一步步書寫了。對于左移，其數(shù)據(jù)恰與右移相反，只需將第四列與第六列的數(shù)據(jù)對換，便分別取相反數(shù)即可。以右移為例，其部分程序為：void crabright(int time){ int i=0。 for(i=0。itime。i++) { //5 抬腿 SendPacket(s, 1, initposi2[1]+100)。 SendPacket(s, 2, initposi2[2]+100)。 SendPacket(s, 27, initposi2[13]100)。 SendPacket(s, 26, initposi2[14]20)。 delay_ms(Delayms)。 //5收縮 SendPacket(s, 1, initposi2[1]40)。 SendPacket(s, 2, initposi2[2]+45)。 SendPacket(s, 27, initposi2[13]+25)。 SendPacket(s, 26, initposi2[14]+50)。 delay_ms(Delayms)。 //5外推 SendPacket(s*2, 1, initposi2[1]25)。 SendPacket(s*2, 2, initposi2[2]50)。 SendPacket(s*2, 27, initposi2[13]+40)。 SendPacket(s*2, 26, initposi2[14]45)。注：6與4腳程序略去}從程序中不難發(fā)現(xiàn)，實際程序編寫值與表中所列值是有區(qū)別的，這是因為，在調(diào)試過程中可以知道，如果按表中的值來運行的話，在很多舵機(jī)還未到達(dá)設(shè)定點時，便要完成下一個動作，單純通過改動延遲時間，會使得機(jī)器人行走時不那么順暢，產(chǎn)生動作停頓，影響觀賞性。為使機(jī)器人更加智能化，功能更強(qiáng)大， 一個簡單的方法就是在其上加上各種傳感器，探知外界，再通過主控制器，來完成相應(yīng)動作。按照調(diào)試順序，下面將對用到的傳感器進(jìn)行一一介紹。需提出的是，傳感器的基本功能程序在本文中就不介紹了，主要介紹傳感器的基本情況與應(yīng)用，當(dāng)然會提及到一點如何將單一的傳感器程序集成到總的控制程序中來。 指南針傳感器Hitachi HM55B（29123）是Parallax推出的一款可以測量方向的指南針傳感器。它是通過內(nèi)部安裝的雙軸磁場傳感器測量周圍的磁場強(qiáng)度來探知當(dāng)前位置的朝向。通過函數(shù)pass()，即可測出方向值，其變化范圍為0~360。并隨著方向的連續(xù)變化數(shù)值發(fā)生連續(xù)變化。在調(diào)試時，由于STM32與51單片機(jī)在接受數(shù)據(jù)存在不一致，故根據(jù)示數(shù)變化規(guī)律對51程序進(jìn)行了一定調(diào)整。相傳黃帝發(fā)明了指南車，當(dāng)然絕不是用了指南針傳感器，這里可以利用該傳感器來編寫一個按設(shè)定方向行走的程序控制機(jī)器人運動。程序如下：void passlead(int direction) // 按設(shè)定方向運動{ int tempdirect,max,min。 tempdirect=pass()。 if(direction=355) //左分別為10度誤差 { max = direction+5360。 min = direction5。 if (tempdirectminamp。amp。tempdirect=min170) //向左增大 向右減小 rotateleft(1)。 else if(tempdirectmaxamp。amp。tempdirectmax+170) rotateright(1)。 else quarforward(1)。 } else if(direction5) { max = direction+5。 min = direction+3605。 if(tempdirectminamp。amp。tempdirectmin170) rotateleft(1)。 else if(tempdirectmaxamp。amp。tempdirect=max+170) rotateright(1)。 else quarforward(1)。 } else if(direction=170