#include "odroid_system.h"
#include "odroid_input.h"
#include "gw_buttons.h"
#include "bq24072.h"
#include "main.h"

/*typedef enum
{
       ODROID_INPUT_UP = 0,
    ODROID_INPUT_RIGHT,
    ODROID_INPUT_DOWN,
    ODROID_INPUT_LEFT,
    ODROID_INPUT_SELECT,
    ODROID_INPUT_START,
    ODROID_INPUT_A,
    ODROID_INPUT_B,
    ODROID_INPUT_MENU,
    ODROID_INPUT_VOLUME,

       ODROID_INPUT_MAX,

    ODROID_INPUT_ANY,
} odroid_gamepad_key_t;

typedef struct
{
    uint8_t values[ODROID_INPUT_MAX];
    uint16_t bitmask;
} odroid_gamepad_state_t;
*/
void update_gamepad_state(odroid_gamepad_state_t *state, uint32_t buttons, odroid_gamepad_key_t odroid_key, uint32_t gw_key) {
    if(buttons & gw_key) {
        state->values[odroid_key] = 1;
        state->bitmask |= 1 << odroid_key;
    } else {
        state->values[odroid_key] = 0;
        state->bitmask &= ~(1 << odroid_key);
    }
}
 
 void odroid_input_read_gamepad(odroid_gamepad_state_t* out_state)
 {
    memset(out_state, '\x00', sizeof(odroid_gamepad_state_t));

    uint32_t buttons = buttons_get();
    update_gamepad_state(out_state, buttons, ODROID_INPUT_UP, B_Up);
    update_gamepad_state(out_state, buttons, ODROID_INPUT_RIGHT, B_Right);
    update_gamepad_state(out_state, buttons, ODROID_INPUT_DOWN, B_Down);
    update_gamepad_state(out_state, buttons, ODROID_INPUT_LEFT, B_Left);
    update_gamepad_state(out_state, buttons, ODROID_INPUT_START, B_GAME);
    update_gamepad_state(out_state, buttons, ODROID_INPUT_SELECT, B_TIME);
    update_gamepad_state(out_state, buttons, ODROID_INPUT_VOLUME, B_PAUSE);
    update_gamepad_state(out_state, buttons, ODROID_INPUT_POWER, B_POWER);
    update_gamepad_state(out_state, buttons, ODROID_INPUT_A, B_A);
    update_gamepad_state(out_state, buttons, ODROID_INPUT_B, B_B);
    // if(buttons & B_Left)

}

void odroid_input_wait_for_key(odroid_gamepad_key_t key, bool pressed)
{
    odroid_gamepad_state_t joystick;

    do {
        odroid_input_read_gamepad(&joystick);
        wdog_refresh();
    } while (joystick.values[key] != (pressed ? 1 : 0));
}

bool odroid_input_key_is_pressed(odroid_gamepad_key_t key)
{
    odroid_gamepad_state_t joystick;
    odroid_input_read_gamepad(&joystick);

    if (key == ODROID_INPUT_ANY) {
        uint32_t buttons = buttons_get();
        if(buttons) {
            return true;
        }
        return false;
    }

    return joystick.values[key];
}

odroid_battery_state_t odroid_input_read_battery()
{
    odroid_battery_state_t ret;

    ret.millivolts = 0;
    ret.percentage = bq24072_get_percent_filtered();
    switch (bq24072_get_state())
    {
        case BQ24072_STATE_MISSING:         ret.state = ODROID_BATTERY_CHARGE_STATE_BATTERY_MISSING;    break;
        case BQ24072_STATE_CHARGING:        ret.state = ODROID_BATTERY_CHARGE_STATE_CHARGING;           break;
        case BQ24072_STATE_DISCHARGING:     ret.state = ODROID_BATTERY_CHARGE_STATE_DISCHARGING;        break;
        case BQ24072_STATE_FULL:            ret.state = ODROID_BATTERY_CHARGE_STATE_FULL;               break;
    }

    return ret;
}