FunctionalInterrupt.cpp

/*
 * FunctionalInterrupt.cpp
 *
 * Created on: 8 jul. 2018
 * Author: Herman
*/

#include"FunctionalInterrupt.h"
#include"Arduino.h"

typedefvoid (*voidFuncPtr)(void);
typedefvoid (*voidFuncPtrArg)(void *);

extern"C" {
externvoid__attachInterruptFunctionalArg(uint8_t pin, voidFuncPtrArg userFunc, void *arg, int intr_type, bool functional);
}

void ARDUINO_ISR_ATTR interruptFunctional(void *arg) {
 InterruptArgStructure *localArg = (InterruptArgStructure *)arg;
if (localArg->interruptFunction) {
 localArg->interruptFunction();
 }
}

voidattachInterrupt(uint8_t pin, std::function<void(void)> intRoutine, int mode) {
// use the local interrupt routine which takes the ArgStructure as argument
__attachInterruptFunctionalArg(pin, (voidFuncPtrArg)interruptFunctional, new InterruptArgStructure{intRoutine}, mode, true);
}

extern"C" {
voidcleanupFunctional(void *arg) {
delete (InterruptArgStructure *)arg;
}
}