Without the mask, control bits are passed on in the keycode, generating incorrect PS/2 sequences when SHIFT, ALT, etc are held down. Cc: qemu-stable@nongnu.org Signed-off-by: Andrew Oates <andrew@aoates.org> Signed-off-by: Gerd Hoffmann <kraxel@redhat.com>
		
			
				
	
	
		
			381 lines
		
	
	
		
			9.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			381 lines
		
	
	
		
			9.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * QEMU curses/ncurses display driver
 | 
						|
 * 
 | 
						|
 * Copyright (c) 2005 Andrzej Zaborowski  <balrog@zabor.org>
 | 
						|
 * 
 | 
						|
 * 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 <curses.h>
 | 
						|
 | 
						|
#ifndef _WIN32
 | 
						|
#include <sys/ioctl.h>
 | 
						|
#include <termios.h>
 | 
						|
#endif
 | 
						|
 | 
						|
#include "qemu-common.h"
 | 
						|
#include "ui/console.h"
 | 
						|
#include "ui/input.h"
 | 
						|
#include "sysemu/sysemu.h"
 | 
						|
 | 
						|
#define FONT_HEIGHT 16
 | 
						|
#define FONT_WIDTH 8
 | 
						|
 | 
						|
static DisplayChangeListener *dcl;
 | 
						|
static console_ch_t screen[160 * 100];
 | 
						|
static WINDOW *screenpad = NULL;
 | 
						|
static int width, height, gwidth, gheight, invalidate;
 | 
						|
static int px, py, sminx, sminy, smaxx, smaxy;
 | 
						|
 | 
						|
static void curses_update(DisplayChangeListener *dcl,
 | 
						|
                          int x, int y, int w, int h)
 | 
						|
{
 | 
						|
    chtype *line;
 | 
						|
 | 
						|
    line = ((chtype *) screen) + y * width;
 | 
						|
    for (h += y; y < h; y ++, line += width)
 | 
						|
        mvwaddchnstr(screenpad, y, 0, line, width);
 | 
						|
 | 
						|
    pnoutrefresh(screenpad, py, px, sminy, sminx, smaxy - 1, smaxx - 1);
 | 
						|
    refresh();
 | 
						|
}
 | 
						|
 | 
						|
