#define VOIDP(__x__) (__x__)
#endif
-static dcpu16_hw_signal_t keyboard_reset_;
-static dcpu16_hw_signal_t keyboard_cycle_;
-static dcpu16_hw_signal_t keyboard_hwi_;
-static struct dcpu16_hw hw_ = {
- .vm = NULL,
- .name_ = "Generic Keyboard (compatible)",
- .id_l = 0x7406,
- .id_h = 0x30cf,
- .ver = 0x0001,
- .mfg_l = 0x0000,
- .mfg_h = 0x0000,
- .hwi = keyboard_hwi_,
- .cycle = keyboard_cycle_,
- .reset = keyboard_reset_,
- .data = (struct keyboard_ *)NULL
-};
+#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 keyboard_ {
char *buf;
struct dcpu16_hw *hw = (struct dcpu16_hw *)cl->screen->screenData;
struct keyboard_ *keyboard = (struct keyboard_ *)hw->data;
- keysym_rfbtodcpu(key, &dcpu_key);
+ MSG_DEBUG(hw->vm, "%s>> down:%u rfb_key:0x%04x", down, key);
- fprintf(stderr, "%s: down:%u key:0x%04x dcpu_key:0x%04x\n",
- __func__,
- down,
- key,
- dcpu_key);
-
- fprintf(stderr, "%s: hw:%p name:%s vm:%p\n",
- __func__,
- VOIDP(hw),
- hw->name_,
- VOIDP(hw->vm));
+ if (keysym_rfbtodcpu(key, &dcpu_key)) {
+ /* unhandled key event */
+ return;
+ }
keyboard->keys_pressed[dcpu_key] = (down ? 1 : 0);
if (down) {
if ((keyboard->buf_tail + 1) % keyboard->buf_sz == keyboard->buf_head) {
- hw->vm->warn_cb_("keyboard buffer overflow");
+ MSG_INFO(hw->vm, "keyboard buffer overflow");
return;
}
keyboard->buf[keyboard->buf_tail] = dcpu_key;
dcpu16_interrupt(hw->vm, keyboard->interrupt_message);
}
}
-
-void keyboard_vnc_associate(struct dcpu16_hw *hw, rfbScreenInfoPtr rfbScreen) {
- rfbScreen->screenData = hw;
- rfbScreen->kbdAddEvent = keyboard_rfbevent_;
-}
#endif /* HAVE_LIBVNCSERVER */
static
-void keyboard_reset_(struct dcpu16 *vm, void *data) {
- struct keyboard_ *keyboard = (struct keyboard_ *)data;
+void keyboard_reset_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
+ struct keyboard_ *keyboard = (struct keyboard_ *)hw->data;
(void)vm;
keyboard->interrupt_message = 0;
- memset(keyboard->buf, 0, keyboard->buf_sz);
+ keyboard->buf_head = 0;
+ keyboard->buf_tail = 0;
+ memset(keyboard->keys_pressed, 0, sizeof keyboard->keys_pressed);
+
+ MSG_DEBUG(vm, "%s>>", __func__);
}
static
-void keyboard_cycle_(struct dcpu16 *vm, void *data) {
- struct keyboard_ *keyboard = (struct keyboard_ *)data;
+void keyboard_cycle_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
+ struct keyboard_ *keyboard = (struct keyboard_ *)hw->data;
(void)vm, (void)keyboard;
}
static
-void keyboard_hwi_(struct dcpu16 *vm, void *data) {
- struct keyboard_ *keyboard = (struct keyboard_ *)data;
+void keyboard_hwi_(struct dcpu16 *vm, struct dcpu16_hw *hw) {
+ struct keyboard_ *keyboard = (struct keyboard_ *)hw->data;
DCPU16_WORD reg_a = vm->reg[DCPU16_REG_A];
DCPU16_WORD reg_b = vm->reg[DCPU16_REG_B];
memset(keyboard->buf, 0, keyboard->buf_sz);
keyboard->buf_head = 0;
keyboard->buf_tail = 0;
+
+ MSG_DEBUG(vm, "%s>> buffer cleared", __func__);
break;
case 1: /* get next key from buffer as C */
vm->reg[DCPU16_REG_C] = keyboard->buf[keyboard->buf_head];
keyboard->buf_head += 1;
keyboard->buf_head %= keyboard->buf_sz;
+
+ MSG_DEBUG(vm, "%s>> next key: %u", __func__, vm->reg[DCPU16_REG_C]);
break;
case 2: /* get currently-pressed-state of key in B as C */
vm->reg[DCPU16_REG_C] = keyboard->keys_pressed[reg_b & 0x00ff];
+
+ MSG_DEBUG(vm, "%s>> state of key 0x%02x: %spressed", __func__, reg_b & 0x00ff, keyboard->keys_pressed[reg_b & 0x00ff] ? "" : "not ");
break;
case 3: /* set interrupt state */
keyboard->interrupt_message = reg_b;
+
+ MSG_DEBUG(vm, "%s>> interrupt_message:0x%04x", __func__, reg_b);
break;
}
}
-struct dcpu16_hw *keyboard_new(struct dcpu16 *vm) {
- struct dcpu16_hw *hw;
- char *b;
+static
+int keyboard_data_init_(struct dcpu16_hw *hw, void *data) {
+ size_t buf_sz = data ? *(size_t *)data : BUF_SZ;
- 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 keyboard_));
if (hw->data == NULL) {
- vm->warn_cb_("%s():%s", "calloc", strerror(errno));
- free(hw);
- return NULL;
+ MSG_ERROR(hw->vm, "%s():%s", "calloc", strerror(errno));
+ return -1;
}
- b = calloc(BUF_SZ, sizeof *b);
- if (b == NULL) {
- vm->warn_cb_("%s():%s", "calloc", strerror(errno));
+ ((struct keyboard_ *)(hw->data))->buf = malloc(buf_sz * sizeof *((struct keyboard_ *)(hw->data))->buf);
+ if (((struct keyboard_ *)(hw->data))->buf == NULL) {
+ MSG_ERROR(hw->vm, "%s():%s", "malloc", strerror(errno));
free(hw->data);
- free(hw);
- return NULL;
+ hw->data = NULL;
+ return -1;
}
- ((struct keyboard_ *)(hw->data))->buf = b;
- ((struct keyboard_ *)(hw->data))->buf_sz = BUF_SZ;
- hw->vm = vm;
+ ((struct keyboard_ *)(hw->data))->buf_sz = buf_sz;
- return hw;
+ return 0;
}
-void keyboard_del(struct dcpu16_hw **hw) {
+static
+void keyboard_data_free_(struct dcpu16_hw *hw) {
if (hw) {
- if (*hw) {
- if ((*hw)->data) {
- free(((struct keyboard_ *)((*hw)->data))->buf);
- ((struct keyboard_ *)((*hw)->data))->buf = NULL;
+ if (hw->data) {
+ if (((struct keyboard_ *)(hw->data))->buf) {
+ free(((struct keyboard_ *)(hw->data))->buf);
+ ((struct keyboard_ *)(hw->data))->buf = NULL;
+ }
+ free(hw->data);
+ hw->data = NULL;
+ }
+ }
+}
- free((*hw)->data);
- (*hw)->data = NULL;
+static struct dcpu16_hw_ctl_cmd ctl_[] = {
+ { "buffer_size", "const size_t *", "size_t *", "get or set current buffer size" },
+ { "associate_rfbScreen", "rfbScreenInfoPtr", "NULL", "associates this keyboard instance with an rfb display" },
+ { NULL, NULL, NULL, NULL }
+};
+static
+int keyboard_data_ctl_(struct dcpu16_hw *hw, const char *cmd, void *data_in, void *data_out) {
+ if (strcmp(cmd, "buffer_size") == 0) {
+ struct keyboard_ *keyboard = (struct keyboard_ *)hw->data;
+ void *tmp_ptr;
+ const size_t *buf_sz_in = (const size_t *)data_in;
+ size_t *buf_sz_out = (size_t *)data_out;
+
+ if (buf_sz_out) {
+ *buf_sz_out = keyboard->buf_sz;
+ }
+
+ if (buf_sz_in) {
+ MSG_DEBUG(hw->vm, "%s>> resizing buffer from %zu to %zu", __func__, keyboard->buf_sz, *buf_sz_in);
+
+ tmp_ptr = realloc(keyboard->buf, *buf_sz_in);
+ if (tmp_ptr == NULL) {
+ MSG_ERROR(hw->vm, "%s():%s", "realloc", strerror(errno));
+ return -1;
}
- free(*hw);
- *hw = NULL;
+ keyboard->buf = tmp_ptr;
+ keyboard->buf_sz = *buf_sz_in;
+ keyboard->buf_head = keyboard->buf_tail = 0;
}
+
+ MSG_DEBUG(hw->vm, "%s>> %s now:%zu was:%zu", __func__, "buffer_size", *buf_sz_in, *buf_sz_out);
+
+ return 0;
}
+
+#ifdef HAVE_LIBVNCSERVER
+ if (strcmp(cmd, "associate_rfbScreen") == 0) {
+ rfbScreenInfoPtr rfbScreen = (rfbScreenInfoPtr)data_in;
+ (void)data_out;
+
+ if (rfbScreen == NULL)
+ return -EFAULT;
+
+ rfbScreen->screenData = hw;
+ rfbScreen->kbdAddEvent = keyboard_rfbevent_;
+
+ MSG_DEBUG(hw->vm, "%s>> %s rfbScreen:%p", __func__, "associate_rfbScreen", rfbScreen);
+
+ return 0;
+ }
+#endif /* HAVE_LIBVNCSERVER */
+
+ return -EINVAL;
}
+
+
+struct dcpu16_hw_module dcpu16_hw_module_keyboard = {
+ .name_ = "Generic Keyboard (compatible)",
+
+ .id_l = 0x7406,
+ .id_h = 0x30cf,
+ .ver = 0x0001,
+ .mfg_l = 0x0000,
+ .mfg_h = 0x0000,
+ .hwi = keyboard_hwi_,
+ .cycle = keyboard_cycle_,
+ .reset = keyboard_reset_,
+
+ .data_init = keyboard_data_init_,
+ .data_free = keyboard_data_free_,
+ .ctl = keyboard_data_ctl_,
+ .ctl_cmd = ctl_,
+};