用DSP實(shí)現(xiàn)增量式光電編碼器的細(xì)分
3 軟件辨向本文引用地址:http://www.ex-cimer.com/article/151159.htm
要精確的控制電機(jī),就必須精確判斷當(dāng)電機(jī)轉(zhuǎn)動(dòng)出現(xiàn)來(lái)回?cái)[動(dòng)時(shí)的方向。對(duì)硬件辨向只能做到在整周期計(jì)數(shù)時(shí)知道電機(jī)的轉(zhuǎn)動(dòng)方向,當(dāng)在一個(gè)整周期內(nèi)方向改變時(shí),硬件辨向就不能及時(shí)的傳遞方向信息。我們根據(jù)判方向的規(guī)則,在軟件中完成辨向,在1,2,7,8卦限,x2小于等于2.5v時(shí)為順時(shí)針轉(zhuǎn)動(dòng),大于2.5v為逆時(shí)針轉(zhuǎn)動(dòng);在3,4,5,6卦限,x2大于2.5v時(shí)為順時(shí)針轉(zhuǎn)動(dòng), 小于等于2.5v為逆時(shí)針轉(zhuǎn)動(dòng);程序流程:
direction=1,表示順時(shí)針,為0是逆時(shí)針;
若做到1024細(xì)分, 分八個(gè)卦限,每個(gè)卦限有256個(gè)細(xì)分值。在DSP中只需要256×16個(gè)單元存儲(chǔ)細(xì)分值即可。
細(xì)分碼如下:
在DSP中有
細(xì)分碼 | 地址碼 | |
卦限地址 | A/D轉(zhuǎn)換得到的地址 | |
000,0000,0000 | 000 3 | 00,0000,0000~00,0000,0010 |
000,0000,0001 | 000 6 | 00,0000,0011~0000,0010~101 |
000,0000,0010 | 。 9 | 1001 |
000,0000,0011 | 。13 | 1101 |
000,0000,0100 | 。16 | 10000 |
000,0000,0101 | 19 | 1 |
000,0000,0110 | 22 |
|
000,0000,0111 | 25 |
|
000,0000,1001 | 28 |
|
000,0000,1010..... | 31 |
|
000,0000,1011 | 35 |
|
000,0000,1100 | 38 |
|
000,0000,1101 | 41 |
|
000,0000,1110 | 44 |
|
000,0000,1111 | 47 |
|
000,0001,0000 | 50 |
|
000,0001,0001 | 53 |
|
000,0001,0010 | 57 |
|
| 60 |
|
| 63 |
|
| 66 |
|
| 69 |
|
000,0110,1111 | 366 |
|
000,0111,0000 | 370 |
|
000,0111,0001 | 373 |
|
000,0111,0010 | 377 |
|
000,0111,0011 | 381 |
|
000,0111,0100 | 384 |
|
000,0111,0101 | 388 |
|
000,0111,0110 | 391 |
|
000,0111,0111 | 395 |
|
000,0111,1000 | 399 |
|
000,0111,1001 | 402 |
|
000,0111,1010 | 406 |
|
000,0111,1011 | 410 |
|
000,0111,1100 | 413 |
|
000,0111,1101 | 417 |
|
000,0111,1110 | 420 |
|
000,0111,1111 | 424 |
|
000,1000,0000 |
|
|
...... |
|
|
000,1111,1000(248) | 945 |
|
000,1111,1001 | 981 |
|
000,1111,1010 | 987 |
|
000,1111,1011 | 993 |
|
000,1111,1100 | 999 |
|
000,1111,1101 | 1005 |
|
000,1111,1110 | 1012 |
|
000,1111,1111 | 1018 | 00 |
001,0000,0000 | 1024 | 11,1111,1111~11,1111,1 |
接地電阻相關(guān)文章:接地電阻測(cè)試方法
評(píng)論