Fix interrupts bug.

This commit is contained in:
Bigbits
2019-04-13 17:54:13 +08:00
parent fd93da2c00
commit 6116e6b348
2 changed files with 15 additions and 4 deletions

View File

@@ -3,11 +3,13 @@
#include "wiring_constants.h"
#include "plic.h"
void attachInterrupt(uint8_t intnum, voidFuncPtr callback, uint8_t mode)
void attachInterrupt(uint8_t intnum, voidFuncPtr user_callback, uint8_t mode)
{
plic_irq_callback_t _callback = (plic_irq_callback_t)callback;
int gpionum = getGpio(intnum);
if(gpionum >= 0){
fpioa_function_t function = FUNC_GPIOHS0 + gpionum;
fpioa_set_function(intnum, function);
gpiohs_set_drive_mode(gpionum, GPIO_DM_INPUT_PULL_UP);
switch(mode){
case LOW :
gpiohs_set_pin_edge((uint8_t)gpionum, GPIO_PE_LOW);
@@ -25,7 +27,7 @@ void attachInterrupt(uint8_t intnum, voidFuncPtr callback, uint8_t mode)
gpiohs_set_pin_edge((uint8_t)gpionum, GPIO_PE_RISING);
break;
}
gpiohs_irq_register((uint8_t)gpionum, 10, _callback, NULL);
gpiohs_irq_register((uint8_t)gpionum, 10, gpiohs_callback, user_callback);
sysctl_enable_irq();
}
}
@@ -37,3 +39,10 @@ void detachInterrupt(uint8_t intnum)
gpiohs_irq_unregister((uint8_t)gpionum);
}
}
int gpiohs_callback(void *ctx)
{
voidFuncPtr user_callback = ctx;
user_callback();
return 0;
}

View File

@@ -35,7 +35,7 @@ extern "C"{
#define DEFAULT 1
#define EXTERNAL 0
#define digitalPinToInterrupt(Pin) Pin;
#define digitalPinToInterrupt(Pin) Pin
typedef void (*voidFuncPtr)(void);
/*
* \brief Specifies a named Interrupt Service Routine (ISR) to call when an interrupt occurs. Use digitalPinToInterrupt(pin) to get the correct intnum.
@@ -49,6 +49,8 @@ void attachInterrupt(uint8_t intnum, voidFuncPtr callback, uint8_t mode);
*/
void detachInterrupt(uint8_t intnum);
int gpiohs_callback(void *ctx);
#ifdef __cplusplus
} // extern "C"
#endif // __cplusplus