qemu

1
/*
2
 * QEMU Baum Braille Device
3
 *
4
 * Copyright (c) 2008, 2010-2011, 2016-2017 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

25
#include "qemu/osdep.h"
26
#include "qapi/error.h"
27
#include "chardev/char.h"
28
#include "qemu/main-loop.h"
29
#include "qemu/module.h"
30
#include "qemu/timer.h"
31
#include "hw/usb.h"
32
#include "ui/console.h"
33
#include <brlapi.h>
34
#include <brlapi_constants.h>
35
#include <brlapi_keycodes.h>
36
#include "qom/object.h"
37

38
#if 0
39
#define DPRINTF(fmt, ...) \
40
        printf(fmt, ## __VA_ARGS__)
41
#else
42
#define DPRINTF(fmt, ...)
43
#endif
44

45
#define ESC 0x1B
46

47
#define BAUM_REQ_DisplayData            0x01
48
#define BAUM_REQ_GetVersionNumber       0x05
49
#define BAUM_REQ_GetKeys                0x08
50
#define BAUM_REQ_SetMode                0x12
51
#define BAUM_REQ_SetProtocol            0x15
52
#define BAUM_REQ_GetDeviceIdentity      0x84
53
#define BAUM_REQ_GetSerialNumber        0x8A
54

55
#define BAUM_RSP_CellCount              0x01
56
#define BAUM_RSP_VersionNumber          0x05
57
#define BAUM_RSP_ModeSetting            0x11
58
#define BAUM_RSP_CommunicationChannel   0x16
59
#define BAUM_RSP_PowerdownSignal        0x17
60
#define BAUM_RSP_HorizontalSensors      0x20
61
#define BAUM_RSP_VerticalSensors        0x21
62
#define BAUM_RSP_RoutingKeys            0x22
63
#define BAUM_RSP_Switches               0x23
64
#define BAUM_RSP_TopKeys                0x24
65
#define BAUM_RSP_HorizontalSensor       0x25
66
#define BAUM_RSP_VerticalSensor         0x26
67
#define BAUM_RSP_RoutingKey             0x27
68
#define BAUM_RSP_FrontKeys6             0x28
69
#define BAUM_RSP_BackKeys6              0x29
70
#define BAUM_RSP_CommandKeys            0x2B
71
#define BAUM_RSP_FrontKeys10            0x2C
72
#define BAUM_RSP_BackKeys10             0x2D
73
#define BAUM_RSP_EntryKeys              0x33
74
#define BAUM_RSP_JoyStick               0x34
75
#define BAUM_RSP_ErrorCode              0x40
76
#define BAUM_RSP_InfoBlock              0x42
77
#define BAUM_RSP_DeviceIdentity         0x84
78
#define BAUM_RSP_SerialNumber           0x8A
79
#define BAUM_RSP_BluetoothName          0x8C
80

81
#define BAUM_TL1 0x01
82
#define BAUM_TL2 0x02
83
#define BAUM_TL3 0x04
84
#define BAUM_TR1 0x08
85
#define BAUM_TR2 0x10
86
#define BAUM_TR3 0x20
87

88
#define BUF_SIZE 256
89

90
#define X_MAX   84
91
#define Y_MAX   1
92

93
struct BaumChardev {
94
    Chardev parent;
95

96
    brlapi_handle_t *brlapi;
97
    int brlapi_fd;
98
    unsigned int x, y;
99
    bool deferred_init;
100

101
    uint8_t in_buf[BUF_SIZE];
102
    uint8_t in_buf_used;
103
    uint8_t out_buf[BUF_SIZE];
104
    uint8_t out_buf_used, out_buf_ptr;
105

106
    QEMUTimer *cellCount_timer;
107
};
108
typedef struct BaumChardev BaumChardev;
109

110
#define TYPE_CHARDEV_BRAILLE "chardev-braille"
111
DECLARE_INSTANCE_CHECKER(BaumChardev, BAUM_CHARDEV,
112
                         TYPE_CHARDEV_BRAILLE)
113

114
/* Let's assume NABCC by default */
115
enum way {
116
    DOTS2ASCII,
117
    ASCII2DOTS
118
};
119
static const uint8_t nabcc_translation[2][256] = {
120
#ifndef BRLAPI_DOTS
121
#define BRLAPI_DOTS(d1,d2,d3,d4,d5,d6,d7,d8) \
122
    ((d1?BRLAPI_DOT1:0)|\
123
     (d2?BRLAPI_DOT2:0)|\
124
     (d3?BRLAPI_DOT3:0)|\
125
     (d4?BRLAPI_DOT4:0)|\
126
     (d5?BRLAPI_DOT5:0)|\
127
     (d6?BRLAPI_DOT6:0)|\
128
     (d7?BRLAPI_DOT7:0)|\
129
     (d8?BRLAPI_DOT8:0))
130
#endif
131
#define DO(dots, ascii) \
132
    [DOTS2ASCII][dots] = ascii, \
133
    [ASCII2DOTS][ascii] = dots
134
    DO(0, ' '),
135
    DO(BRLAPI_DOTS(1, 0, 0, 0, 0, 0, 0, 0), 'a'),
136
    DO(BRLAPI_DOTS(1, 1, 0, 0, 0, 0, 0, 0), 'b'),
137
    DO(BRLAPI_DOTS(1, 0, 0, 1, 0, 0, 0, 0), 'c'),
138
    DO(BRLAPI_DOTS(1, 0, 0, 1, 1, 0, 0, 0), 'd'),
139
    DO(BRLAPI_DOTS(1, 0, 0, 0, 1, 0, 0, 0), 'e'),
140
    DO(BRLAPI_DOTS(1, 1, 0, 1, 0, 0, 0, 0), 'f'),
141
    DO(BRLAPI_DOTS(1, 1, 0, 1, 1, 0, 0, 0), 'g'),
142
    DO(BRLAPI_DOTS(1, 1, 0, 0, 1, 0, 0, 0), 'h'),
143
    DO(BRLAPI_DOTS(0, 1, 0, 1, 0, 0, 0, 0), 'i'),
144
    DO(BRLAPI_DOTS(0, 1, 0, 1, 1, 0, 0, 0), 'j'),
145
    DO(BRLAPI_DOTS(1, 0, 1, 0, 0, 0, 0, 0), 'k'),
146
    DO(BRLAPI_DOTS(1, 1, 1, 0, 0, 0, 0, 0), 'l'),
147
    DO(BRLAPI_DOTS(1, 0, 1, 1, 0, 0, 0, 0), 'm'),
148
    DO(BRLAPI_DOTS(1, 0, 1, 1, 1, 0, 0, 0), 'n'),
149
    DO(BRLAPI_DOTS(1, 0, 1, 0, 1, 0, 0, 0), 'o'),
150
    DO(BRLAPI_DOTS(1, 1, 1, 1, 0, 0, 0, 0), 'p'),
151
    DO(BRLAPI_DOTS(1, 1, 1, 1, 1, 0, 0, 0), 'q'),
152
    DO(BRLAPI_DOTS(1, 1, 1, 0, 1, 0, 0, 0), 'r'),
153
    DO(BRLAPI_DOTS(0, 1, 1, 1, 0, 0, 0, 0), 's'),
154
    DO(BRLAPI_DOTS(0, 1, 1, 1, 1, 0, 0, 0), 't'),
155
    DO(BRLAPI_DOTS(1, 0, 1, 0, 0, 1, 0, 0), 'u'),
156
    DO(BRLAPI_DOTS(1, 1, 1, 0, 0, 1, 0, 0), 'v'),
157
    DO(BRLAPI_DOTS(0, 1, 0, 1, 1, 1, 0, 0), 'w'),
158
    DO(BRLAPI_DOTS(1, 0, 1, 1, 0, 1, 0, 0), 'x'),
159
    DO(BRLAPI_DOTS(1, 0, 1, 1, 1, 1, 0, 0), 'y'),
160
    DO(BRLAPI_DOTS(1, 0, 1, 0, 1, 1, 0, 0), 'z'),
161

162
    DO(BRLAPI_DOTS(1, 0, 0, 0, 0, 0, 1, 0), 'A'),
163
    DO(BRLAPI_DOTS(1, 1, 0, 0, 0, 0, 1, 0), 'B'),
164
    DO(BRLAPI_DOTS(1, 0, 0, 1, 0, 0, 1, 0), 'C'),
165
    DO(BRLAPI_DOTS(1, 0, 0, 1, 1, 0, 1, 0), 'D'),
166
    DO(BRLAPI_DOTS(1, 0, 0, 0, 1, 0, 1, 0), 'E'),
167
    DO(BRLAPI_DOTS(1, 1, 0, 1, 0, 0, 1, 0), 'F'),
168
    DO(BRLAPI_DOTS(1, 1, 0, 1, 1, 0, 1, 0), 'G'),
169
    DO(BRLAPI_DOTS(1, 1, 0, 0, 1, 0, 1, 0), 'H'),
170
    DO(BRLAPI_DOTS(0, 1, 0, 1, 0, 0, 1, 0), 'I'),
171
    DO(BRLAPI_DOTS(0, 1, 0, 1, 1, 0, 1, 0), 'J'),
172
    DO(BRLAPI_DOTS(1, 0, 1, 0, 0, 0, 1, 0), 'K'),
173
    DO(BRLAPI_DOTS(1, 1, 1, 0, 0, 0, 1, 0), 'L'),
174
    DO(BRLAPI_DOTS(1, 0, 1, 1, 0, 0, 1, 0), 'M'),
175
    DO(BRLAPI_DOTS(1, 0, 1, 1, 1, 0, 1, 0), 'N'),
176
    DO(BRLAPI_DOTS(1, 0, 1, 0, 1, 0, 1, 0), 'O'),
177
    DO(BRLAPI_DOTS(1, 1, 1, 1, 0, 0, 1, 0), 'P'),
178
    DO(BRLAPI_DOTS(1, 1, 1, 1, 1, 0, 1, 0), 'Q'),
179
    DO(BRLAPI_DOTS(1, 1, 1, 0, 1, 0, 1, 0), 'R'),
180
    DO(BRLAPI_DOTS(0, 1, 1, 1, 0, 0, 1, 0), 'S'),
181
    DO(BRLAPI_DOTS(0, 1, 1, 1, 1, 0, 1, 0), 'T'),
182
    DO(BRLAPI_DOTS(1, 0, 1, 0, 0, 1, 1, 0), 'U'),
183
    DO(BRLAPI_DOTS(1, 1, 1, 0, 0, 1, 1, 0), 'V'),
184
    DO(BRLAPI_DOTS(0, 1, 0, 1, 1, 1, 1, 0), 'W'),
185
    DO(BRLAPI_DOTS(1, 0, 1, 1, 0, 1, 1, 0), 'X'),
186
    DO(BRLAPI_DOTS(1, 0, 1, 1, 1, 1, 1, 0), 'Y'),
187
    DO(BRLAPI_DOTS(1, 0, 1, 0, 1, 1, 1, 0), 'Z'),
188

189
    DO(BRLAPI_DOTS(0, 0, 1, 0, 1, 1, 0, 0), '0'),
190
    DO(BRLAPI_DOTS(0, 1, 0, 0, 0, 0, 0, 0), '1'),
191
    DO(BRLAPI_DOTS(0, 1, 1, 0, 0, 0, 0, 0), '2'),
192
    DO(BRLAPI_DOTS(0, 1, 0, 0, 1, 0, 0, 0), '3'),
193
    DO(BRLAPI_DOTS(0, 1, 0, 0, 1, 1, 0, 0), '4'),
194
    DO(BRLAPI_DOTS(0, 1, 0, 0, 0, 1, 0, 0), '5'),
195
    DO(BRLAPI_DOTS(0, 1, 1, 0, 1, 0, 0, 0), '6'),
196
    DO(BRLAPI_DOTS(0, 1, 1, 0, 1, 1, 0, 0), '7'),
197
    DO(BRLAPI_DOTS(0, 1, 1, 0, 0, 1, 0, 0), '8'),
198
    DO(BRLAPI_DOTS(0, 0, 1, 0, 1, 0, 0, 0), '9'),
199

200
    DO(BRLAPI_DOTS(0, 0, 0, 1, 0, 1, 0, 0), '.'),
201
    DO(BRLAPI_DOTS(0, 0, 1, 1, 0, 1, 0, 0), '+'),
202
    DO(BRLAPI_DOTS(0, 0, 1, 0, 0, 1, 0, 0), '-'),
203
    DO(BRLAPI_DOTS(1, 0, 0, 0, 0, 1, 0, 0), '*'),
204
    DO(BRLAPI_DOTS(0, 0, 1, 1, 0, 0, 0, 0), '/'),
205
    DO(BRLAPI_DOTS(1, 1, 1, 0, 1, 1, 0, 0), '('),
206
    DO(BRLAPI_DOTS(0, 1, 1, 1, 1, 1, 0, 0), ')'),
207

208
    DO(BRLAPI_DOTS(1, 1, 1, 1, 0, 1, 0, 0), '&'),
209
    DO(BRLAPI_DOTS(0, 0, 1, 1, 1, 1, 0, 0), '#'),
210

211
    DO(BRLAPI_DOTS(0, 0, 0, 0, 0, 1, 0, 0), ','),
212
    DO(BRLAPI_DOTS(0, 0, 0, 0, 1, 1, 0, 0), ';'),
213
    DO(BRLAPI_DOTS(1, 0, 0, 0, 1, 1, 0, 0), ':'),
214
    DO(BRLAPI_DOTS(0, 1, 1, 1, 0, 1, 0, 0), '!'),
215
    DO(BRLAPI_DOTS(1, 0, 0, 1, 1, 1, 0, 0), '?'),
216
    DO(BRLAPI_DOTS(0, 0, 0, 0, 1, 0, 0, 0), '"'),
217
    DO(BRLAPI_DOTS(0, 0, 1, 0, 0, 0, 0, 0), '\''),
218
    DO(BRLAPI_DOTS(0, 0, 0, 1, 0, 0, 0, 0), '`'),
219
    DO(BRLAPI_DOTS(0, 0, 0, 1, 1, 0, 1, 0), '^'),
220
    DO(BRLAPI_DOTS(0, 0, 0, 1, 1, 0, 0, 0), '~'),
221
    DO(BRLAPI_DOTS(0, 1, 0, 1, 0, 1, 1, 0), '['),
222
    DO(BRLAPI_DOTS(1, 1, 0, 1, 1, 1, 1, 0), ']'),
223
    DO(BRLAPI_DOTS(0, 1, 0, 1, 0, 1, 0, 0), '{'),
224
    DO(BRLAPI_DOTS(1, 1, 0, 1, 1, 1, 0, 0), '}'),
225
    DO(BRLAPI_DOTS(1, 1, 1, 1, 1, 1, 0, 0), '='),
226
    DO(BRLAPI_DOTS(1, 1, 0, 0, 0, 1, 0, 0), '<'),
227
    DO(BRLAPI_DOTS(0, 0, 1, 1, 1, 0, 0, 0), '>'),
228
    DO(BRLAPI_DOTS(1, 1, 0, 1, 0, 1, 0, 0), '$'),
229
    DO(BRLAPI_DOTS(1, 0, 0, 1, 0, 1, 0, 0), '%'),
230
    DO(BRLAPI_DOTS(0, 0, 0, 1, 0, 0, 1, 0), '@'),
231
    DO(BRLAPI_DOTS(1, 1, 0, 0, 1, 1, 0, 0), '|'),
232
    DO(BRLAPI_DOTS(1, 1, 0, 0, 1, 1, 1, 0), '\\'),
233
    DO(BRLAPI_DOTS(0, 0, 0, 1, 1, 1, 0, 0), '_'),
234
};
235

