firmware/right/src/config/parse_keymap.c

#include "config/parse_keymap.h"
#include "key_action.h"
#include "current_keymap.h"

#define longCompactLengthPrefix 0xff

static uint8_t readUInt8(serialized_buffer_t *buffer) {
    return buffer->buffer[buffer->offset++];
}

static uint16_t readUInt16(serialized_buffer_t *buffer) {
    uint8_t firstByte = buffer->buffer[buffer->offset++];
    return firstByte + (buffer->buffer[buffer->offset++] << 8);
}

static bool readBool(serialized_buffer_t *buffer) {
    return buffer->buffer[buffer->offset++] == 1;
}

static uint16_t readCompactLength(serialized_buffer_t *buffer) {
    uint16_t length = readUInt8(buffer);
    if (length == longCompactLengthPrefix) {
        length = readUInt16(buffer);
    }
    return length;
}

static const char *readString(serialized_buffer_t *buffer, uint16_t *len) {
    const char *str = (const char *)&(buffer->buffer[buffer->offset]);

    *len = readCompactLength(buffer);
    buffer->offset += *len;

    return str;
}

static bool parseNoneAction(key_action_t *keyAction, serialized_buffer_t *buffer) {
    keyAction->type = KeyActionType_None;
    return false;
}

static bool parseKeyStrokeAction(key_action_t *keyAction, uint8_t keyStrokeAction, serialized_buffer_t *buffer) {
    keyAction->type = KeyActionType_Keystroke;

    uint8_t keystrokeType = (SERIALIZED_KEYSTROKE_TYPE_MASK_KEYSTROKE_TYPE & keyStrokeAction) >> SERIALIZED_KEYSTROKE_TYPE_OFFSET_KEYSTROKE_TYPE;
    switch (keystrokeType) {
        case SerializedKeystrokeType_Basic:
            keyAction->keystroke.keystrokeType = KeystrokeType_Basic;
            break;
        case SerializedKeystrokeType_ShortMedia:
        case SerializedKeystrokeType_LongMedia:
            keyAction->keystroke.keystrokeType = KeystrokeType_Media;
            break;
        case SerializedKeystrokeType_System:
            keyAction->keystroke.keystrokeType = KeystrokeType_System;
            break;
        default:
            return true;
    }
    if (keyStrokeAction & SERIALIZED_KEYSTROKE_TYPE_MASK_HAS_SCANCODE) {
        keyAction->keystroke.scancode = keystrokeType == SerializedKeystrokeType_LongMedia ? readUInt16(buffer) : readUInt8(buffer);
    }
    if (keyStrokeAction & SERIALIZED_KEYSTROKE_TYPE_MASK_HAS_MODIFIERS) {
        keyAction->keystroke.modifiers = readUInt8(buffer);
    }
    if (keyStrokeAction & SERIALIZED_KEYSTROKE_TYPE_MASK_HAS_LONGPRESS) {
        keyAction->keystroke.longPressAction = readUInt8(buffer);
    }
    return false;
}

static bool parseSwitchLayerAction(key_action_t *KeyAction, serialized_buffer_t *buffer) {
    uint8_t layer = readUInt8(buffer) + 1;
    bool isToggle = readBool(buffer);

    KeyAction->type = KeyActionType_SwitchLayer;
    KeyAction->switchLayer.layer = layer;
    KeyAction->switchLayer.isToggle = isToggle;
    return false;
}

static bool parseSwitchKeymapAction(key_action_t *keyAction, serialized_buffer_t *buffer) {
//    uint16_t len;
//    const char *keymap = readString(buffer, &len);

    keyAction->type = KeyActionType_SwitchKeymap;

    // TODO: Implement this
    return false;
}

