多功能噴射混凝土機(jī)器人控制系統(tǒng)研究＊

李云江,竇美寧,張 輝,郭祥乾

(1.山東建筑大學(xué)機(jī)電工程學(xué)院,山東濟(jì)南 250101;2.煙臺工程職業(yè)技術(shù)學(xué)院數(shù)控技術(shù)系,山東煙臺 264006)

多功能噴射混凝土機(jī)器人控制系統(tǒng)研究＊

李云江1,竇美寧2,張 輝1,郭祥乾1

(1.山東建筑大學(xué)機(jī)電工程學(xué)院,山東濟(jì)南 250101;2.煙臺工程職業(yè)技術(shù)學(xué)院數(shù)控技術(shù)系,山東煙臺 264006)

針對噴射混凝土機(jī)器人存在的問題,對產(chǎn)品的機(jī)械結(jié)構(gòu)和控制系統(tǒng)進(jìn)行模塊化重新劃分、構(gòu)造,基本實現(xiàn)了噴射混凝土機(jī)器人的多功能化。本文介紹了無線遙控控制系統(tǒng)的設(shè)計與實現(xiàn),包括輸入信號采集電路板、無線發(fā)送模塊、無線接收模塊以及輸出控制電路板。

噴射混凝土;機(jī)器人;控制系統(tǒng)

1 引言

噴射混凝土支護(hù)技術(shù)與傳統(tǒng)的混凝土整體支護(hù)技術(shù)相比,具有強度高、減少巷道開拓量、降低支護(hù)成本、提高圍巖自撐支護(hù)效能、使支護(hù)層厚度減少和加快施工進(jìn)度的特點[1]。噴射混凝土機(jī)器人克服了人工噴射混凝土的許多不足,而且有效地實現(xiàn)了支護(hù)[2]。在國家 863計劃的支持下,目前已經(jīng)開發(fā)出大、中、小系列化機(jī)器人。但是,在進(jìn)行試銷過程中,發(fā)現(xiàn)該機(jī)器人作為一種專業(yè)的施工裝備,有一些不足之處。主要表現(xiàn)在:噴射混凝土機(jī)器人產(chǎn)品單一,配套設(shè)施沒有跟上,使得機(jī)器人在施工過程中出現(xiàn)了“大馬拉小車”現(xiàn)象,嚴(yán)重制約了機(jī)器人能力的發(fā)揮。噴射混凝土機(jī)器人功能單一,噴射混凝土機(jī)器人只作為一臺噴射混凝土的設(shè)備,在現(xiàn)場施工過程中閑置時間過長,尤其當(dāng)用戶沒有隧道施工任務(wù)時,設(shè)備就閑置起來,嚴(yán)重影響了設(shè)備有效使用率。

噴射混凝土機(jī)器人要實現(xiàn)模塊化構(gòu)造,以便可以根據(jù)現(xiàn)場需要進(jìn)行不同形式的改裝,以擴(kuò)大其適用性[3]。針對以上問題,對噴射混凝土機(jī)器人進(jìn)行了改造和完善,基本實現(xiàn)了噴射混凝土機(jī)器人的多功能設(shè)計,限于篇幅,本文只闡述其無線控制系統(tǒng)的設(shè)計與實現(xiàn)。

無線遙控控制系統(tǒng)包括輸入信號采集電路板、無線發(fā)送模塊、無線接收模塊以及輸出控制電路板。輸入信號采集電路板與輸出控制電路板的設(shè)計采用的微處理器是低功耗單片機(jī)MSP430,無線發(fā)送接收模塊選用的是無線數(shù)傳模塊[4,5]。

2 輸入信號采集電路板

根據(jù)噴射混凝土機(jī)器人的作業(yè)軌跡,按照機(jī)器人學(xué)的運動分解過程,把描述各個關(guān)節(jié)運動的模擬量控制信號(如:腰部轉(zhuǎn)動、大臂俯仰、大臂伸縮、手腕轉(zhuǎn)動、噴嘴向前向后、縱臂進(jìn)退等)和開關(guān)量控制信號 (如:噴嘴轉(zhuǎn)動、下車油源、縱臂左右、縱臂俯仰、電機(jī)停止等)通過相關(guān)電路輸入到微處理器MSP430。微處理器的 A/D轉(zhuǎn)換模塊的轉(zhuǎn)換精度為12位,對輸入的模擬信號進(jìn)行數(shù)字轉(zhuǎn)換處理后,根據(jù)采用的A/D轉(zhuǎn)換序列通道多次轉(zhuǎn)換方式將轉(zhuǎn)換結(jié)果依次存入ADCMEMX中,等待處理器對它們的讀取。開關(guān)量輸入電路中,為了消除抖動信號對開關(guān)量輸入的影響,采用了MAXI M6818開關(guān)去抖器,用以產(chǎn)生穩(wěn)定的開關(guān)量輸入信號。

