These changes are a raw update to a vanilla kernel 4.1.10, with the
[kvmfornfv.git] / qemu / backends / baum.c
1 /*
2  * QEMU Baum Braille Device
3  *
4  * Copyright (c) 2008 Samuel Thibault
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining a copy
7  * of this software and associated documentation files (the "Software"), to deal
8  * in the Software without restriction, including without limitation the rights
9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10  * copies of the Software, and to permit persons to whom the Software is
11  * furnished to do so, subject to the following conditions:
12  *
13  * The above copyright notice and this permission notice shall be included in
14  * all copies or substantial portions of the Software.
15  *
16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22  * THE SOFTWARE.
23  */
24 #include "qemu-common.h"
25 #include "sysemu/char.h"
26 #include "qemu/timer.h"
27 #include "hw/usb.h"
28 #include <brlapi.h>
29 #include <brlapi_constants.h>
30 #include <brlapi_keycodes.h>
31 #ifdef CONFIG_SDL
32 #include <SDL_syswm.h>
33 #endif
34
35 #if 0
36 #define DPRINTF(fmt, ...) \
37         printf(fmt, ## __VA_ARGS__)
38 #else
39 #define DPRINTF(fmt, ...)
40 #endif
41
42 #define ESC 0x1B
43
44 #define BAUM_REQ_DisplayData            0x01
45 #define BAUM_REQ_GetVersionNumber       0x05
46 #define BAUM_REQ_GetKeys                0x08
47 #define BAUM_REQ_SetMode                0x12
48 #define BAUM_REQ_SetProtocol            0x15
49 #define BAUM_REQ_GetDeviceIdentity      0x84
50 #define BAUM_REQ_GetSerialNumber        0x8A
51
52 #define BAUM_RSP_CellCount              0x01
53 #define BAUM_RSP_VersionNumber          0x05
54 #define BAUM_RSP_ModeSetting            0x11
55 #define BAUM_RSP_CommunicationChannel   0x16
56 #define BAUM_RSP_PowerdownSignal        0x17
57 #define BAUM_RSP_HorizontalSensors      0x20
58 #define BAUM_RSP_VerticalSensors        0x21
59 #define BAUM_RSP_RoutingKeys            0x22
60 #define BAUM_RSP_Switches               0x23
61 #define BAUM_RSP_TopKeys                0x24
62 #define BAUM_RSP_HorizontalSensor       0x25
63 #define BAUM_RSP_VerticalSensor         0x26
64 #define BAUM_RSP_RoutingKey             0x27
65 #define BAUM_RSP_FrontKeys6             0x28
66 #define BAUM_RSP_BackKeys6              0x29
67 #define BAUM_RSP_CommandKeys            0x2B
68 #define BAUM_RSP_FrontKeys10            0x2C
69 #define BAUM_RSP_BackKeys10             0x2D
70 #define BAUM_RSP_EntryKeys              0x33
71 #define BAUM_RSP_JoyStick               0x34
72 #define BAUM_RSP_ErrorCode              0x40
73 #define BAUM_RSP_InfoBlock              0x42
74 #define BAUM_RSP_DeviceIdentity         0x84
75 #define BAUM_RSP_SerialNumber           0x8A
76 #define BAUM_RSP_BluetoothName          0x8C
77
78 #define BAUM_TL1 0x01
79 #define BAUM_TL2 0x02
80 #define BAUM_TL3 0x04
81 #define BAUM_TR1 0x08
82 #define BAUM_TR2 0x10
83 #define BAUM_TR3 0x20
84
85 #define BUF_SIZE 256
86
87 typedef struct {
88     CharDriverState *chr;
89
90     brlapi_handle_t *brlapi;
91     int brlapi_fd;
92     unsigned int x, y;
93
94     uint8_t in_buf[BUF_SIZE];
95     uint8_t in_buf_used;
96     uint8_t out_buf[BUF_SIZE];
97     uint8_t out_buf_used, out_buf_ptr;
98
99     QEMUTimer *cellCount_timer;
100 } BaumDriverState;
101
102 /* Let's assume NABCC by default */
103 static const uint8_t nabcc_translation[256] = {
104     [0] = ' ',
105 #ifndef BRLAPI_DOTS
106 #define BRLAPI_DOTS(d1,d2,d3,d4,d5,d6,d7,d8) \
107     ((d1?BRLAPI_DOT1:0)|\
108      (d2?BRLAPI_DOT2:0)|\
109      (d3?BRLAPI_DOT3:0)|\
110      (d4?BRLAPI_DOT4:0)|\
111      (d5?BRLAPI_DOT5:0)|\
112      (d6?BRLAPI_DOT6:0)|\
113      (d7?BRLAPI_DOT7:0)|\
114      (d8?BRLAPI_DOT8:0))
115 #endif
116     [BRLAPI_DOTS(1,0,0,0,0,0,0,0)] = 'a',
117     [BRLAPI_DOTS(1,1,0,0,0,0,0,0)] = 'b',
118     [BRLAPI_DOTS(1,0,0,1,0,0,0,0)] = 'c',
119     [BRLAPI_DOTS(1,0,0,1,1,0,0,0)] = 'd',
120     [BRLAPI_DOTS(1,0,0,0,1,0,0,0)] = 'e',
121     [BRLAPI_DOTS(1,1,0,1,0,0,0,0)] = 'f',
122     [BRLAPI_DOTS(1,1,0,1,1,0,0,0)] = 'g',
123     [BRLAPI_DOTS(1,1,0,0,1,0,0,0)] = 'h',
124     [BRLAPI_DOTS(0,1,0,1,0,0,0,0)] = 'i',
125     [BRLAPI_DOTS(0,1,0,1,1,0,0,0)] = 'j',
126     [BRLAPI_DOTS(1,0,1,0,0,0,0,0)] = 'k',
127     [BRLAPI_DOTS(1,1,1,0,0,0,0,0)] = 'l',
128     [BRLAPI_DOTS(1,0,1,1,0,0,0,0)] = 'm',
129     [BRLAPI_DOTS(1,0,1,1,1,0,0,0)] = 'n',
130     [BRLAPI_DOTS(1,0,1,0,1,0,0,0)] = 'o',
131     [BRLAPI_DOTS(1,1,1,1,0,0,0,0)] = 'p',
132     [BRLAPI_DOTS(1,1,1,1,1,0,0,0)] = 'q',
133     [BRLAPI_DOTS(1,1,1,0,1,0,0,0)] = 'r',
134     [BRLAPI_DOTS(0,1,1,1,0,0,0,0)] = 's',
135     [BRLAPI_DOTS(0,1,1,1,1,0,0,0)] = 't',
136     [BRLAPI_DOTS(1,0,1,0,0,1,0,0)] = 'u',
137     [BRLAPI_DOTS(1,1,1,0,0,1,0,0)] = 'v',
138     [BRLAPI_DOTS(0,1,0,1,1,1,0,0)] = 'w',
139     [BRLAPI_DOTS(1,0,1,1,0,1,0,0)] = 'x',
140     [BRLAPI_DOTS(1,0,1,1,1,1,0,0)] = 'y',
141     [BRLAPI_DOTS(1,0,1,0,1,1,0,0)] = 'z',
142
143     [BRLAPI_DOTS(1,0,0,0,0,0,1,0)] = 'A',
144     [BRLAPI_DOTS(1,1,0,0,0,0,1,0)] = 'B',
145     [BRLAPI_DOTS(1,0,0,1,0,0,1,0)] = 'C',
146     [BRLAPI_DOTS(1,0,0,1,1,0,1,0)] = 'D',
147     [BRLAPI_DOTS(1,0,0,0,1,0,1,0)] = 'E',
148     [BRLAPI_DOTS(1,1,0,1,0,0,1,0)] = 'F',
149     [BRLAPI_DOTS(1,1,0,1,1,0,1,0)] = 'G',
150     [BRLAPI_DOTS(1,1,0,0,1,0,1,0)] = 'H',
151     [BRLAPI_DOTS(0,1,0,1,0,0,1,0)] = 'I',
152     [BRLAPI_DOTS(0,1,0,1,1,0,1,0)] = 'J',
153     [BRLAPI_DOTS(1,0,1,0,0,0,1,0)] = 'K',
154     [BRLAPI_DOTS(1,1,1,0,0,0,1,0)] = 'L',
155     [BRLAPI_DOTS(1,0,1,1,0,0,1,0)] = 'M',
156     [BRLAPI_DOTS(1,0,1,1,1,0,1,0)] = 'N',
157     [BRLAPI_DOTS(1,0,1,0,1,0,1,0)] = 'O',
158     [BRLAPI_DOTS(1,1,1,1,0,0,1,0)] = 'P',
159     [BRLAPI_DOTS(1,1,1,1,1,0,1,0)] = 'Q',
160     [BRLAPI_DOTS(1,1,1,0,1,0,1,0)] = 'R',
161     [BRLAPI_DOTS(0,1,1,1,0,0,1,0)] = 'S',
162     [BRLAPI_DOTS(0,1,1,1,1,0,1,0)] = 'T',
163     [BRLAPI_DOTS(1,0,1,0,0,1,1,0)] = 'U',
164     [BRLAPI_DOTS(1,1,1,0,0,1,1,0)] = 'V',
165     [BRLAPI_DOTS(0,1,0,1,1,1,1,0)] = 'W',
166     [BRLAPI_DOTS(1,0,1,1,0,1,1,0)] = 'X',
167     [BRLAPI_DOTS(1,0,1,1,1,1,1,0)] = 'Y',
168     [BRLAPI_DOTS(1,0,1,0,1,1,1,0)] = 'Z',
169
170     [BRLAPI_DOTS(0,0,1,0,1,1,0,0)] = '0',
171     [BRLAPI_DOTS(0,1,0,0,0,0,0,0)] = '1',
172     [BRLAPI_DOTS(0,1,1,0,0,0,0,0)] = '2',
173     [BRLAPI_DOTS(0,1,0,0,1,0,0,0)] = '3',
174     [BRLAPI_DOTS(0,1,0,0,1,1,0,0)] = '4',
175     [BRLAPI_DOTS(0,1,0,0,0,1,0,0)] = '5',
176     [BRLAPI_DOTS(0,1,1,0,1,0,0,0)] = '6',
177     [BRLAPI_DOTS(0,1,1,0,1,1,0,0)] = '7',
178     [BRLAPI_DOTS(0,1,1,0,0,1,0,0)] = '8',
179     [BRLAPI_DOTS(0,0,1,0,1,0,0,0)] = '9',
180
181     [BRLAPI_DOTS(0,0,0,1,0,1,0,0)] = '.',
182     [BRLAPI_DOTS(0,0,1,1,0,1,0,0)] = '+',
183     [BRLAPI_DOTS(0,0,1,0,0,1,0,0)] = '-',
184     [BRLAPI_DOTS(1,0,0,0,0,1,0,0)] = '*',
185     [BRLAPI_DOTS(0,0,1,1,0,0,0,0)] = '/',
186     [BRLAPI_DOTS(1,1,1,0,1,1,0,0)] = '(',
187     [BRLAPI_DOTS(0,1,1,1,1,1,0,0)] = ')',
188
189     [BRLAPI_DOTS(1,1,1,1,0,1,0,0)] = '&',
190     [BRLAPI_DOTS(0,0,1,1,1,1,0,0)] = '#',
191
192     [BRLAPI_DOTS(0,0,0,0,0,1,0,0)] = ',',
193     [BRLAPI_DOTS(0,0,0,0,1,1,0,0)] = ';',
194     [BRLAPI_DOTS(1,0,0,0,1,1,0,0)] = ':',
195     [BRLAPI_DOTS(0,1,1,1,0,1,0,0)] = '!',
196     [BRLAPI_DOTS(1,0,0,1,1,1,0,0)] = '?',
197     [BRLAPI_DOTS(0,0,0,0,1,0,0,0)] = '"',
198     [BRLAPI_DOTS(0,0,1,0,0,0,0,0)] ='\'',
199     [BRLAPI_DOTS(0,0,0,1,0,0,0,0)] = '`',
200     [BRLAPI_DOTS(0,0,0,1,1,0,1,0)] = '^',
201     [BRLAPI_DOTS(0,0,0,1,1,0,0,0)] = '~',
202     [BRLAPI_DOTS(0,1,0,1,0,1,1,0)] = '[',
203     [BRLAPI_DOTS(1,1,0,1,1,1,1,0)] = ']',
204     [BRLAPI_DOTS(0,1,0,1,0,1,0,0)] = '{',
205     [BRLAPI_DOTS(1,1,0,1,1,1,0,0)] = '}',
206     [BRLAPI_DOTS(1,1,1,1,1,1,0,0)] = '=',
207     [BRLAPI_DOTS(1,1,0,0,0,1,0,0)] = '<',
208     [BRLAPI_DOTS(0,0,1,1,1,0,0,0)] = '>',
209     [BRLAPI_DOTS(1,1,0,1,0,1,0,0)] = '$',
210     [BRLAPI_DOTS(1,0,0,1,0,1,0,0)] = '%',
211     [BRLAPI_DOTS(0,0,0,1,0,0,1,0)] = '@',
212     [BRLAPI_DOTS(1,1,0,0,1,1,0,0)] = '|',
213     [BRLAPI_DOTS(1,1,0,0,1,1,1,0)] ='\\',
214     [BRLAPI_DOTS(0,0,0,1,1,1,0,0)] = '_',
215 };
216
217 /* The serial port can receive more of our data */
218 static void baum_accept_input(struct CharDriverState *chr)
219 {
220     BaumDriverState *baum = chr->opaque;
221     int room, first;
222
223     if (!baum->out_buf_used)
224         return;
225     room = qemu_chr_be_can_write(chr);
226     if (!room)
227         return;
228     if (room > baum->out_buf_used)
229         room = baum->out_buf_used;
230
231     first = BUF_SIZE - baum->out_buf_ptr;
232     if (room > first) {
233         qemu_chr_be_write(chr, baum->out_buf + baum->out_buf_ptr, first);
234         baum->out_buf_ptr = 0;
235         baum->out_buf_used -= first;
236         room -= first;
237     }
238     qemu_chr_be_write(chr, baum->out_buf + baum->out_buf_ptr, room);
239     baum->out_buf_ptr += room;
240     baum->out_buf_used -= room;
241 }
242
243 /* We want to send a packet */
244 static void baum_write_packet(BaumDriverState *baum, const uint8_t *buf, int len)
245 {
246     uint8_t io_buf[1 + 2 * len], *cur = io_buf;
247     int room;
248     *cur++ = ESC;
249     while (len--)
250         if ((*cur++ = *buf++) == ESC)
251             *cur++ = ESC;
252     room = qemu_chr_be_can_write(baum->chr);
253     len = cur - io_buf;
254     if (len <= room) {
255         /* Fits */
256         qemu_chr_be_write(baum->chr, io_buf, len);
257     } else {
258         int first;
259         uint8_t out;
260         /* Can't fit all, send what can be, and store the rest. */
261         qemu_chr_be_write(baum->chr, io_buf, room);
262         len -= room;
263         cur = io_buf + room;
264         if (len > BUF_SIZE - baum->out_buf_used) {
265             /* Can't even store it, drop the previous data... */
266             assert(len <= BUF_SIZE);
267             baum->out_buf_used = 0;
268             baum->out_buf_ptr = 0;
269         }
270         out = baum->out_buf_ptr;
271         baum->out_buf_used += len;
272         first = BUF_SIZE - baum->out_buf_ptr;
273         if (len > first) {
274             memcpy(baum->out_buf + out, cur, first);
275             out = 0;
276             len -= first;
277             cur += first;
278         }
279         memcpy(baum->out_buf + out, cur, len);
280     }
281 }
282
283 /* Called when the other end seems to have a wrong idea of our display size */
284 static void baum_cellCount_timer_cb(void *opaque)
285 {
286     BaumDriverState *baum = opaque;
287     uint8_t cell_count[] = { BAUM_RSP_CellCount, baum->x * baum->y };
288     DPRINTF("Timeout waiting for DisplayData, sending cell count\n");
289     baum_write_packet(baum, cell_count, sizeof(cell_count));
290 }
291
292 /* Try to interpret a whole incoming packet */
293 static int baum_eat_packet(BaumDriverState *baum, const uint8_t *buf, int len)
294 {
295     const uint8_t *cur = buf;
296     uint8_t req = 0;
297
298     if (!len--)
299         return 0;
300     if (*cur++ != ESC) {
301         while (*cur != ESC) {
302             if (!len--)
303                 return 0;
304             cur++;
305         }
306         DPRINTF("Dropped %d bytes!\n", cur - buf);
307     }
308
309 #define EAT(c) do {\
310     if (!len--) \
311         return 0; \
312     if ((c = *cur++) == ESC) { \
313         if (!len--) \
314             return 0; \
315         if (*cur++ != ESC) { \
316             DPRINTF("Broken packet %#2x, tossing\n", req); \
317             if (timer_pending(baum->cellCount_timer)) {    \
318                 timer_del(baum->cellCount_timer);     \
319                 baum_cellCount_timer_cb(baum);             \
320             } \
321             return (cur - 2 - buf); \
322         } \
323     } \
324 } while (0)
325
326     EAT(req);
327     switch (req) {
328     case BAUM_REQ_DisplayData:
329     {
330         uint8_t cells[baum->x * baum->y], c;
331         uint8_t text[baum->x * baum->y];
332         uint8_t zero[baum->x * baum->y];
333         int cursor = BRLAPI_CURSOR_OFF;
334         int i;
335
336         /* Allow 100ms to complete the DisplayData packet */
337         timer_mod(baum->cellCount_timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) +
338                        get_ticks_per_sec() / 10);
339         for (i = 0; i < baum->x * baum->y ; i++) {
340             EAT(c);
341             cells[i] = c;
342             if ((c & (BRLAPI_DOT7|BRLAPI_DOT8))
343                     == (BRLAPI_DOT7|BRLAPI_DOT8)) {
344                 cursor = i + 1;
345                 c &= ~(BRLAPI_DOT7|BRLAPI_DOT8);
346             }
347             if (!(c = nabcc_translation[c]))
348                 c = '?';
349             text[i] = c;
350         }
351         timer_del(baum->cellCount_timer);
352
353         memset(zero, 0, sizeof(zero));
354
355         brlapi_writeArguments_t wa = {
356             .displayNumber = BRLAPI_DISPLAY_DEFAULT,
357             .regionBegin = 1,
358             .regionSize = baum->x * baum->y,
359             .text = (char *)text,
360             .textSize = baum->x * baum->y,
361             .andMask = zero,
362             .orMask = cells,
363             .cursor = cursor,
364             .charset = (char *)"ISO-8859-1",
365         };
366
367         if (brlapi__write(baum->brlapi, &wa) == -1)
368             brlapi_perror("baum brlapi_write");
369         break;
370     }
371     case BAUM_REQ_SetMode:
372     {
373         uint8_t mode, setting;
374         DPRINTF("SetMode\n");
375         EAT(mode);
376         EAT(setting);
377         /* ignore */
378         break;
379     }
380     case BAUM_REQ_SetProtocol:
381     {
382         uint8_t protocol;
383         DPRINTF("SetProtocol\n");
384         EAT(protocol);
385         /* ignore */
386         break;
387     }
388     case BAUM_REQ_GetDeviceIdentity:
389     {
390         uint8_t identity[17] = { BAUM_RSP_DeviceIdentity,
391             'B','a','u','m',' ','V','a','r','i','o' };
392         DPRINTF("GetDeviceIdentity\n");
393         identity[11] = '0' + baum->x / 10;
394         identity[12] = '0' + baum->x % 10;
395         baum_write_packet(baum, identity, sizeof(identity));
396         break;
397     }
398     case BAUM_REQ_GetVersionNumber:
399     {
400         uint8_t version[] = { BAUM_RSP_VersionNumber, 1 }; /* ? */
401         DPRINTF("GetVersionNumber\n");
402         baum_write_packet(baum, version, sizeof(version));
403         break;
404     }
405     case BAUM_REQ_GetSerialNumber:
406     {
407         uint8_t serial[] = { BAUM_RSP_SerialNumber,
408             '0','0','0','0','0','0','0','0' };
409         DPRINTF("GetSerialNumber\n");
410         baum_write_packet(baum, serial, sizeof(serial));
411         break;
412     }
413     case BAUM_REQ_GetKeys:
414     {
415         DPRINTF("Get%0#2x\n", req);
416         /* ignore */
417         break;
418     }
419     default:
420         DPRINTF("unrecognized request %0#2x\n", req);
421         do
422             if (!len--)
423                 return 0;
424         while (*cur++ != ESC);
425         cur--;
426         break;
427     }
428     return cur - buf;
429 }
430
431 /* The other end is writing some data.  Store it and try to interpret */
432 static int baum_write(CharDriverState *chr, const uint8_t *buf, int len)
433 {
434     BaumDriverState *baum = chr->opaque;
435     int tocopy, cur, eaten, orig_len = len;
436
437     if (!len)
438         return 0;
439     if (!baum->brlapi)
440         return len;
441
442     while (len) {
443         /* Complete our buffer as much as possible */
444         tocopy = len;
445         if (tocopy > BUF_SIZE - baum->in_buf_used)
446             tocopy = BUF_SIZE - baum->in_buf_used;
447
448         memcpy(baum->in_buf + baum->in_buf_used, buf, tocopy);
449         baum->in_buf_used += tocopy;
450         buf += tocopy;
451         len -= tocopy;
452
453         /* Interpret it as much as possible */
454         cur = 0;
455         while (cur < baum->in_buf_used &&
456                 (eaten = baum_eat_packet(baum, baum->in_buf + cur, baum->in_buf_used - cur)))
457             cur += eaten;
458
459         /* Shift the remainder */
460         if (cur) {
461             memmove(baum->in_buf, baum->in_buf + cur, baum->in_buf_used - cur);
462             baum->in_buf_used -= cur;
463         }
464
465         /* And continue if any data left */
466     }
467     return orig_len;
468 }
469
470 /* Send the key code to the other end */
471 static void baum_send_key(BaumDriverState *baum, uint8_t type, uint8_t value) {
472     uint8_t packet[] = { type, value };
473     DPRINTF("writing key %x %x\n", type, value);
474     baum_write_packet(baum, packet, sizeof(packet));
475 }
476
477 /* We got some data on the BrlAPI socket */
478 static void baum_chr_read(void *opaque)
479 {
480     BaumDriverState *baum = opaque;
481     brlapi_keyCode_t code;
482     int ret;
483     if (!baum->brlapi)
484         return;
485     while ((ret = brlapi__readKey(baum->brlapi, 0, &code)) == 1) {
486         DPRINTF("got key %"BRLAPI_PRIxKEYCODE"\n", code);
487         /* Emulate */
488         switch (code & BRLAPI_KEY_TYPE_MASK) {
489         case BRLAPI_KEY_TYPE_CMD:
490             switch (code & BRLAPI_KEY_CMD_BLK_MASK) {
491             case BRLAPI_KEY_CMD_ROUTE:
492                 baum_send_key(baum, BAUM_RSP_RoutingKey, (code & BRLAPI_KEY_CMD_ARG_MASK)+1);
493                 baum_send_key(baum, BAUM_RSP_RoutingKey, 0);
494                 break;
495             case 0:
496                 switch (code & BRLAPI_KEY_CMD_ARG_MASK) {
497                 case BRLAPI_KEY_CMD_FWINLT:
498                     baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2);
499                     baum_send_key(baum, BAUM_RSP_TopKeys, 0);
500                     break;
501                 case BRLAPI_KEY_CMD_FWINRT:
502                     baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TR2);
503                     baum_send_key(baum, BAUM_RSP_TopKeys, 0);
504                     break;
505                 case BRLAPI_KEY_CMD_LNUP:
506                     baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TR1);
507                     baum_send_key(baum, BAUM_RSP_TopKeys, 0);
508                     break;
509                 case BRLAPI_KEY_CMD_LNDN:
510                     baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TR3);
511                     baum_send_key(baum, BAUM_RSP_TopKeys, 0);
512                     break;
513                 case BRLAPI_KEY_CMD_TOP:
514                     baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL1|BAUM_TR1);
515                     baum_send_key(baum, BAUM_RSP_TopKeys, 0);
516                     break;
517                 case BRLAPI_KEY_CMD_BOT:
518                     baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL3|BAUM_TR3);
519                     baum_send_key(baum, BAUM_RSP_TopKeys, 0);
520                     break;
521                 case BRLAPI_KEY_CMD_TOP_LEFT:
522                     baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2|BAUM_TR1);
523                     baum_send_key(baum, BAUM_RSP_TopKeys, 0);
524                     break;
525                 case BRLAPI_KEY_CMD_BOT_LEFT:
526                     baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2|BAUM_TR3);
527                     baum_send_key(baum, BAUM_RSP_TopKeys, 0);
528                     break;
529                 case BRLAPI_KEY_CMD_HOME:
530                     baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2|BAUM_TR1|BAUM_TR3);
531                     baum_send_key(baum, BAUM_RSP_TopKeys, 0);
532                     break;
533                 case BRLAPI_KEY_CMD_PREFMENU:
534                     baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL1|BAUM_TL3|BAUM_TR1);
535                     baum_send_key(baum, BAUM_RSP_TopKeys, 0);
536                     break;
537                 }
538             }
539             break;
540         case BRLAPI_KEY_TYPE_SYM:
541             break;
542         }
543     }
544     if (ret == -1 && (brlapi_errno != BRLAPI_ERROR_LIBCERR || errno != EINTR)) {
545         brlapi_perror("baum: brlapi_readKey");
546         brlapi__closeConnection(baum->brlapi);
547         g_free(baum->brlapi);
548         baum->brlapi = NULL;
549     }
550 }
551
552 static void baum_close(struct CharDriverState *chr)
553 {
554     BaumDriverState *baum = chr->opaque;
555
556     timer_free(baum->cellCount_timer);
557     if (baum->brlapi) {
558         brlapi__closeConnection(baum->brlapi);
559         g_free(baum->brlapi);
560     }
561     g_free(baum);
562 }
563
564 CharDriverState *chr_baum_init(void)
565 {
566     BaumDriverState *baum;
567     CharDriverState *chr;
568     brlapi_handle_t *handle;
569 #if defined(CONFIG_SDL)
570 #if SDL_COMPILEDVERSION < SDL_VERSIONNUM(2, 0, 0)
571     SDL_SysWMinfo info;
572 #endif
573 #endif
574     int tty;
575
576     baum = g_malloc0(sizeof(BaumDriverState));
577     baum->chr = chr = qemu_chr_alloc();
578
579     chr->opaque = baum;
580     chr->chr_write = baum_write;
581     chr->chr_accept_input = baum_accept_input;
582     chr->chr_close = baum_close;
583
584     handle = g_malloc0(brlapi_getHandleSize());
585     baum->brlapi = handle;
586
587     baum->brlapi_fd = brlapi__openConnection(handle, NULL, NULL);
588     if (baum->brlapi_fd == -1) {
589         brlapi_perror("baum_init: brlapi_openConnection");
590         goto fail_handle;
591     }
592
593     baum->cellCount_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, baum_cellCount_timer_cb, baum);
594
595     if (brlapi__getDisplaySize(handle, &baum->x, &baum->y) == -1) {
596         brlapi_perror("baum_init: brlapi_getDisplaySize");
597         goto fail;
598     }
599
600 #if defined(CONFIG_SDL)
601 #if SDL_COMPILEDVERSION < SDL_VERSIONNUM(2, 0, 0)
602     memset(&info, 0, sizeof(info));
603     SDL_VERSION(&info.version);
604     if (SDL_GetWMInfo(&info))
605         tty = info.info.x11.wmwindow;
606     else
607 #endif
608 #endif
609         tty = BRLAPI_TTY_DEFAULT;
610
611     if (brlapi__enterTtyMode(handle, tty, NULL) == -1) {
612         brlapi_perror("baum_init: brlapi_enterTtyMode");
613         goto fail;
614     }
615
616     qemu_set_fd_handler(baum->brlapi_fd, baum_chr_read, NULL, baum);
617
618     return chr;
619
620 fail:
621     timer_free(baum->cellCount_timer);
622     brlapi__closeConnection(handle);
623 fail_handle:
624     g_free(handle);
625     g_free(chr);
626     g_free(baum);
627     return NULL;
628 }
629
630 static void register_types(void)
631 {
632     register_char_driver("braille", CHARDEV_BACKEND_KIND_BRAILLE, NULL);
633 }
634
635 type_init(register_types);