#include "dcpu16.h"
#include "hw_clock.h"
-static dcpu16_hw_signal_t clock_reset_;
-static dcpu16_hw_signal_t clock_cycle_;
-static dcpu16_hw_signal_t clock_hwi_;
-static struct dcpu16_hw hw_ = {
- .name_ = "Generic Clock (compatible)",
- .id_l = 0xb402,
- .id_h = 0x12d0,
- .ver = 0x0001,
- .mfg_l = 0x0000,
- .mfg_h = 0x0000,
- .hwi = clock_hwi_,
- .cycle = clock_cycle_,
- .reset = clock_reset_,
- .data = (struct clock_ *)NULL
-};
-
struct clock_ {
DCPU16_WORD cycle_;
DCPU16_WORD rate;
};
static
-void clock_reset_(struct dcpu16 *vm, void *data) {
- struct clock_ *clock = (struct clock_ *)data;
+void clock_reset_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
+ struct clock_ *clock = (struct clock_ *)hw->data;
(void)vm;
}
static
-void clock_cycle_(struct dcpu16 *vm, void *data) {
- struct clock_ *clock = (struct clock_ *)data;
+void clock_cycle_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
+ struct clock_ *clock = (struct clock_ *)hw->data;
/* cycle is only called 100000 times per second */
/* maximum rate is 60hz / word_max = 3932160 */
if (clock->interrupt_message) {
if (dcpu16_interrupt(vm, clock->interrupt_message))
- vm->warn_cb_("%s: could not send interrupt", hw_.name_);
+ vm->warn_cb_("%s: could not send interrupt", hw->mod->name_);
}
}
}
static
-void clock_hwi_(struct dcpu16 *vm, void *data) {
- struct clock_ *clock = (struct clock_ *)data;
+void clock_hwi_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
+ struct clock_ *clock = (struct clock_ *)hw->data;
DCPU16_WORD reg_a = vm->reg[DCPU16_REG_A];
DCPU16_WORD reg_b = vm->reg[DCPU16_REG_B];
}
}
-/* instantitate a new clock */
-struct dcpu16_hw *clock_new(struct dcpu16 *vm) {
- struct dcpu16_hw *hw;
+static
+int clock_data_init_(struct dcpu16_hw *hw, void *data) {
+ (void)data;
- hw = calloc(1, sizeof *hw);
- if (hw == NULL) {
- vm->warn_cb_("%s():%s", "calloc", strerror(errno));
- return NULL;
- }
- memcpy(hw, &hw_, sizeof *hw);
- hw->data = calloc(1, sizeof hw->data);
+ hw->data = calloc(1, sizeof(struct clock_));
if (hw->data == NULL) {
- vm->warn_cb_("%s():%s", "calloc", strerror(errno));
- free(hw);
- return NULL;
+ hw->vm->warn_cb_("%s():%s", "calloc", strerror(errno));
+ return -1;
}
-
- return hw;
+ return 0;
}
-void clock_del(struct dcpu16_hw **hw) {
+static
+void clock_data_free_(struct dcpu16_hw *hw) {
if (hw) {
- free((*hw)->data);
- (*hw)->data = NULL;
-
- free((*hw));
- *hw = NULL;
+ if (hw->data) {
+ free(hw->data);
+ hw->data = NULL;
+ }
}
}
+
+
+struct dcpu16_hw_module dcpu16_hw_module_clock = {
+ .name_ = "Generic Clock (compatible)",
+
+ .id_l = 0xb402,
+ .id_h = 0x12d0,
+ .ver = 0x0001,
+ .mfg_l = 0x0000,
+ .mfg_h = 0x0000,
+ .hwi = clock_hwi_,
+ .cycle = clock_cycle_,
+ .reset = clock_reset_,
+
+ .data_init = clock_data_init_,
+ .data_free = clock_data_free_,
+ .ctl = NULL,
+ .ctl_cmd = NULL,
+};