static bool parseMouseAction(key_action_t *keyAction, serialized_buffer_t *buffer) {
    uint8_t mouseAction = readUInt8(buffer);

    keyAction->type = KeyActionType_Mouse;
    switch (mouseAction) {
    case SerializedMouseAction_LeftClick:
        keyAction->mouse.buttonActions |= MouseButton_Left;
        break;
    case SerializedMouseAction_MiddleClick:
        keyAction->mouse.buttonActions |= MouseButton_Middle;
        break;
    case SerializedMouseAction_RightClick:
        keyAction->mouse.buttonActions |= MouseButton_Right;
        break;
    case SerializedMouseAction_MoveUp:
        keyAction->mouse.moveActions |= MouseMove_Up;
        break;
    case SerializedMouseAction_MoveDown:
        keyAction->mouse.moveActions |= MouseMove_Down;
        break;
    case SerializedMouseAction_MoveLeft:
        keyAction->mouse.moveActions |= MouseMove_Left;
        break;
    case SerializedMouseAction_MoveRight:
        keyAction->mouse.moveActions |= MouseMove_Right;
        break;
    case SerializedMouseAction_ScrollUp:
        keyAction->mouse.scrollActions |= MouseScroll_Up;
        break;
    case SerializedMouseAction_ScrollDown:
        keyAction->mouse.scrollActions |= MouseScroll_Down;
        break;
    case SerializedMouseAction_ScrollLeft:
        keyAction->mouse.scrollActions |= MouseScroll_Left;
        break;
    case SerializedMouseAction_ScrollRight:
        keyAction->mouse.scrollActions |= MouseScroll_Right;
        break;
    case SerializedMouseAction_Accelerate:
        keyAction->mouse.moveActions |= MouseMove_Accelerate;
        break;
    case SerializedMouseAction_Decelerate:
        keyAction->mouse.moveActions |= MouseMove_Decelerate;
        break;
    default:
        return true;
    }
    return false;
}

static bool parseKeyAction(key_action_t *keyAction, serialized_buffer_t *buffer) {
    uint8_t keyActionType = readUInt8(buffer);

    switch (keyActionType) {
    case SerializedKeyActionType_None:
        return parseNoneAction(keyAction, buffer);
    case SerializedKeyActionType_KeyStroke ... SerializedKeyActionType_LastKeyStroke:
        return parseKeyStrokeAction(keyAction, keyActionType, buffer);
    case SerializedKeyActionType_SwitchLayer:
        return parseSwitchLayerAction(keyAction, buffer);
    case SerializedKeyActionType_SwitchKeymap:
        return parseSwitchKeymapAction(keyAction, buffer);
    case SerializedKeyActionType_Mouse:
        return parseMouseAction(keyAction, buffer);
    default:
        return true;
    }
    return false;
}

static bool parseKeyActions(uint8_t targetLayer, serialized_buffer_t *buffer, uint8_t moduleId, uint8_t pointerRole) {
    uint8_t actionCount = readCompactLength(buffer);

    for (uint8_t actionIdx = 0; actionIdx < actionCount; actionIdx++) {
        key_action_t *keyAction = &(CurrentKeymap[targetLayer][moduleId][actionIdx]);
        if (parseKeyAction(keyAction, buffer)) {
            return true;
        }
    }
    return false;
}

static bool parseModule(serialized_buffer_t *buffer, uint8_t layer) {
    uint8_t moduleId = readUInt8(buffer);
    uint8_t pointerRole = readUInt8(buffer);
    return parseKeyActions(layer, buffer, moduleId, pointerRole);
}

static void clearModule(uint8_t layer, uint8_t moduleId) {
    memset(&CurrentKeymap[layer][moduleId], 0, MAX_KEY_COUNT_PER_MODULE * sizeof(key_action_t));
}

static bool parseLayer(serialized_buffer_t *buffer, uint8_t layer) {
    uint8_t moduleCount = readCompactLength(buffer);

    for (uint8_t moduleIdx = 0; moduleIdx < moduleCount; moduleIdx++) {
        clearModule(layer, moduleIdx);
        if (parseModule(buffer, layer)) {
            return true;
        }
    }
    return false;
}

bool ParseKeymap(uint8_t *data) {
    serialized_buffer_t *buffer = &(serialized_buffer_t){ data, 0 };
    uint16_t abbreviationLen;
    uint16_t nameLen;
    uint16_t descriptionLen;
    const char *abbreviation = readString(buffer, &abbreviationLen);
    bool isDefault = readBool(buffer);
    const char *name = readString(buffer, &nameLen);
    const char *description = readString(buffer, &descriptionLen);
    uint8_t layerCount = readCompactLength(buffer);

    (void)abbreviation;
    (void)isDefault;
    (void)name;
    (void)description;
    for (uint8_t layerIdx = 0; layerIdx < layerCount; layerIdx++) {
        if (parseLayer(buffer, layerIdx)) {
            return true;
        }
    }
    return false;
}