sdl.c 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (c) 2013 Google, Inc
  4. */
  5. #include <errno.h>
  6. #include <unistd.h>
  7. #include <stdbool.h>
  8. #include <linux/input.h>
  9. #include <SDL2/SDL.h>
  10. #include <asm/state.h>
  11. /**
  12. * struct buf_info - a data buffer holding audio data
  13. *
  14. * @pos: Current position playing in audio buffer
  15. * @size: Size of data in audio buffer (0=empty)
  16. * @alloced: Allocated size of audio buffer (max size it can hold)
  17. * @data: Audio data
  18. */
  19. struct buf_info {
  20. uint pos;
  21. uint size;
  22. uint alloced;
  23. uint8_t *data;
  24. };
  25. /**
  26. * struct sdl_info - Information about our use of the SDL library
  27. *
  28. * @width: Width of simulated LCD display
  29. * @height: Height of simulated LCD display
  30. * @vis_width: Visible width (may be larger to allow for scaling up)
  31. * @vis_height: Visible height (may be larger to allow for scaling up)
  32. * @depth: Depth of the display in bits per pixel (16 or 32)
  33. * @pitch: Number of bytes per line of the display
  34. * @sample_rate: Current sample rate for audio
  35. * @audio_active: true if audio can be used
  36. * @inited: true if this module is initialised
  37. * @cur_buf: Current audio buffer being used by sandbox_sdl_fill_audio (0 or 1)
  38. * @buf: The two available audio buffers. SDL can be reading from one while we
  39. * are setting up the next
  40. * @running: true if audio is running
  41. * @stopping: true if audio will stop once it runs out of data
  42. * @texture: SDL texture to use for U-Boot display contents
  43. * @renderer: SDL renderer to use
  44. */
  45. static struct sdl_info {
  46. int width;
  47. int height;
  48. int vis_width;
  49. int vis_height;
  50. int depth;
  51. int pitch;
  52. uint sample_rate;
  53. bool audio_active;
  54. bool inited;
  55. int cur_buf;
  56. struct buf_info buf[2];
  57. bool running;
  58. bool stopping;
  59. SDL_Texture *texture;
  60. SDL_Renderer *renderer;
  61. } sdl;
  62. static void sandbox_sdl_poll_events(void)
  63. {
  64. /*
  65. * We don't want to include common.h in this file since it uses
  66. * system headers. So add a declation here.
  67. */
  68. extern void reset_cpu(void);
  69. SDL_Event event;
  70. while (SDL_PollEvent(&event)) {
  71. switch (event.type) {
  72. case SDL_QUIT:
  73. puts("LCD window closed - quitting\n");
  74. reset_cpu();
  75. break;
  76. }
  77. }
  78. }
  79. static int sandbox_sdl_ensure_init(void)
  80. {
  81. if (!sdl.inited) {
  82. if (SDL_Init(0) < 0) {
  83. printf("Unable to initialise SDL: %s\n",
  84. SDL_GetError());
  85. return -EIO;
  86. }
  87. atexit(SDL_Quit);
  88. sdl.inited = true;
  89. }
  90. return 0;
  91. }
  92. int sandbox_sdl_init_display(int width, int height, int log2_bpp,
  93. bool double_size)
  94. {
  95. struct sandbox_state *state = state_get_current();
  96. int err;
  97. if (!width || !state->show_lcd)
  98. return 0;
  99. err = sandbox_sdl_ensure_init();
  100. if (err)
  101. return err;
  102. if (SDL_InitSubSystem(SDL_INIT_VIDEO) < 0) {
  103. printf("Unable to initialise SDL LCD: %s\n", SDL_GetError());
  104. return -EPERM;
  105. }
  106. sdl.width = width;
  107. sdl.height = height;
  108. if (double_size) {
  109. sdl.vis_width = sdl.width * 2;
  110. sdl.vis_height = sdl.height * 2;
  111. } else {
  112. sdl.vis_width = sdl.width;
  113. sdl.vis_height = sdl.height;
  114. }
  115. sdl.depth = 1 << log2_bpp;
  116. sdl.pitch = sdl.width * sdl.depth / 8;
  117. SDL_Window *screen = SDL_CreateWindow("U-Boot", SDL_WINDOWPOS_UNDEFINED,
  118. SDL_WINDOWPOS_UNDEFINED,
  119. sdl.vis_width, sdl.vis_height,
  120. SDL_WINDOW_RESIZABLE);
  121. if (!screen) {
  122. printf("Unable to initialise SDL screen: %s\n",
  123. SDL_GetError());
  124. return -EIO;
  125. }
  126. if (log2_bpp != 4 && log2_bpp != 5) {
  127. printf("U-Boot SDL does not support depth %d\n", log2_bpp);
  128. return -EINVAL;
  129. }
  130. sdl.renderer = SDL_CreateRenderer(screen, -1,
  131. SDL_RENDERER_ACCELERATED |
  132. SDL_RENDERER_PRESENTVSYNC);
  133. if (!sdl.renderer) {
  134. printf("Unable to initialise SDL renderer: %s\n",
  135. SDL_GetError());
  136. return -EIO;
  137. }
  138. sdl.texture = SDL_CreateTexture(sdl.renderer, log2_bpp == 4 ?
  139. SDL_PIXELFORMAT_RGB565 :
  140. SDL_PIXELFORMAT_RGB888,
  141. SDL_TEXTUREACCESS_STREAMING,
  142. width, height);
  143. if (!sdl.texture) {
  144. printf("Unable to initialise SDL texture: %s\n",
  145. SDL_GetError());
  146. return -EBADF;
  147. }
  148. sandbox_sdl_poll_events();
  149. return 0;
  150. }
  151. int sandbox_sdl_sync(void *lcd_base)
  152. {
  153. SDL_UpdateTexture(sdl.texture, NULL, lcd_base, sdl.pitch);
  154. SDL_RenderCopy(sdl.renderer, sdl.texture, NULL, NULL);
  155. SDL_RenderPresent(sdl.renderer);
  156. sandbox_sdl_poll_events();
  157. return 0;
  158. }
  159. static const unsigned short sdl_to_keycode[SDL_NUM_SCANCODES] = {
  160. [SDL_SCANCODE_ESCAPE] = KEY_ESC,
  161. [SDL_SCANCODE_1] = KEY_1,
  162. [SDL_SCANCODE_2] = KEY_2,
  163. [SDL_SCANCODE_3] = KEY_3,
  164. [SDL_SCANCODE_4] = KEY_4,
  165. [SDL_SCANCODE_5] = KEY_5,
  166. [SDL_SCANCODE_6] = KEY_6,
  167. [SDL_SCANCODE_7] = KEY_7,
  168. [SDL_SCANCODE_8] = KEY_8,
  169. [SDL_SCANCODE_9] = KEY_9,
  170. [SDL_SCANCODE_0] = KEY_0,
  171. [SDL_SCANCODE_MINUS] = KEY_MINUS,
  172. [SDL_SCANCODE_EQUALS] = KEY_EQUAL,
  173. [SDL_SCANCODE_BACKSPACE] = KEY_BACKSPACE,
  174. [SDL_SCANCODE_TAB] = KEY_TAB,
  175. [SDL_SCANCODE_Q] = KEY_Q,
  176. [SDL_SCANCODE_W] = KEY_W,
  177. [SDL_SCANCODE_E] = KEY_E,
  178. [SDL_SCANCODE_R] = KEY_R,
  179. [SDL_SCANCODE_T] = KEY_T,
  180. [SDL_SCANCODE_Y] = KEY_Y,
  181. [SDL_SCANCODE_U] = KEY_U,
  182. [SDL_SCANCODE_I] = KEY_I,
  183. [SDL_SCANCODE_O] = KEY_O,
  184. [SDL_SCANCODE_P] = KEY_P,
  185. [SDL_SCANCODE_LEFTBRACKET] = KEY_LEFTBRACE,
  186. [SDL_SCANCODE_RIGHTBRACKET] = KEY_RIGHTBRACE,
  187. [SDL_SCANCODE_RETURN] = KEY_ENTER,
  188. [SDL_SCANCODE_LCTRL] = KEY_LEFTCTRL,
  189. [SDL_SCANCODE_A] = KEY_A,
  190. [SDL_SCANCODE_S] = KEY_S,
  191. [SDL_SCANCODE_D] = KEY_D,
  192. [SDL_SCANCODE_F] = KEY_F,
  193. [SDL_SCANCODE_G] = KEY_G,
  194. [SDL_SCANCODE_H] = KEY_H,
  195. [SDL_SCANCODE_J] = KEY_J,
  196. [SDL_SCANCODE_K] = KEY_K,
  197. [SDL_SCANCODE_L] = KEY_L,
  198. [SDL_SCANCODE_SEMICOLON] = KEY_SEMICOLON,
  199. [SDL_SCANCODE_APOSTROPHE] = KEY_APOSTROPHE,
  200. [SDL_SCANCODE_GRAVE] = KEY_GRAVE,
  201. [SDL_SCANCODE_LSHIFT] = KEY_LEFTSHIFT,
  202. [SDL_SCANCODE_BACKSLASH] = KEY_BACKSLASH,
  203. [SDL_SCANCODE_Z] = KEY_Z,
  204. [SDL_SCANCODE_X] = KEY_X,
  205. [SDL_SCANCODE_C] = KEY_C,
  206. [SDL_SCANCODE_V] = KEY_V,
  207. [SDL_SCANCODE_B] = KEY_B,
  208. [SDL_SCANCODE_N] = KEY_N,
  209. [SDL_SCANCODE_M] = KEY_M,
  210. [SDL_SCANCODE_COMMA] = KEY_COMMA,
  211. [SDL_SCANCODE_PERIOD] = KEY_DOT,
  212. [SDL_SCANCODE_SLASH] = KEY_SLASH,
  213. [SDL_SCANCODE_RSHIFT] = KEY_RIGHTSHIFT,
  214. [SDL_SCANCODE_KP_MULTIPLY] = KEY_KPASTERISK,
  215. [SDL_SCANCODE_LALT] = KEY_LEFTALT,
  216. [SDL_SCANCODE_SPACE] = KEY_SPACE,
  217. [SDL_SCANCODE_CAPSLOCK] = KEY_CAPSLOCK,
  218. [SDL_SCANCODE_F1] = KEY_F1,
  219. [SDL_SCANCODE_F2] = KEY_F2,
  220. [SDL_SCANCODE_F3] = KEY_F3,
  221. [SDL_SCANCODE_F4] = KEY_F4,
  222. [SDL_SCANCODE_F5] = KEY_F5,
  223. [SDL_SCANCODE_F6] = KEY_F6,
  224. [SDL_SCANCODE_F7] = KEY_F7,
  225. [SDL_SCANCODE_F8] = KEY_F8,
  226. [SDL_SCANCODE_F9] = KEY_F9,
  227. [SDL_SCANCODE_F10] = KEY_F10,
  228. [SDL_SCANCODE_NUMLOCKCLEAR] = KEY_NUMLOCK,
  229. [SDL_SCANCODE_SCROLLLOCK] = KEY_SCROLLLOCK,
  230. [SDL_SCANCODE_KP_7] = KEY_KP7,
  231. [SDL_SCANCODE_KP_8] = KEY_KP8,
  232. [SDL_SCANCODE_KP_9] = KEY_KP9,
  233. [SDL_SCANCODE_KP_MINUS] = KEY_KPMINUS,
  234. [SDL_SCANCODE_KP_4] = KEY_KP4,
  235. [SDL_SCANCODE_KP_5] = KEY_KP5,
  236. [SDL_SCANCODE_KP_6] = KEY_KP6,
  237. [SDL_SCANCODE_KP_PLUS] = KEY_KPPLUS,
  238. [SDL_SCANCODE_KP_1] = KEY_KP1,
  239. [SDL_SCANCODE_KP_2] = KEY_KP2,
  240. [SDL_SCANCODE_KP_3] = KEY_KP3,
  241. [SDL_SCANCODE_KP_0] = KEY_KP0,
  242. [SDL_SCANCODE_KP_PERIOD] = KEY_KPDOT,
  243. /* key 84 does not exist linux_input.h */
  244. [SDL_SCANCODE_LANG5] = KEY_ZENKAKUHANKAKU,
  245. [SDL_SCANCODE_NONUSBACKSLASH] = KEY_102ND,
  246. [SDL_SCANCODE_F11] = KEY_F11,
  247. [SDL_SCANCODE_F12] = KEY_F12,
  248. [SDL_SCANCODE_INTERNATIONAL1] = KEY_RO,
  249. [SDL_SCANCODE_LANG3] = KEY_KATAKANA,
  250. [SDL_SCANCODE_LANG4] = KEY_HIRAGANA,
  251. [SDL_SCANCODE_INTERNATIONAL4] = KEY_HENKAN,
  252. [SDL_SCANCODE_INTERNATIONAL2] = KEY_KATAKANAHIRAGANA,
  253. [SDL_SCANCODE_INTERNATIONAL5] = KEY_MUHENKAN,
  254. /* [SDL_SCANCODE_INTERNATIONAL5] -> [KEY_KPJPCOMMA] */
  255. [SDL_SCANCODE_KP_ENTER] = KEY_KPENTER,
  256. [SDL_SCANCODE_RCTRL] = KEY_RIGHTCTRL,
  257. [SDL_SCANCODE_KP_DIVIDE] = KEY_KPSLASH,
  258. [SDL_SCANCODE_SYSREQ] = KEY_SYSRQ,
  259. [SDL_SCANCODE_RALT] = KEY_RIGHTALT,
  260. /* KEY_LINEFEED */
  261. [SDL_SCANCODE_HOME] = KEY_HOME,
  262. [SDL_SCANCODE_UP] = KEY_UP,
  263. [SDL_SCANCODE_PAGEUP] = KEY_PAGEUP,
  264. [SDL_SCANCODE_LEFT] = KEY_LEFT,
  265. [SDL_SCANCODE_RIGHT] = KEY_RIGHT,
  266. [SDL_SCANCODE_END] = KEY_END,
  267. [SDL_SCANCODE_DOWN] = KEY_DOWN,
  268. [SDL_SCANCODE_PAGEDOWN] = KEY_PAGEDOWN,
  269. [SDL_SCANCODE_INSERT] = KEY_INSERT,
  270. [SDL_SCANCODE_DELETE] = KEY_DELETE,
  271. /* KEY_MACRO */
  272. [SDL_SCANCODE_MUTE] = KEY_MUTE,
  273. [SDL_SCANCODE_VOLUMEDOWN] = KEY_VOLUMEDOWN,
  274. [SDL_SCANCODE_VOLUMEUP] = KEY_VOLUMEUP,
  275. [SDL_SCANCODE_POWER] = KEY_POWER,
  276. [SDL_SCANCODE_KP_EQUALS] = KEY_KPEQUAL,
  277. [SDL_SCANCODE_KP_PLUSMINUS] = KEY_KPPLUSMINUS,
  278. [SDL_SCANCODE_PAUSE] = KEY_PAUSE,
  279. /* KEY_SCALE */
  280. [SDL_SCANCODE_KP_COMMA] = KEY_KPCOMMA,
  281. [SDL_SCANCODE_LANG1] = KEY_HANGUEL,
  282. [SDL_SCANCODE_LANG2] = KEY_HANJA,
  283. [SDL_SCANCODE_INTERNATIONAL3] = KEY_YEN,
  284. [SDL_SCANCODE_LGUI] = KEY_LEFTMETA,
  285. [SDL_SCANCODE_RGUI] = KEY_RIGHTMETA,
  286. [SDL_SCANCODE_APPLICATION] = KEY_COMPOSE,
  287. };
  288. int sandbox_sdl_scan_keys(int key[], int max_keys)
  289. {
  290. const Uint8 *keystate;
  291. int num_keys;
  292. int i, count;
  293. sandbox_sdl_poll_events();
  294. keystate = SDL_GetKeyboardState(&num_keys);
  295. for (i = count = 0; i < num_keys; i++) {
  296. if (count < max_keys && keystate[i]) {
  297. int keycode = sdl_to_keycode[i];
  298. if (keycode)
  299. key[count++] = keycode;
  300. }
  301. }
  302. return count;
  303. }
  304. int sandbox_sdl_key_pressed(int keycode)
  305. {
  306. int key[8]; /* allow up to 8 keys to be pressed at once */
  307. int count;
  308. int i;
  309. count = sandbox_sdl_scan_keys(key, sizeof(key) / sizeof(key[0]));
  310. for (i = 0; i < count; i++) {
  311. if (key[i] == keycode)
  312. return 0;
  313. }
  314. return -ENOENT;
  315. }
  316. void sandbox_sdl_fill_audio(void *udata, Uint8 *stream, int len)
  317. {
  318. struct buf_info *buf;
  319. int avail;
  320. bool have_data = false;
  321. int i;
  322. for (i = 0; i < 2; i++) {
  323. buf = &sdl.buf[sdl.cur_buf];
  324. avail = buf->size - buf->pos;
  325. if (avail <= 0) {
  326. sdl.cur_buf = 1 - sdl.cur_buf;
  327. continue;
  328. }
  329. if (avail > len)
  330. avail = len;
  331. have_data = true;
  332. SDL_MixAudio(stream, buf->data + buf->pos, avail,
  333. SDL_MIX_MAXVOLUME);
  334. buf->pos += avail;
  335. len -= avail;
  336. /* Move to next buffer if we are at the end */
  337. if (buf->pos == buf->size)
  338. buf->size = 0;
  339. else
  340. break;
  341. }
  342. sdl.stopping = !have_data;
  343. }
  344. int sandbox_sdl_sound_init(int rate, int channels)
  345. {
  346. SDL_AudioSpec wanted, have;
  347. int i;
  348. if (sandbox_sdl_ensure_init())
  349. return -1;
  350. if (sdl.audio_active)
  351. return 0;
  352. /* Set the audio format */
  353. wanted.freq = rate;
  354. wanted.format = AUDIO_S16;
  355. wanted.channels = channels;
  356. wanted.samples = 1024; /* Good low-latency value for callback */
  357. wanted.callback = sandbox_sdl_fill_audio;
  358. wanted.userdata = NULL;
  359. for (i = 0; i < 2; i++) {
  360. struct buf_info *buf = &sdl.buf[i];
  361. buf->alloced = sizeof(uint16_t) * wanted.freq * wanted.channels;
  362. buf->data = malloc(buf->alloced);
  363. if (!buf->data) {
  364. printf("%s: Out of memory\n", __func__);
  365. if (i == 1)
  366. free(sdl.buf[0].data);
  367. return -1;
  368. }
  369. buf->pos = 0;
  370. buf->size = 0;
  371. }
  372. if (SDL_InitSubSystem(SDL_INIT_AUDIO) < 0) {
  373. printf("Unable to initialise SDL audio: %s\n", SDL_GetError());
  374. goto err;
  375. }
  376. /* Open the audio device, forcing the desired format */
  377. if (SDL_OpenAudio(&wanted, &have) < 0) {
  378. printf("Couldn't open audio: %s\n", SDL_GetError());
  379. goto err;
  380. }
  381. if (have.format != wanted.format) {
  382. printf("Couldn't select required audio format\n");
  383. goto err;
  384. }
  385. sdl.audio_active = true;
  386. sdl.sample_rate = wanted.freq;
  387. sdl.cur_buf = 0;
  388. sdl.running = false;
  389. return 0;
  390. err:
  391. for (i = 0; i < 2; i++)
  392. free(sdl.buf[i].data);
  393. return -1;
  394. }
  395. int sandbox_sdl_sound_play(const void *data, uint size)
  396. {
  397. struct buf_info *buf;
  398. if (!sdl.audio_active)
  399. return 0;
  400. buf = &sdl.buf[0];
  401. if (buf->size)
  402. buf = &sdl.buf[1];
  403. while (buf->size)
  404. usleep(1000);
  405. if (size > buf->alloced)
  406. return -E2BIG;
  407. memcpy(buf->data, data, size);
  408. buf->size = size;
  409. buf->pos = 0;
  410. if (!sdl.running) {
  411. SDL_PauseAudio(0);
  412. sdl.running = true;
  413. sdl.stopping = false;
  414. }
  415. return 0;
  416. }
  417. int sandbox_sdl_sound_stop(void)
  418. {
  419. if (sdl.running) {
  420. while (!sdl.stopping)
  421. SDL_Delay(100);
  422. SDL_PauseAudio(1);
  423. sdl.running = 0;
  424. sdl.stopping = false;
  425. }
  426. return 0;
  427. }