13f838fecSPekka Enberg #include "kvm/sdl.h" 23f838fecSPekka Enberg 33f838fecSPekka Enberg #include "kvm/framebuffer.h" 4175f8e86SPekka Enberg #include "kvm/i8042.h" 53f838fecSPekka Enberg #include "kvm/util.h" 61c48f5f8SPekka Enberg #include "kvm/kvm.h" 7f9911ebaSSasha Levin #include "kvm/kvm-cpu.h" 83f838fecSPekka Enberg 93f838fecSPekka Enberg #include <SDL/SDL.h> 103f838fecSPekka Enberg #include <pthread.h> 111c48f5f8SPekka Enberg #include <signal.h> 123f838fecSPekka Enberg 133f838fecSPekka Enberg #define FRAME_RATE 25 143f838fecSPekka Enberg 15571cf4baSAlessandro Guido #define SCANCODE_UNKNOWN 0 16571cf4baSAlessandro Guido #define SCANCODE_NORMAL 1 17571cf4baSAlessandro Guido #define SCANCODE_ESCAPED 2 18571cf4baSAlessandro Guido #define SCANCODE_KEY_PAUSE 3 19571cf4baSAlessandro Guido #define SCANCODE_KEY_PRNTSCRN 4 20175f8e86SPekka Enberg 21571cf4baSAlessandro Guido struct set2_scancode { 22571cf4baSAlessandro Guido u8 code; 23571cf4baSAlessandro Guido u8 type; 24175f8e86SPekka Enberg }; 25175f8e86SPekka Enberg 26571cf4baSAlessandro Guido #define DEFINE_SC(_code) {\ 27571cf4baSAlessandro Guido .code = _code,\ 28571cf4baSAlessandro Guido .type = SCANCODE_NORMAL,\ 29571cf4baSAlessandro Guido } 30571cf4baSAlessandro Guido 31571cf4baSAlessandro Guido /* escaped scancodes */ 32571cf4baSAlessandro Guido #define DEFINE_ESC(_code) {\ 33571cf4baSAlessandro Guido .code = _code,\ 34571cf4baSAlessandro Guido .type = SCANCODE_ESCAPED,\ 35571cf4baSAlessandro Guido } 36571cf4baSAlessandro Guido 374c61e7f8SCyrill Gorcunov static const struct set2_scancode const keymap[256] = { 38571cf4baSAlessandro Guido [9] = DEFINE_SC(0x76), /* <esc> */ 39571cf4baSAlessandro Guido [10] = DEFINE_SC(0x16), /* 1 */ 40571cf4baSAlessandro Guido [11] = DEFINE_SC(0x1e), /* 2 */ 41571cf4baSAlessandro Guido [12] = DEFINE_SC(0x26), /* 3 */ 42571cf4baSAlessandro Guido [13] = DEFINE_SC(0x25), /* 4 */ 43a022099dSAlessandro Guido [14] = DEFINE_SC(0x2e), /* 5 */ 44571cf4baSAlessandro Guido [15] = DEFINE_SC(0x36), /* 6 */ 45571cf4baSAlessandro Guido [16] = DEFINE_SC(0x3d), /* 7 */ 46571cf4baSAlessandro Guido [17] = DEFINE_SC(0x3e), /* 8 */ 47571cf4baSAlessandro Guido [18] = DEFINE_SC(0x46), /* 9 */ 48571cf4baSAlessandro Guido [19] = DEFINE_SC(0x45), /* 9 */ 49571cf4baSAlessandro Guido [20] = DEFINE_SC(0x4e), /* - */ 50571cf4baSAlessandro Guido [21] = DEFINE_SC(0x55), /* + */ 51571cf4baSAlessandro Guido [22] = DEFINE_SC(0x66), /* <backspace> */ 52571cf4baSAlessandro Guido [23] = DEFINE_SC(0x0d), /* <tab> */ 53571cf4baSAlessandro Guido [24] = DEFINE_SC(0x15), /* q */ 54571cf4baSAlessandro Guido [25] = DEFINE_SC(0x1d), /* w */ 55571cf4baSAlessandro Guido [26] = DEFINE_SC(0x24), /* e */ 56571cf4baSAlessandro Guido [27] = DEFINE_SC(0x2d), /* r */ 57571cf4baSAlessandro Guido [28] = DEFINE_SC(0x2c), /* t */ 58571cf4baSAlessandro Guido [29] = DEFINE_SC(0x35), /* y */ 59571cf4baSAlessandro Guido [30] = DEFINE_SC(0x3c), /* u */ 60571cf4baSAlessandro Guido [31] = DEFINE_SC(0x43), /* i */ 61571cf4baSAlessandro Guido [32] = DEFINE_SC(0x44), /* o */ 62571cf4baSAlessandro Guido [33] = DEFINE_SC(0x4d), /* p */ 63571cf4baSAlessandro Guido [34] = DEFINE_SC(0x54), /* [ */ 64571cf4baSAlessandro Guido [35] = DEFINE_SC(0x5b), /* ] */ 65571cf4baSAlessandro Guido [36] = DEFINE_SC(0x5a), /* <enter> */ 66571cf4baSAlessandro Guido [37] = DEFINE_SC(0x14), /* <left ctrl> */ 67571cf4baSAlessandro Guido [38] = DEFINE_SC(0x1c), /* a */ 68571cf4baSAlessandro Guido [39] = DEFINE_SC(0x1b), /* s */ 69571cf4baSAlessandro Guido [40] = DEFINE_SC(0x23), /* d */ 70571cf4baSAlessandro Guido [41] = DEFINE_SC(0x2b), /* f */ 71571cf4baSAlessandro Guido [42] = DEFINE_SC(0x34), /* g */ 72571cf4baSAlessandro Guido [43] = DEFINE_SC(0x33), /* h */ 73571cf4baSAlessandro Guido [44] = DEFINE_SC(0x3b), /* j */ 74571cf4baSAlessandro Guido [45] = DEFINE_SC(0x42), /* k */ 75571cf4baSAlessandro Guido [46] = DEFINE_SC(0x4b), /* l */ 76571cf4baSAlessandro Guido [47] = DEFINE_SC(0x4c), /* ; */ 77571cf4baSAlessandro Guido [48] = DEFINE_SC(0x52), /* ' */ 78571cf4baSAlessandro Guido [49] = DEFINE_SC(0x0e), /* ` */ 79571cf4baSAlessandro Guido [50] = DEFINE_SC(0x12), /* <left shift> */ 80571cf4baSAlessandro Guido [51] = DEFINE_SC(0x5d), /* \ */ 81571cf4baSAlessandro Guido [52] = DEFINE_SC(0x1a), /* z */ 82571cf4baSAlessandro Guido [53] = DEFINE_SC(0x22), /* x */ 83571cf4baSAlessandro Guido [54] = DEFINE_SC(0x21), /* c */ 84571cf4baSAlessandro Guido [55] = DEFINE_SC(0x2a), /* v */ 85571cf4baSAlessandro Guido [56] = DEFINE_SC(0x32), /* b */ 86571cf4baSAlessandro Guido [57] = DEFINE_SC(0x31), /* n */ 87571cf4baSAlessandro Guido [58] = DEFINE_SC(0x3a), /* m */ 88571cf4baSAlessandro Guido [59] = DEFINE_SC(0x41), /* < */ 89571cf4baSAlessandro Guido [60] = DEFINE_SC(0x49), /* > */ 90571cf4baSAlessandro Guido [61] = DEFINE_SC(0x4a), /* / */ 91571cf4baSAlessandro Guido [62] = DEFINE_SC(0x59), /* <right shift> */ 92571cf4baSAlessandro Guido [63] = DEFINE_SC(0x7c), /* keypad * */ 93571cf4baSAlessandro Guido [64] = DEFINE_SC(0x11), /* <left alt> */ 94571cf4baSAlessandro Guido [65] = DEFINE_SC(0x29), /* <space> */ 95571cf4baSAlessandro Guido 96571cf4baSAlessandro Guido [67] = DEFINE_SC(0x05), /* <F1> */ 97571cf4baSAlessandro Guido [68] = DEFINE_SC(0x06), /* <F2> */ 98571cf4baSAlessandro Guido [69] = DEFINE_SC(0x04), /* <F3> */ 99571cf4baSAlessandro Guido [70] = DEFINE_SC(0x0c), /* <F4> */ 100571cf4baSAlessandro Guido [71] = DEFINE_SC(0x03), /* <F5> */ 101571cf4baSAlessandro Guido [72] = DEFINE_SC(0x0b), /* <F6> */ 102571cf4baSAlessandro Guido [73] = DEFINE_SC(0x83), /* <F7> */ 103571cf4baSAlessandro Guido [74] = DEFINE_SC(0x0a), /* <F8> */ 104571cf4baSAlessandro Guido [75] = DEFINE_SC(0x01), /* <F9> */ 105571cf4baSAlessandro Guido [76] = DEFINE_SC(0x09), /* <F10> */ 106571cf4baSAlessandro Guido 107571cf4baSAlessandro Guido [79] = DEFINE_SC(0x6c), /* keypad 7 */ 108571cf4baSAlessandro Guido [80] = DEFINE_SC(0x75), /* keypad 8 */ 109571cf4baSAlessandro Guido [81] = DEFINE_SC(0x7d), /* keypad 9 */ 110571cf4baSAlessandro Guido [82] = DEFINE_SC(0x7b), /* keypad - */ 111571cf4baSAlessandro Guido [83] = DEFINE_SC(0x6b), /* keypad 4 */ 112571cf4baSAlessandro Guido [84] = DEFINE_SC(0x73), /* keypad 5 */ 113571cf4baSAlessandro Guido [85] = DEFINE_SC(0x74), /* keypad 6 */ 114571cf4baSAlessandro Guido [86] = DEFINE_SC(0x79), /* keypad + */ 115571cf4baSAlessandro Guido [87] = DEFINE_SC(0x69), /* keypad 1 */ 116571cf4baSAlessandro Guido [88] = DEFINE_SC(0x72), /* keypad 2 */ 117571cf4baSAlessandro Guido [89] = DEFINE_SC(0x7a), /* keypad 3 */ 118571cf4baSAlessandro Guido [90] = DEFINE_SC(0x70), /* keypad 0 */ 119571cf4baSAlessandro Guido [91] = DEFINE_SC(0x71), /* keypad . */ 120571cf4baSAlessandro Guido 121571cf4baSAlessandro Guido [94] = DEFINE_SC(0x61), /* <INT 1> */ 122571cf4baSAlessandro Guido [95] = DEFINE_SC(0x78), /* <F11> */ 123571cf4baSAlessandro Guido [96] = DEFINE_SC(0x07), /* <F12> */ 124571cf4baSAlessandro Guido 125571cf4baSAlessandro Guido [104] = DEFINE_ESC(0x5a), /* keypad <enter> */ 126571cf4baSAlessandro Guido [105] = DEFINE_ESC(0x14), /* <right ctrl> */ 127571cf4baSAlessandro Guido [106] = DEFINE_ESC(0x4a), /* keypad / */ 128571cf4baSAlessandro Guido [108] = DEFINE_ESC(0x11), /* <right alt> */ 129571cf4baSAlessandro Guido [110] = DEFINE_ESC(0x6c), /* <home> */ 130571cf4baSAlessandro Guido [111] = DEFINE_ESC(0x75), /* <up> */ 131571cf4baSAlessandro Guido [112] = DEFINE_ESC(0x7d), /* <pag up> */ 132571cf4baSAlessandro Guido [113] = DEFINE_ESC(0x6b), /* <left> */ 133571cf4baSAlessandro Guido [114] = DEFINE_ESC(0x74), /* <right> */ 134571cf4baSAlessandro Guido [115] = DEFINE_ESC(0x69), /* <end> */ 135571cf4baSAlessandro Guido [116] = DEFINE_ESC(0x72), /* <down> */ 136571cf4baSAlessandro Guido [117] = DEFINE_ESC(0x7a), /* <pag down> */ 137571cf4baSAlessandro Guido [118] = DEFINE_ESC(0x70), /* <ins> */ 138571cf4baSAlessandro Guido [119] = DEFINE_ESC(0x71), /* <delete> */ 139571cf4baSAlessandro Guido }; 14048d9e01aSSasha Levin static bool running, done; 141571cf4baSAlessandro Guido 142571cf4baSAlessandro Guido static const struct set2_scancode *to_code(u8 scancode) 143175f8e86SPekka Enberg { 144571cf4baSAlessandro Guido return &keymap[scancode]; 145571cf4baSAlessandro Guido } 146571cf4baSAlessandro Guido 147571cf4baSAlessandro Guido static void key_press(const struct set2_scancode *sc) 148571cf4baSAlessandro Guido { 149571cf4baSAlessandro Guido switch (sc->type) { 150571cf4baSAlessandro Guido case SCANCODE_ESCAPED: 151571cf4baSAlessandro Guido kbd_queue(0xe0); 152571cf4baSAlessandro Guido /* fallthrough */ 153571cf4baSAlessandro Guido case SCANCODE_NORMAL: 154571cf4baSAlessandro Guido kbd_queue(sc->code); 155571cf4baSAlessandro Guido break; 156571cf4baSAlessandro Guido case SCANCODE_KEY_PAUSE: 157571cf4baSAlessandro Guido kbd_queue(0xe1); 158571cf4baSAlessandro Guido kbd_queue(0x14); 159571cf4baSAlessandro Guido kbd_queue(0x77); 160571cf4baSAlessandro Guido kbd_queue(0xe1); 161571cf4baSAlessandro Guido kbd_queue(0xf0); 162571cf4baSAlessandro Guido kbd_queue(0x14); 163571cf4baSAlessandro Guido kbd_queue(0x77); 164571cf4baSAlessandro Guido break; 165571cf4baSAlessandro Guido case SCANCODE_KEY_PRNTSCRN: 166571cf4baSAlessandro Guido kbd_queue(0xe0); 167571cf4baSAlessandro Guido kbd_queue(0x12); 168571cf4baSAlessandro Guido kbd_queue(0xe0); 169571cf4baSAlessandro Guido kbd_queue(0x7c); 170571cf4baSAlessandro Guido break; 171571cf4baSAlessandro Guido } 172571cf4baSAlessandro Guido } 173571cf4baSAlessandro Guido 174571cf4baSAlessandro Guido static void key_release(const struct set2_scancode *sc) 175571cf4baSAlessandro Guido { 176571cf4baSAlessandro Guido switch (sc->type) { 177571cf4baSAlessandro Guido case SCANCODE_ESCAPED: 178571cf4baSAlessandro Guido kbd_queue(0xe0); 179571cf4baSAlessandro Guido /* fallthrough */ 180571cf4baSAlessandro Guido case SCANCODE_NORMAL: 181571cf4baSAlessandro Guido kbd_queue(0xf0); 182571cf4baSAlessandro Guido kbd_queue(sc->code); 183571cf4baSAlessandro Guido break; 184571cf4baSAlessandro Guido case SCANCODE_KEY_PAUSE: 185571cf4baSAlessandro Guido /* nothing to do */ 186571cf4baSAlessandro Guido break; 187571cf4baSAlessandro Guido case SCANCODE_KEY_PRNTSCRN: 188571cf4baSAlessandro Guido kbd_queue(0xe0); 189571cf4baSAlessandro Guido kbd_queue(0xf0); 190571cf4baSAlessandro Guido kbd_queue(0x7c); 191571cf4baSAlessandro Guido kbd_queue(0xe0); 192571cf4baSAlessandro Guido kbd_queue(0xf0); 193571cf4baSAlessandro Guido kbd_queue(0x12); 194571cf4baSAlessandro Guido break; 195571cf4baSAlessandro Guido } 196175f8e86SPekka Enberg } 197175f8e86SPekka Enberg 1983f838fecSPekka Enberg static void *sdl__thread(void *p) 1993f838fecSPekka Enberg { 2003f838fecSPekka Enberg Uint32 rmask, gmask, bmask, amask; 2013f838fecSPekka Enberg struct framebuffer *fb = p; 2023f838fecSPekka Enberg SDL_Surface *guest_screen; 2033f838fecSPekka Enberg SDL_Surface *screen; 2043f838fecSPekka Enberg SDL_Event ev; 2053f838fecSPekka Enberg Uint32 flags; 2063f838fecSPekka Enberg 2073f838fecSPekka Enberg if (SDL_Init(SDL_INIT_VIDEO) != 0) 2083f838fecSPekka Enberg die("Unable to initialize SDL"); 2093f838fecSPekka Enberg 2103f838fecSPekka Enberg rmask = 0x000000ff; 2113f838fecSPekka Enberg gmask = 0x0000ff00; 2123f838fecSPekka Enberg bmask = 0x00ff0000; 2133f838fecSPekka Enberg amask = 0x00000000; 2143f838fecSPekka Enberg 2153f838fecSPekka Enberg guest_screen = SDL_CreateRGBSurfaceFrom(fb->mem, fb->width, fb->height, fb->depth, fb->width * fb->depth / 8, rmask, gmask, bmask, amask); 2163f838fecSPekka Enberg if (!guest_screen) 2173f838fecSPekka Enberg die("Unable to create SDL RBG surface"); 2183f838fecSPekka Enberg 219268d0f1bSSasha Levin flags = SDL_HWSURFACE | SDL_ASYNCBLIT | SDL_HWACCEL | SDL_DOUBLEBUF; 2203f838fecSPekka Enberg 2212a77516bSPekka Enberg SDL_WM_SetCaption("KVM tool", "KVM tool"); 2222a77516bSPekka Enberg 2233f838fecSPekka Enberg screen = SDL_SetVideoMode(fb->width, fb->height, fb->depth, flags); 2243f838fecSPekka Enberg if (!screen) 2253f838fecSPekka Enberg die("Unable to set SDL video mode"); 2263f838fecSPekka Enberg 22768770058SLiming Wang SDL_EnableKeyRepeat(200, 50); 22868770058SLiming Wang 22948d9e01aSSasha Levin while (running) { 2303f838fecSPekka Enberg SDL_BlitSurface(guest_screen, NULL, screen, NULL); 231268d0f1bSSasha Levin SDL_Flip(screen); 232175f8e86SPekka Enberg 2333f838fecSPekka Enberg while (SDL_PollEvent(&ev)) { 2343f838fecSPekka Enberg switch (ev.type) { 235175f8e86SPekka Enberg case SDL_KEYDOWN: { 236571cf4baSAlessandro Guido const struct set2_scancode *sc = to_code(ev.key.keysym.scancode); 237571cf4baSAlessandro Guido if (sc->type == SCANCODE_UNKNOWN) { 238175f8e86SPekka Enberg pr_warning("key '%d' not found in keymap", ev.key.keysym.scancode); 239175f8e86SPekka Enberg break; 240175f8e86SPekka Enberg } 241571cf4baSAlessandro Guido key_press(sc); 242571cf4baSAlessandro Guido break; 243175f8e86SPekka Enberg } 244571cf4baSAlessandro Guido case SDL_KEYUP: { 245571cf4baSAlessandro Guido const struct set2_scancode *sc = to_code(ev.key.keysym.scancode); 246571cf4baSAlessandro Guido if (sc->type == SCANCODE_UNKNOWN) 247571cf4baSAlessandro Guido break; 248571cf4baSAlessandro Guido key_release(sc); 249175f8e86SPekka Enberg break; 250175f8e86SPekka Enberg } 2513f838fecSPekka Enberg case SDL_QUIT: 2523f838fecSPekka Enberg goto exit; 2533f838fecSPekka Enberg } 2543f838fecSPekka Enberg } 255175f8e86SPekka Enberg 2563f838fecSPekka Enberg SDL_Delay(1000 / FRAME_RATE); 2573f838fecSPekka Enberg } 25848d9e01aSSasha Levin 25948d9e01aSSasha Levin if (running == false && done == false) { 26048d9e01aSSasha Levin done = true; 26148d9e01aSSasha Levin return NULL; 26248d9e01aSSasha Levin } 2633f838fecSPekka Enberg exit: 264*df4239fbSSasha Levin kvm_cpu__reboot(fb->kvm); 2651c48f5f8SPekka Enberg 2663f838fecSPekka Enberg return NULL; 2673f838fecSPekka Enberg } 2683f838fecSPekka Enberg 2693f838fecSPekka Enberg static int sdl__start(struct framebuffer *fb) 2703f838fecSPekka Enberg { 2713f838fecSPekka Enberg pthread_t thread; 2723f838fecSPekka Enberg 27348d9e01aSSasha Levin running = true; 27448d9e01aSSasha Levin 2753f838fecSPekka Enberg if (pthread_create(&thread, NULL, sdl__thread, fb) != 0) 2763f838fecSPekka Enberg return -1; 2773f838fecSPekka Enberg 2783f838fecSPekka Enberg return 0; 2793f838fecSPekka Enberg } 2803f838fecSPekka Enberg 28148d9e01aSSasha Levin static int sdl__stop(struct framebuffer *fb) 28248d9e01aSSasha Levin { 28348d9e01aSSasha Levin running = false; 28448d9e01aSSasha Levin while (done == false) 28548d9e01aSSasha Levin sleep(0); 28648d9e01aSSasha Levin 28748d9e01aSSasha Levin return 0; 28848d9e01aSSasha Levin } 28948d9e01aSSasha Levin 2903f838fecSPekka Enberg static struct fb_target_operations sdl_ops = { 2913f838fecSPekka Enberg .start = sdl__start, 2928fbd1187SAsias He .stop = sdl__stop, 2933f838fecSPekka Enberg }; 2943f838fecSPekka Enberg 29548d9e01aSSasha Levin int sdl__init(struct framebuffer *fb) 2963f838fecSPekka Enberg { 29748d9e01aSSasha Levin return fb__attach(fb, &sdl_ops); 29848d9e01aSSasha Levin } 29948d9e01aSSasha Levin 30048d9e01aSSasha Levin int sdl__exit(struct framebuffer *fb) 30148d9e01aSSasha Levin { 30248d9e01aSSasha Levin return sdl__stop(fb); 3033f838fecSPekka Enberg } 304