static void curses_calc_pad(void)
 | 
						|
{
 | 
						|
    if (qemu_console_is_fixedsize(NULL)) {
 | 
						|
        width = gwidth;
 | 
						|
        height = gheight;
 | 
						|
    } else {
 | 
						|
        width = COLS;
 | 
						|
        height = LINES;
 | 
						|
    }
 | 
						|
 | 
						|
    if (screenpad)
 | 
						|
        delwin(screenpad);
 | 
						|
 | 
						|
    clear();
 | 
						|
    refresh();
 | 
						|
 | 
						|
    screenpad = newpad(height, width);
 | 
						|
 | 
						|
    if (width > COLS) {
 | 
						|
        px = (width - COLS) / 2;
 | 
						|
        sminx = 0;
 | 
						|
        smaxx = COLS;
 | 
						|
    } else {
 | 
						|
        px = 0;
 | 
						|
        sminx = (COLS - width) / 2;
 | 
						|
        smaxx = sminx + width;
 | 
						|
    }
 | 
						|
 | 
						|
    if (height > LINES) {
 | 
						|
        py = (height - LINES) / 2;
 | 
						|
        sminy = 0;
 | 
						|
        smaxy = LINES;
 | 
						|
    } else {
 | 
						|
        py = 0;
 | 
						|
        sminy = (LINES - height) / 2;
 | 
						|
        smaxy = sminy + height;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static void curses_resize(DisplayChangeListener *dcl,
 | 
						|
                          int width, int height)
 | 
						|
{
 | 
						|
    if (width == gwidth && height == gheight) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    gwidth = width;
 | 
						|
    gheight = height;
 | 
						|
 | 
						|
    curses_calc_pad();
 | 
						|
}
 | 
						|
 | 
						|
#if !defined(_WIN32) && defined(SIGWINCH) && defined(KEY_RESIZE)
 | 
						|
static volatile sig_atomic_t got_sigwinch;
 | 
						|
static void curses_winch_check(void)
 | 
						|
{
 | 
						|
    struct winsize {
 | 
						|
        unsigned short ws_row;
 | 
						|
        unsigned short ws_col;
 | 
						|
        unsigned short ws_xpixel;   /* unused */
 | 
						|
        unsigned short ws_ypixel;   /* unused */
 | 
						|
    } ws;
 | 
						|
 | 
						|
    if (!got_sigwinch) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
    got_sigwinch = false;
 | 
						|
 | 
						|
    if (ioctl(1, TIOCGWINSZ, &ws) == -1) {
 | 
						|
        return;
 | 
						|
    }
 | 
						|
 | 
						|
    resize_term(ws.ws_row, ws.ws_col);
 | 
						|
    invalidate = 1;
 | 
						|
}
 | 
						|
 | 
						|
static void curses_winch_handler(int signum)
 | 
						|
{
 | 
						|
    got_sigwinch = true;
 | 
						|
}
 | 
						|
 | 
						|
static void curses_winch_init(void)
 | 
						|
{
 | 
						|
    struct sigaction old, winch = {
 | 
						|
        .sa_handler  = curses_winch_handler,
 | 
						|
    };
 | 
						|
    sigaction(SIGWINCH, &winch, &old);
 | 
						|
}
 | 
						|
#else
 | 
						|
static void curses_winch_check(void) {}
 | 
						|
static void curses_winch_init(void) {}
 | 
						|
#endif
 | 
						|
 | 
						|
static void curses_cursor_position(DisplayChangeListener *dcl,
 | 
						|
                                   int x, int y)
 | 
						|
{
 | 
						|
    if (x >= 0) {
 | 
						|
        x = sminx + x - px;
 | 
						|
        y = sminy + y - py;
 | 
						|
 | 
						|
        if (x >= 0 && y >= 0 && x < COLS && y < LINES) {
 | 
						|
            move(y, x);
 | 
						|
            curs_set(1);
 | 
						|
            /* it seems that curs_set(1) must always be called before
 | 
						|
             * curs_set(2) for the latter to have effect */
 | 
						|
            if (!qemu_console_is_graphic(NULL)) {
 | 
						|
                curs_set(2);
 | 
						|
            }
 | 
						|
            return;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    curs_set(0);
 | 
						|
}
 | 
						|
 | 
						|
/* generic keyboard conversion */
 | 
						|
 | 
						|
#include "curses_keys.h"
 | 
						|
 | 
						|
static kbd_layout_t *kbd_layout = NULL;
 | 
						|
 | 
						|
static void curses_refresh(DisplayChangeListener *dcl)
 | 
						|
{
 | 
						|
    int chr, nextchr, keysym, keycode, keycode_alt;
 | 
						|
 | 
						|
    curses_winch_check();
 | 
						|
 | 
						|
    if (invalidate) {
 | 
						|
        clear();
 | 
						|
        refresh();
 | 
						|
        curses_calc_pad();
 | 
						|
        graphic_hw_invalidate(NULL);
 | 
						|
        invalidate = 0;
 | 
						|
    }
 | 
						|
 | 
						|
    graphic_hw_text_update(NULL, screen);
 | 
						|
 | 
						|
    nextchr = ERR;
 | 
						|
    while (1) {
 | 
						|
        /* while there are any pending key strokes to process */
 | 
						|
        if (nextchr == ERR)
 | 
						|
            chr = getch();
 | 
						|
        else {
 | 
						|
            chr = nextchr;
 | 
						|
            nextchr = ERR;
 | 
						|
        }
 | 
						|
 | 
						|
        if (chr == ERR)
 | 
						|
            break;
 | 
						|
 | 
						|
#ifdef KEY_RESIZE
 | 
						|
        /* this shouldn't occur when we use a custom SIGWINCH handler */
 | 
						|
        if (chr == KEY_RESIZE) {
 | 
						|
            clear();
 | 
						|
            refresh();
 | 
						|
            curses_calc_pad();
 | 
						|
            curses_update(dcl, 0, 0, width, height);
 | 
						|
            continue;
 | 
						|
        }
 | 
						|
#endif
 | 
						|
 | 
						|
        keycode = curses2keycode[chr];
 | 
						|
        keycode_alt = 0;
 | 
						|
 | 
						|
        /* alt key */
 | 
						|
        if (keycode == 1) {
 | 
						|
            nextchr = getch();
 | 
						|
 | 
						|
            if (nextchr != ERR) {
 | 
						|
                chr = nextchr;
 | 
						|
                keycode_alt = ALT;
 | 
						|
                keycode = curses2keycode[nextchr];
 | 
						|
                nextchr = ERR;
 | 
						|
 | 
						|
                if (keycode != -1) {
 | 
						|
                    keycode |= ALT;
 | 
						|
 | 
						|
                    /* process keys reserved for qemu */
 | 
						|
                    if (keycode >= QEMU_KEY_CONSOLE0 &&
 | 
						|
                            keycode < QEMU_KEY_CONSOLE0 + 9) {
 | 
						|
                        erase();
 | 
						|
                        wnoutrefresh(stdscr);
 | 
						|
                        console_select(keycode - QEMU_KEY_CONSOLE0);
 | 
						|
 | 
						|
                        invalidate = 1;
 | 
						|
                        continue;
 | 
						|
                    }
 | 
						|
                }
 | 
						|
            }
 | 
						|
        }
 | 
						|
 | 
						|
        if (kbd_layout) {
 | 
						|
            keysym = -1;
 | 
						|
            if (chr < CURSES_KEYS)
 | 
						|
                keysym = curses2keysym[chr];
 | 
						|
 | 
						|
            if (keysym == -1) {
 | 
						|
                if (chr < ' ') {
 | 
						|
                    keysym = chr + '@';
 | 
						|
                    if (keysym >= 'A' && keysym <= 'Z')
 | 
						|
                        keysym += 'a' - 'A';
 | 
						|
                    keysym |= KEYSYM_CNTRL;
 | 
						|
                } else
 | 
						|
                    keysym = chr;
 | 
						|
            }
 | 
						|
 | 
						|
            keycode = keysym2scancode(kbd_layout, keysym & KEYSYM_MASK);
 | 
						|
            if (keycode == 0)
 | 
						|
                continue;
 | 
						|
 | 
						|
            keycode |= (keysym & ~KEYSYM_MASK) >> 16;
 | 
						|
            keycode |= keycode_alt;
 | 
						|
        }
 | 
						|
 | 
						|
        if (keycode == -1)
 | 
						|
            continue;
 | 
						|
 | 
						|
        if (qemu_console_is_graphic(NULL)) {
 | 
						|
            /* since terminals don't know about key press and release
 | 
						|
             * events, we need to emit both for each key received */
 | 
						|
            if (keycode & SHIFT) {
 | 
						|
                qemu_input_event_send_key_number(NULL, SHIFT_CODE, true);
 | 
						|
            }
 | 
						|
            if (keycode & CNTRL) {
 | 
						|
                qemu_input_event_send_key_number(NULL, CNTRL_CODE, true);
 | 
						|
            }
 | 
						|
            if (keycode & ALT) {
 | 
						|
                qemu_input_event_send_key_number(NULL, ALT_CODE, true);
 | 
						|
            }
 | 
						|
            if (keycode & ALTGR) {
 | 
						|
                qemu_input_event_send_key_number(NULL, GREY | ALT_CODE, true);
 | 
						|
            }
 | 
						|
 | 
						|
            qemu_input_event_send_key_number(NULL, keycode & KEY_MASK, true);
 | 
						|
            qemu_input_event_send_key_number(NULL, keycode & KEY_MASK, false);
 | 
						|
 | 
						|
            if (keycode & ALTGR) {
 | 
						|
                qemu_input_event_send_key_number(NULL, GREY | ALT_CODE, false);
 | 
						|
            }
 | 
						|
            if (keycode & ALT) {
 | 
						|
                qemu_input_event_send_key_number(NULL, ALT_CODE, false);
 | 
						|
            }
 | 
						|
            if (keycode & CNTRL) {
 | 
						|
                qemu_input_event_send_key_number(NULL, CNTRL_CODE, false);
 | 
						|
            }
 | 
						|
            if (keycode & SHIFT) {
 | 
						|
                qemu_input_event_send_key_number(NULL, SHIFT_CODE, false);
 | 
						|
            }
 | 
						|
        } else {
 | 
						|
            keysym = curses2qemu[chr];
 | 
						|
            if (keysym == -1)
 | 
						|
                keysym = chr;
 | 
						|
 | 
						|
            kbd_put_keysym(keysym);
 | 
						|
        }
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static void curses_atexit(void)
 | 
						|
{
 | 
						|
    endwin();
 | 
						|
}
 | 
						|
 | 
						|
static void curses_setup(void)
 | 
						|
{
 | 
						|
    int i, colour_default[8] = {
 | 
						|
        COLOR_BLACK, COLOR_BLUE, COLOR_GREEN, COLOR_CYAN,
 | 
						|
        COLOR_RED, COLOR_MAGENTA, COLOR_YELLOW, COLOR_WHITE,
 | 
						|
    };
 | 
						|
 | 
						|
    /* input as raw as possible, let everything be interpreted
 | 
						|
     * by the guest system */
 | 
						|
    initscr(); noecho(); intrflush(stdscr, FALSE);
 | 
						|
    nodelay(stdscr, TRUE); nonl(); keypad(stdscr, TRUE);
 | 
						|
    start_color(); raw(); scrollok(stdscr, FALSE);
 | 
						|
 | 
						|
    for (i = 0; i < 64; i ++)
 | 
						|
        init_pair(i, colour_default[i & 7], colour_default[i >> 3]);
 | 
						|
}
 | 
						|
 | 
						|
static void curses_keyboard_setup(void)
 | 
						|
{
 | 
						|
#if defined(__APPLE__)
 | 
						|
    /* always use generic keymaps */
 | 
						|
    if (!keyboard_layout)
 | 
						|
        keyboard_layout = "en-us";
 | 
						|
#endif
 | 
						|
    if(keyboard_layout) {
 | 
						|
        kbd_layout = init_keyboard_layout(name2keysym, keyboard_layout);
 | 
						|
        if (!kbd_layout)
 | 
						|
            exit(1);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static const DisplayChangeListenerOps dcl_ops = {
 | 
						|
    .dpy_name        = "curses",
 | 
						|
    .dpy_text_update = curses_update,
 | 
						|
    .dpy_text_resize = curses_resize,
 | 
						|
    .dpy_refresh     = curses_refresh,
 | 
						|
    .dpy_text_cursor = curses_cursor_position,
 | 
						|
};
 | 
						|
 | 
						|
void curses_display_init(DisplayState *ds, int full_screen)
 | 
						|
{
 | 
						|
#ifndef _WIN32
 | 
						|
    if (!isatty(1)) {
 | 
						|
        fprintf(stderr, "We need a terminal output\n");
 | 
						|
        exit(1);
 | 
						|
    }
 | 
						|
#endif
 | 
						|
 | 
						|
    curses_setup();
 | 
						|
    curses_keyboard_setup();
 | 
						|
    atexit(curses_atexit);
 | 
						|
 | 
						|
    curses_winch_init();
 | 
						|
 | 
						|
    dcl = (DisplayChangeListener *) g_malloc0(sizeof(DisplayChangeListener));
 | 
						|
    dcl->ops = &dcl_ops;
 | 
						|
    register_displaychangelistener(dcl);
 | 
						|
 | 
						|
    invalidate = 1;
 | 
						|
}
 |