collab/pb-hal

git clone https://git.julia.blue/collab/pb-hal

Joseph RyanClean up old code and add python wrappere2c64f5

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