collab/pb-hal
git clone https://git.julia.blue/collab/pb-hal
e2c64f5
master
1#include <pigpio.h> 2#include "../inc/enc.h" 3 4void _cb (int gpio ,int level ,uint32_t tick ,void * user ) { 5Enc * enc = (Enc * )user ; 6if (gpio == enc -> encA ) { 7enc -> levA = level ; 8 }else { 9enc -> levB = level ; 10 } 11if (gpio != enc -> lastGpio ) {// Debounce 12enc -> lastGpio = gpio ; 13if ((gpio == enc -> encA )&& (level == 1 )) { 14if (enc -> levB ) { 15++ enc -> pos ; 16 } 17 }else if ((gpio == enc -> encB )&& (level == 1 )) { 18if (enc -> levA ) { 19-- enc -> pos ; 20 } 21 } 22 } 23} 24 25Enc ::Enc (int apin ,int bpin ) { 26encA = apin ; 27encB = bpin ; 28levA = 0 ; 29levB = 0 ; 30pos = 0 ; 31lastGpio = -1 ; 32gpioSetMode (apin ,PI_INPUT ); 33gpioSetMode (bpin ,PI_INPUT ); 34gpioSetPullUpDown (apin ,PI_PUD_UP ); 35gpioSetPullUpDown (bpin ,PI_PUD_UP ); 36gpioSetAlertFuncEx (apin ,_cb ,this ); 37gpioSetAlertFuncEx (bpin ,_cb ,this ); 38} 39 40Enc ::~Enc () { 41gpioSetAlertFunc (encA ,0 ); 42gpioSetAlertFunc (encB ,0 ); 43} 44