/*
 * CMD 模块 V2 - 行为处理器实现
 */
#include "cmd_behavior.h"
#include "cmd.h"
#include <string.h>

/* ========================================================================== */
/*                           行为配置表                                         */
/* ========================================================================== */

/* 行为处理函数实现 */
int8_t CMD_Behavior_Handle_FORE(CMD_Context_t *ctx) {
    ctx->chassis.cmd.ctrl_vec.vy += ctx->config->sensitivity.move_sens;
    return CMD_OK;
}

int8_t CMD_Behavior_Handle_BACK(CMD_Context_t *ctx) {
    ctx->chassis.cmd.ctrl_vec.vy -= ctx->config->sensitivity.move_sens;
    return CMD_OK;
}

int8_t CMD_Behavior_Handle_LEFT(CMD_Context_t *ctx) {
    ctx->chassis.cmd.ctrl_vec.vx -= ctx->config->sensitivity.move_sens;
    return CMD_OK;
}

int8_t CMD_Behavior_Handle_RIGHT(CMD_Context_t *ctx) {
    ctx->chassis.cmd.ctrl_vec.vx += ctx->config->sensitivity.move_sens;
    return CMD_OK;
}

int8_t CMD_Behavior_Handle_ACCELERATE(CMD_Context_t *ctx) {
    ctx->chassis.cmd.ctrl_vec.vx *= ctx->config->sensitivity.move_fast_mult;
    ctx->chassis.cmd.ctrl_vec.vy *= ctx->config->sensitivity.move_fast_mult;
    return CMD_OK;
}

int8_t CMD_Behavior_Handle_DECELERATE(CMD_Context_t *ctx) {
    ctx->chassis.cmd.ctrl_vec.vx *= ctx->config->sensitivity.move_slow_mult;
    ctx->chassis.cmd.ctrl_vec.vy *= ctx->config->sensitivity.move_slow_mult;
    return CMD_OK;
}

int8_t CMD_Behavior_Handle_FIRE(CMD_Context_t *ctx) {
    ctx->shoot.cmd.firecmd = true;
    return CMD_OK;
}

int8_t CMD_Behavior_Handle_FIRE_MODE(CMD_Context_t *ctx) {
    ctx->shoot.cmd.mode = (ctx->shoot.cmd.mode + 1) % SHOOT_MODE_NUM;
    return CMD_OK;
}

int8_t CMD_Behavior_Handle_ROTOR(CMD_Context_t *ctx) {
    if (ctx->chassis.cmd.mode == CHASSIS_MODE_ROTOR) {
        ctx->chassis.cmd.mode = CHASSIS_MODE_FOLLOW_GIMBAL;
    } else {
        ctx->chassis.cmd.mode = CHASSIS_MODE_ROTOR;
        ctx->chassis.cmd.mode_rotor = ROTOR_MODE_RAND;
    }
    return CMD_OK;
}

int8_t CMD_Behavior_Handle_AUTOAIM(CMD_Context_t *ctx) {
    /* TODO: 自瞄模式切换 */
    return CMD_OK;
}

/* 行为配置表 - 由宏生成 */
static const CMD_BehaviorConfig_t g_behavior_configs[] = {
    CMD_BEHAVIOR_TABLE(BUILD_BEHAVIOR_CONFIG)
};

#define BEHAVIOR_CONFIG_COUNT (sizeof(g_behavior_configs) / sizeof(g_behavior_configs[0]))

/* ========================================================================== */
/*                           API实现                                            */
/* ========================================================================== */

int8_t CMD_Behavior_Init(void) {
    /* 当前静态配置，无需初始化 */
    return CMD_OK;
}

bool CMD_Behavior_IsTriggered(const CMD_RawInput_t *current,
                               const CMD_RawInput_t *last,
                               const CMD_BehaviorConfig_t *config) {
    if (config == NULL || current == NULL) {
        return false;
    }
    
    bool now_pressed = false;
    bool last_pressed = false;
    
    /* 处理特殊按键 */
    switch (config->key) {
        case CMD_KEY_NONE:
            return false;
            
        case CMD_KEY_L_CLICK:
            now_pressed = current->mouse.l_click;
            last_pressed = last ? last->mouse.l_click : false;
            break;
            
        case CMD_KEY_R_CLICK:
            now_pressed = current->mouse.r_click;
            last_pressed = last ? last->mouse.r_click : false;
            break;
            
        case CMD_KEY_M_CLICK:
            now_pressed = current->mouse.m_click;
            last_pressed = last ? last->mouse.m_click : false;
            break;
            
        default:
            if (config->key < CMD_KEY_NUM) {
                now_pressed = CMD_KEY_PRESSED(&current->keyboard, config->key);
                last_pressed = last ? CMD_KEY_PRESSED(&last->keyboard, config->key) : false;
            }
            break;
    }
    
    /* 根据触发类型判断 */
    switch (config->trigger) {
        case CMD_ACTIVE_PRESSED:
            return now_pressed;
            
        case CMD_ACTIVE_RISING_EDGE:
            return now_pressed && !last_pressed;
            
        case CMD_ACTIVE_FALLING_EDGE:
            return !now_pressed && last_pressed;
            
        default:
            return false;
    }
}

int8_t CMD_Behavior_ProcessAll(CMD_Context_t *ctx,
                                const CMD_RawInput_t *current,
                                const CMD_RawInput_t *last,
                                CMD_ModuleMask_t active_modules) {
    if (ctx == NULL || current == NULL) {
        return CMD_ERR_NULL;
    }
    
    for (size_t i = 0; i < BEHAVIOR_CONFIG_COUNT; i++) {
        const CMD_BehaviorConfig_t *config = &g_behavior_configs[i];
        
        /* 检查模块掩码 */
        if ((config->module_mask & active_modules) == 0) {
            continue;
        }
        
        /* 检查是否触发 */
        if (CMD_Behavior_IsTriggered(current, last, config)) {
            if (config->handler != NULL) {
                config->handler(ctx);
            }
        }
    }
    
    return CMD_OK;
}

const CMD_BehaviorConfig_t* CMD_Behavior_GetConfig(CMD_Behavior_t behavior) {
    for (size_t i = 0; i < BEHAVIOR_CONFIG_COUNT; i++) {
        if (g_behavior_configs[i].behavior == behavior) {
            return &g_behavior_configs[i];
        }
    }
    return NULL;
}