TOP1 危險(xiǎn)品處理機(jī)器人控制電路設(shè)計(jì)
本文首先簡(jiǎn)要介紹了危險(xiǎn)品危險(xiǎn)品處理機(jī)器人的作用,機(jī)械手的結(jié)構(gòu)形式,著重從控制系統(tǒng)與硬件設(shè)計(jì)介紹了危險(xiǎn)品處理機(jī)器人機(jī)械手控制系統(tǒng)的設(shè)計(jì)與實(shí)現(xiàn)。最后給出了測(cè)得的機(jī)械手的各項(xiàng)技術(shù)指標(biāo)。危險(xiǎn)品處理機(jī)器人是用于危險(xiǎn)彈藥夾持、拔出、搬運(yùn)和放置作業(yè),并可攜帶和放置的裝置。該項(xiàng)目的完成將解決長(zhǎng)期困擾我軍的事故炮彈、戰(zhàn)爭(zhēng)遺留彈等危險(xiǎn)彈藥安全處理問題。機(jī)械手是危險(xiǎn)品處理機(jī)器人操作過程中直接與彈藥接觸的重要部件,主要用于執(zhí)行對(duì)危險(xiǎn)彈藥的夾持、拆除、搬運(yùn)和放置作業(yè), 機(jī)械手工作的穩(wěn)定性直接決定著彈藥處理的成功率,因此機(jī)械手的設(shè)計(jì)至關(guān)重要。
PWM 管腳:DSP 的每個(gè)事件管理器都有與比較單元相關(guān)的PWM 電路,能夠產(chǎn)生六路帶可編程死區(qū)和輸出極性的PWM 輸出,但是都是成對(duì)輸出的,對(duì)于本控制器需要的獨(dú)立的輸出,每個(gè)事件管理器只有3 路,一個(gè)DSP 有兩個(gè)事件管理器,可以獨(dú)立的輸出6 路PWM 波。液壓控制器需要6 路PWM 波驅(qū)動(dòng)電業(yè)比例閥,而伺服電機(jī)控制器需要4 路0-5V 的加速器信號(hào)調(diào)節(jié)電機(jī)轉(zhuǎn)速,在設(shè)計(jì)電路時(shí)將這兩種電路設(shè)計(jì)在一起,并制成印刷電路板,焊板時(shí)按每板的功能焊接即可,液壓控制器需要輸出PWM 波形,芯片用LM393 做比較器,此時(shí)電阻R19 和電容C71 不焊即可,但要有R21 上拉電阻,R17 和R18 將2 腳電壓分在1.7V 左右比較合適。伺服控制器需要輸出0-5V 電壓芯片用LM2904 做運(yùn)放用,焊電阻R19 和電容C17不用MOS 管、R21 和外接電源,也不用焊R17,直接將DSP 輸出0-3.3V 電壓放大到0-5V 輸出。PWM/電壓輸出電路圖見圖1:
圖1 PWM/電壓輸出電路
IO 口:DSP 的數(shù)字I/O 口模塊具有控制專用I/O 和復(fù)用引腳的功能,可以輸出輸入高低電平信號(hào),根據(jù)其功能將其設(shè)計(jì)成開關(guān)量輸出,輸入,并用其控制繼電器,作為控的開關(guān)。開關(guān)量輸入只要用電阻分壓即可,開關(guān)量輸出使用光耦隔離,本設(shè)計(jì)用的光耦PC817,比較適合DSP 使用。當(dāng)DSP 輸出高電平時(shí)繼電器吸合,CNETA1 和CNETA2 兩腳導(dǎo)通繼電器電路圖見圖2:
圖2 繼電器電路圖
QEP 電路:DSP 的每個(gè)時(shí)間管理器都有一個(gè)正交編碼器脈沖(QEP)電路。當(dāng)QEP電路被使能時(shí)可以對(duì)CAP1/QEP1 和CAP2/QEP2(對(duì)于EVA 模塊)引腳上的正交編碼輸入脈沖進(jìn)行解碼和計(jì)數(shù)。正交編碼脈沖電路可用于連接光電編碼器以獲得旋轉(zhuǎn)機(jī)械的位置和速率。伺服電機(jī)控制器需要使用QEP 電路,由于一個(gè)伺服電機(jī)控制器需要控制4 臺(tái)伺服電機(jī),所以碼盤信號(hào)使用74153 芯片選擇輸入,同時(shí)碼盤的每路信號(hào)都有正負(fù)兩根線通過運(yùn)放放大后再到74153 選擇后輸入DSP,碼盤選擇電路見圖3:
圖3 碼盤選擇電路
其中W/R/IOPC0 為使能信號(hào),XINT1/IOPA2 和XINT2/ADCSOC/IOPDO 構(gòu)成選擇信號(hào),74153 通過選擇信號(hào)的選擇碼選擇一對(duì)信號(hào)從7 腳和9 腳輸出給DSP。其他硬件電路設(shè)計(jì)包括電源、串口、CAN 總線和DSP 外圍接線等都是典型的設(shè)計(jì)。整個(gè)機(jī)器人車設(shè)計(jì)經(jīng)過安裝調(diào)試,機(jī)械手完全符合設(shè)計(jì)要求,達(dá)到如下技術(shù)指標(biāo):最大作業(yè)幅度約2.5m;最大作業(yè)深度:地下1m;最大作業(yè)幅度下夾持提升力≤80kg;最大夾持彈藥直徑160mm;目前國(guó)內(nèi)還沒有這種專業(yè)的處理危險(xiǎn)品的機(jī)器人批量生產(chǎn),本產(chǎn)品的成功完成為將來的批量生產(chǎn)奠定了堅(jiān)實(shí)的基礎(chǔ),市場(chǎng)潛力巨大。
接力競(jìng)賽機(jī)器人系統(tǒng)電路設(shè)計(jì)
接力機(jī)器人機(jī)械部分采用遙控汽車,造型時(shí)尚,色彩華麗,車上裝配的火炬有“2008奧運(yùn)”標(biāo)志,內(nèi)部七彩電子火焰舞動(dòng)閃爍,令人賞心悅目。比賽開始,人工啟動(dòng)第一輛機(jī)器人小車,車上火炬同時(shí)點(diǎn)亮,當(dāng)遇到下一輛機(jī)器人小車時(shí),下一輛機(jī)器人小車火炬自動(dòng)點(diǎn)亮并啟動(dòng)前進(jìn)。為了渲染效果,在終點(diǎn),還設(shè)計(jì)了艷麗鮮花構(gòu)成的凱旋門,當(dāng)機(jī)器人小車勝利到達(dá)終點(diǎn)凱旋門時(shí),電路自動(dòng)觸發(fā)燃放焰火,聲光相伴,具有很強(qiáng)的視覺沖擊力
電路原理:一片電機(jī)驅(qū)動(dòng)電路L293D、一個(gè)紅外光電開關(guān)TCRT5000和一個(gè)電阻R2四樣?xùn)|西就構(gòu)成了具有循跡功能的最簡(jiǎn)約的機(jī)器人。TCRT5000由一對(duì)相 “互隔開的紅外發(fā)射和接收二極管構(gòu)成,TCRT5000朝下安裝在機(jī)器人小車底盤上。其中的發(fā)射二極管向地面發(fā)射紅外線,接收二極管接收從地面反射的紅外線。機(jī)器人使用了ATMAGE8單片機(jī)內(nèi)部集成的模數(shù)轉(zhuǎn)換功能,不同顏色的地面反射紅外線的情況不同,因而接收二極管接收到的紅外線信號(hào)強(qiáng)度也就不同,通過ATMAGE8單片機(jī)進(jìn)行模數(shù)轉(zhuǎn)換。
不同的紅外線信號(hào)強(qiáng)度轉(zhuǎn)換成不同的數(shù)值。據(jù)此就能識(shí)別地面的線跡,程序再通過電機(jī)驅(qū)動(dòng)電路L293D控制車輪運(yùn)動(dòng)實(shí)現(xiàn)自動(dòng)循跡。干簧管GHG是用來實(shí)現(xiàn)接力的,每輛車前端裝磁鐵,尾端裝干簧管,后車靠近前車時(shí),后車前端的磁鐵作用于前車后端的干簧管,就傳遞了接力信號(hào)。紅外發(fā)射二極管D3和紅外接收二極管D4是用來配合機(jī)器人在完成接力后實(shí)現(xiàn)停車功能的。每輛車前端安裝紅外接收二極管D4,尾端安裝紅外發(fā)射二極管D3。當(dāng)磁鐵作用于干簧管,傳遞了接力信號(hào)后,前車通過后端的紅外發(fā)射二極管D3發(fā)射紅外線,后車通過前端的紅外接收二極管D4接收到紅外線后就停止前進(jìn)。
????? 更多機(jī)器人技術(shù)資料,電路圖及DIY設(shè)計(jì),可參見本期Designs of week——當(dāng)中國(guó)制造遇上機(jī)器人技術(shù),設(shè)計(jì)思維請(qǐng)跟上!
評(píng)論
查看更多