基于PC/104與單片機(jī)的仿人機(jī)器人控制系統(tǒng)設(shè)計(jì)
主要特性有:
(1)高速、流水線結(jié)構(gòu)的8051兼容的CIP一51內(nèi)核(可達(dá)25 MIPS),70%的指令的執(zhí)行時(shí)間為1個(gè)或2個(gè)系統(tǒng)時(shí)鐘周期,能滿足關(guān)節(jié)控制器的需要。
(2)有4個(gè)通用16位計(jì)數(shù)器/定時(shí)器,以及16位可編程計(jì)數(shù)器/定時(shí)器陣列,5個(gè)捕捉/比較模塊,29個(gè)端口I/O。通過(guò)對(duì)片內(nèi)進(jìn)行編程,以及合理地分配比較器與I/O口,實(shí)現(xiàn)在C8051F310芯片上產(chǎn)生21路PWM波。由于單片機(jī)輸出的是數(shù)字形式的控制量,必須經(jīng)過(guò)D/A轉(zhuǎn)換變成模擬控制量,經(jīng)伺服放大器驅(qū)動(dòng)電機(jī)。
在此采用MAXIIM的12位串行D/A芯片MAX531作為數(shù)/模轉(zhuǎn)換芯片,將MAX531工作在雙極性電壓方式下,其輸出模擬量的范圍在一2.048~+2.048 V,精度為1 mV。輸出的模擬量經(jīng)過(guò)運(yùn)算放大器進(jìn)行放大,進(jìn)入伺服放大器驅(qū)動(dòng)電機(jī)。
C8051F310作為關(guān)節(jié)控制器控制核心,它主要負(fù)責(zé)21路PWM的產(chǎn)生,在C8051F310芯片中集成了4個(gè)通用的16位計(jì)數(shù)器/定時(shí)器,5個(gè)捕捉/比較模塊,運(yùn)用1個(gè)計(jì)數(shù)器/定時(shí)器和1個(gè)比較模塊控制6路I/0端口,其他3個(gè)計(jì)數(shù)器/定時(shí)器和3個(gè)比較器控制15路I/O口,來(lái)實(shí)現(xiàn)21路PWM波的產(chǎn)生。這里以6路PWM波的產(chǎn)生來(lái)說(shuō)明運(yùn)用C8051F310實(shí)現(xiàn)電路,其電路圖如圖4所示:CEXn引腳產(chǎn)生脈寬調(diào)制PWM輸出,PWM輸出的頻率取決于PCA計(jì)數(shù)器/定時(shí)器的時(shí)基,使用模塊的捕捉/比較寄存器PCA0CPLn改變PWM輸出信號(hào)的占空比。當(dāng)關(guān)節(jié)控制器接收給定的6個(gè)電機(jī)轉(zhuǎn)動(dòng)角度序列數(shù)據(jù)后.由軟件將6個(gè)數(shù)據(jù)從小到大排列,并依次求出相鄰2個(gè)數(shù)的差值,按照最小的數(shù)、前2個(gè)數(shù)的差值到最后兩個(gè)數(shù)的差值排列好,并將從小到大的數(shù)據(jù)對(duì)映的交叉開(kāi)關(guān)的地址依次對(duì)映。
程序?qū)⒌谝粋€(gè)最小角度數(shù)放入比較寄存器的低8位PCA0CPLn中,當(dāng)PCA計(jì)數(shù)器/定時(shí)器的低字節(jié)(PCAOL)與PCA0CPLn中的值相等時(shí),CEXn引腳上的輸出被置“1”;同時(shí)程序?qū)⒌诙€(gè)數(shù)據(jù)即差值放入比較寄存器的PCA0CPLn中,PCA計(jì)數(shù)器/定時(shí)器清零,并將交叉開(kāi)關(guān)置位到相應(yīng)的輸出腳,當(dāng)PCA計(jì)數(shù)器/定時(shí)器的低字節(jié)(PCAOL)與PCA0CPLn中的值再次相等時(shí),CEXn引腳上的輸出被置“1”,直到這組數(shù)據(jù)完畢。PCAOL中的計(jì)數(shù)值溢出,CEXn輸出被復(fù)位,準(zhǔn)備第二輪的PWM波的產(chǎn)生。
3 實(shí) 驗(yàn)
3.1 圖像采集處理
為了使機(jī)器人能夠達(dá)到預(yù)定目標(biāo),必須對(duì)軟件系統(tǒng)進(jìn)行設(shè)計(jì)規(guī)劃。主控計(jì)算機(jī)上安裝了WIN98系統(tǒng),圖像采集與處理采用VC進(jìn)行編程,下面是圖像采集處理的程序運(yùn)行界面如圖5所示。
3.2 仿人機(jī)器人穩(wěn)定步行
運(yùn)用這種控制系統(tǒng)來(lái)實(shí)現(xiàn)DF一1仿人機(jī)器人行走的控制,通過(guò)實(shí)驗(yàn)表明,此系統(tǒng)能夠完成仿人機(jī)器的動(dòng)態(tài)穩(wěn)定行走,圖6是一系列行走連續(xù)行走的截圖。
4 結(jié) 語(yǔ)
基于PC/104嵌入式計(jì)算機(jī)和C8051F310芯片設(shè)計(jì)了仿人機(jī)器人的控制系統(tǒng),實(shí)現(xiàn)了機(jī)器人的圖像采集和處理,以及機(jī)器人的穩(wěn)定步行。PC/104嵌入式計(jì)算機(jī)功能齊備,運(yùn)算能力強(qiáng),可擴(kuò)展性好,作為仿人機(jī)器人控制系統(tǒng)有它獨(dú)特的優(yōu)點(diǎn)。單片機(jī)實(shí)現(xiàn)仿人機(jī)器人的關(guān)節(jié)控制,由于其計(jì)算能力有限,難以實(shí)現(xiàn)復(fù)雜的控制,因此這種控制系統(tǒng)可以用來(lái)作為實(shí)驗(yàn)用和教學(xué)用機(jī)器人。
評(píng)論