236
/* The guest OS has started discussing with us, finish initializing BrlAPI */
237
static int baum_deferred_init(BaumChardev *baum)
238
{
239
    int tty = BRLAPI_TTY_DEFAULT;
240
    QemuConsole *con;
241

242
    if (baum->deferred_init) {
243
        return 1;
244
    }
245

246
    if (brlapi__getDisplaySize(baum->brlapi, &baum->x, &baum->y) == -1) {
247
        brlapi_perror("baum: brlapi__getDisplaySize");
248
        return 0;
249
    }
250
    if (baum->y > Y_MAX) {
251
        baum->y = Y_MAX;
252
    }
253
    if (baum->x > X_MAX) {
254
        baum->x = X_MAX;
255
    }
256

257
    con = qemu_console_lookup_by_index(0);
258
    if (con && qemu_console_is_graphic(con)) {
259
        tty = qemu_console_get_window_id(con);
260
        if (tty == -1)
261
            tty = BRLAPI_TTY_DEFAULT;
262
    }
263

264
    if (brlapi__enterTtyMode(baum->brlapi, tty, NULL) == -1) {
265
        brlapi_perror("baum: brlapi__enterTtyMode");
266
        return 0;
267
    }
268
    baum->deferred_init = 1;
269
    return 1;
270
}
271

