#include "kbI2cBase.h"
#include "configuration.h"
#include <Wire.h>

extern uint8_t cardkb_found;

KbI2cBase::KbI2cBase(const char *name) : concurrency::OSThread(name)
{
    this->_originName = name;
}

int32_t KbI2cBase::runOnce()
{
    if (cardkb_found != CARDKB_ADDR){
        // Input device is not detected.
        return INT32_MAX;
    }

    Wire.requestFrom(CARDKB_ADDR, 1);

    while (Wire.available()) {
        char c = Wire.read();
        InputEvent e;
        e.inputEvent = ModuleConfig_CannedMessageConfig_InputEventChar_NONE;
        e.source = this->_originName;
        switch (c) {
        case 0x1b: // ESC
            e.inputEvent = ModuleConfig_CannedMessageConfig_InputEventChar_CANCEL;
            break;
        case 0x08: // Back
            e.inputEvent = ModuleConfig_CannedMessageConfig_InputEventChar_BACK;
            e.kbchar = c;
            break;
        case 0xb5: // Up
            e.inputEvent = ModuleConfig_CannedMessageConfig_InputEventChar_UP;
            break;
        case 0xb6: // Down
            e.inputEvent = ModuleConfig_CannedMessageConfig_InputEventChar_DOWN;
            break;
        case 0xb4: // Left
            e.inputEvent = ModuleConfig_CannedMessageConfig_InputEventChar_LEFT;
            e.kbchar = c;
            break;
        case 0xb7: // Right
            e.inputEvent = ModuleConfig_CannedMessageConfig_InputEventChar_RIGHT;
            e.kbchar = c;
            break;
        case 0x0d: // Enter
            e.inputEvent = ModuleConfig_CannedMessageConfig_InputEventChar_SELECT;
            break;
        case 0x00: //nopress
            e.inputEvent = ModuleConfig_CannedMessageConfig_InputEventChar_NONE;
            break;
        default: // all other keys
            e.inputEvent = ANYKEY;
            e.kbchar = c;
            break;
        }

        if (e.inputEvent != ModuleConfig_CannedMessageConfig_InputEventChar_NONE) {
            this->notifyObservers(&e);
        }
    }
    return 500;
}