git.squeep.com Git - dcpu16/blob - hw_keyboard.c

   1 #include <stdlib.h>
   2 #include <string.h>
   3 #include <errno.h>
   4
   5 #ifdef HAVE_LIBVNCSERVER
   6 #include <rfb/rfb.h>
   7 #include <rfb/keysym.h>
   8 #endif /* HAVE_LIBVNCSERVER */
   9
  10 #include "dcpu16.h"
  11 #include "hw_keyboard.h"
  12
  13 #define BUF_SZ 32
  14
  15 static dcpu16_hw_signal_t keyboard_reset_;
  16 static dcpu16_hw_signal_t keyboard_cycle_;
  17 static dcpu16_hw_signal_t keyboard_hwi_;
  18 static struct dcpu16_hw hw_ = {
  19     .vm     = NULL,
  20     .name_  = "Generic Keyboard (compatible)",
  21     .id_l   = 0x7406,
  22     .id_h   = 0x30cf,
  23     .ver    = 0x0001,
  24     .mfg_l  = 0x0000,
  25     .mfg_h  = 0x0000,
  26     .hwi    = keyboard_hwi_,
  27     .cycle  = keyboard_cycle_,
  28     .reset  = keyboard_reset_,
  29     .data   = (struct keyboard_ *)NULL
  30 };
  31
  32 struct keyboard_ {
  33     char *buf;
  34     size_t buf_sz;
  35     DCPU16_WORD interrupt_message;
  36     unsigned char keys_pressed[256];
  37 };
  38
  39 #ifdef HAVE_LIBVNCSERVER
  40
  41 static const struct keysym_map_ {
  42     unsigned int rfb_start;
  43     unsigned int rfb_end;
  44     DCPU16_WORD dcpu_start;
  45 } keymap_[] = {
  46     { XK_space,     XK_asciitilde,  0x20 }, /* ASCII range */
  47     { XK_Delete,    XK_Delete,      0x7f }, /* ASCII del */
  48     { XK_BackSpace, XK_BackSpace,   0x10 }, /* bs */
  49     { XK_Return,    XK_Return,      0x11 }, /* ret */
  50     { XK_Insert,    XK_Insert,      0x12 }, /* ins */
  51     { XK_Delete,    XK_Delete,      0x13 }, /* del */
  52     { XK_Up,        XK_Up,          0x80 }, /* arrow up */
  53     { XK_Down,      XK_Down,        0x81 }, /* arrow down */
  54     { XK_Left,      XK_Left,        0x82 }, /* arrow left */
  55     { XK_Right,     XK_Right,       0x83 }, /* arrow right */
  56     { XK_Shift_L,   XK_Shift_R,     0x90 }, /* shift range */
  57     { XK_Control_L, XK_Control_R,   0x91 }, /* control range */
  58     { 0, 0, 0x0 }
  59 };
  60
  61 static int keysym_rfbtodcpu(unsigned int rfb, DCPU16_WORD *dcpu) {
  62     const struct keysym_map_ *map;
  63
  64     for (map = keymap_; map->rfb_start; map++) {
  65         if (rfb >= map->rfb_start
  66         &&  rfb <= map->rfb_end) {
  67             *dcpu = (map->dcpu_start + (rfb - map->rfb_start));
  68             return 0;
  69         }
  70     }
  71
  72     *dcpu = 0x00;
  73     return -1;
  74 }
  75
  76 static
  77 void keyboard_rfbevent_(rfbBool down, rfbKeySym key, rfbClientPtr cl) {
  78     DCPU16_WORD dcpu_key;
  79     struct dcpu16_hw *hw = (struct dcpu16_hw *)cl->screen->screenData;
  80     struct keyboard_ *keyboard = (struct keyboard_ *)hw->data;
  81
  82     keysym_rfbtodcpu(key, &dcpu_key);
  83
  84     fprintf(stderr, "%s: down:%u key:0x%04x dcpu_key:0x%04x\n", __func__,
  85             down, key, dcpu_key);
  86
  87     fprintf(stderr, "%s: hw:%p name:%s vm:%p\n", __func__, hw, hw->name_, hw->vm);
  88
  89     keyboard->keys_pressed[dcpu_key] = (down ? 1 : 0);
  90     if (down)
  91         keyboard->buf[0] = dcpu_key;
  92     if (keyboard->interrupt_message) {
  93         dcpu16_interrupt(hw->vm, keyboard->interrupt_message);
  94     }
  95 }
  96
  97 void keyboard_vnc_associate(struct dcpu16_hw *hw, rfbScreenInfoPtr rfbScreen) {
  98     rfbScreen->screenData = hw;
  99     rfbScreen->kbdAddEvent = keyboard_rfbevent_;
 100 }
 101 #endif /* HAVE_LIBVNCSERVER */
 102
 103 static
 104 void keyboard_reset_(struct dcpu16 *vm, void *data) {
 105     struct keyboard_ *keyboard = (struct keyboard_ *)data;
 106
 107     (void)vm;
 108
 109     keyboard->interrupt_message = 0;
 110     memset(keyboard->buf, 0, keyboard->buf_sz);
 111 }
 112
 113 static
 114 void keyboard_cycle_(struct dcpu16 *vm, void *data) {
 115     struct keyboard_ *keyboard = (struct keyboard_ *)data;
 116
 117     (void)vm, (void)keyboard;
 118 }
 119
 120 static
 121 void keyboard_hwi_(struct dcpu16 *vm, void *data) {
 122     struct keyboard_ *keyboard = (struct keyboard_ *)data;
 123     DCPU16_WORD reg_a = vm->reg[DCPU16_REG_A];
 124     DCPU16_WORD reg_b = vm->reg[DCPU16_REG_B];
 125     size_t i;
 126
 127     switch (reg_a) {
 128         case 0: /* clear keyboard buffer */
 129             memset(keyboard->buf, 0, keyboard->buf_sz);
 130             break;
 131
 132         case 1: /* get next key from buffer as C */
 133             vm->reg[DCPU16_REG_C] = keyboard->buf[0];
 134             for (i = 1; i < keyboard->buf_sz; i++) {
 135                 keyboard->buf[i-1] = keyboard->buf[i];
 136             }
 137             keyboard->buf[i] = '\0';
 138             break;
 139
 140         case 2: /* get currently-pressed-state of key in B as C */
 141             vm->reg[DCPU16_REG_C] = keyboard->keys_pressed[reg_b & 0x00ff];
 142             break;
 143
 144         case 3: /* set interrupt state */
 145             keyboard->interrupt_message = reg_b;
 146             break;
 147
 148     }
 149 }
 150
 151 struct dcpu16_hw *keyboard_new(struct dcpu16 *vm) {
 152     struct dcpu16_hw *hw;
 153     char *b;
 154
 155     hw = calloc(1, sizeof *hw);
 156     if (hw == NULL) {
 157         vm->warn_cb_("%s():%s", "calloc", strerror(errno));
 158         return NULL;
 159     }
 160     memcpy(hw, &hw_, sizeof *hw);
 161     hw->data = calloc(1, sizeof hw->data);
 162     if (hw->data == NULL) {
 163         vm->warn_cb_("%s():%s", "calloc", strerror(errno));
 164         free(hw);
 165         return NULL;
 166     }
 167
 168     b = calloc(BUF_SZ, sizeof *b);
 169     if (b == NULL) {
 170         vm->warn_cb_("%s():%s", "calloc", strerror(errno));
 171         free(hw->data);
 172         free(hw);
 173         return NULL;
 174     }
 175     ((struct keyboard_ *)(hw->data))->buf = b;
 176     ((struct keyboard_ *)(hw->data))->buf_sz = BUF_SZ;
 177
 178     hw->vm = vm;
 179
 180     return hw;
 181 }
 182
 183 void keyboard_del(struct dcpu16_hw **hw) {
 184     if (hw) {
 185         free(((struct keyboard_ *)((*hw)->data))->buf);
 186         ((struct keyboard_ *)((*hw)->data))->buf = NULL;
 187
 188         free((*hw)->data);
 189         (*hw)->data = NULL;
 190
 191         free(*hw);
 192         *hw = NULL;
 193     }
 194 }