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