73 lines
1.8 KiB
C
73 lines
1.8 KiB
C
|
|
#include "common-hal/countio/Counter.h"
|
|
|
|
#include "py/runtime.h"
|
|
|
|
#include "nrfx_gpiote.h"
|
|
|
|
// obj array to map pin number -> self since nrfx hide the mapping
|
|
static countio_counter_obj_t *_countio_objs[NUMBER_OF_PINS];
|
|
|
|
static void _intr_handler(nrfx_gpiote_pin_t pin, nrf_gpiote_polarity_t action) {
|
|
countio_counter_obj_t *self = _countio_objs[pin];
|
|
if (!self) {
|
|
return;
|
|
}
|
|
self->count += 1;
|
|
}
|
|
|
|
void common_hal_countio_counter_construct(countio_counter_obj_t *self,
|
|
const mcu_pin_obj_t *pin_a) {
|
|
|
|
self->pin_a = pin_a->number;
|
|
_countio_objs[self->pin_a] = self;
|
|
|
|
self->count = 0;
|
|
|
|
nrfx_gpiote_in_config_t cfg = {
|
|
.sense = NRF_GPIOTE_POLARITY_HITOLO,
|
|
.pull = NRF_GPIO_PIN_PULLUP,
|
|
.is_watcher = false,
|
|
.hi_accuracy = true,
|
|
.skip_gpio_setup = false
|
|
};
|
|
|
|
|
|
nrfx_err_t err = nrfx_gpiote_in_init(self->pin_a, &cfg, _intr_handler);
|
|
if (err != NRFX_SUCCESS) {
|
|
mp_raise_RuntimeError(translate("All channels in use"));
|
|
}
|
|
nrfx_gpiote_in_event_enable(self->pin_a, true);
|
|
|
|
claim_pin(pin_a);
|
|
}
|
|
|
|
bool common_hal_countio_counter_deinited(countio_counter_obj_t *self) {
|
|
return self->pin_a == NO_PIN;
|
|
}
|
|
|
|
void common_hal_countio_counter_deinit(countio_counter_obj_t *self) {
|
|
if (common_hal_countio_counter_deinited(self)) {
|
|
return;
|
|
}
|
|
_countio_objs[self->pin_a] = NULL;
|
|
|
|
nrfx_gpiote_in_event_disable(self->pin_a);
|
|
nrfx_gpiote_in_uninit(self->pin_a);
|
|
reset_pin_number(self->pin_a);
|
|
self->pin_a = NO_PIN;
|
|
}
|
|
|
|
mp_int_t common_hal_countio_counter_get_count(countio_counter_obj_t *self) {
|
|
return self->count;
|
|
}
|
|
|
|
void common_hal_countio_counter_set_count(countio_counter_obj_t *self,
|
|
mp_int_t new_count) {
|
|
self->count = new_count;
|
|
}
|
|
|
|
void common_hal_countio_counter_reset(countio_counter_obj_t *self) {
|
|
self->count = 0;
|
|
}
|