介紹一種高精度位置環(huán)系統(tǒng)
摘要:本文簡(jiǎn)要敘述了高精度位置環(huán)系統(tǒng)的組成方法,詳細(xì)闡述了光電編碼器在位置環(huán)中的應(yīng)用原理和速度修正方法。概述了單片機(jī)及串行D/A的應(yīng)用。
關(guān)鍵詞:光電編碼器,位置控制,測(cè)速發(fā)電機(jī),恒速控制。
0 引言:
我們?cè)跒槟硢挝婚_(kāi)發(fā)一種高精度恒速泵產(chǎn)品時(shí),需要一種速度調(diào)節(jié)范圍達(dá)1:100000以上﹑穩(wěn)定精度≤0.3%調(diào)速系統(tǒng)。我們查閱了國(guó)內(nèi)有關(guān)生產(chǎn)伺服控制系統(tǒng)廠家的產(chǎn)品,幾乎沒(méi)有一家能滿足要求。為了研制該產(chǎn)品,我們經(jīng)過(guò)認(rèn)真分析,仔細(xì)論證后,決定采用光電編碼器作反饋元件,用單片機(jī)測(cè)出光電編碼器每分鐘脈沖輸出個(gè)數(shù),與給定的速度量進(jìn)行比較然后改變D/A輸出電壓幅度,送給伺服系統(tǒng)調(diào)整電機(jī)轉(zhuǎn)速,最終將電機(jī)速度控制在±0.3%以內(nèi)。試驗(yàn)證明該方案是可行的。
現(xiàn)將該系統(tǒng)的組成原理及實(shí)現(xiàn)方法作一個(gè)簡(jiǎn)單的介紹。
1 實(shí)現(xiàn)原理:
圖1中的系統(tǒng)是傳統(tǒng)的帶PID調(diào)節(jié)的直流伺服速度控制系統(tǒng)。對(duì)于控制精度較低的產(chǎn)品雖能滿足要求。但對(duì)于精度要求高的場(chǎng)合就不能適應(yīng)了。這是因?yàn)椋寒?dāng)電機(jī)運(yùn)轉(zhuǎn)一段時(shí)間后,電機(jī)溫度隨著工作時(shí)間加長(zhǎng)而不斷上升,而反饋元件(測(cè)速發(fā)電機(jī))與伺服電機(jī)同軸連接,故測(cè)速發(fā)電機(jī)的溫度也隨之升高。因?yàn)闇y(cè)速發(fā)電機(jī)是用永磁磁缸制成,其轉(zhuǎn)子線圈切割磁力線而產(chǎn)生電勢(shì),其值為:
Ea=εa ∝ N
式中 Ea為測(cè)速機(jī)輸出電勢(shì)
εa為測(cè)速機(jī)電勢(shì)常數(shù)
N為電機(jī)轉(zhuǎn)速
一般情況下,εa是個(gè)常數(shù),測(cè)速發(fā)電機(jī)產(chǎn)生的電勢(shì)Ea正比于轉(zhuǎn)速N。而實(shí)際上電機(jī)溫度上升后εa已經(jīng)發(fā)生了變化,通常情況下是下降的,εa變小,故Ea也變小。而此時(shí)電機(jī)轉(zhuǎn)速并未下降,反饋到速度環(huán)的電壓Δu隨之上升,促使電機(jī)轉(zhuǎn)速上升,迫使Ea上升,從而達(dá)到Δu維持不變。這樣,隨著電機(jī)溫度上升,電機(jī)的速度也慢慢上升,而給定值并未改變,這就引起電機(jī)轉(zhuǎn)速的誤差增大。根據(jù)實(shí)際測(cè)量一般電機(jī)溫度每上升100℃,電機(jī)轉(zhuǎn)速的誤差會(huì)增大1-3%左右。電機(jī)轉(zhuǎn)速越低,相對(duì)誤差越大。
為了糾正電機(jī)轉(zhuǎn)速的偏差,采用600線/轉(zhuǎn)的光電編碼器作反饋元件,與電機(jī)同軸安裝,就可以準(zhǔn)確測(cè)出電機(jī)的轉(zhuǎn)速。因?yàn)楣怆娋幋a器是由激光照射光珊發(fā)出脈沖的,而光珊安裝在光電編碼器的轉(zhuǎn)軸上,轉(zhuǎn)軸每轉(zhuǎn)一周(3600)編碼器就產(chǎn)生600個(gè)脈沖,該脈沖只與轉(zhuǎn)軸速度有關(guān),而與溫度無(wú)關(guān)。因此,只要準(zhǔn)確測(cè)出光電編碼器的脈沖個(gè)數(shù),就可確切知道電機(jī)的轉(zhuǎn)速。
例如,當(dāng)電機(jī)的轉(zhuǎn)速ND=1000轉(zhuǎn)/分,則每秒鐘光電編碼器的脈沖個(gè)數(shù)應(yīng)為
n光=1000*600/60
=10000(個(gè)脈沖)
若
ND=1轉(zhuǎn)/分
n光=1*600/60 =10(個(gè))
如果實(shí)際測(cè)量值與上述理論計(jì)算值有偏差,則可以通過(guò)調(diào)節(jié)D/A輸出電壓調(diào)整電機(jī)的轉(zhuǎn)速,最終使
Δn=ND測(cè)-ND理
這樣就可以將電機(jī)的轉(zhuǎn)速控制在我們所希望的誤差范圍內(nèi)。
2 元器件的選擇;
2.1伺服系統(tǒng)(速度環(huán))選用SC5HC60型直流脈寬伺服系統(tǒng),調(diào)速范圍可達(dá)1:10000以上,速度精度為0.5%FS。
2.2電機(jī)選用稀土直流寬調(diào)速伺服測(cè)速機(jī)組,與伺服系統(tǒng)構(gòu)成速度閉環(huán)系統(tǒng)。
2.3 D/A器件選用分辨率為16位串行D/A??刂凭€為三線串行方式,即:一根時(shí)鐘線,一根數(shù)據(jù)線,一根選通線。
2.4 光電編碼器每轉(zhuǎn)輸出600個(gè)脈沖,五線制。其中兩根為電源線,三根為脈沖線(A、B、Z)。電源的工作電壓為 +5~+24V直流電源。
工作原理:當(dāng)光電編碼器的軸轉(zhuǎn)動(dòng)時(shí)A、B兩根線都產(chǎn)生脈沖輸出,A、B兩相脈沖相差90 0相位角,由此可測(cè)出光電編碼器轉(zhuǎn)動(dòng)方向與電機(jī)轉(zhuǎn)速。如果A相脈沖比B相脈沖超前則光電編碼器為正轉(zhuǎn),否則為反轉(zhuǎn).Z線為零脈沖線,光電編碼器每轉(zhuǎn)一圈產(chǎn)生一個(gè)脈沖.主要用作計(jì)數(shù)。A線用來(lái)測(cè)量脈沖個(gè)數(shù),B線與A線配合可測(cè)量出轉(zhuǎn)動(dòng)方向.
2.5單片機(jī)選用89C51-24PC單片機(jī),晶振頻率為24MHz,用一個(gè)定時(shí)器作計(jì)數(shù)器來(lái)測(cè)量光電編碼器的脈沖個(gè)數(shù),另一個(gè)定時(shí)器精確定時(shí),這樣可準(zhǔn)確測(cè)出電機(jī)每秒鐘轉(zhuǎn)動(dòng)的距離,同時(shí)根據(jù)設(shè)定值計(jì)算出電機(jī)每秒鐘應(yīng)轉(zhuǎn)動(dòng)的理論值并與測(cè)量值進(jìn)行比較,將誤差值轉(zhuǎn)換成數(shù)字量輸出到D/A芯片的輸入端,從而改變其電壓輸出,送給伺服系統(tǒng)控制電機(jī)的轉(zhuǎn)速,從而達(dá)到恒速的目的。
例如:要將電機(jī)控制在500轉(zhuǎn)/分,根據(jù)伺服系統(tǒng)的指標(biāo),當(dāng)輸入為0~5V信號(hào)時(shí),電機(jī)轉(zhuǎn)速為1500轉(zhuǎn)/分,故可求得當(dāng)ND=500轉(zhuǎn)/分時(shí),光碼盤(pán)每秒鐘輸出的脈沖數(shù)為:
PD=500×600/60=5000個(gè)脈沖
對(duì)應(yīng)該轉(zhuǎn)速伺服系統(tǒng)的輸入電壓應(yīng)為:
VD=5.000×500/1500=1.6666V
當(dāng)測(cè)出的脈沖個(gè)數(shù)與計(jì)算出的標(biāo)準(zhǔn)值有偏差時(shí),可根據(jù)電壓與脈沖個(gè)數(shù)的對(duì)應(yīng)關(guān)系計(jì)算出輸出給伺服系統(tǒng)的增量電壓△U:
△U=△P×5.000/(1500×600/60)= △P/3000(V)
而輸出到D/A的數(shù)字量的增量應(yīng)為:
△D=△U×216/5.000
電機(jī)的整個(gè)工作調(diào)節(jié)過(guò)程如下:
工作前通過(guò)鍵盤(pán)設(shè)定控制轉(zhuǎn)速,計(jì)算出輸出電壓VD并將該電壓對(duì)應(yīng)的輸出到D/A的數(shù)字量V數(shù)=VD×216/5.000算出,直接送給D/A,電機(jī)開(kāi)始起動(dòng)運(yùn)轉(zhuǎn)。當(dāng)電機(jī)運(yùn)轉(zhuǎn)一段時(shí)間后電機(jī)轉(zhuǎn)速不斷上升從而導(dǎo)致測(cè)速機(jī)磁性下降,測(cè)速機(jī)輸出電勢(shì)下降,經(jīng)速度環(huán)調(diào)整后使電機(jī)轉(zhuǎn)速上升,運(yùn)行時(shí)間越長(zhǎng),電機(jī)轉(zhuǎn)速上升越多。這時(shí)系統(tǒng)起動(dòng)位置環(huán),通過(guò)不斷測(cè)量光電編碼器每秒鐘輸出的脈沖個(gè)數(shù),并與標(biāo)準(zhǔn)值PD進(jìn)行比較,計(jì)算出增量△P并將之轉(zhuǎn)換成對(duì)應(yīng)的D/A輸出數(shù)字量,在原來(lái)輸出電壓的基礎(chǔ)上減去增量,迫使電機(jī)轉(zhuǎn)速降下來(lái),當(dāng)測(cè)出的△P近似為零時(shí)停止調(diào)節(jié),這樣可將電機(jī)轉(zhuǎn)速始終控制在允許的范圍內(nèi)。
3 硬件電路的實(shí)現(xiàn)
實(shí)際工作中由于伺服系統(tǒng)工作電流較大,對(duì)于微機(jī)干擾較大,故在硬件電路設(shè)計(jì)時(shí)應(yīng)考慮到系統(tǒng)的隔離和干擾問(wèn)題。由于選用的是串行D/A。信號(hào)的傳輸只用三根線,故采取隔離措施相對(duì)容易些。而光電編碼器工作也容易受到干擾,因此除了正常的接地外,還要將光電編碼器輸出線中的地線可靠接地。光電編碼器的A線做脈沖檢測(cè)用,Z線作計(jì)數(shù)器用,速度輸入用鍵盤(pán)輸入數(shù)字,顯示用液晶顯示器。
4 軟件
根據(jù)電路的連接情況,采用匯編語(yǔ)言編寫(xiě)了整個(gè)程序。現(xiàn)將部分闡述如下:
4. 1初始化
初始化內(nèi)容包括定時(shí)器、中斷系統(tǒng)及個(gè)單元內(nèi)容的初始化
HSTART:MOV SP,#0E0H ;設(shè)置堆棧頂?shù)刂?BR> MOV IE,#90H ;開(kāi)中斷及串行口中斷允許
MOV IP,#5 ;將定時(shí)器1和串口中斷設(shè)置高優(yōu)先權(quán)
MOV TCON,#5 ;外中斷0和外中斷1全部為邊沿觸發(fā)方式
MOV TMOD,#21H ;定時(shí)器0為方式1定時(shí)器2為方式2
MOV PCON,#0 ;SMOD=0
MOV SCON,#0D8H ;串口設(shè)置成方式3,TB8=1,REN=1
MOV TH1,#0FDH ;設(shè)定定時(shí)器1重裝時(shí)間常數(shù)
MOV TL1,#0FDH
CLR ET1
SETB REN
SETB ES
MOV TH0,#2CH
MOV TL0,#0
SETB TR0
SETB TR1
……
4. 2定時(shí)器0中斷子程序
CLOCK0:CLR ET0 ;保護(hù)現(xiàn)場(chǎng)指令
MOV TH0,#2CH ;重置時(shí)間常數(shù)
MOV TL0,#0
INC QSE0
MOV A,#14H ;判別1秒鐘定時(shí)到否
CJNE A,QSE0,HCLZ
MOV QSE0,#0 ;計(jì)數(shù)器清零
MOV A,QSEC
ADD A,#1 ;秒單元加1
DA A
MOV QSEC,A
MOV A,#5
CJNE A,QSEC,HCLZ ;判5秒鐘到否
MOV QSEC,#0 ;秒單元清零
CLR EX0 ;關(guān)中斷0停止計(jì)數(shù)
HCLZ: 恢復(fù)現(xiàn)場(chǎng)指令
SETB ET0
RETI ;中斷返回
4.3中斷0計(jì)數(shù)程序
POST1:CLR EX0
保護(hù)現(xiàn)場(chǎng)指令
MOV A,QLLD ;計(jì)數(shù)器低位加1
ADD A,#1
MOV QLLD,A
MOV A,QLLD+1
ADDC A,#0
MOV QLLD+1,A
恢復(fù)現(xiàn)場(chǎng)指令
SETB EX0
RETI
4. 4處理程序
處理程序包括加減運(yùn)算程序、數(shù)字轉(zhuǎn)換程序、D/A輸出程序、實(shí)時(shí)報(bào)警程序、數(shù)據(jù)采集程序等。
本文相關(guān)信息
- [新聞資訊] 解析個(gè)人商鋪投資的十大注意要點(diǎn)
- [新聞資訊] 解析工程機(jī)械經(jīng)銷(xiāo)商如何在壓力中尋求突破
- [新聞資訊] 解析工業(yè)車(chē)輛的生存與發(fā)展
- [新聞資訊] 今后5年是中國(guó)工程機(jī)械開(kāi)拓印度市場(chǎng)的佳期
- [新聞資訊] 今明兩年機(jī)場(chǎng)建設(shè)需水泥5000萬(wàn)噸
- [新聞資訊] 解析焦化行業(yè)清潔生產(chǎn)政策指向
- [有關(guān)專(zhuān)業(yè)] 解析鋁及鋁合金鉻磷化的技術(shù)
- [新聞資訊] 解析麥包包如何靠電子商務(wù)建立品牌
- [新聞資訊] 解析中國(guó)工程機(jī)械出口產(chǎn)品的“專(zhuān)利門(mén)楹”
- [新聞資訊] 解析資金大小與投資方法