本系統(tǒng)中所采用的 A/D轉(zhuǎn)換模塊是MSP430單片機(jī)內(nèi)嵌的數(shù)模轉(zhuǎn)換器模塊,轉(zhuǎn)換精度分為 10位、12位、14位三種。根據(jù)控制系統(tǒng)所要求的精度采用了ADC12模塊,其內(nèi)核是一個帶有采樣和保持功能的 12位轉(zhuǎn)換器。

機(jī)器人的操作過程是連續(xù)的,需要將模擬量持續(xù)不間斷的進(jìn)行轉(zhuǎn)換,因此,采用了序列通道多次轉(zhuǎn)換模式。序列通道多次轉(zhuǎn)換模式是對一個序列(有順序的多個轉(zhuǎn)換通道)進(jìn)行持續(xù)的轉(zhuǎn)換,直到用軟件將其停止。A/D轉(zhuǎn)換結(jié)果的存放是由ADC12控制寄存器中的 CSStar-tAdd(轉(zhuǎn)換存儲器地址定義位)決定,它指向第一個轉(zhuǎn)換寄存器,其后的結(jié)果將順序的存放在轉(zhuǎn)換寄存器中。比如噴射混凝土機(jī)器人的一個A/D轉(zhuǎn)換序列有 2個轉(zhuǎn)換結(jié)果,第一個轉(zhuǎn)換結(jié)果存放在ADCMEM0中,則其后的第 2個轉(zhuǎn)換結(jié)果分別存放在ADCMEM1中。

在原先有線控制器中,采用的微處理器的A/D轉(zhuǎn)換為 10位的,電壓分辨力為:5/210=4.88mV。我們現(xiàn)在所采用的MSP430 ADC12模塊,其工作電壓為 3.6V,電壓的分辨力為:3.6/212=0.88mV,完全滿足了系統(tǒng)的工作要求。

噴射混凝土機(jī)器人的六個自由度:腰部轉(zhuǎn)動、大臂俯仰、大臂伸縮、手腕轉(zhuǎn)動、噴嘴向前向后、縱臂進(jìn)退,都是通過遙控器上的 6個操作手柄來進(jìn)行控制。每個操作手柄根據(jù)它所代表的自由度的運動路徑,將它的電壓分值以模擬量的形式傳遞給MSP430單片機(jī)。采用的A/D轉(zhuǎn)換是:每次進(jìn)行轉(zhuǎn)換時每個電位器都進(jìn)行掃描,掃描的結(jié)果以數(shù)據(jù)包的格式存依次存放在轉(zhuǎn)換寄存器ADCMEMx中,對轉(zhuǎn)換結(jié)果的讀取也是以整體的形式進(jìn)行讀取。

3 開關(guān)量輸入的防抖動設(shè)計

無線遙控器系統(tǒng)的開關(guān)量輸入信號一般用來控制電磁閥和繼電器。系統(tǒng)所涉及的開關(guān)量信號的輸入是通過MSP430F147的 P1端口,這 8位端口既能用作輸入和輸出,同時又具有中斷的能力,每個信號都可以用作一個中斷源,有 7個寄存器用于輸入/輸出的控制。在進(jìn)行信號的輸入時必須要定義 P1端口的方向選擇寄存器,將選定的引腳切換成輸入模式。

機(jī)械開關(guān)在實際應(yīng)用中不可能象數(shù)字系統(tǒng)希望的那樣產(chǎn)生一個單一平穩(wěn)的數(shù)字信號輸出,在開關(guān)閉合和斷開的時候會產(chǎn)生很多毫秒級的開抖動和關(guān)抖動,這是在硬件電路設(shè)計中不可回避的問題。抖動干擾的存在會使得系統(tǒng)在進(jìn)行信號采集時產(chǎn)生多個計數(shù)值,如果取值錯誤,就會令系統(tǒng)的控制出錯,所以在系統(tǒng)的設(shè)計時應(yīng)當(dāng)采取防抖動的措施。系統(tǒng)的防抖動設(shè)計有軟件設(shè)計法和硬件設(shè)計法兩種。

