rotaryEncoder.cpp

#include "pxt.h"
#include "mbed.h"
using namespace pxt;

enum class YFPins{
    P0=  3,
    P1=  2,
    P2=  1,
    P3=  4,
    P4=  5,
    P5=  17,
    P6=  12,
    P7=  11,
    P8=  18,
    P9=  10,
    P10= 6,
    P11= 26,
    P12= 20,
    P13= 23,
    P14= 22,
    P15= 21,
    P16= 16,
    P19= 0,
    P20= 30
};

enum class YFRotationDirection{
    Left = 0,
    Right = 1
};

namespace YFRotaryEncoder {
    uint32_t lri = 0, lbi=0;
    InterruptIn *ri; 
    DigitalIn *dv, *dsw; 
    Timer tsb; 
    Action leftRotate, rightRotate, pressRotate;
    
    //%
    void onRotateEvent(YFRotationDirection dir, Action body) {
        //if(dir == YFRotationDirection::Left) leftRotate.push_back(body);
        //else rightRotate.push_back(body);
        if(dir == YFRotationDirection::Left) leftRotate = body;
        else rightRotate = body;
    }
  
    //%
    void onPressEvent(Action body){
        //pressRotate.push_back(body);
        pressRotate = body;
    }
    
    //void cA(vA runner){for(int i=0;i<runner.size();i++){runAction0(runner[i]);} }
    void onLR(){runAction0(leftRotate);}
    void onRR(){runAction0(rightRotate);}

    void onPress(){
        runAction0(pressRotate);
    }

    class RotateHandler {
        public:
        void onRotated(){
            uint32_t now = tsb.read_ms();
            if(now - lri < 50) return;
            lri = now;
            if(dv->read()) create_fiber(onLR);//fire right rotate
            else create_fiber(onRR); //fire left rotate
        }
    };
    
    RotateHandler rh;

    void monitorPress(){
        //printf("entering fiber\r\n");
        while(1){
            uBit.sleep(50);
            if(dsw->read()) continue;
            uint32_t now = tsb.read_ms();
            if(now - lbi < 50) continue;
            lbi = now;
            onPress();
        }
    }
    
    //%
    // void init(YFPins clk, YFPins dt, YFPins sw){
    void init(YFPins clk, YFPins dt){
        ri = new InterruptIn((PinName)clk);
        dv = new DigitalIn((PinName)dt);
        // dsw = new DigitalIn((PinName)sw);
        create_fiber(monitorPress);
        tsb.start(); //interrupt timer for debounce
        ri->fall(&rh, &RotateHandler::onRotated);
    }
}