/*
 * buttons.c
 *
 * Copyright (c) 2022 - 2023 Thomas Buck (thomas@xythobuz.de)
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation, either version 3 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * See <http://www.gnu.org/licenses/>.
 */

#include "pico/stdlib.h"

#include "config.h"
#include "buttons.h"

static const uint gpio_num[NUM_BTNS] = {
    15, // BTN_A
    17, // BTN_B
    19, // BTN_X
    21, // BTN_Y
     2, // BTN_UP
    18, // BTN_DOWN
    16, // BTN_LEFT
    20, // BTN_RIGHT
     3, // BTN_ENTER
};

struct button_state {
    uint32_t last_time;
    bool current_state, last_state;
};

static struct button_state buttons[NUM_BTNS];

void buttons_init(void) {
    for (uint i = 0; i < NUM_BTNS; i++) {
        gpio_init(gpio_num[i]);
        gpio_set_dir(gpio_num[i], GPIO_IN);
        gpio_pull_up(gpio_num[i]);

        buttons[i].last_time = 0;
        buttons[i].current_state = false;
        buttons[i].last_state = false;
    }
}

void buttons_run(void) {
    for (uint i = 0; i < NUM_BTNS; i++) {
        bool state = !gpio_get(gpio_num[i]);
        uint32_t now = to_ms_since_boot(get_absolute_time());

        if (state != buttons[i].last_state) {
            buttons[i].last_time = now;
        }

        if ((now - buttons[i].last_time) > DEBOUNCE_DELAY_MS) {
            if (state != buttons[i].current_state) {
                buttons[i].current_state = state;
            }
        }

        buttons[i].last_state = state;
    }
}