(1)防抖動設(shè)計的軟件實現(xiàn)方法。

軟件防抖動設(shè)計法就是處理器在接受到一個開關(guān)量的值時,先將其保存在一個寄存器中,利用一個時間延遲循環(huán)后再采集一次開關(guān)信號的值,兩者進(jìn)行比較。如果兩者相同,就可以將這個結(jié)果做為系統(tǒng)的開關(guān)量輸入值;反之,需要繼續(xù)采樣,直到取到兩個相同的值為止。軟件防抖動的優(yōu)點是:不用外加硬件電路,實現(xiàn)起來比較的簡單,缺點是:具有較大的時間延遲,占用微處理器的工作時間,如果存在多路開關(guān)信號的話,會占用較多的存儲器空間。

(2)防抖動設(shè)計的硬件實現(xiàn)方法。

簡易的硬件防抖動設(shè)計是采用電阻和電容的方法來實現(xiàn),出于硬件設(shè)計方面的考慮,這種方法不適用與多路開關(guān)信號的情況下。在本系統(tǒng)中我們采用的是防抖動開關(guān)接口芯片MAX6818。

MAX6818是MAXI M公司生產(chǎn)的一個 8路開關(guān)去抖器,提供了從機(jī)械開關(guān)到數(shù)字系統(tǒng)的穩(wěn)定接口。從一個機(jī)械開關(guān)接收到一個或多個抖動的輸入,經(jīng)過一個短暫的、預(yù)制限定的延時后產(chǎn)生一個穩(wěn)定的數(shù)字輸出。經(jīng)過該接口芯片,操作時的開抖動和關(guān)抖動都被消除了。開關(guān)信號的輸入沖擊電壓可達(dá)到±25V水平,工作的電源電壓為:2.7～5.5V,電源電流為:6μA,完全滿足本系統(tǒng)中所采用的低功耗要求。MAX6818防抖動延時的典型值為 40ms,最小為 20ms,最大為 60ms,能頭適應(yīng)性能較差的機(jī)械開關(guān),同時具有可控制的三態(tài)輸出。從圖 1可以看出, MAX6818與微處理器的接口方式非常簡單,只需要外接一個濾波電容,所以在硬件電路上實現(xiàn)起來比較容易。

圖1 MAX6818防抖動接口電路

無線遙控器對系統(tǒng)的開關(guān)量輸入信號的讀取是通過掃描 P1口的輸入寄存器得到的。輸入寄存器是 CPU掃描 I/O引腳信號的只讀寄存器。用戶不能對它寫入,只能通過讀取該寄存器中的內(nèi)容知道I/O端口的輸入信號。此時,引腳的方向必須選定為輸入方式。

4 輸出控制電路板

輸出控制電路板是將通過無線數(shù)傳模塊接收到的模擬及開關(guān)量信號通過相關(guān)電路處理后驅(qū)動相應(yīng)的閥塊和繼電器。其中模擬量信號利用MSP430單片機(jī)定時器A的輸出模塊功能,將控制信號轉(zhuǎn)換為PWM波形輸出到濾波電路和放大電路,從而完成數(shù)據(jù)的D/A轉(zhuǎn)換和放大過程。開關(guān)量信號經(jīng)過開關(guān)量放大電路實現(xiàn)驅(qū)動功能。

5 無線數(shù)傳模塊

本控制系統(tǒng)所采用的無線數(shù)傳模塊(包括無線發(fā)送模塊和無線接收模塊)FC-201-E無線數(shù)傳電臺,它具有透明,包容性強的 E型通訊協(xié)議,適合多種通訊場合。

(1)高、低電壓之間的電平轉(zhuǎn)換。

隨著電子集成芯片向著小型化和低功耗的方向發(fā)展,數(shù)字系統(tǒng)的工作電壓已經(jīng)從 5V下降到 3V甚至更低的檔次,所以存在很多 5V器件與 3V器件共存于一個系統(tǒng)中的情況。在工作實踐中,由于種種實際需要,往往要求MSP430單片機(jī)與常用的、在5V電壓下工作的單片機(jī)進(jìn)行串行通訊,或與個人計算機(jī)進(jìn)行串行通訊。因此,不同工作電壓之間的電平轉(zhuǎn)換是要解決的一個關(guān)鍵問題。

