基于DSP／QEP電路的電機(jī)位置檢測(cè)和轉(zhuǎn)速測(cè)量研究

1、    基于DSPQEP電路的電機(jī)位置檢測(cè)和轉(zhuǎn)速測(cè)量研究摘要：在現(xiàn)代伺服系統(tǒng)中，位置檢測(cè)和轉(zhuǎn)速測(cè)量技術(shù)是提高控制系統(tǒng)精度的關(guān)鍵技術(shù)。本文詳細(xì)的介紹了使用光電編碼器和DSPQEP電路來進(jìn)行電機(jī)位置檢測(cè)和轉(zhuǎn)速測(cè)量的原理。實(shí)踐表明，該方法具有檢測(cè)精度高、易于編程實(shí)現(xiàn)的特點(diǎn)。關(guān)鍵詞：DSPOEP電路；光電編碼器；MT法測(cè)速0引言在電機(jī)的閉環(huán)控制系統(tǒng)中，由于需要實(shí)時(shí)獲得電機(jī)的位置和轉(zhuǎn)速信息，高速、高精度的傳感器以及相應(yīng)的處理電路是必不可少的。光電編碼器輸出數(shù)字信號(hào)，容易摘要：在現(xiàn)代伺服系統(tǒng)中，位置檢測(cè)和轉(zhuǎn)速測(cè)量技術(shù)是提高控制系統(tǒng)精度的關(guān)鍵技術(shù)。本文詳細(xì)的介紹了使用

2、光電編碼器和DSPQEP電路來進(jìn)行電機(jī)位置檢測(cè)和轉(zhuǎn)速測(cè)量的原理。實(shí)踐表明，該方法具有檢測(cè)精度高、易于編程實(shí)現(xiàn)的特點(diǎn)。關(guān)鍵詞：DSPOEP電路；光電編碼器；MT法測(cè)速0 引言    在電機(jī)的閉環(huán)控制系統(tǒng)中，由于需要實(shí)時(shí)獲得電機(jī)的位置和轉(zhuǎn)速信息，高速、高精度的傳感器以及相應(yīng)的處理電路是必不可少的。光電編碼器輸出數(shù)字信號(hào)，容易實(shí)現(xiàn)高分辨率、高精度的檢測(cè)，在現(xiàn)代電機(jī)檢測(cè)技術(shù)中得到了廣泛的應(yīng)用。TI公司2000系列的DSP是目前控制領(lǐng)域最先進(jìn)的處理器之一，其最新產(chǎn)品的工作頻率高達(dá)150MHz，大大提高了控制系統(tǒng)的控制精度和實(shí)時(shí)處理信息的能力，其特有的QEP電路和光電編碼器的

3、配合使用為電機(jī)位置和轉(zhuǎn)速測(cè)量提供了完美的解決方案。1DSPQEP電路簡(jiǎn)介    以TI公司控制領(lǐng)域最新產(chǎn)品TMS320F2812為例，它的正交編碼脈沖(QEP)電路和捕獲單元共用輸入引腳，分別為CAPlQEPl、CAP2QEP2、CAP3QEPIl(對(duì)于EVA)，CAP4QEP4、CAP5QEP5、CAP6QEPI2(對(duì)于EVB)，可以通過設(shè)置相應(yīng)的捕獲單元控制寄存器使能QEP電路而禁止其捕獲功能。QEP電路可以對(duì)固定在電機(jī)軸上的光電編碼器產(chǎn)生的正交編碼脈沖A、B路信號(hào)進(jìn)行解碼和計(jì)數(shù)，從而獲得電機(jī)的位置和速率等信息。    光電編碼器

4、的正交編碼脈沖輸入到DSP的CAPlQEPl、CAP2QEP2腳，通常選擇通用定時(shí)器T2(EVA)對(duì)輸入的正交脈沖進(jìn)行解碼和計(jì)數(shù)。要使QEP電路正常工作，必須使T2工作在定向增減模式，在此模式下，QEP電路不僅為定時(shí)器T2提供計(jì)數(shù)脈沖，而且還決定了它的計(jì)數(shù)方向。QEP電路對(duì)輸入的正交編碼脈沖的上升沿和下降沿都進(jìn)行計(jì)數(shù)，因此對(duì)輸入的正交編碼脈沖進(jìn)行4倍頻后作為T2的計(jì)數(shù)脈沖，并通過QEP電路的方向檢測(cè)邏輯確定哪個(gè)脈沖序列相位超前，然后產(chǎn)生一個(gè)方向信號(hào)作為T2的方向輸入，當(dāng)電機(jī)正轉(zhuǎn)時(shí)，T2增計(jì)數(shù)，當(dāng)電機(jī)反轉(zhuǎn)時(shí)，T2減計(jì)數(shù)。正交編碼脈沖、定時(shí)器計(jì)數(shù)脈沖及計(jì)數(shù)方向時(shí)序邏輯如圖1所示。 

