5 #ifdef HAVE_LIBVNCSERVER
7 #include <rfb/keysym.h>
8 #endif /* HAVE_LIBVNCSERVER */
11 #include "hw_keyboard.h"
15 #ifdef WANT_VARIADIC_VOIDP_CAST
16 #define VOIDP(__x__) ((void *)(__x__))
18 #define VOIDP(__x__) (__x__)
26 DCPU16_WORD interrupt_message
;
27 unsigned char keys_pressed
[256];
30 #ifdef HAVE_LIBVNCSERVER
32 static const struct keysym_map_
{
33 unsigned int rfb_start
;
35 DCPU16_WORD dcpu_start
;
37 { XK_space
, XK_asciitilde
, 0x20 }, /* ASCII range */
38 { XK_Delete
, XK_Delete
, 0x7f }, /* ASCII del */
39 { XK_BackSpace
, XK_BackSpace
, 0x10 }, /* bs */
40 { XK_Return
, XK_Return
, 0x11 }, /* ret */
41 { XK_Insert
, XK_Insert
, 0x12 }, /* ins */
42 { XK_Delete
, XK_Delete
, 0x13 }, /* del */
43 { XK_Up
, XK_Up
, 0x80 }, /* arrow up */
44 { XK_Down
, XK_Down
, 0x81 }, /* arrow down */
45 { XK_Left
, XK_Left
, 0x82 }, /* arrow left */
46 { XK_Right
, XK_Right
, 0x83 }, /* arrow right */
47 { XK_Shift_L
, XK_Shift_R
, 0x90 }, /* shift range */
48 { XK_Control_L
, XK_Control_R
, 0x91 }, /* control range */
52 static int keysym_rfbtodcpu(unsigned int rfb
, DCPU16_WORD
*dcpu
) {
53 const struct keysym_map_
*map
;
55 for (map
= keymap_
; map
->rfb_start
; map
++) {
56 if (rfb
>= map
->rfb_start
57 && rfb
<= map
->rfb_end
) {
58 *dcpu
= (map
->dcpu_start
+ (rfb
- map
->rfb_start
));
68 void keyboard_rfbevent_(rfbBool down
, rfbKeySym key
, rfbClientPtr cl
) {
70 struct dcpu16_hw
*hw
= (struct dcpu16_hw
*)cl
->screen
->screenData
;
71 struct keyboard_
*keyboard
= (struct keyboard_
*)hw
->data
;
73 hw
->vm
->trace_cb_("%s>> down:%u rfb_key:0x%04x", down
, key
);
75 if (keysym_rfbtodcpu(key
, &dcpu_key
)) {
76 /* unhandled key event */
80 keyboard
->keys_pressed
[dcpu_key
] = (down
? 1 : 0);
82 if ((keyboard
->buf_tail
+ 1) % keyboard
->buf_sz
== keyboard
->buf_head
) {
83 hw
->vm
->warn_cb_("keyboard buffer overflow");
86 keyboard
->buf
[keyboard
->buf_tail
] = dcpu_key
;
87 keyboard
->buf_tail
+= 1;
88 keyboard
->buf_tail
%= keyboard
->buf_sz
;
90 if (keyboard
->interrupt_message
) {
91 dcpu16_interrupt(hw
->vm
, keyboard
->interrupt_message
);
94 #endif /* HAVE_LIBVNCSERVER */
97 void keyboard_reset_(struct dcpu16
*vm
, struct dcpu16_hw
*hw
) {
98 struct keyboard_
*keyboard
= (struct keyboard_
*)hw
->data
;
102 keyboard
->interrupt_message
= 0;
103 keyboard
->buf_head
= 0;
104 keyboard
->buf_tail
= 0;
105 memset(keyboard
->keys_pressed
, 0, sizeof keyboard
->keys_pressed
);
109 void keyboard_cycle_(struct dcpu16
*vm
, struct dcpu16_hw
*hw
) {
110 struct keyboard_
*keyboard
= (struct keyboard_
*)hw
->data
;
112 (void)vm
, (void)keyboard
;
116 void keyboard_hwi_(struct dcpu16
*vm
, struct dcpu16_hw
*hw
) {
117 struct keyboard_
*keyboard
= (struct keyboard_
*)hw
->data
;
118 DCPU16_WORD reg_a
= vm
->reg
[DCPU16_REG_A
];
119 DCPU16_WORD reg_b
= vm
->reg
[DCPU16_REG_B
];
122 case 0: /* clear keyboard buffer */
123 memset(keyboard
->buf
, 0, keyboard
->buf_sz
);
124 keyboard
->buf_head
= 0;
125 keyboard
->buf_tail
= 0;
128 case 1: /* get next key from buffer as C */
129 if (keyboard
->buf_head
== keyboard
->buf_tail
)
131 vm
->reg
[DCPU16_REG_C
] = keyboard
->buf
[keyboard
->buf_head
];
132 keyboard
->buf_head
+= 1;
133 keyboard
->buf_head
%= keyboard
->buf_sz
;
136 case 2: /* get currently-pressed-state of key in B as C */
137 vm
->reg
[DCPU16_REG_C
] = keyboard
->keys_pressed
[reg_b
& 0x00ff];
140 case 3: /* set interrupt state */
141 keyboard
->interrupt_message
= reg_b
;
148 int keyboard_data_init_(struct dcpu16_hw
*hw
, void *data
) {
149 size_t buf_sz
= data
? *(size_t *)data
: BUF_SZ
;
151 hw
->data
= calloc(1, sizeof(struct keyboard_
));
152 if (hw
->data
== NULL
) {
153 hw
->vm
->warn_cb_("%s():%s", "calloc", strerror(errno
));
157 ((struct keyboard_
*)(hw
->data
))->buf
= malloc(buf_sz
* sizeof *((struct keyboard_
*)(hw
->data
))->buf
);
158 if (((struct keyboard_
*)(hw
->data
))->buf
== NULL
) {
159 hw
->vm
->warn_cb_("%s():%s", "malloc", strerror(errno
));
165 ((struct keyboard_
*)(hw
->data
))->buf_sz
= buf_sz
;
171 void keyboard_data_free_(struct dcpu16_hw
*hw
) {
174 if (((struct keyboard_
*)(hw
->data
))->buf
) {
175 free(((struct keyboard_
*)(hw
->data
))->buf
);
176 ((struct keyboard_
*)(hw
->data
))->buf
= NULL
;
184 static struct dcpu16_hw_ctl_cmd ctl_
[] = {
185 { "buffer_size", "const size_t *", "size_t *", "get or set current buffer size" },
186 { "associate_rfbScreen", "rfbScreenInfoPtr", "NULL", "associates this keyboard instance with an rfb display" },
187 { NULL
, NULL
, NULL
, NULL
}
190 int keyboard_data_ctl_(struct dcpu16_hw
*hw
, const char *cmd
, void *data_in
, void *data_out
) {
191 if (strcmp(cmd
, "buffer_size") == 0) {
192 struct keyboard_
*keyboard
= (struct keyboard_
*)hw
->data
;
194 const size_t *buf_sz_in
= (const size_t *)data_in
;
195 size_t *buf_sz_out
= (size_t *)data_out
;
198 *buf_sz_out
= keyboard
->buf_sz
;
202 hw
->vm
->trace_cb_("%s>> resizing buffer from %zu to %zu", __func__
, keyboard
->buf_sz
, *buf_sz_in
);
204 tmp_ptr
= realloc(keyboard
->buf
, *buf_sz_in
);
205 if (tmp_ptr
== NULL
) {
206 hw
->vm
->warn_cb_("%s():%s", "realloc", strerror(errno
));
209 keyboard
->buf
= tmp_ptr
;
210 keyboard
->buf_sz
= *buf_sz_in
;
211 keyboard
->buf_head
= keyboard
->buf_tail
= 0;
217 #ifdef HAVE_LIBVNCSERVER
218 if (strcmp(cmd
, "associate_rfbScreen") == 0) {
219 rfbScreenInfoPtr rfbScreen
= (rfbScreenInfoPtr
)data_in
;
222 if (rfbScreen
== NULL
)
225 rfbScreen
->screenData
= hw
;
226 rfbScreen
->kbdAddEvent
= keyboard_rfbevent_
;
230 #endif /* HAVE_LIBVNCSERVER */
236 struct dcpu16_hw_module dcpu16_hw_module_keyboard
= {
237 .name_
= "Generic Keyboard (compatible)",
244 .hwi
= keyboard_hwi_
,
245 .cycle
= keyboard_cycle_
,
246 .reset
= keyboard_reset_
,
248 .data_init
= keyboard_data_init_
,
249 .data_free
= keyboard_data_free_
,
250 .ctl
= keyboard_data_ctl_
,