| 1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374 |
- #include "input_i.h"
- #define GPIO_Read(input_pin) \
- (HAL_GPIO_ReadPin((GPIO_TypeDef*)input_pin.pin->port, input_pin.pin->pin) ^ \
- input_pin.pin->inverted)
- static Input* input = NULL;
- void input_press_timer_callback(void* arg) {
- InputPinState* input_pin = arg;
- InputEvent event;
- event.key = input_pin->pin->key;
- event.type = InputTypeLong;
- notify_pubsub(&input->event_pubsub, &event);
- }
- void input_isr(void* _pin, void* _ctx) {
- osThreadFlagsSet(input->thread, INPUT_THREAD_FLAG_ISR);
- }
- int32_t input_task() {
- input = furi_alloc(sizeof(Input));
- input->thread = osThreadGetId();
- init_pubsub(&input->event_pubsub);
- furi_record_create("input_events", &input->event_pubsub);
- const size_t pin_count = input_pins_count;
- input->pin_states = furi_alloc(pin_count * sizeof(InputPinState));
- api_interrupt_add(input_isr, InterruptTypeExternalInterrupt, NULL);
- for(size_t i = 0; i < pin_count; i++) {
- input->pin_states[i].pin = &input_pins[i];
- input->pin_states[i].state = GPIO_Read(input->pin_states[i]);
- input->pin_states[i].debounce = INPUT_DEBOUNCE_TICKS_HALF;
- input->pin_states[i].press_timer =
- osTimerNew(input_press_timer_callback, osTimerOnce, &input->pin_states[i], NULL);
- }
- while(1) {
- bool is_changing = false;
- for(size_t i = 0; i < pin_count; i++) {
- bool state = GPIO_Read(input->pin_states[i]);
- if(input->pin_states[i].debounce > 0 &&
- input->pin_states[i].debounce < INPUT_DEBOUNCE_TICKS) {
- is_changing = true;
- input->pin_states[i].debounce += (state ? 1 : -1);
- } else if(input->pin_states[i].state != state) {
- input->pin_states[i].state = state;
- // Common state info
- InputEvent event;
- event.type = input->pin_states[i].state ? InputTypePress : InputTypeRelease;
- event.key = input->pin_states[i].pin->key;
- // Send Press/Release event
- notify_pubsub(&input->event_pubsub, &event);
- // Short/Long press logic
- if(state) {
- osTimerStart(input->pin_states[i].press_timer, INPUT_LONG_PRESS_TICKS);
- } else if(osTimerStop(input->pin_states[i].press_timer) == osOK) {
- event.type = InputTypeShort;
- notify_pubsub(&input->event_pubsub, &event);
- }
- }
- }
- if(is_changing) {
- osDelay(1);
- } else {
- osThreadFlagsWait(INPUT_THREAD_FLAG_ISR, osFlagsWaitAny, osWaitForever);
- }
- }
- return 0;
- }
|