#include <stdlib.h>
#include <string.h>
#include <errno.h>

#include "dcpu16.h"
#include "hw_spc2000.h"

#define MSG_(__level__, __vm__, ...) do { ((__vm__) ? ((struct dcpu16 *)(__vm__))->msg_cb_ : dcpu16_msg_)(__level__, __VA_ARGS__); } while (0)
#define MSG_INFO(__vm__, ...) MSG_(DCPU16_MSG_INFO, __vm__, __VA_ARGS__)
#define MSG_ERROR(__vm__, ...) MSG_(DCPU16_MSG_ERROR, __vm__, __VA_ARGS__)
#ifdef DEBUG
#define MSG_DEBUG(__vm__, ...) MSG_(DCPU16_MSG_DEBUG, __vm__, __VA_ARGS__)
#else /* DEBUG  */
#define MSG_DEBUG(__vm__, ...) do { } while (0)
#endif /* DEBUG */

struct spc2000_ {
    DCPU16_WORD skip_unit;
    long long skip;
};

static
int spc2000_data_init_(struct dcpu16_hw *hw, void *data) {
    (void)data;

    hw->data = calloc(1, sizeof(struct spc2000_));
    if (hw->data == NULL) {
        MSG_ERROR(hw->vm, "%s():%s", "calloc", strerror(errno));
        return -1;
    }
    return 0;
}

static
void spc2000_data_free_(struct dcpu16_hw *hw) {
    if (hw) {
        if (hw->data) {
            free(hw->data);
            hw->data = NULL;
        }
    }
}

static
void spc2000_reset_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
    struct spc2000_ *spc2000 = (struct spc2000_ *)hw->data;

    (void)vm;

    memset(spc2000, 0, sizeof *spc2000);
}

static
void spc2000_cycle_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
    struct spc2000_ *spc2000 = (struct spc2000_ *)hw->data;

    (void)vm;
    (void)spc2000;
}

static
void spc2000_hwi_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
    struct spc2000_ *spc2000 = (struct spc2000_ *)hw->data;
    DCPU16_WORD reg_a = vm->reg[DCPU16_REG_A],
                reg_b = vm->reg[DCPU16_REG_B];
    long long x;

    switch (reg_a) {
        case 0: /* GET_STATUS */
        case 2: /* TRIGGER_DEVICE */
            /* check status */
            vm->reg[DCPU16_REG_C] = 0;
            vm->reg[DCPU16_REG_B] = 0;
            if (reg_a == 0
            ||  vm->reg[DCPU16_REG_C] != 0)
                break;
            /* trigger */
            MSG_INFO(vm, "spc2000 triggered\n");
            break;

        case 1: /* SET_UNIT_TO_SKIP */
            spc2000->skip = vm->ram[reg_b];
            x = vm->ram[reg_b + 1];
            spc2000->skip |= x << 16;
            x = vm->ram[reg_b + 2];
            spc2000->skip |= x << 32;
            x = vm->ram[reg_b + 3];
            spc2000->skip |= x << 48;
            break;

        case 3: /* SET_SKIP_UNIT */
            spc2000->skip_unit = reg_b;
            break;
    }
}

struct dcpu16_hw_module dcpu16_hw_module_spc2000 = {
    .name_  = "SPC2000 - Suspension Chamber 2000",

    .id_l   = 0x1d9d,
    .id_h   = 0x40e4,
    .ver    = 0x005e,
    .mfg_l  = 0x8b36,
    .mfg_h  = 0x1c6c,
    .hwi    = spc2000_hwi_,
    .cycle  = spc2000_cycle_,
    .reset  = spc2000_reset_,

    .data_init = spc2000_data_init_,
    .data_free = spc2000_data_free_,
    .ctl = NULL,
    .ctl_cmd = NULL,
};