79 lines
1.9 KiB
C++
79 lines
1.9 KiB
C++
/*
|
|
* digital_input_exti.cpp
|
|
*
|
|
* Created on: Dec 18, 2018
|
|
* @author Andrey Belomutskiy, (c) 2012-2020
|
|
*/
|
|
|
|
#include "global.h"
|
|
|
|
#if HAL_USE_PAL && EFI_PROD_CODE
|
|
#include "digital_input_exti.h"
|
|
#include "efi_gpio.h"
|
|
#include "error_handling.h"
|
|
|
|
/**
|
|
* EXTI is a funny thing: you can only use same pin on one port. For example, you can use
|
|
* PA0 PB5 PE2 PD7
|
|
* but you cannot use
|
|
* PA0 PB0 PE2 PD7
|
|
* because pin '0' would be used on two different ports
|
|
*/
|
|
|
|
static ioportmask_t ext_used = 0;
|
|
|
|
// EXT is not able to give you the front direction but you could read the pin in the callback.
|
|
void efiExtiEnablePin(const char *msg, brain_pin_e brainPin, uint32_t mode, palcallback_t cb, void *cb_data) {
|
|
|
|
/* paranoid check, in case of GPIO_UNASSIGNED getHwPort will return NULL
|
|
* and we will fail on next check */
|
|
if (brainPin == GPIO_UNASSIGNED)
|
|
return;
|
|
|
|
ioportid_t port = getHwPort(msg, brainPin);
|
|
if (port == NULL)
|
|
return;
|
|
|
|
int index = getHwPin(msg, brainPin);
|
|
|
|
/* is this index already used? */
|
|
if (ext_used & PAL_PORT_BIT(index)) {
|
|
firmwareError(CUSTOM_ERR_PIN_ALREADY_USED_2, "%s: pin %d: exti index already used", msg, brainPin);
|
|
return;
|
|
}
|
|
|
|
ioline_t line = PAL_LINE(port, index);
|
|
palEnableLineEvent(line, mode);
|
|
palSetLineCallback(line, cb, cb_data);
|
|
|
|
/* mark used */
|
|
ext_used |= PAL_PORT_BIT(index);
|
|
}
|
|
|
|
void efiExtiDisablePin(brain_pin_e brainPin)
|
|
{
|
|
/* paranoid check, in case of GPIO_UNASSIGNED getHwPort will return NULL
|
|
* and we will fail on next check */
|
|
if (brainPin == GPIO_UNASSIGNED)
|
|
return;
|
|
|
|
ioportid_t port = getHwPort("exti", brainPin);
|
|
if (port == NULL)
|
|
return;
|
|
|
|
int index = getHwPin("exti", brainPin);
|
|
|
|
/* is this index was used? */
|
|
if (!(ext_used & PAL_PORT_BIT(index))) {
|
|
return;
|
|
}
|
|
|
|
ioline_t line = PAL_LINE(port, index);
|
|
palDisableLineEvent(line);
|
|
|
|
/* mark unused */
|
|
ext_used &= ~PAL_PORT_BIT(index);
|
|
}
|
|
|
|
#endif /* HAL_USE_PAL && EFI_PROD_CODE */
|