diff options
author | Marc-André Lureau <marcandre.lureau@redhat.com> | 2017-05-29 12:39:42 +0400 |
---|---|---|
committer | Marc-André Lureau <marcandre.lureau@redhat.com> | 2017-06-02 11:33:53 +0400 |
commit | 6b10e573d15ef82dbc5c5b3726028e6642e134f6 (patch) | |
tree | cb48ec34656eb50c2ec8fcdafc1b0652124caf31 /backends/baum.c | |
parent | 1ce2610c106d925387669b3133fc18ea986f0476 (diff) | |
download | qemu-6b10e573d15ef82dbc5c5b3726028e6642e134f6.zip qemu-6b10e573d15ef82dbc5c5b3726028e6642e134f6.tar.gz qemu-6b10e573d15ef82dbc5c5b3726028e6642e134f6.tar.bz2 |
char: move char devices to chardev/
Suggested by Paolo Bonzini during series review.
Signed-off-by: Marc-André Lureau <marcandre.lureau@redhat.com>
Reviewed-by: Philippe Mathieu-Daudé <f4bug@amsat.org>
Diffstat (limited to 'backends/baum.c')
-rw-r--r-- | backends/baum.c | 677 |
1 files changed, 0 insertions, 677 deletions
diff --git a/backends/baum.c b/backends/baum.c deleted file mode 100644 index 302dd96..0000000 --- a/backends/baum.c +++ /dev/null @@ -1,677 +0,0 @@ -/* - * QEMU Baum Braille Device - * - * Copyright (c) 2008, 2010-2011, 2016 Samuel Thibault - * - * Permission is hereby granted, free of charge, to any person obtaining a copy - * of this software and associated documentation files (the "Software"), to deal - * in the Software without restriction, including without limitation the rights - * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell - * copies of the Software, and to permit persons to whom the Software is - * furnished to do so, subject to the following conditions: - * - * The above copyright notice and this permission notice shall be included in - * all copies or substantial portions of the Software. - * - * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR - * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, - * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL - * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER - * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, - * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN - * THE SOFTWARE. - */ -#include "qemu/osdep.h" -#include "qapi/error.h" -#include "qemu-common.h" -#include "chardev/char.h" -#include "qemu/timer.h" -#include "hw/usb.h" -#include "ui/console.h" -#include <brlapi.h> -#include <brlapi_constants.h> -#include <brlapi_keycodes.h> - -#if 0 -#define DPRINTF(fmt, ...) \ - printf(fmt, ## __VA_ARGS__) -#else -#define DPRINTF(fmt, ...) -#endif - -#define ESC 0x1B - -#define BAUM_REQ_DisplayData 0x01 -#define BAUM_REQ_GetVersionNumber 0x05 -#define BAUM_REQ_GetKeys 0x08 -#define BAUM_REQ_SetMode 0x12 -#define BAUM_REQ_SetProtocol 0x15 -#define BAUM_REQ_GetDeviceIdentity 0x84 -#define BAUM_REQ_GetSerialNumber 0x8A - -#define BAUM_RSP_CellCount 0x01 -#define BAUM_RSP_VersionNumber 0x05 -#define BAUM_RSP_ModeSetting 0x11 -#define BAUM_RSP_CommunicationChannel 0x16 -#define BAUM_RSP_PowerdownSignal 0x17 -#define BAUM_RSP_HorizontalSensors 0x20 -#define BAUM_RSP_VerticalSensors 0x21 -#define BAUM_RSP_RoutingKeys 0x22 -#define BAUM_RSP_Switches 0x23 -#define BAUM_RSP_TopKeys 0x24 -#define BAUM_RSP_HorizontalSensor 0x25 -#define BAUM_RSP_VerticalSensor 0x26 -#define BAUM_RSP_RoutingKey 0x27 -#define BAUM_RSP_FrontKeys6 0x28 -#define BAUM_RSP_BackKeys6 0x29 -#define BAUM_RSP_CommandKeys 0x2B -#define BAUM_RSP_FrontKeys10 0x2C -#define BAUM_RSP_BackKeys10 0x2D -#define BAUM_RSP_EntryKeys 0x33 -#define BAUM_RSP_JoyStick 0x34 -#define BAUM_RSP_ErrorCode 0x40 -#define BAUM_RSP_InfoBlock 0x42 -#define BAUM_RSP_DeviceIdentity 0x84 -#define BAUM_RSP_SerialNumber 0x8A -#define BAUM_RSP_BluetoothName 0x8C - -#define BAUM_TL1 0x01 -#define BAUM_TL2 0x02 -#define BAUM_TL3 0x04 -#define BAUM_TR1 0x08 -#define BAUM_TR2 0x10 -#define BAUM_TR3 0x20 - -#define BUF_SIZE 256 - -typedef struct { - Chardev parent; - - brlapi_handle_t *brlapi; - int brlapi_fd; - unsigned int x, y; - bool deferred_init; - - uint8_t in_buf[BUF_SIZE]; - uint8_t in_buf_used; - uint8_t out_buf[BUF_SIZE]; - uint8_t out_buf_used, out_buf_ptr; - - QEMUTimer *cellCount_timer; -} BaumChardev; - -#define TYPE_CHARDEV_BRAILLE "chardev-braille" -#define BAUM_CHARDEV(obj) OBJECT_CHECK(BaumChardev, (obj), TYPE_CHARDEV_BRAILLE) - -/* Let's assume NABCC by default */ -enum way { - DOTS2ASCII, - ASCII2DOTS -}; -static const uint8_t nabcc_translation[2][256] = { -#ifndef BRLAPI_DOTS -#define BRLAPI_DOTS(d1,d2,d3,d4,d5,d6,d7,d8) \ - ((d1?BRLAPI_DOT1:0)|\ - (d2?BRLAPI_DOT2:0)|\ - (d3?BRLAPI_DOT3:0)|\ - (d4?BRLAPI_DOT4:0)|\ - (d5?BRLAPI_DOT5:0)|\ - (d6?BRLAPI_DOT6:0)|\ - (d7?BRLAPI_DOT7:0)|\ - (d8?BRLAPI_DOT8:0)) -#endif -#define DO(dots, ascii) \ - [DOTS2ASCII][dots] = ascii, \ - [ASCII2DOTS][ascii] = dots - DO(0, ' '), - DO(BRLAPI_DOTS(1, 0, 0, 0, 0, 0, 0, 0), 'a'), - DO(BRLAPI_DOTS(1, 1, 0, 0, 0, 0, 0, 0), 'b'), - DO(BRLAPI_DOTS(1, 0, 0, 1, 0, 0, 0, 0), 'c'), - DO(BRLAPI_DOTS(1, 0, 0, 1, 1, 0, 0, 0), 'd'), - DO(BRLAPI_DOTS(1, 0, 0, 0, 1, 0, 0, 0), 'e'), - DO(BRLAPI_DOTS(1, 1, 0, 1, 0, 0, 0, 0), 'f'), - DO(BRLAPI_DOTS(1, 1, 0, 1, 1, 0, 0, 0), 'g'), - DO(BRLAPI_DOTS(1, 1, 0, 0, 1, 0, 0, 0), 'h'), - DO(BRLAPI_DOTS(0, 1, 0, 1, 0, 0, 0, 0), 'i'), - DO(BRLAPI_DOTS(0, 1, 0, 1, 1, 0, 0, 0), 'j'), - DO(BRLAPI_DOTS(1, 0, 1, 0, 0, 0, 0, 0), 'k'), - DO(BRLAPI_DOTS(1, 1, 1, 0, 0, 0, 0, 0), 'l'), - DO(BRLAPI_DOTS(1, 0, 1, 1, 0, 0, 0, 0), 'm'), - DO(BRLAPI_DOTS(1, 0, 1, 1, 1, 0, 0, 0), 'n'), - DO(BRLAPI_DOTS(1, 0, 1, 0, 1, 0, 0, 0), 'o'), - DO(BRLAPI_DOTS(1, 1, 1, 1, 0, 0, 0, 0), 'p'), - DO(BRLAPI_DOTS(1, 1, 1, 1, 1, 0, 0, 0), 'q'), - DO(BRLAPI_DOTS(1, 1, 1, 0, 1, 0, 0, 0), 'r'), - DO(BRLAPI_DOTS(0, 1, 1, 1, 0, 0, 0, 0), 's'), - DO(BRLAPI_DOTS(0, 1, 1, 1, 1, 0, 0, 0), 't'), - DO(BRLAPI_DOTS(1, 0, 1, 0, 0, 1, 0, 0), 'u'), - DO(BRLAPI_DOTS(1, 1, 1, 0, 0, 1, 0, 0), 'v'), - DO(BRLAPI_DOTS(0, 1, 0, 1, 1, 1, 0, 0), 'w'), - DO(BRLAPI_DOTS(1, 0, 1, 1, 0, 1, 0, 0), 'x'), - DO(BRLAPI_DOTS(1, 0, 1, 1, 1, 1, 0, 0), 'y'), - DO(BRLAPI_DOTS(1, 0, 1, 0, 1, 1, 0, 0), 'z'), - - DO(BRLAPI_DOTS(1, 0, 0, 0, 0, 0, 1, 0), 'A'), - DO(BRLAPI_DOTS(1, 1, 0, 0, 0, 0, 1, 0), 'B'), - DO(BRLAPI_DOTS(1, 0, 0, 1, 0, 0, 1, 0), 'C'), - DO(BRLAPI_DOTS(1, 0, 0, 1, 1, 0, 1, 0), 'D'), - DO(BRLAPI_DOTS(1, 0, 0, 0, 1, 0, 1, 0), 'E'), - DO(BRLAPI_DOTS(1, 1, 0, 1, 0, 0, 1, 0), 'F'), - DO(BRLAPI_DOTS(1, 1, 0, 1, 1, 0, 1, 0), 'G'), - DO(BRLAPI_DOTS(1, 1, 0, 0, 1, 0, 1, 0), 'H'), - DO(BRLAPI_DOTS(0, 1, 0, 1, 0, 0, 1, 0), 'I'), - DO(BRLAPI_DOTS(0, 1, 0, 1, 1, 0, 1, 0), 'J'), - DO(BRLAPI_DOTS(1, 0, 1, 0, 0, 0, 1, 0), 'K'), - DO(BRLAPI_DOTS(1, 1, 1, 0, 0, 0, 1, 0), 'L'), - DO(BRLAPI_DOTS(1, 0, 1, 1, 0, 0, 1, 0), 'M'), - DO(BRLAPI_DOTS(1, 0, 1, 1, 1, 0, 1, 0), 'N'), - DO(BRLAPI_DOTS(1, 0, 1, 0, 1, 0, 1, 0), 'O'), - DO(BRLAPI_DOTS(1, 1, 1, 1, 0, 0, 1, 0), 'P'), - DO(BRLAPI_DOTS(1, 1, 1, 1, 1, 0, 1, 0), 'Q'), - DO(BRLAPI_DOTS(1, 1, 1, 0, 1, 0, 1, 0), 'R'), - DO(BRLAPI_DOTS(0, 1, 1, 1, 0, 0, 1, 0), 'S'), - DO(BRLAPI_DOTS(0, 1, 1, 1, 1, 0, 1, 0), 'T'), - DO(BRLAPI_DOTS(1, 0, 1, 0, 0, 1, 1, 0), 'U'), - DO(BRLAPI_DOTS(1, 1, 1, 0, 0, 1, 1, 0), 'V'), - DO(BRLAPI_DOTS(0, 1, 0, 1, 1, 1, 1, 0), 'W'), - DO(BRLAPI_DOTS(1, 0, 1, 1, 0, 1, 1, 0), 'X'), - DO(BRLAPI_DOTS(1, 0, 1, 1, 1, 1, 1, 0), 'Y'), - DO(BRLAPI_DOTS(1, 0, 1, 0, 1, 1, 1, 0), 'Z'), - - DO(BRLAPI_DOTS(0, 0, 1, 0, 1, 1, 0, 0), '0'), - DO(BRLAPI_DOTS(0, 1, 0, 0, 0, 0, 0, 0), '1'), - DO(BRLAPI_DOTS(0, 1, 1, 0, 0, 0, 0, 0), '2'), - DO(BRLAPI_DOTS(0, 1, 0, 0, 1, 0, 0, 0), '3'), - DO(BRLAPI_DOTS(0, 1, 0, 0, 1, 1, 0, 0), '4'), - DO(BRLAPI_DOTS(0, 1, 0, 0, 0, 1, 0, 0), '5'), - DO(BRLAPI_DOTS(0, 1, 1, 0, 1, 0, 0, 0), '6'), - DO(BRLAPI_DOTS(0, 1, 1, 0, 1, 1, 0, 0), '7'), - DO(BRLAPI_DOTS(0, 1, 1, 0, 0, 1, 0, 0), '8'), - DO(BRLAPI_DOTS(0, 0, 1, 0, 1, 0, 0, 0), '9'), - - DO(BRLAPI_DOTS(0, 0, 0, 1, 0, 1, 0, 0), '.'), - DO(BRLAPI_DOTS(0, 0, 1, 1, 0, 1, 0, 0), '+'), - DO(BRLAPI_DOTS(0, 0, 1, 0, 0, 1, 0, 0), '-'), - DO(BRLAPI_DOTS(1, 0, 0, 0, 0, 1, 0, 0), '*'), - DO(BRLAPI_DOTS(0, 0, 1, 1, 0, 0, 0, 0), '/'), - DO(BRLAPI_DOTS(1, 1, 1, 0, 1, 1, 0, 0), '('), - DO(BRLAPI_DOTS(0, 1, 1, 1, 1, 1, 0, 0), ')'), - - DO(BRLAPI_DOTS(1, 1, 1, 1, 0, 1, 0, 0), '&'), - DO(BRLAPI_DOTS(0, 0, 1, 1, 1, 1, 0, 0), '#'), - - DO(BRLAPI_DOTS(0, 0, 0, 0, 0, 1, 0, 0), ','), - DO(BRLAPI_DOTS(0, 0, 0, 0, 1, 1, 0, 0), ';'), - DO(BRLAPI_DOTS(1, 0, 0, 0, 1, 1, 0, 0), ':'), - DO(BRLAPI_DOTS(0, 1, 1, 1, 0, 1, 0, 0), '!'), - DO(BRLAPI_DOTS(1, 0, 0, 1, 1, 1, 0, 0), '?'), - DO(BRLAPI_DOTS(0, 0, 0, 0, 1, 0, 0, 0), '"'), - DO(BRLAPI_DOTS(0, 0, 1, 0, 0, 0, 0, 0), '\''), - DO(BRLAPI_DOTS(0, 0, 0, 1, 0, 0, 0, 0), '`'), - DO(BRLAPI_DOTS(0, 0, 0, 1, 1, 0, 1, 0), '^'), - DO(BRLAPI_DOTS(0, 0, 0, 1, 1, 0, 0, 0), '~'), - DO(BRLAPI_DOTS(0, 1, 0, 1, 0, 1, 1, 0), '['), - DO(BRLAPI_DOTS(1, 1, 0, 1, 1, 1, 1, 0), ']'), - DO(BRLAPI_DOTS(0, 1, 0, 1, 0, 1, 0, 0), '{'), - DO(BRLAPI_DOTS(1, 1, 0, 1, 1, 1, 0, 0), '}'), - DO(BRLAPI_DOTS(1, 1, 1, 1, 1, 1, 0, 0), '='), - DO(BRLAPI_DOTS(1, 1, 0, 0, 0, 1, 0, 0), '<'), - DO(BRLAPI_DOTS(0, 0, 1, 1, 1, 0, 0, 0), '>'), - DO(BRLAPI_DOTS(1, 1, 0, 1, 0, 1, 0, 0), '$'), - DO(BRLAPI_DOTS(1, 0, 0, 1, 0, 1, 0, 0), '%'), - DO(BRLAPI_DOTS(0, 0, 0, 1, 0, 0, 1, 0), '@'), - DO(BRLAPI_DOTS(1, 1, 0, 0, 1, 1, 0, 0), '|'), - DO(BRLAPI_DOTS(1, 1, 0, 0, 1, 1, 1, 0), '\\'), - DO(BRLAPI_DOTS(0, 0, 0, 1, 1, 1, 0, 0), '_'), -}; - -/* The guest OS has started discussing with us, finish initializing BrlAPI */ -static int baum_deferred_init(BaumChardev *baum) -{ - int tty = BRLAPI_TTY_DEFAULT; - QemuConsole *con; - - if (baum->deferred_init) { - return 1; - } - - if (brlapi__getDisplaySize(baum->brlapi, &baum->x, &baum->y) == -1) { - brlapi_perror("baum: brlapi__getDisplaySize"); - return 0; - } - - con = qemu_console_lookup_by_index(0); - if (con && qemu_console_is_graphic(con)) { - tty = qemu_console_get_window_id(con); - if (tty == -1) - tty = BRLAPI_TTY_DEFAULT; - } - - if (brlapi__enterTtyMode(baum->brlapi, tty, NULL) == -1) { - brlapi_perror("baum: brlapi__enterTtyMode"); - return 0; - } - baum->deferred_init = 1; - return 1; -} - -/* The serial port can receive more of our data */ -static void baum_chr_accept_input(struct Chardev *chr) -{ - BaumChardev *baum = BAUM_CHARDEV(chr); - int room, first; - - if (!baum->out_buf_used) - return; - room = qemu_chr_be_can_write(chr); - if (!room) - return; - if (room > baum->out_buf_used) - room = baum->out_buf_used; - - first = BUF_SIZE - baum->out_buf_ptr; - if (room > first) { - qemu_chr_be_write(chr, baum->out_buf + baum->out_buf_ptr, first); - baum->out_buf_ptr = 0; - baum->out_buf_used -= first; - room -= first; - } - qemu_chr_be_write(chr, baum->out_buf + baum->out_buf_ptr, room); - baum->out_buf_ptr += room; - baum->out_buf_used -= room; -} - -/* We want to send a packet */ -static void baum_write_packet(BaumChardev *baum, const uint8_t *buf, int len) -{ - Chardev *chr = CHARDEV(baum); - uint8_t io_buf[1 + 2 * len], *cur = io_buf; - int room; - *cur++ = ESC; - while (len--) - if ((*cur++ = *buf++) == ESC) - *cur++ = ESC; - room = qemu_chr_be_can_write(chr); - len = cur - io_buf; - if (len <= room) { - /* Fits */ - qemu_chr_be_write(chr, io_buf, len); - } else { - int first; - uint8_t out; - /* Can't fit all, send what can be, and store the rest. */ - qemu_chr_be_write(chr, io_buf, room); - len -= room; - cur = io_buf + room; - if (len > BUF_SIZE - baum->out_buf_used) { - /* Can't even store it, drop the previous data... */ - assert(len <= BUF_SIZE); - baum->out_buf_used = 0; - baum->out_buf_ptr = 0; - } - out = baum->out_buf_ptr; - baum->out_buf_used += len; - first = BUF_SIZE - baum->out_buf_ptr; - if (len > first) { - memcpy(baum->out_buf + out, cur, first); - out = 0; - len -= first; - cur += first; - } - memcpy(baum->out_buf + out, cur, len); - } -} - -/* Called when the other end seems to have a wrong idea of our display size */ -static void baum_cellCount_timer_cb(void *opaque) -{ - BaumChardev *baum = BAUM_CHARDEV(opaque); - uint8_t cell_count[] = { BAUM_RSP_CellCount, baum->x * baum->y }; - DPRINTF("Timeout waiting for DisplayData, sending cell count\n"); - baum_write_packet(baum, cell_count, sizeof(cell_count)); -} - -/* Try to interpret a whole incoming packet */ -static int baum_eat_packet(BaumChardev *baum, const uint8_t *buf, int len) -{ - const uint8_t *cur = buf; - uint8_t req = 0; - - if (!len--) - return 0; - if (*cur++ != ESC) { - while (*cur != ESC) { - if (!len--) - return 0; - cur++; - } - DPRINTF("Dropped %td bytes!\n", cur - buf); - } - -#define EAT(c) do {\ - if (!len--) \ - return 0; \ - if ((c = *cur++) == ESC) { \ - if (!len--) \ - return 0; \ - if (*cur++ != ESC) { \ - DPRINTF("Broken packet %#2x, tossing\n", req); \ - if (timer_pending(baum->cellCount_timer)) { \ - timer_del(baum->cellCount_timer); \ - baum_cellCount_timer_cb(baum); \ - } \ - return (cur - 2 - buf); \ - } \ - } \ -} while (0) - - EAT(req); - switch (req) { - case BAUM_REQ_DisplayData: - { - uint8_t cells[baum->x * baum->y], c; - uint8_t text[baum->x * baum->y]; - uint8_t zero[baum->x * baum->y]; - int cursor = BRLAPI_CURSOR_OFF; - int i; - - /* Allow 100ms to complete the DisplayData packet */ - timer_mod(baum->cellCount_timer, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + - NANOSECONDS_PER_SECOND / 10); - for (i = 0; i < baum->x * baum->y ; i++) { - EAT(c); - cells[i] = c; - if ((c & (BRLAPI_DOT7|BRLAPI_DOT8)) - == (BRLAPI_DOT7|BRLAPI_DOT8)) { - cursor = i + 1; - c &= ~(BRLAPI_DOT7|BRLAPI_DOT8); - } - c = nabcc_translation[DOTS2ASCII][c]; - if (!c) { - c = '?'; - } - text[i] = c; - } - timer_del(baum->cellCount_timer); - - memset(zero, 0, sizeof(zero)); - - brlapi_writeArguments_t wa = { - .displayNumber = BRLAPI_DISPLAY_DEFAULT, - .regionBegin = 1, - .regionSize = baum->x * baum->y, - .text = (char *)text, - .textSize = baum->x * baum->y, - .andMask = zero, - .orMask = cells, - .cursor = cursor, - .charset = (char *)"ISO-8859-1", - }; - - if (brlapi__write(baum->brlapi, &wa) == -1) - brlapi_perror("baum brlapi_write"); - break; - } - case BAUM_REQ_SetMode: - { - uint8_t mode, setting; - DPRINTF("SetMode\n"); - EAT(mode); - EAT(setting); - /* ignore */ - break; - } - case BAUM_REQ_SetProtocol: - { - uint8_t protocol; - DPRINTF("SetProtocol\n"); - EAT(protocol); - /* ignore */ - break; - } - case BAUM_REQ_GetDeviceIdentity: - { - uint8_t identity[17] = { BAUM_RSP_DeviceIdentity, - 'B','a','u','m',' ','V','a','r','i','o' }; - DPRINTF("GetDeviceIdentity\n"); - identity[11] = '0' + baum->x / 10; - identity[12] = '0' + baum->x % 10; - baum_write_packet(baum, identity, sizeof(identity)); - break; - } - case BAUM_REQ_GetVersionNumber: - { - uint8_t version[] = { BAUM_RSP_VersionNumber, 1 }; /* ? */ - DPRINTF("GetVersionNumber\n"); - baum_write_packet(baum, version, sizeof(version)); - break; - } - case BAUM_REQ_GetSerialNumber: - { - uint8_t serial[] = { BAUM_RSP_SerialNumber, - '0','0','0','0','0','0','0','0' }; - DPRINTF("GetSerialNumber\n"); - baum_write_packet(baum, serial, sizeof(serial)); - break; - } - case BAUM_REQ_GetKeys: - { - DPRINTF("Get%0#2x\n", req); - /* ignore */ - break; - } - default: - DPRINTF("unrecognized request %0#2x\n", req); - do - if (!len--) - return 0; - while (*cur++ != ESC); - cur--; - break; - } - return cur - buf; -} - -/* The other end is writing some data. Store it and try to interpret */ -static int baum_chr_write(Chardev *chr, const uint8_t *buf, int len) -{ - BaumChardev *baum = BAUM_CHARDEV(chr); - int tocopy, cur, eaten, orig_len = len; - - if (!len) - return 0; - if (!baum->brlapi) - return len; - if (!baum_deferred_init(baum)) - return len; - - while (len) { - /* Complete our buffer as much as possible */ - tocopy = len; - if (tocopy > BUF_SIZE - baum->in_buf_used) - tocopy = BUF_SIZE - baum->in_buf_used; - - memcpy(baum->in_buf + baum->in_buf_used, buf, tocopy); - baum->in_buf_used += tocopy; - buf += tocopy; - len -= tocopy; - - /* Interpret it as much as possible */ - cur = 0; - while (cur < baum->in_buf_used && - (eaten = baum_eat_packet(baum, baum->in_buf + cur, baum->in_buf_used - cur))) - cur += eaten; - - /* Shift the remainder */ - if (cur) { - memmove(baum->in_buf, baum->in_buf + cur, baum->in_buf_used - cur); - baum->in_buf_used -= cur; - } - - /* And continue if any data left */ - } - return orig_len; -} - -/* Send the key code to the other end */ -static void baum_send_key(BaumChardev *baum, uint8_t type, uint8_t value) -{ - uint8_t packet[] = { type, value }; - DPRINTF("writing key %x %x\n", type, value); - baum_write_packet(baum, packet, sizeof(packet)); -} - -static void baum_send_key2(BaumChardev *baum, uint8_t type, uint8_t value, - uint8_t value2) -{ - uint8_t packet[] = { type, value, value2 }; - DPRINTF("writing key %x %x\n", type, value); - baum_write_packet(baum, packet, sizeof(packet)); -} - -/* We got some data on the BrlAPI socket */ -static void baum_chr_read(void *opaque) -{ - BaumChardev *baum = BAUM_CHARDEV(opaque); - brlapi_keyCode_t code; - int ret; - if (!baum->brlapi) - return; - if (!baum_deferred_init(baum)) - return; - while ((ret = brlapi__readKey(baum->brlapi, 0, &code)) == 1) { - DPRINTF("got key %"BRLAPI_PRIxKEYCODE"\n", code); - /* Emulate */ - switch (code & BRLAPI_KEY_TYPE_MASK) { - case BRLAPI_KEY_TYPE_CMD: - switch (code & BRLAPI_KEY_CMD_BLK_MASK) { - case BRLAPI_KEY_CMD_ROUTE: - baum_send_key(baum, BAUM_RSP_RoutingKey, (code & BRLAPI_KEY_CMD_ARG_MASK)+1); - baum_send_key(baum, BAUM_RSP_RoutingKey, 0); - break; - case 0: - switch (code & BRLAPI_KEY_CMD_ARG_MASK) { - case BRLAPI_KEY_CMD_FWINLT: - baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2); - baum_send_key(baum, BAUM_RSP_TopKeys, 0); - break; - case BRLAPI_KEY_CMD_FWINRT: - baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TR2); - baum_send_key(baum, BAUM_RSP_TopKeys, 0); - break; - case BRLAPI_KEY_CMD_LNUP: - baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TR1); - baum_send_key(baum, BAUM_RSP_TopKeys, 0); - break; - case BRLAPI_KEY_CMD_LNDN: - baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TR3); - baum_send_key(baum, BAUM_RSP_TopKeys, 0); - break; - case BRLAPI_KEY_CMD_TOP: - baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL1|BAUM_TR1); - baum_send_key(baum, BAUM_RSP_TopKeys, 0); - break; - case BRLAPI_KEY_CMD_BOT: - baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL3|BAUM_TR3); - baum_send_key(baum, BAUM_RSP_TopKeys, 0); - break; - case BRLAPI_KEY_CMD_TOP_LEFT: - baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2|BAUM_TR1); - baum_send_key(baum, BAUM_RSP_TopKeys, 0); - break; - case BRLAPI_KEY_CMD_BOT_LEFT: - baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2|BAUM_TR3); - baum_send_key(baum, BAUM_RSP_TopKeys, 0); - break; - case BRLAPI_KEY_CMD_HOME: - baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL2|BAUM_TR1|BAUM_TR3); - baum_send_key(baum, BAUM_RSP_TopKeys, 0); - break; - case BRLAPI_KEY_CMD_PREFMENU: - baum_send_key(baum, BAUM_RSP_TopKeys, BAUM_TL1|BAUM_TL3|BAUM_TR1); - baum_send_key(baum, BAUM_RSP_TopKeys, 0); - break; - } - } - break; - case BRLAPI_KEY_TYPE_SYM: - { - brlapi_keyCode_t keysym = code & BRLAPI_KEY_CODE_MASK; - if (keysym < 0x100) { - uint8_t dots = nabcc_translation[ASCII2DOTS][keysym]; - if (dots) { - baum_send_key2(baum, BAUM_RSP_EntryKeys, 0, dots); - baum_send_key2(baum, BAUM_RSP_EntryKeys, 0, 0); - } - } - break; - } - } - } - if (ret == -1 && (brlapi_errno != BRLAPI_ERROR_LIBCERR || errno != EINTR)) { - brlapi_perror("baum: brlapi_readKey"); - brlapi__closeConnection(baum->brlapi); - g_free(baum->brlapi); - baum->brlapi = NULL; - } -} - -static void char_braille_finalize(Object *obj) -{ - BaumChardev *baum = BAUM_CHARDEV(obj); - - timer_free(baum->cellCount_timer); - if (baum->brlapi) { - brlapi__closeConnection(baum->brlapi); - g_free(baum->brlapi); - } -} - -static void baum_chr_open(Chardev *chr, - ChardevBackend *backend, - bool *be_opened, - Error **errp) -{ - BaumChardev *baum = BAUM_CHARDEV(chr); - brlapi_handle_t *handle; - - handle = g_malloc0(brlapi_getHandleSize()); - baum->brlapi = handle; - - baum->brlapi_fd = brlapi__openConnection(handle, NULL, NULL); - if (baum->brlapi_fd == -1) { - error_setg(errp, "brlapi__openConnection: %s", - brlapi_strerror(brlapi_error_location())); - g_free(handle); - return; - } - baum->deferred_init = 0; - - baum->cellCount_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, baum_cellCount_timer_cb, baum); - - qemu_set_fd_handler(baum->brlapi_fd, baum_chr_read, NULL, baum); -} - -static void char_braille_class_init(ObjectClass *oc, void *data) -{ - ChardevClass *cc = CHARDEV_CLASS(oc); - - cc->open = baum_chr_open; - cc->chr_write = baum_chr_write; - cc->chr_accept_input = baum_chr_accept_input; -} - -static const TypeInfo char_braille_type_info = { - .name = TYPE_CHARDEV_BRAILLE, - .parent = TYPE_CHARDEV, - .instance_size = sizeof(BaumChardev), - .instance_finalize = char_braille_finalize, - .class_init = char_braille_class_init, -}; - -static void register_types(void) -{ - type_register_static(&char_braille_type_info); -} - -type_init(register_types); |