collab/pb-hal

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

Joseph RyanSeparate source and headers2a4b84b

control
1.0 KiB45 linesraw
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) {
6    Enc* enc = (Enc*)user;
7    if (gpio == enc->encA) {
8        enc->levA = level;
9    } else {
10        enc->levB = level;
11    }
12    if (gpio != enc->lastGpio) { // Debounce
13        enc->lastGpio = gpio;
14        if ((gpio == enc->encA) && (level == 1)) {
15            if (enc->levB) {
16                ++enc->pos;
17            }
18        } else if ((gpio == enc->encB) && (level == 1)) {
19            if (enc->levA) {
20                --enc->pos;
21            }
22        }
23    }
24}
25
26Enc::Enc(int apin, int bpin) {
27    encA = apin;
28    encB = bpin;
29    levA = 0;
30    levB = 0;
31    pos = 0;
32    lastGpio = -1;
33    gpioSetMode(apin, PI_INPUT);
34    gpioSetMode(bpin, PI_INPUT);
35    gpioSetPullUpDown(apin, PI_PUD_UP);
36    gpioSetPullUpDown(bpin, PI_PUD_UP);
37    gpioSetAlertFuncEx(apin, _cb, this);
38    gpioSetAlertFuncEx(bpin, _cb, this);
39}
40
41Enc::~Enc() {
42    gpioSetAlertFunc(encA, 0);
43    gpioSetAlertFunc(encB, 0);
44}
45