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 keysym_rfbtodcpu(key
, &dcpu_key
);
75 fprintf(stderr
, "%s: down:%u key:0x%04x dcpu_key:0x%04x\n",
81 fprintf(stderr
, "%s: hw:%p name:%s vm:%p\n",
87 keyboard
->keys_pressed
[dcpu_key
] = (down
? 1 : 0);
89 if ((keyboard
->buf_tail
+ 1) % keyboard
->buf_sz
== keyboard
->buf_head
) {
90 hw
->vm
->warn_cb_("keyboard buffer overflow");
93 keyboard
->buf
[keyboard
->buf_tail
] = dcpu_key
;
94 keyboard
->buf_tail
+= 1;
95 keyboard
->buf_tail
%= keyboard
->buf_sz
;
97 if (keyboard
->interrupt_message
) {
98 dcpu16_interrupt(hw
->vm
, keyboard
->interrupt_message
);
102 void keyboard_vnc_associate(struct dcpu16_hw
*hw
, rfbScreenInfoPtr rfbScreen
) {
103 rfbScreen
->screenData
= hw
;
104 rfbScreen
->kbdAddEvent
= keyboard_rfbevent_
;
106 #endif /* HAVE_LIBVNCSERVER */
109 void keyboard_reset_(struct dcpu16
*vm
, struct dcpu16_hw
*hw
) {
110 struct keyboard_
*keyboard
= (struct keyboard_
*)hw
->data
;
114 keyboard
->interrupt_message
= 0;
115 memset(keyboard
->buf
, 0, keyboard
->buf_sz
);
119 void keyboard_cycle_(struct dcpu16
*vm
, struct dcpu16_hw
*hw
) {
120 struct keyboard_
*keyboard
= (struct keyboard_
*)hw
->data
;
122 (void)vm
, (void)keyboard
;
126 void keyboard_hwi_(struct dcpu16
*vm
, struct dcpu16_hw
*hw
) {
127 struct keyboard_
*keyboard
= (struct keyboard_
*)hw
->data
;
128 DCPU16_WORD reg_a
= vm
->reg
[DCPU16_REG_A
];
129 DCPU16_WORD reg_b
= vm
->reg
[DCPU16_REG_B
];
132 case 0: /* clear keyboard buffer */
133 memset(keyboard
->buf
, 0, keyboard
->buf_sz
);
134 keyboard
->buf_head
= 0;
135 keyboard
->buf_tail
= 0;
138 case 1: /* get next key from buffer as C */
139 if (keyboard
->buf_head
== keyboard
->buf_tail
)
141 vm
->reg
[DCPU16_REG_C
] = keyboard
->buf
[keyboard
->buf_head
];
142 keyboard
->buf_head
+= 1;
143 keyboard
->buf_head
%= keyboard
->buf_sz
;
146 case 2: /* get currently-pressed-state of key in B as C */
147 vm
->reg
[DCPU16_REG_C
] = keyboard
->keys_pressed
[reg_b
& 0x00ff];
150 case 3: /* set interrupt state */
151 keyboard
->interrupt_message
= reg_b
;
158 int keyboard_data_init_(struct dcpu16_hw
*hw
, void *data
) {
159 size_t buf_sz
= data
? *(size_t *)data
: BUF_SZ
;
161 hw
->data
= calloc(1, sizeof(struct keyboard_
));
162 if (hw
->data
== NULL
) {
163 hw
->vm
->warn_cb_("%s():%s", "calloc", strerror(errno
));
167 ((struct keyboard_
*)(hw
->data
))->buf
= malloc(buf_sz
* sizeof *((struct keyboard_
*)(hw
->data
))->buf
);
168 if (((struct keyboard_
*)(hw
->data
))->buf
== NULL
) {
169 hw
->vm
->warn_cb_("%s():%s", "malloc", strerror(errno
));
175 ((struct keyboard_
*)(hw
->data
))->buf_sz
= buf_sz
;
181 void keyboard_data_free_(struct dcpu16_hw
*hw
) {
184 if (((struct keyboard_
*)(hw
->data
))->buf
) {
185 free(((struct keyboard_
*)(hw
->data
))->buf
);
186 ((struct keyboard_
*)(hw
->data
))->buf
= NULL
;
194 static struct dcpu16_hw hw_
= {
196 .name_
= "Generic Keyboard (compatible)",
202 .hwi
= keyboard_hwi_
,
203 .cycle
= keyboard_cycle_
,
204 .reset
= keyboard_reset_
,
205 .data
= (struct keyboard_
*)NULL
208 struct dcpu16_hw_module dcpu16_hw_module_keyboard
= {
210 .data_init
= keyboard_data_init_
,
211 .data_free
= keyboard_data_free_
,