]> git.proxmox.com Git - mirror_qemu.git/blame - chardev/baum.c
projects / mirror_qemu.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
io: Add support for MSG_PEEK for socket channel
[mirror_qemu.git] / chardev / baum.c
CommitLineData
2e4d9fb1
AJ		 1/*
2 * QEMU Baum Braille Device
3 *
1ef7c96e 4 * Copyright (c) 2008, 2010-2011, 2016-2017 Samuel Thibault
2e4d9fb1
AJ		 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 */
0b8fa32f 24
9c058332 25#include "qemu/osdep.h"
da34e65c 26#include "qapi/error.h"
8228e353 27#include "chardev/char.h"
db725815 28#include "qemu/main-loop.h"
0b8fa32f 29#include "qemu/module.h"
1de7afc9 30#include "qemu/timer.h"
159b6e9f 31#include "hw/usb.h"
f29b3431 32#include "ui/console.h"
2e4d9fb1
AJ		 33#include <brlapi.h>
34#include <brlapi_constants.h>
35#include <brlapi_keycodes.h>
db1015e9 36#include "qom/object.h"
2e4d9fb1
AJ		 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
f63a6e38
PMD		 90#define X_MAX 84
91#define Y_MAX 1
92
db1015e9 93struct BaumChardev {
0ec7b3e7 94 Chardev parent;
2e4d9fb1
AJ		 95
96 brlapi_handle_t *brlapi;
97 int brlapi_fd;
4f72c4dd 98 unsigned int x, y;
cb78d4a1 99 bool deferred_init;
2e4d9fb1
AJ		 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;
db1015e9
EH		 107};
108typedef struct BaumChardev BaumChardev;
2e4d9fb1 109
777357d7 110#define TYPE_CHARDEV_BRAILLE "chardev-braille"
8110fa1d
EH		 111DECLARE_INSTANCE_CHECKER(BaumChardev, BAUM_CHARDEV,
112 TYPE_CHARDEV_BRAILLE)
777357d7 113
2e4d9fb1 114/* Let's assume NABCC by default */
0fb7c882
ST		 115enum way {
116 DOTS2ASCII,
117 ASCII2DOTS
118};
119static const uint8_t nabcc_translation[2][256] = {
2e4d9fb1
AJ		 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
0fb7c882
ST		 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), '_'),
2e4d9fb1
AJ		 234};
235
cb78d4a1 236/* The guest OS has started discussing with us, finish initializing BrlAPI */
0ec7b3e7 237static int baum_deferred_init(BaumChardev *baum)
cb78d4a1 238{
f29b3431
ST		 239 int tty = BRLAPI_TTY_DEFAULT;
240 QemuConsole *con;
cb78d4a1
ST		 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 }
f63a6e38
PMD		 250 if (baum->y > Y_MAX) {
251 baum->y = Y_MAX;
1ef7c96e 252 }
f63a6e38
PMD		 253 if (baum->x > X_MAX) {
254 baum->x = X_MAX;
1ef7c96e 255 }
cb78d4a1 256
f29b3431
ST		 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;
cb78d4a1 262 }
cb78d4a1
ST		 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
2e4d9fb1 272/* The serial port can receive more of our data */
fc6d0b86 273static void baum_chr_accept_input(struct Chardev *chr)
2e4d9fb1 274{
777357d7 275 BaumChardev *baum = BAUM_CHARDEV(chr);
2e4d9fb1
AJ		 276 int room, first;
277
278 if (!baum->out_buf_used)
279 return;
909cda12 280 room = qemu_chr_be_can_write(chr);
2e4d9fb1
AJ		 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) {
fa5efccb 288 qemu_chr_be_write(chr, baum->out_buf + baum->out_buf_ptr, first);
2e4d9fb1
AJ		 289 baum->out_buf_ptr = 0;
290 baum->out_buf_used -= first;
291 room -= first;
292 }
fa5efccb 293 qemu_chr_be_write(chr, baum->out_buf + baum->out_buf_ptr, room);
2e4d9fb1
AJ		 294 baum->out_buf_ptr += room;
295 baum->out_buf_used -= room;
296}
297
298/* We want to send a packet */
0ec7b3e7 299static void baum_write_packet(BaumChardev *baum, const uint8_t *buf, int len)
2e4d9fb1 300{
777357d7 301 Chardev *chr = CHARDEV(baum);
d34977d6
PMD		 302 g_autofree uint8_t *io_buf = g_malloc(1 + 2 * len);
303 uint8_t *cur = io_buf;
2e4d9fb1
AJ		 304 int room;
305 *cur++ = ESC;
306 while (len--)
307 if ((*cur++ = *buf++) == ESC)
308 *cur++ = ESC;
41ac54b2 309 room = qemu_chr_be_can_write(chr);
2e4d9fb1
AJ		 310 len = cur - io_buf;
311 if (len <= room) {
312 /* Fits */
41ac54b2 313 qemu_chr_be_write(chr, io_buf, len);
2e4d9fb1
AJ		 314 } else {
315 int first;
316 uint8_t out;
317 /* Can't fit all, send what can be, and store the rest. */
41ac54b2 318 qemu_chr_be_write(chr, io_buf, room);
2e4d9fb1
AJ		 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 */
341static void baum_cellCount_timer_cb(void *opaque)
342{
777357d7 343 BaumChardev *baum = BAUM_CHARDEV(opaque);
2e4d9fb1
AJ		 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 */
0ec7b3e7 350static int baum_eat_packet(BaumChardev *baum, const uint8_t *buf, int len)
2e4d9fb1
AJ		 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 }
70cbae1d 363 DPRINTF("Dropped %td bytes!\n", cur - buf);
2e4d9fb1
AJ		 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); \
e93379b0 374 if (timer_pending(baum->cellCount_timer)) { \
bc72ad67 375 timer_del(baum->cellCount_timer); \
e93379b0 376 baum_cellCount_timer_cb(baum); \
2e4d9fb1
AJ		 377 } \
378 return (cur - 2 - buf); \
379 } \
380 } \
381} while (0)
382
383 EAT(req);
384 switch (req) {
385 case BAUM_REQ_DisplayData:
386 {
1e3acd33
PMD		 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];
2e4d9fb1
AJ		 390 int cursor = BRLAPI_CURSOR_OFF;
391 int i;
392
393 /* Allow 100ms to complete the DisplayData packet */
bc72ad67 394 timer_mod(baum->cellCount_timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) +
73bcb24d 395 NANOSECONDS_PER_SECOND / 10);
2e4d9fb1
AJ		 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 }
0fb7c882
ST		 404 c = nabcc_translation[DOTS2ASCII][c];
405 if (!c) {
2e4d9fb1 406 c = '?';
0fb7c882 407 }
2e4d9fb1
AJ		 408 text[i] = c;
409 }
bc72ad67 410 timer_del(baum->cellCount_timer);
2e4d9fb1 411
1e3acd33 412 memset(zero, 0, baum->x * baum->y);
2e4d9fb1
AJ		 413
414 brlapi_writeArguments_t wa = {
415 .displayNumber = BRLAPI_DISPLAY_DEFAULT,
416 .regionBegin = 1,
417 .regionSize = baum->x * baum->y,
4f72c4dd 418 .text = (char *)text,
2e4d9fb1
AJ		 419 .textSize = baum->x * baum->y,
420 .andMask = zero,
421 .orMask = cells,
422 .cursor = cursor,
4f72c4dd 423 .charset = (char *)"ISO-8859-1",
2e4d9fb1
AJ		 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 */
fc6d0b86 491static int baum_chr_write(Chardev *chr, const uint8_t *buf, int len)
2e4d9fb1 492{
777357d7 493 BaumChardev *baum = BAUM_CHARDEV(chr);
2e4d9fb1
AJ		 494 int tocopy, cur, eaten, orig_len = len;
495
496 if (!len)
497 return 0;
498 if (!baum->brlapi)
499 return len;
cb78d4a1
ST		 500 if (!baum_deferred_init(baum))
501 return len;
2e4d9fb1
AJ		 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
2e4d9fb1 531/* Send the key code to the other end */
0ec7b3e7
MAL		 532static void baum_send_key(BaumChardev *baum, uint8_t type, uint8_t value)
533{
2e4d9fb1
AJ		 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
0ec7b3e7
MAL		 539static void baum_send_key2(BaumChardev *baum, uint8_t type, uint8_t value,
540 uint8_t value2)
541{
0fb7c882
ST		 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
2e4d9fb1
AJ		 547/* We got some data on the BrlAPI socket */
548static void baum_chr_read(void *opaque)
549{
777357d7 550 BaumChardev *baum = BAUM_CHARDEV(opaque);
2e4d9fb1
AJ		 551 brlapi_keyCode_t code;
552 int ret;
553 if (!baum->brlapi)
554 return;
cb78d4a1
ST		 555 if (!baum_deferred_init(baum))
556 return;
2e4d9fb1
AJ		 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:
0fb7c882
ST		 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 }
2e4d9fb1
AJ		 624 }
625 }
626 if (ret == -1 && (brlapi_errno != BRLAPI_ERROR_LIBCERR || errno != EINTR)) {
627 brlapi_perror("baum: brlapi_readKey");
628 brlapi__closeConnection(baum->brlapi);
7267c094 629 g_free(baum->brlapi);
2e4d9fb1
AJ		 630 baum->brlapi = NULL;
631 }
632}
633
e96ebf49 634static void char_braille_finalize(Object *obj)
2c7faf31 635{
e96ebf49 636 BaumChardev *baum = BAUM_CHARDEV(obj);
2c7faf31 637
bc72ad67 638 timer_free(baum->cellCount_timer);
2c7faf31
ST		 639 if (baum->brlapi) {
640 brlapi__closeConnection(baum->brlapi);
7267c094 641 g_free(baum->brlapi);
2c7faf31 642 }
2c7faf31
ST		 643}
644
777357d7
MAL		 645static void baum_chr_open(Chardev *chr,
646 ChardevBackend *backend,
647 bool *be_opened,
648 Error **errp)
2e4d9fb1 649{
777357d7 650 BaumChardev *baum = BAUM_CHARDEV(chr);
2e4d9fb1 651 brlapi_handle_t *handle;
2e4d9fb1 652
7267c094 653 handle = g_malloc0(brlapi_getHandleSize());
2e4d9fb1
AJ		 654 baum->brlapi = handle;
655
656 baum->brlapi_fd = brlapi__openConnection(handle, NULL, NULL);
657 if (baum->brlapi_fd == -1) {
e47666b8
PB		 658 error_setg(errp, "brlapi__openConnection: %s",
659 brlapi_strerror(brlapi_error_location()));
777357d7 660 g_free(handle);
98e87903 661 baum->brlapi = NULL;
777357d7 662 return;
2e4d9fb1 663 }
cb78d4a1 664 baum->deferred_init = 0;
2e4d9fb1 665
bc72ad67 666 baum->cellCount_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, baum_cellCount_timer_cb, baum);
2e4d9fb1 667
2e4d9fb1 668 qemu_set_fd_handler(baum->brlapi_fd, baum_chr_read, NULL, baum);
777357d7 669}
2e4d9fb1 670
777357d7
MAL		 671static void char_braille_class_init(ObjectClass *oc, void *data)
672{
673 ChardevClass *cc = CHARDEV_CLASS(oc);
2e4d9fb1 674
777357d7
MAL		 675 cc->open = baum_chr_open;
676 cc->chr_write = baum_chr_write;
677 cc->chr_accept_input = baum_chr_accept_input;
2e4d9fb1 678}
08744c98 679
777357d7
MAL		 680static const TypeInfo char_braille_type_info = {
681 .name = TYPE_CHARDEV_BRAILLE,
682 .parent = TYPE_CHARDEV,
683 .instance_size = sizeof(BaumChardev),
e96ebf49 684 .instance_finalize = char_braille_finalize,
777357d7
MAL		 685 .class_init = char_braille_class_init,
686};
882273d9 687module_obj(TYPE_CHARDEV_BRAILLE);
777357d7 688
08744c98
AL		 689static void register_types(void)
690{
777357d7 691 type_register_static(&char_braille_type_info);
08744c98
AL		 692}
693
694type_init(register_types);
QEMU mirror