272
/* The serial port can receive more of our data */
273
static void baum_chr_accept_input(struct Chardev *chr)
274
{
275
    BaumChardev *baum = BAUM_CHARDEV(chr);
276
    int room, first;
277

278
    if (!baum->out_buf_used)
279
        return;
280
    room = qemu_chr_be_can_write(chr);
281
    if (!room)
282
        return;
283
    if (room > baum->out_buf_used)
284
        room = baum->out_buf_used;
285

286
    first = BUF_SIZE - baum->out_buf_ptr;
287
    if (room > first) {
288
        qemu_chr_be_write(chr, baum->out_buf + baum->out_buf_ptr, first);
289
        baum->out_buf_ptr = 0;
290
        baum->out_buf_used -= first;
291
        room -= first;
292
    }
293
    qemu_chr_be_write(chr, baum->out_buf + baum->out_buf_ptr, room);
294
    baum->out_buf_ptr += room;
295
    baum->out_buf_used -= room;
296
}
297

298
/* We want to send a packet */
299
static void baum_write_packet(BaumChardev *baum, const uint8_t *buf, int len)
300
{
301
    Chardev *chr = CHARDEV(baum);
302
    g_autofree uint8_t *io_buf = g_malloc(1 + 2 * len);
303
    uint8_t *cur = io_buf;
304
    int room;
305
    *cur++ = ESC;
306
    while (len--)
307
        if ((*cur++ = *buf++) == ESC)
308
            *cur++ = ESC;
309
    room = qemu_chr_be_can_write(chr);
310
    len = cur - io_buf;
311
    if (len <= room) {
312
        /* Fits */
313
        qemu_chr_be_write(chr, io_buf, len);
314
    } else {
315
        int first;
316
        uint8_t out;
317
        /* Can't fit all, send what can be, and store the rest. */
318
        qemu_chr_be_write(chr, io_buf, room);
319
        len -= room;
320
        cur = io_buf + room;
321
        if (len > BUF_SIZE - baum->out_buf_used) {
322
            /* Can't even store it, drop the previous data... */
323
            assert(len <= BUF_SIZE);
324
            baum->out_buf_used = 0;
325
            baum->out_buf_ptr = 0;
326
        }
327
        out = baum->out_buf_ptr;
328
        baum->out_buf_used += len;
329
        first = BUF_SIZE - baum->out_buf_ptr;
330
        if (len > first) {
331
            memcpy(baum->out_buf + out, cur, first);
332
            out = 0;
333
            len -= first;
334
            cur += first;
335
        }
336
        memcpy(baum->out_buf + out, cur, len);
337
    }
338
}
339

