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