QEP位置與速度的計算

1、設定unit time 為20khz,eqep1regs.quprd = 2999;/20khz設定unit position為1；eqep1regs.qcapctl.all = qcapctl_init_state;qep1.qepperiod = eqep1regs.qcprdlat;/單個qep脈沖的周期speed1.qepperiod = qep1.qepperiod;m法測速：通過一個測速周期內(nèi)的脈沖個數(shù)來計算速度1） 設定一個測速周期內(nèi)，脈沖個數(shù)為n，測試周期為t;2） 每秒鐘的脈沖個數(shù)為;3） 那么，60s內(nèi)的脈沖個數(shù)為;4） 那么，60s,即1min內(nèi)圈數(shù)為脈沖個數(shù)與速度標幺值

2、的轉(zhuǎn)換系數(shù)為speed1.k1=_iq(60 / (base_freq_rpm * t * qep1.lineencoder * 4);t法測速：根據(jù)固定脈沖個數(shù)所耗費的時間來計算速度在計數(shù)脈沖個數(shù)為1,系統(tǒng)時鐘為60mhz,脈沖計數(shù)時鐘為64分頻系統(tǒng)時鐘，的情況下：1） 設定一個脈沖寬度內(nèi)所用的時間為n個脈沖計數(shù)時鐘 n對應qep1.qepperiod = eqep1regs.qcprdlat;2） 那么，1440個脈沖，即電機轉(zhuǎn)動一圈所需的時間為3） 那么，60s電機所轉(zhuǎn)圈數(shù)為t法測速系數(shù)k4：1、t法使用的時鐘為cpu時鐘的64分頻，即60/64mhz=937500hz。2、k4定標q2

3、4，qepperiod定標q0，速度變量tmp_fr定標q0。原算法中，為保證數(shù)據(jù)不溢出，需轉(zhuǎn)換iq值。qepperiod左移15位變?yōu)閝15的中間變量qepperiod3，k4也轉(zhuǎn)為q15（乘以q24最大值128，再除以q15最大值65535）。k4和qepperiod3做同位除法得到q0的速度標幺值。3、計算公式： f2 * 60s/min q24maxspeed* = * （lineencoder*4） * speedbaseq15max其中：f2為cpu時鐘的64分頻頻率，單位hz；lineencoder*4為一個物理周期編碼器所走脈沖，通用為10000，工縫為1440等；speedb

4、ase為速度標幺基值；q24max和q15max為q24和q15表示數(shù)據(jù)的最大值，分別為128和65536。第一項為系數(shù)，第二項為iq位轉(zhuǎn)換。新算法中第二項省略。speed1.k4 = _iq(937500.0*60*128/65536/(qep1.lineencoder * 4)/base_freq_rpm);/iq15/speed1.k4 = _iq(937500.0 * 60 / (qep1.lineencoder * 4) / base_freq_rpm);mt法測速：1、m法測速是指在測速頻率（f1=20khz）下，計數(shù)每個周期內(nèi)有多少個脈沖；t法測速是指計數(shù)一個脈沖寬度內(nèi)有多少個分頻時鐘周期（f2）。m、t法分別適用于高速、低速測量。其中介頻率f=sqrt（f1*f2）。2、t法設定有最低速度（通用0.1rpm，工縫1rpm），最低速度以下認為速度為0，轉(zhuǎn)為m法，防止t法0速時引起震蕩。3、速度提高時，測速周期內(nèi)脈沖數(shù)增加，而單個脈沖寬度內(nèi)的時鐘周期減小。當前后二者計數(shù)值恰好相等時，轉(zhuǎn)速頻率等于中介頻率。故以此為判斷依據(jù)選擇m、t法。4、m法中，k1為脈沖數(shù)到標幺速度的定標值。電機轉(zhuǎn)速基值通用為1000rpm，工縫為5000rpm。通用編碼器線數(shù)2500，物理