340
/* Called when the other end seems to have a wrong idea of our display size */
341
static void baum_cellCount_timer_cb(void *opaque)
342
{
343
    BaumChardev *baum = BAUM_CHARDEV(opaque);
344
    uint8_t cell_count[] = { BAUM_RSP_CellCount, baum->x * baum->y };
345
    DPRINTF("Timeout waiting for DisplayData, sending cell count\n");
346
    baum_write_packet(baum, cell_count, sizeof(cell_count));
347
}
348

349
/* Try to interpret a whole incoming packet */
350
static int baum_eat_packet(BaumChardev *baum, const uint8_t *buf, int len)
351
{
352
    const uint8_t *cur = buf;
353
    uint8_t req = 0;
354

355
    if (!len--)
356
        return 0;
357
    if (*cur++ != ESC) {
358
        while (*cur != ESC) {
359
            if (!len--)
360
                return 0;
361
            cur++;
362
        }
363
        DPRINTF("Dropped %td bytes!\n", cur - buf);
364
    }
365

366
#define EAT(c) do {\
367
    if (!len--) \
368
        return 0; \
369
    if ((c = *cur++) == ESC) { \
370
        if (!len--) \
371
            return 0; \
372
        if (*cur++ != ESC) { \
373
            DPRINTF("Broken packet %#2x, tossing\n", req); \
374
            if (timer_pending(baum->cellCount_timer)) {    \
375
                timer_del(baum->cellCount_timer);     \
376
                baum_cellCount_timer_cb(baum);             \
377
            } \
378
            return (cur - 2 - buf); \
379
        } \
380
    } \
381
} while (0)
382

