SwitchMatrixInput

#include "input/SwitchMatrixInput.hpp"
#include "core/state.hpp"

// Define matrix dimensions
const size_t num_rows = 5;
const size_t num_cols = 13;

// Define pin assignments
const uint row_pins[num_rows] = { 20, 19, 18, 17, 16 };
const uint col_pins[num_cols] = { 12, 11, 10, 9, 8, 7, 6, 5, 4, 3, 2, 1, 0 };

// Define button matrix layout
// NA indicates no button at that position
const Button matrix[num_rows][num_cols] = {
    {BTN_LF8, BTN_LF7, BTN_LF6, BTN_LF5, NA, BTN_MB3, BTN_MB1, BTN_MB2, NA, BTN_RF5, BTN_RF6, BTN_RF7, BTN_RF8 },
    {BTN_LF4, BTN_LF3, BTN_LF2, BTN_LF1, NA, BTN_MB4, BTN_MB5, BTN_MB6, NA, BTN_RF1, BTN_RF2, BTN_RF3, BTN_RF4 },
    {BTN_LF12,BTN_LF11,BTN_LF10,BTN_LF9, NA, BTN_MB7, BTN_MB8, BTN_MB9, NA, BTN_RF9, BTN_RF10,BTN_RF11,BTN_RF12},
    {NA,      BTN_LT5, BTN_LT4, BTN_LT3, NA, BTN_MB10,BTN_MB11,BTN_MB12,NA, BTN_RT3, BTN_RT4, BTN_RT5, NA      },
    {NA,      NA,      BTN_LT1, BTN_LT2, NA, BTN_LT6, BTN_RT7, BTN_RT6, NA, BTN_RT2, BTN_RT1, NA,      NA      },
};

// Specify diode direction
const DiodeDirection diode_direction = DiodeDirection::COL2ROW;

// Create matrix input source
SwitchMatrixInput<num_rows, num_cols> matrix_input(
    row_pins, 
    col_pins, 
    matrix, 
    diode_direction
);

void setup() {
    static InputState inputs;
    
    // Read buttons immediately for early checks
    matrix_input.UpdateInputs(inputs);
    
    // Check for bootloader entry
    if (inputs.rt2) {
        reboot_bootloader();
    }
    
    // Initialize backends (no input_sources array needed)
    backend_count = initialize_backends(
        backends, 
        inputs, 
        nullptr,  // No input sources array needed
        0, 
        config, 
        pinout
    );
}

// Core 0: Main communication loop
void setup() {
    static InputState inputs;
    matrix_input.UpdateInputs(inputs);
    
    if (inputs.rt2) {
        reboot_bootloader();
    }
    
    backend_count = initialize_backends(backends, inputs, nullptr, 0, config, pinout);
    setup_mode_activation_bindings(config.game_mode_configs, config.game_mode_configs_count);
}

void loop() {
    select_mode(backends, backend_count, config);
    
    for (size_t i = 0; i < backend_count; i++) {
        backends[i]->SendReport();
    }
}

// Core 1: Dedicated input scanning
void setup1() {
    while (backends == nullptr) {
        tight_loop_contents();
    }
}

void loop1() {
    if (backends != nullptr) {
        // Continuously scan matrix on second core
        matrix_input.UpdateInputs(backends[0]->GetInputs());
    }
}