new rotary encoder implementation

src/rotary.cpp

@@ -44,9 +44,15 @@ void Rotary::task(void *pvParameters) {
   uint32_t ulNotificationValue;
   while(true) {
     ulNotificationValue = ulTaskNotifyTake( pdFALSE, portMAX_DELAY );
-    int newPos = encoderPos/2;
+    debouncePulses++;
-    if (lastPos != newPos)
+    if (debouncePulses > 3) {
-      if (callback) callback(newPos);
+    debouncePulses = 0;
+    if (encoderPos > encoderPosOld+1) value++;
+    else if (encoderPos < encoderPosOld-1) value--;
+    else continue;
+    encoderPosOld = encoderPos;
+    if (callback) callback(value);
+    }
   }
   vTaskDelete(NULL);
 }

src/rotary.h

@@ -20,9 +20,12 @@ class Rotary {
     static void IRAM_ATTR doEncoder(void);
     static Rotary* instance;
     volatile int encoderPos = 0;
-    int lastPos = 0;
+    int encoderPosOld = 0;
+    int value = 0;
     uint32_t debounceMillis;
     uint32_t debounceDelay = 1;
+    uint32_t debouncePulses = 0;
+    int countDirection = 0;
     TaskHandle_t xTaskToNotify;
   private:
     uint8_t pinA;