383
    EAT(req);
384
    switch (req) {
385
    case BAUM_REQ_DisplayData:
386
    {
387
        uint8_t cells[X_MAX * Y_MAX], c;
388
        uint8_t text[X_MAX * Y_MAX];
389
        uint8_t zero[X_MAX * Y_MAX];
390
        int cursor = BRLAPI_CURSOR_OFF;
391
        int i;
392

393
        /* Allow 100ms to complete the DisplayData packet */
394
        timer_mod(baum->cellCount_timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) +
395
                       NANOSECONDS_PER_SECOND / 10);
396
        for (i = 0; i < baum->x * baum->y ; i++) {
397
            EAT(c);
398
            cells[i] = c;
399
            if ((c & (BRLAPI_DOT7|BRLAPI_DOT8))
400
                    == (BRLAPI_DOT7|BRLAPI_DOT8)) {
401
                cursor = i + 1;
402
                c &= ~(BRLAPI_DOT7|BRLAPI_DOT8);
403
            }
404
            c = nabcc_translation[DOTS2ASCII][c];
405
            if (!c) {
406
                c = '?';
407
            }
408
            text[i] = c;
409
        }
410
        timer_del(baum->cellCount_timer);
411

412
        memset(zero, 0, baum->x * baum->y);
413

414
        brlapi_writeArguments_t wa = {
415
            .displayNumber = BRLAPI_DISPLAY_DEFAULT,
416
            .regionBegin = 1,
417
            .regionSize = baum->x * baum->y,
418
            .text = (char *)text,
419
            .textSize = baum->x * baum->y,
420
            .andMask = zero,
421
            .orMask = cells,
422
            .cursor = cursor,
423
            .charset = (char *)"ISO-8859-1",
424
        };
425

426
        if (brlapi__write(baum->brlapi, &wa) == -1)
427
            brlapi_perror("baum brlapi_write");
428
        break;
429
    }