由于MSP430F147單片機(jī)的電源電壓是 1.8～ 3.6V,通常,5V TTL器件可以驅(qū)動 3V TTL輸入,因為典型雙極晶體管的輸出并不能達(dá)到電源電壓幅度。當(dāng)一個5V器件的輸出為高電平時,內(nèi)部壓降限制了輸出電壓。典型情況是VCC-2VBE,即約 3.6V。用3V器件驅(qū)動 5V TT L的輸入端應(yīng)當(dāng)是沒有困難的。3V CMOS器件實際上能輸出 3V擺幅的電壓。對 5V TT L輸入的高電平2V門限是容易滿足的,但3V輸出卻不能可靠的驅(qū)動5V的CMOS器件,因為,5VCMOS器件的輸入高電平要求最小的幅值為 3.8V,這是 3V器件不能做到的。顯然在此電源范圍內(nèi),其串行口的輸出電平既不能可靠實現(xiàn)與 TT L電平單片機(jī)的通訊,也不能實現(xiàn)COMS器件及RS232接口的通訊。為此,本系統(tǒng)給出了一種采用MAX3221E芯片進(jìn)行電平轉(zhuǎn)換,從而實現(xiàn)MSP430單片機(jī)與(5V)單片機(jī)及 RS232進(jìn)行串行通信的解決方案。MSP430與數(shù)傳模塊之間的通信原理圖如圖 2所示。

圖 2 通信原理圖

(2)MSP430串行通信波特率的產(chǎn)生。

MSP430F147的串行通信模塊主要包括:波特率的產(chǎn)生部分,數(shù)據(jù)的接收和發(fā)送部分,硬件接口部分等。MSP430的波特率發(fā)生器與其他標(biāo)準(zhǔn)的串行通信接口適配器實現(xiàn)的方法不同。MSP430的波特率發(fā)生器是由一個時鐘源預(yù)分頻器和一個調(diào)整器組成。分頻器實現(xiàn)分頻因子的整數(shù)部分,調(diào)整器使得小數(shù)部分盡量準(zhǔn)確。波特率發(fā)生器的結(jié)構(gòu)示意圖如圖3所示。

圖 3 波特率發(fā)生器的結(jié)構(gòu)示意圖

(3)MSP430串行通信的方式。

MSP430系列的串行通信模塊有兩種通信協(xié)議:UART異步通信協(xié)議和 SPI同步通信協(xié)議。異步通信模式下接收器自身實現(xiàn)禎的同步,因此通信雙方必須使用相同的波特率。異步禎的格式由 1位起始位,7位或 8位數(shù)據(jù)位,校驗位,1位地址位和 1位或 2位的停止位組成,接收操作以收到有效起始位,如圖 4所示:

圖4 異步幀格式

在異步模式下支持兩種多機(jī)模式:線路空閑多機(jī)模式和地址位多機(jī)模式,實現(xiàn)了在多處理機(jī)通信系統(tǒng)間的有效數(shù)據(jù)傳輸,通過選擇控制寄存器中的MM位(多機(jī)模式選擇位)來選擇采用何種模式。線路空閑模式下數(shù)據(jù)塊被一段空閑的時間分隔,地址位模式下字符包含一個附加的位作為地址標(biāo)志,兩種模式都可以用查詢方法或者中斷方法來實現(xiàn)。

同步通信模式下允許 7位或 8位數(shù)據(jù)流以內(nèi)部或外部確定的速率進(jìn)行串行通信。在同步模式下接收和發(fā)送有各自的寄存器,且接收和發(fā)送為雙緩沖,字符的長度為 7位或者 8位。

在串行通信的過程中,將采集到的 6個模擬量和 8個開關(guān)量的數(shù)字信號作為一個數(shù)據(jù)包進(jìn)行整體發(fā)送的。為了保證數(shù)據(jù)傳輸?shù)目煽啃?在一組數(shù)據(jù)包傳輸?shù)拈_始加上一個校驗碼 0x55做為接收模塊檢驗數(shù)據(jù)開始發(fā)送的標(biāo)志信號,在數(shù)據(jù)包的結(jié)尾加上一個校驗碼 0xaa作為接收模塊檢驗數(shù)據(jù)發(fā)送結(jié)束的標(biāo)志信號。如果接收模塊接收到 0s55說明數(shù)據(jù)開始發(fā)送,接收模塊可以進(jìn)行數(shù)據(jù)接收,直到接收到信號 0xaa,方可認(rèn)為一個數(shù)據(jù)包傳送的結(jié)束。如果接收模塊開始接收到的信號不是 0x55,則,接收模塊就要進(jìn)入等待直到接收到 0x55。