5、60;  在QEP模式下，T2CNT計(jì)數(shù)到邊沿時(shí)將自動(dòng)翻轉(zhuǎn)，當(dāng)增計(jì)數(shù)到ffffh時(shí)將返回0重新開始增計(jì)數(shù)，當(dāng)減到O時(shí)，翻轉(zhuǎn)到ffffh重新開始減計(jì)數(shù)，由于在采樣時(shí)間內(nèi)計(jì)數(shù)脈沖的數(shù)目遠(yuǎn)小于T2CNT的周期數(shù)ffffh，所以在增減計(jì)數(shù)過程中至多有一次翻轉(zhuǎn)，圖2和圖3分別描述了電機(jī)正轉(zhuǎn)和反轉(zhuǎn)時(shí)T2CNT的計(jì)數(shù)情況。2光電編碼器和DSP的接口電路    光電編碼器可以輸出3路信號(hào)，其中A路和B路信號(hào)相位相差90°，光電編碼器的輸出的脈沖信號(hào)經(jīng)過光電隔離、濾波整形后直接送到DSP的相應(yīng)引腳，其接口電路如圖4所示。其中6N137是高速光耦，實(shí)現(xiàn)模擬信號(hào)和數(shù)

6、字信號(hào)的隔離，74Hel4是CMOS反相器，實(shí)現(xiàn)對(duì)信號(hào)的整形。3電機(jī)位置測(cè)量    DSPQEP電路將編碼器送過來的脈沖數(shù)轉(zhuǎn)換為絕對(duì)的轉(zhuǎn)子軸機(jī)械位置，絕對(duì)的轉(zhuǎn)子軸機(jī)械位置將存放在變量m中。通過每一次采樣周期t內(nèi)T2的計(jì)數(shù)脈沖的改變量，可以得到相應(yīng)的位置增量m。如上圖所示：f(t)和f(t+t)分別表示兩次相鄰采樣時(shí)刻的值，那么在t時(shí)間內(nèi)電機(jī)轉(zhuǎn)子旋轉(zhuǎn)的機(jī)械角度為：       其中：P為電機(jī)旋轉(zhuǎn)一尉T2CNT的脈沖計(jì)數(shù)值    如圖2所示：當(dāng)T2增計(jì)數(shù)無翻轉(zhuǎn)時(shí)，=f(t+t)一

7、f(t)當(dāng)T2增計(jì)數(shù)有翻轉(zhuǎn)時(shí)，=f(t+t)-f(t)65536，此時(shí)m=m+m    如圖3所示：當(dāng)T2減計(jì)數(shù)無翻轉(zhuǎn)時(shí)，=-f(t+t)一f(t,)當(dāng)T2減計(jì)數(shù)有翻轉(zhuǎn)時(shí)，=-f(t)一f(t+t)+65536，此時(shí)m=m-m4電機(jī)轉(zhuǎn)速測(cè)量    常見的電機(jī)測(cè)速方法主要有三種：M法、T法、和MT法，由于M法比較適合高速的場(chǎng)合，而T法適合低速的場(chǎng)合，為了在整個(gè)調(diào)速范圍內(nèi)都得到較好的準(zhǔn)確性，在這里我們選擇MT法，其原理如圖5所示。   M1為測(cè)速脈沖計(jì)數(shù)值(對(duì)應(yīng)前面的)，M2為高頻時(shí)鐘脈沖計(jì)數(shù)值，t為采樣周期，雖然在M1個(gè)計(jì)數(shù)脈沖內(nèi)，M2存在多一個(gè)少一個(gè)的誤差，但由于時(shí)鐘脈沖的頻率遠(yuǎn)高于計(jì)數(shù)脈沖頻率，引起的誤差可以忽略，所以轉(zhuǎn)速的計(jì)算公式為：       其中F為時(shí)鐘脈沖的頻率5 結(jié)束語