430
    case BAUM_REQ_SetMode:
431
    {
432
        uint8_t mode, setting;
433
        DPRINTF("SetMode\n");
434
        EAT(mode);
435
        EAT(setting);
436
        /* ignore */
437
        break;
438
    }
439
    case BAUM_REQ_SetProtocol:
440
    {
441
        uint8_t protocol;
442
        DPRINTF("SetProtocol\n");
443
        EAT(protocol);
444
        /* ignore */
445
        break;
446
    }
447
    case BAUM_REQ_GetDeviceIdentity:
448
    {
449
        uint8_t identity[17] = { BAUM_RSP_DeviceIdentity,
450
            'B','a','u','m',' ','V','a','r','i','o' };
451
        DPRINTF("GetDeviceIdentity\n");
452
        identity[11] = '0' + baum->x / 10;
453
        identity[12] = '0' + baum->x % 10;
454
        baum_write_packet(baum, identity, sizeof(identity));
455
        break;
456
    }
457
    case BAUM_REQ_GetVersionNumber:
458
    {
459
        uint8_t version[] = { BAUM_RSP_VersionNumber, 1 }; /* ? */
460
        DPRINTF("GetVersionNumber\n");
461
        baum_write_packet(baum, version, sizeof(version));
462
        break;
463
    }
464
    case BAUM_REQ_GetSerialNumber:
465
    {
466
        uint8_t serial[] = { BAUM_RSP_SerialNumber,
467
            '0','0','0','0','0','0','0','0' };
468
        DPRINTF("GetSerialNumber\n");
469
        baum_write_packet(baum, serial, sizeof(serial));
470
        break;
471
    }
472
    case BAUM_REQ_GetKeys:
473
    {
474
        DPRINTF("Get%0#2x\n", req);
475
        /* ignore */
476
        break;
477
    }
478
    default:
479
        DPRINTF("unrecognized request %0#2x\n", req);
480
        do
481
            if (!len--)
482
                return 0;
483
        while (*cur++ != ESC);
484
        cur--;
485
        break;
486
    }
487
    return cur - buf;
488
}
489