數(shù)據(jù)包的傳送和接收主要是一個移位寄存器在起作用。在接收時,當(dāng)移位寄存器將接收來的數(shù)據(jù)位組合夠一個字節(jié)就保存到接收緩存URXBUF;在發(fā)送時,將發(fā)送緩存UTXBUF內(nèi)的數(shù)據(jù)一位一位地送到發(fā)送端口。發(fā)送和接收兩個移位寄存器的移位時鐘都是波特率發(fā)生器的時鐘信號 B ITCLK。串行通信時,要發(fā)送的數(shù)據(jù)保存在發(fā)送數(shù)據(jù)緩沖器中,只有發(fā)送數(shù)據(jù)緩沖器為空時,寫入數(shù)據(jù)才會有效,發(fā)送才會開始。接收機(jī)通過讀取接收數(shù)據(jù)緩存器中的內(nèi)容來獲得發(fā)送的數(shù)據(jù)。通過判斷接收緩沖器中是否有數(shù)據(jù)來作為能否接收數(shù)據(jù)的一個依據(jù)。

由于串行通信是8位傳送方式,MSP430單片機(jī)的A/D轉(zhuǎn)換模塊是 12位的,因此,將單片機(jī)的A/D轉(zhuǎn)換結(jié)果進(jìn)行發(fā)送和接收時需要對數(shù)據(jù)進(jìn)行移位操作。發(fā)送時,將 A/D轉(zhuǎn)換結(jié)果左移 4位,高 4位為0。因為我們要傳送 6個模擬量和 8個開關(guān)量,轉(zhuǎn)換后就變?yōu)橐粋€數(shù)據(jù)包要傳送 15個字節(jié)。MSP430的發(fā)送框圖如圖 5所示。

圖 5 MSP430的發(fā)送框圖

6 結(jié)論

多功能噴射混凝土機(jī)器人已產(chǎn)業(yè)化,并在東營油田某項目和珠海高欄島 CNG地下儲氣項目得到應(yīng)用。實踐表明,該機(jī)器人可以通過多種組合適應(yīng)不同的工況要求,完成規(guī)定的作業(yè)任務(wù),其控制系統(tǒng)運行可靠,能滿足噴射混凝土工藝要求。

REFERENCES

[1] 毛文清.錨噴技術(shù)在橋梁加固工程施工中的運用[J].銅業(yè)工程,2008,(3):73-74.

[2] 李云江,榮學(xué)文,樊炳輝,等.PRJ-Z型噴漿機(jī)器人的研制與開發(fā)[J].中國機(jī)械工程,2003,14(20):1711-1713.

[3] 王靖,李斌,馬書根.模塊化可變形機(jī)器人控制系統(tǒng)設(shè)計與變形方法研究[J].機(jī)器人,2006,(5):457-462.

[4] 王傳江.PJR-X小型噴漿機(jī)器人滑模變結(jié)構(gòu)控制系統(tǒng)[J].煤炭學(xué)報,2007,(5):548-551.

[5] 皮揚,王興松,徐豐羽.基于 C8051F單片機(jī)的纜索檢測機(jī)器人控制系統(tǒng)設(shè)計[J].機(jī)械工程師,2008,(12):55-57.

Study on the Control System ofM ultifunctional Shotcrete Robot

L I Yun-jiang1,DOU Mei-ning2,ZHANG Hui1,GUO Xiang-qian1
(1.School ofMechanical and Electronic Engineering,Shandong Jianzhu University,Ji’nan,Shandong,China 250101; 2.Depart ment ofNumerical Control Technology,Yantai Engineer and Technology College,Yantai,Shandong,China 264006)

〗To counter the main shortcomings of spray concrete,the products ofmechanical structure,control systems and other parts of the modular function are re-plotted and restructured.The robot’smultiple function features is basically achieved.This paper introduces the design and implementation of the wireless remote control system,including input signal acquisition board,the wireless trans mission module,wireless receivermodules and output control circuit board.

Shotcrete;Robot;Control system

book=66,ebook=71

TD403

A

1009-3842(2010)02-0066-04

2010-04-01

山東省科技廳科技發(fā)展計劃項目(021050103)

李云江(1966-),男,山東萊陽人,碩士,教授,主要從事特種機(jī)器人技術(shù)的教學(xué)與研究。E-mail:liyunjiang38@126.com