490
/* The other end is writing some data.  Store it and try to interpret */
491
static int baum_chr_write(Chardev *chr, const uint8_t *buf, int len)
492
{
493
    BaumChardev *baum = BAUM_CHARDEV(chr);
494
    int tocopy, cur, eaten, orig_len = len;
495

496
    if (!len)
497
        return 0;
498
    if (!baum->brlapi)
499
        return len;
500
    if (!baum_deferred_init(baum))
501
        return len;
502

503
    while (len) {
504
        /* Complete our buffer as much as possible */
505
        tocopy = len;
506
        if (tocopy > BUF_SIZE - baum->in_buf_used)
507
            tocopy = BUF_SIZE - baum->in_buf_used;
508

509
        memcpy(baum->in_buf + baum->in_buf_used, buf, tocopy);
510
        baum->in_buf_used += tocopy;
511
        buf += tocopy;
512
        len -= tocopy;
513

514
        /* Interpret it as much as possible */
515
        cur = 0;
516
        while (cur < baum->in_buf_used &&
517
                (eaten = baum_eat_packet(baum, baum->in_buf + cur, baum->in_buf_used - cur)))
518
            cur += eaten;
519

520
        /* Shift the remainder */
521
        if (cur) {
522
            memmove(baum->in_buf, baum->in_buf + cur, baum->in_buf_used - cur);
523
            baum->in_buf_used -= cur;
524
        }
525

526
        /* And continue if any data left */
527
    }
528
    return orig_len;
529
}
530

531
/* Send the key code to the other end */
532
static void baum_send_key(BaumChardev *baum, uint8_t type, uint8_t value)
533
{
534
    uint8_t packet[] = { type, value };
535
    DPRINTF("writing key %x %x\n", type, value);
536
    baum_write_packet(baum, packet, sizeof(packet));
537
}
538

539
static void baum_send_key2(BaumChardev *baum, uint8_t type, uint8_t value,
540
                           uint8_t value2)
541
{
542
    uint8_t packet[] = { type, value, value2 };
543
    DPRINTF("writing key %x %x\n", type, value);
544
    baum_write_packet(baum, packet, sizeof(packet));
545
}
546

547
/* We got some data on the BrlAPI socket */
548
static void baum_chr_read(void *opaque)
549
{
550
    BaumChardev *baum = BAUM_CHARDEV(opaque);
551
    brlapi_keyCode_t code;
552
    int ret;
553
    if (!baum->brlapi)
554
        return;
555
    if (!baum_deferred_init(baum))
556
        return;
557
    while ((ret = brlapi__readKey(baum->brlapi, 0, &code)) == 1) {
558
        DPRINTF("got key %"BRLAPI_PRIxKEYCODE"\n", code);
559
        /* Emulate */
560
        switch (code & BRLAPI_KEY_TYPE_MASK) {
561
        case BRLAPI_KEY_TYPE_CMD:
562
            switch (code & BRLAPI_KEY_CMD_BLK_MASK) {
563
            case BRLAPI_KEY_CMD_ROUTE:
564
                baum_send_key(baum, BAUM_RSP_RoutingKey, (code & BRLAPI_KEY_CMD_ARG_MASK)+1);
565
                baum_send_key(baum, BAUM_RSP_RoutingKey, 0);
566
                break;
567
            case 0:
568
                switch (code & BRLAPI_KEY_CMD_ARG_MASK) {
569
                case BRLAPI_KEY_CMD_FWINLT:
570
                    baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2);
571
                    baum_send_key(baum, BAUM_RSP_TopKeys, 0);
572
                    break;
573
                case BRLAPI_KEY_CMD_FWINRT:
574
                    baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TR2);
575
                    baum_send_key(baum, BAUM_RSP_TopKeys, 0);
576
                    break;
577
                case BRLAPI_KEY_CMD_LNUP:
578
                    baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TR1);
579
                    baum_send_key(baum, BAUM_RSP_TopKeys, 0);
580
                    break;
581
                case BRLAPI_KEY_CMD_LNDN:
582
                    baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TR3);
583
                    baum_send_key(baum, BAUM_RSP_TopKeys, 0);
584
                    break;
585
                case BRLAPI_KEY_CMD_TOP:
586
                    baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL1|BAUM_TR1);
587
                    baum_send_key(baum, BAUM_RSP_TopKeys, 0);
588
                    break;
589
                case BRLAPI_KEY_CMD_BOT:
590
                    baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL3|BAUM_TR3);
591
                    baum_send_key(baum, BAUM_RSP_TopKeys, 0);
592
                    break;
593
                case BRLAPI_KEY_CMD_TOP_LEFT:
594
                    baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2|BAUM_TR1);
595
                    baum_send_key(baum, BAUM_RSP_TopKeys, 0);
596
                    break;
597
                case BRLAPI_KEY_CMD_BOT_LEFT:
598
                    baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2|BAUM_TR3);
599
                    baum_send_key(baum, BAUM_RSP_TopKeys, 0);
600
                    break;
601
                case BRLAPI_KEY_CMD_HOME:
602
                    baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2|BAUM_TR1|BAUM_TR3);
603
                    baum_send_key(baum, BAUM_RSP_TopKeys, 0);
604
                    break;
605
                case BRLAPI_KEY_CMD_PREFMENU:
606
                    baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL1|BAUM_TL3|BAUM_TR1);
607
                    baum_send_key(baum, BAUM_RSP_TopKeys, 0);
608
                    break;
609
                }
610
            }
611
            break;
612
        case BRLAPI_KEY_TYPE_SYM:
613
            {
614
                brlapi_keyCode_t keysym = code & BRLAPI_KEY_CODE_MASK;
615
                if (keysym < 0x100) {
616
                    uint8_t dots = nabcc_translation[ASCII2DOTS][keysym];
617
                    if (dots) {
618
                        baum_send_key2(baum, BAUM_RSP_EntryKeys, 0, dots);
619
                        baum_send_key2(baum, BAUM_RSP_EntryKeys, 0, 0);
620
                    }
621
                }
622
                break;
623
            }
624
        }
625
    }
626
    if (ret == -1 && (brlapi_errno != BRLAPI_ERROR_LIBCERR || errno != EINTR)) {
627
        brlapi_perror("baum: brlapi_readKey");
628
        brlapi__closeConnection(baum->brlapi);
629
        g_free(baum->brlapi);
630
        baum->brlapi = NULL;
631
    }
632
}
633

634
static void char_braille_finalize(Object *obj)
635
{
636
    BaumChardev *baum = BAUM_CHARDEV(obj);
637

638
    timer_free(baum->cellCount_timer);
639
    if (baum->brlapi) {
640
        brlapi__closeConnection(baum->brlapi);
641
        g_free(baum->brlapi);
642
    }
643
}
644

645
static void baum_chr_open(Chardev *chr,
646
                          ChardevBackend *backend,
647
                          bool *be_opened,
648
                          Error **errp)
649
{
650
    BaumChardev *baum = BAUM_CHARDEV(chr);
651
    brlapi_handle_t *handle;
652

653
    handle = g_malloc0(brlapi_getHandleSize());
654
    baum->brlapi = handle;
655

656
    baum->brlapi_fd = brlapi__openConnection(handle, NULL, NULL);
657
    if (baum->brlapi_fd == -1) {
658
        error_setg(errp, "brlapi__openConnection: %s",
659
                   brlapi_strerror(brlapi_error_location()));
660
        g_free(handle);
661
        baum->brlapi = NULL;
662
        return;
663
    }
664
    baum->deferred_init = 0;
665

666
    baum->cellCount_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, baum_cellCount_timer_cb, baum);
667

668
    qemu_set_fd_handler(baum->brlapi_fd, baum_chr_read, NULL, baum);
669
}
670

671
static void char_braille_class_init(ObjectClass *oc, void *data)
672
{
673
    ChardevClass *cc = CHARDEV_CLASS(oc);
674

675
    cc->open = baum_chr_open;
676
    cc->chr_write = baum_chr_write;
677
    cc->chr_accept_input = baum_chr_accept_input;
678
}
679

680
static const TypeInfo char_braille_type_info = {
681
    .name = TYPE_CHARDEV_BRAILLE,
682
    .parent = TYPE_CHARDEV,
683
    .instance_size = sizeof(BaumChardev),
684
    .instance_finalize = char_braille_finalize,
685
    .class_init = char_braille_class_init,
686
};
687
module_obj(TYPE_CHARDEV_BRAILLE);
688

689
static void register_types(void)
690
{
691
    type_register_static(&char_braille_type_info);
692
}
693

694
type_init(register_types);
695