platform/pandora/plat.c

   1 /*\r
   2  * PicoDrive\r
   3  * (C) notaz, 2010,2011\r
   4  *\r
   5  * This work is licensed under the terms of MAME license.\r
   6  * See COPYING file in the top-level directory.\r
   7  */\r
   8 \r
   9 #include <stdio.h>\r
  10 #include <unistd.h>\r
  11 #include <sys/types.h>\r
  12 #include <sys/stat.h>\r
  13 #include <fcntl.h>\r
  14 #include <sys/ioctl.h>\r
  15 #include <unistd.h>\r
  16 #include <linux/fb.h>\r
  17 #include <linux/omapfb.h>\r
  18 \r
  19 #include "../common/emu.h"\r
  20 #include "../common/menu.h"\r
  21 #include "../common/plat.h"\r
  22 #include "../common/arm_utils.h"\r
  23 #include "../common/input.h"\r
  24 #include "../linux/sndout_oss.h"\r
  25 #include "../linux/fbdev.h"\r
  26 #include "../linux/xenv.h"\r
  27 #include "plat.h"\r
  28 #include "asm_utils.h"\r
  29 #include "version.h"\r
  30 \r
  31 #include <pico/pico_int.h>\r
  32 \r
  33 #include <linux/input.h>\r
  34 \r
  35 static struct vout_fbdev *main_fb, *layer_fb;\r
  36 // g_layer_* - in use, g_layer_c* - configured custom\r
  37 int g_layer_cx, g_layer_cy, g_layer_cw, g_layer_ch;\r
  38 static int g_layer_x, g_layer_y;\r
  39 static int g_layer_w = 320, g_layer_h = 240;\r
  40 static int g_osd_fps_x, g_osd_y, doing_bg_frame;\r
  41 \r
  42 static const char pnd_script_base[] = "sudo -n /usr/pandora/scripts";\r
  43 static short __attribute__((aligned(4))) sndBuffer[2*44100/50];\r
  44 static unsigned char __attribute__((aligned(4))) fb_copy[g_screen_width * g_screen_height * 2];\r
  45 static void *temp_frame;\r
  46 unsigned char *PicoDraw2FB;\r
  47 const char *renderer_names[] = { NULL };\r
  48 const char *renderer_names32x[] = { NULL };\r
  49 \r
  50 static const char * const pandora_gpio_keys[KEY_MAX + 1] = {\r
  51         [0 ... KEY_MAX] = NULL,\r
  52         [KEY_UP]        = "Up",\r
  53         [KEY_LEFT]      = "Left",\r
  54         [KEY_RIGHT]     = "Right",\r
  55         [KEY_DOWN]      = "Down",\r
  56         [KEY_HOME]      = "A",\r
  57         [KEY_PAGEDOWN]  = "X",\r
  58         [KEY_END]       = "B",\r
  59         [KEY_PAGEUP]    = "Y",\r
  60         [KEY_RIGHTSHIFT]= "L",\r
  61         [KEY_RIGHTCTRL] = "R",\r
  62         [KEY_LEFTALT]   = "Start",\r
  63         [KEY_LEFTCTRL]  = "Select",\r
  64         [KEY_MENU]      = "Pandora",\r
  65 };\r
  66 \r
  67 struct in_default_bind in_evdev_defbinds[] =\r
  68 {\r
  69         /* MXYZ SACB RLDU */\r
  70         { KEY_UP,       IN_BINDTYPE_PLAYER12, 0 },\r
  71         { KEY_DOWN,     IN_BINDTYPE_PLAYER12, 1 },\r
  72         { KEY_LEFT,     IN_BINDTYPE_PLAYER12, 2 },\r
  73         { KEY_RIGHT,    IN_BINDTYPE_PLAYER12, 3 },\r
  74         { KEY_S,        IN_BINDTYPE_PLAYER12, 4 },      /* B */\r
  75         { KEY_D,        IN_BINDTYPE_PLAYER12, 5 },      /* C */\r
  76         { KEY_A,        IN_BINDTYPE_PLAYER12, 6 },      /* A */\r
  77         { KEY_ENTER,    IN_BINDTYPE_PLAYER12, 7 },\r
  78         { KEY_BACKSLASH, IN_BINDTYPE_EMU, PEVB_MENU },\r
  79         { KEY_SPACE,    IN_BINDTYPE_EMU, PEVB_MENU },\r
  80         /* Pandora */\r
  81         { KEY_PAGEDOWN, IN_BINDTYPE_PLAYER12, 4 },\r
  82         { KEY_END,      IN_BINDTYPE_PLAYER12, 5 },\r
  83         { KEY_HOME,     IN_BINDTYPE_PLAYER12, 6 },\r
  84         { KEY_LEFTALT,  IN_BINDTYPE_PLAYER12, 7 },\r
  85         { KEY_RIGHTSHIFT,IN_BINDTYPE_EMU, PEVB_STATE_SAVE },\r
  86         { KEY_RIGHTCTRL, IN_BINDTYPE_EMU, PEVB_STATE_LOAD },\r
  87         { KEY_LEFTCTRL,  IN_BINDTYPE_EMU, PEVB_MENU },\r
  88         { 0, 0, 0 }\r
  89 };\r
  90 \r
  91 static int get_cpu_clock(void)\r
  92 {\r
  93         FILE *f;\r
  94         int ret = 0;\r
  95         f = fopen("/proc/pandora/cpu_mhz_max", "r");\r
  96         if (f) {\r
  97                 fscanf(f, "%d", &ret);\r
  98                 fclose(f);\r
  99         }\r
 100         return ret;\r
 101 }\r
 102 \r
 103 void pemu_prep_defconfig(void)\r
 104 {\r
 105         defaultConfig.EmuOpt |= EOPT_VSYNC|EOPT_16BPP;\r
 106         defaultConfig.s_PicoOpt |= POPT_EN_MCD_GFX|POPT_EN_MCD_PSYNC;\r
 107         defaultConfig.scaling = SCALE_2x2_3x2;\r
 108 }\r
 109 \r
 110 void pemu_validate_config(void)\r
 111 {\r
 112         currentConfig.CPUclock = get_cpu_clock();\r
 113 }\r
 114 \r
 115 static void osd_text(int x, int y, const char *text)\r
 116 {\r
 117         int len = strlen(text)*8;\r
 118         int i, h;\r
 119 \r
 120         len++;\r
 121         for (h = 0; h < 8; h++) {\r
 122                 unsigned short *p;\r
 123                 p = (unsigned short *)g_screen_ptr + x + g_screen_width*(y + h);\r
 124                 for (i = len; i; i--, p++)\r
 125                         *p = (*p>>2) & 0x39e7;\r
 126         }\r
 127         emu_text_out16(x, y, text);\r
 128 }\r
 129 \r
 130 static void draw_cd_leds(void)\r
 131 {\r
 132         int old_reg;\r
 133         old_reg = Pico_mcd->s68k_regs[0];\r
 134 \r
 135         if (0) {\r
 136                 // 8-bit modes\r
 137                 unsigned int col_g = (old_reg & 2) ? 0xc0c0c0c0 : 0xe0e0e0e0;\r
 138                 unsigned int col_r = (old_reg & 1) ? 0xd0d0d0d0 : 0xe0e0e0e0;\r
 139                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*2+ 4) =\r
 140                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*3+ 4) =\r
 141                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*4+ 4) = col_g;\r
 142                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*2+12) =\r
 143                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*3+12) =\r
 144                 *(unsigned int *)((char *)g_screen_ptr + g_screen_width*4+12) = col_r;\r
 145         } else {\r
 146                 // 16-bit modes\r
 147                 unsigned int *p = (unsigned int *)((short *)g_screen_ptr + g_screen_width*2+4);\r
 148                 unsigned int col_g = (old_reg & 2) ? 0x06000600 : 0;\r
 149                 unsigned int col_r = (old_reg & 1) ? 0xc000c000 : 0;\r
 150                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += g_screen_width/2 - 12/2;\r
 151                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r; p += g_screen_width/2 - 12/2;\r
 152                 *p++ = col_g; *p++ = col_g; p+=2; *p++ = col_r; *p++ = col_r;\r
 153         }\r
 154 }\r
 155 \r
 156 static int emuscan(unsigned int num)\r
 157 {\r
 158         DrawLineDest = (unsigned short *)g_screen_ptr + num * g_screen_width;\r
 159 \r
 160         return 0;\r
 161 }\r
 162 \r
 163 void pemu_finalize_frame(const char *fps, const char *notice)\r
 164 {\r
 165         if (notice && notice[0])\r
 166                 osd_text(2, g_osd_y, notice);\r
 167         if (fps && fps[0] && (currentConfig.EmuOpt & EOPT_SHOW_FPS))\r
 168                 osd_text(g_osd_fps_x, g_osd_y, fps);\r
 169         if ((PicoAHW & PAHW_MCD) && (currentConfig.EmuOpt & EOPT_EN_CD_LEDS))\r
 170                 draw_cd_leds();\r
 171 }\r
 172 \r
 173 void plat_video_flip(void)\r
 174 {\r
 175         g_screen_ptr = vout_fbdev_flip(layer_fb);\r
 176 \r
 177         // XXX: drain OS event queue here, maybe we'll actually use it someday..\r
 178         int dummy;\r
 179         xenv_update(&dummy);\r
 180 }\r
 181 \r
 182 void plat_video_toggle_renderer(int change, int is_menu)\r
 183 {\r
 184 }\r
 185 \r
 186 void plat_video_menu_enter(int is_rom_loaded)\r
 187 {\r
 188 }\r
 189 \r
 190 void plat_video_menu_begin(void)\r
 191 {\r
 192 }\r
 193 \r
 194 void plat_video_menu_end(void)\r
 195 {\r
 196         g_menuscreen_ptr = vout_fbdev_flip(main_fb);\r
 197 }\r
 198 \r
 199 void plat_video_wait_vsync(void)\r
 200 {\r
 201         vout_fbdev_wait_vsync(main_fb);\r
 202 }\r
 203 \r
 204 void plat_status_msg_clear(void)\r
 205 {\r
 206         vout_fbdev_clear_lines(layer_fb, g_osd_y, 8);\r
 207 }\r
 208 \r
 209 void plat_status_msg_busy_next(const char *msg)\r
 210 {\r
 211         plat_status_msg_clear();\r
 212         pemu_finalize_frame("", msg);\r
 213         plat_video_flip();\r
 214         emu_status_msg("");\r
 215         reset_timing = 1;\r
 216 }\r
 217 \r
 218 void plat_status_msg_busy_first(const char *msg)\r
 219 {\r
 220         plat_status_msg_busy_next(msg);\r
 221 }\r
 222 \r
 223 void plat_update_volume(int has_changed, int is_up)\r
 224 {\r
 225         static int prev_frame = 0, wait_frames = 0;\r
 226         int vol = currentConfig.volume;\r
 227 \r
 228         if (has_changed)\r
 229         {\r
 230                 if (is_up) {\r
 231                         if (vol < 99) vol++;\r
 232                 } else {\r
 233                         if (vol >  0) vol--;\r
 234                 }\r
 235                 wait_frames = 0;\r
 236                 sndout_oss_setvol(vol, vol);\r
 237                 currentConfig.volume = vol;\r
 238                 emu_status_msg("VOL: %02i", vol);\r
 239                 prev_frame = Pico.m.frame_count;\r
 240         }\r
 241 }\r
 242 \r
 243 static void make_bg(int no_scale)\r
 244 {\r
 245         unsigned short *s = (void *)fb_copy;\r
 246         int x, y;\r
 247 \r
 248         memset32(g_menubg_src_ptr, 0, g_menuscreen_w * g_menuscreen_h * 2 / 4);\r
 249 \r
 250         if (!no_scale && g_menuscreen_w >= 640 && g_menuscreen_h >= 480) {\r
 251                 unsigned int t, *d = g_menubg_src_ptr;\r
 252                 d += (g_menuscreen_h / 2 - 480 / 2) * g_menuscreen_w / 2;\r
 253                 d += (g_menuscreen_w / 2 - 640 / 2) / 2;\r
 254                 for (y = 0; y < 240; y++, s += 320, d += g_menuscreen_w*2/2) {\r
 255                         for (x = 0; x < 320; x++) {\r
 256                                 t = s[x];\r
 257                                 t |= t << 16;\r
 258                                 d[x] = d[x + g_menuscreen_w / 2] = t;\r
 259                         }\r
 260                 }\r
 261                 return;\r
 262         }\r
 263 \r
 264         if (g_menuscreen_w >= 320 && g_menuscreen_h >= 240) {\r
 265                 unsigned short *d = g_menubg_src_ptr;\r
 266                 d += (g_menuscreen_h / 2 - 240 / 2) * g_menuscreen_w;\r
 267                 d += (g_menuscreen_w / 2 - 320 / 2);\r
 268                 for (y = 0; y < 240; y++, s += 320, d += g_menuscreen_w)\r
 269                         memcpy(d, s, 320*2);\r
 270                 return;\r
 271         }\r
 272 }\r
 273 \r
 274 void pemu_forced_frame(int no_scale, int do_emu)\r
 275 {\r
 276         doing_bg_frame = 1;\r
 277         emu_cmn_forced_frame(no_scale, do_emu);\r
 278         doing_bg_frame = 0;\r
 279 \r
 280         // making a copy because enabling the layer clears it's mem\r
 281         memcpy32((void *)fb_copy, g_screen_ptr, sizeof(fb_copy) / 4);\r
 282         make_bg(no_scale);\r
 283 }\r
 284 \r
 285 static void oss_write_nonblocking(int len)\r
 286 {\r
 287         // sndout_oss_can_write() is not reliable, only use with no_frmlimit\r
 288         if ((currentConfig.EmuOpt & EOPT_NO_FRMLIMIT) && !sndout_oss_can_write(len))\r
 289                 return;\r
 290 \r
 291         sndout_oss_write_nb(PsndOut, len);\r
 292 }\r
 293 \r
 294 void pemu_sound_start(void)\r
 295 {\r
 296         PsndOut = NULL;\r
 297 \r
 298         if (currentConfig.EmuOpt & EOPT_EN_SOUND)\r
 299         {\r
 300                 int is_stereo = (PicoOpt & POPT_EN_STEREO) ? 1 : 0;\r
 301 \r
 302                 PsndRerate(Pico.m.frame_count ? 1 : 0);\r
 303 \r
 304                 /*\r
 305                  * for 44k stereo, we do 1470 samples/emu_frame\r
 306                  * OMAP driver does power of 2 buffers, so we need at least 4K buffer.\r
 307                  * The most we can lag is 1K samples, size of OMAP's McBSP FIFO,\r
 308                  * with 2K sample buffer we might sometimes lag more than that,\r
 309                  * thus causing underflows.\r
 310                  */\r
 311                 printf("starting audio: %i len: %i stereo: %i, pal: %i\n",\r
 312                         PsndRate, PsndLen, is_stereo, Pico.m.pal);\r
 313                 sndout_oss_start(PsndRate, is_stereo, 2);\r
 314                 //sndout_oss_setvol(currentConfig.volume, currentConfig.volume);\r
 315                 PicoWriteSound = oss_write_nonblocking;\r
 316                 plat_update_volume(0, 0);\r
 317                 memset(sndBuffer, 0, sizeof(sndBuffer));\r
 318                 PsndOut = sndBuffer;\r
 319         }\r
 320 }\r
 321 \r
 322 void pemu_sound_stop(void)\r
 323 {\r
 324         sndout_oss_stop();\r
 325 }\r
 326 \r
 327 void pemu_sound_wait(void)\r
 328 {\r
 329         // don't need to do anything, writes will block by themselves\r
 330 }\r
 331 \r
 332 void plat_debug_cat(char *str)\r
 333 {\r
 334 }\r
 335 \r
 336 static int pnd_setup_layer_(int fd, int enabled, int x, int y, int w, int h)\r
 337 {\r
 338         struct omapfb_plane_info pi;\r
 339         struct omapfb_mem_info mi;\r
 340         int ret;\r
 341 \r
 342         ret = ioctl(fd, OMAPFB_QUERY_PLANE, &pi);\r
 343         if (ret != 0) {\r
 344                 perror("QUERY_PLANE");\r
 345                 return -1;\r
 346         }\r
 347 \r
 348         ret = ioctl(fd, OMAPFB_QUERY_MEM, &mi);\r
 349         if (ret != 0) {\r
 350                 perror("QUERY_MEM");\r
 351                 return -1;\r
 352         }\r
 353 \r
 354         /* must disable when changing stuff */\r
 355         if (pi.enabled) {\r
 356                 pi.enabled = 0;\r
 357                 ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);\r
 358                 if (ret != 0)\r
 359                         perror("SETUP_PLANE");\r
 360         }\r
 361 \r
 362         mi.size = 320*240*2*4;\r
 363         ret = ioctl(fd, OMAPFB_SETUP_MEM, &mi);\r
 364         if (ret != 0) {\r
 365                 perror("SETUP_MEM");\r
 366                 return -1;\r
 367         }\r
 368 \r
 369         pi.pos_x = x;\r
 370         pi.pos_y = y;\r
 371         pi.out_width = w;\r
 372         pi.out_height = h;\r
 373         pi.enabled = enabled;\r
 374 \r
 375         ret = ioctl(fd, OMAPFB_SETUP_PLANE, &pi);\r
 376         if (ret != 0) {\r
 377                 perror("SETUP_PLANE");\r
 378                 return -1;\r
 379         }\r
 380 \r
 381         return 0;\r
 382 }\r
 383 \r
 384 int pnd_setup_layer(int enabled, int x, int y, int w, int h)\r
 385 {\r
 386         return pnd_setup_layer_(vout_fbdev_get_fd(layer_fb), enabled, x, y, w, h);\r
 387 }\r
 388 \r
 389 void pnd_restore_layer_data(void)\r
 390 {\r
 391         short *t = (short *)fb_copy + 320*240 / 2 + 160;\r
 392 \r
 393         // right now this is used by menu, which wants to preview something\r
 394         // so try to get something on the layer.\r
 395         if ((t[0] | t[5] | t[13]) == 0)\r
 396                 memset32((void *)fb_copy, 0x07000700, sizeof(fb_copy) / 4);\r
 397 \r
 398         memcpy32(g_screen_ptr, (void *)fb_copy, 320*240*2 / 4);\r
 399         plat_video_flip();\r
 400 }\r
 401 \r
 402 static void apply_filter(int which)\r
 403 {\r
 404         char buf[128];\r
 405         int i;\r
 406 \r
 407         if (pnd_filter_list == NULL)\r
 408                 return;\r
 409 \r
 410         for (i = 0; i < which; i++)\r
 411                 if (pnd_filter_list[i] == NULL)\r
 412                         return;\r
 413 \r
 414         if (pnd_filter_list[i] == NULL)\r
 415                 return;\r
 416 \r
 417         snprintf(buf, sizeof(buf), "%s/op_videofir.sh %s", pnd_script_base, pnd_filter_list[i]);\r
 418         system(buf);\r
 419 }\r
 420 \r
 421 void emu_video_mode_change(int start_line, int line_count, int is_32cols)\r
 422 {\r
 423         int fb_w = 320, fb_h = 240, fb_left = 0, fb_right = 0, fb_top = 0, fb_bottom = 0;\r
 424 \r
 425         if (doing_bg_frame)\r
 426                 return;\r
 427 \r
 428         PicoDrawSetOutFormat(PDF_RGB555, 1);\r
 429         PicoDrawSetCallbacks(emuscan, NULL);\r
 430 \r
 431         if (is_32cols) {\r
 432                 fb_w = 256;\r
 433                 fb_left = fb_right = 32;\r
 434         }\r
 435 \r
 436         switch (currentConfig.scaling) {\r
 437         case SCALE_1x1:\r
 438                 g_layer_w = fb_w;\r
 439                 g_layer_h = fb_h;\r
 440                 break;\r
 441         case SCALE_2x2_3x2:\r
 442                 g_layer_w = fb_w * (is_32cols ? 3 : 2);\r
 443                 g_layer_h = fb_h * 2;\r
 444                 break;\r
 445         case SCALE_2x2_2x2:\r
 446                 g_layer_w = fb_w * 2;\r
 447                 g_layer_h = fb_h * 2;\r
 448                 break;\r
 449         case SCALE_FULLSCREEN:\r
 450                 g_layer_w = 800;\r
 451                 g_layer_h = 480;\r
 452                 break;\r
 453         case SCALE_CUSTOM:\r
 454                 g_layer_x = g_layer_cx;\r
 455                 g_layer_y = g_layer_cy;\r
 456                 g_layer_w = g_layer_cw;\r
 457                 g_layer_h = g_layer_ch;\r
 458                 break;\r
 459         }\r
 460 \r
 461         if (currentConfig.scaling != SCALE_CUSTOM) {\r
 462                 // center the layer\r
 463                 g_layer_x = 800 / 2 - g_layer_w / 2;\r
 464                 g_layer_y = 480 / 2 - g_layer_h / 2;\r
 465         }\r
 466 \r
 467         switch (currentConfig.scaling) {\r
 468         case SCALE_FULLSCREEN:\r
 469         case SCALE_CUSTOM:\r
 470                 fb_top = start_line;\r
 471                 fb_h = line_count;\r
 472                 break;\r
 473         }\r
 474         g_osd_fps_x = is_32cols ? 232 : 264;\r
 475         g_osd_y = fb_top + fb_h - 8;\r
 476 \r
 477         pnd_setup_layer(1, g_layer_x, g_layer_y, g_layer_w, g_layer_h);\r
 478         vout_fbdev_clear(layer_fb);\r
 479         vout_fbdev_resize(layer_fb, fb_w, fb_h, 16, fb_left, fb_right, fb_top, fb_bottom, 3);\r
 480         plat_video_flip();\r
 481 }\r
 482 \r
 483 void pemu_loop_prep(void)\r
 484 {\r
 485         static int pal_old = -1;\r
 486         static int filter_old = -1;\r
 487         char buf[128];\r
 488 \r
 489         if (currentConfig.CPUclock != get_cpu_clock()) {\r
 490                 snprintf(buf, sizeof(buf), "unset DISPLAY; echo y | %s/op_cpuspeed.sh %d",\r
 491                          pnd_script_base, currentConfig.CPUclock);\r
 492                 system(buf);\r
 493         }\r
 494 \r
 495         if (Pico.m.pal != pal_old) {\r
 496                 snprintf(buf, sizeof(buf), "%s/op_lcdrate.sh %d",\r
 497                          pnd_script_base, Pico.m.pal ? 50 : 60);\r
 498                 system(buf);\r
 499                 pal_old = Pico.m.pal;\r
 500         }\r
 501 \r
 502         if (currentConfig.filter != filter_old) {\r
 503                 apply_filter(currentConfig.filter);\r
 504                 filter_old = currentConfig.filter;\r
 505         }\r
 506 \r
 507         // make sure there is no junk left behind the layer\r
 508         memset32(g_menuscreen_ptr, 0, g_menuscreen_w * g_menuscreen_h * 2 / 4);\r
 509         g_menuscreen_ptr = vout_fbdev_flip(main_fb);\r
 510 \r
 511         // emu_video_mode_change will call pnd_setup_layer()\r
 512 \r
 513         // dirty buffers better go now than during gameplay\r
 514         sync();\r
 515         sleep(0);\r
 516 \r
 517         pemu_sound_start();\r
 518 }\r
 519 \r
 520 void pemu_loop_end(void)\r
 521 {\r
 522         pemu_sound_stop();\r
 523 \r
 524         /* do one more frame for menu bg */\r
 525         pemu_forced_frame(0, 1);\r
 526 \r
 527         pnd_setup_layer(0, g_layer_x, g_layer_y, g_layer_w, g_layer_h);\r
 528 }\r
 529 \r
 530 void plat_wait_till_us(unsigned int us_to)\r
 531 {\r
 532         unsigned int now;\r
 533         signed int diff;\r
 534 \r
 535         now = plat_get_ticks_us();\r
 536 \r
 537         // XXX: need to check NOHZ\r
 538         diff = (signed int)(us_to - now);\r
 539         if (diff > 10000) {\r
 540                 //printf("sleep %d\n", us_to - now);\r
 541                 usleep(diff * 15 / 16);\r
 542                 now = plat_get_ticks_us();\r
 543                 //printf(" wake %d\n", (signed)(us_to - now));\r
 544         }\r
 545 /*\r
 546         while ((signed int)(us_to - now) > 512) {\r
 547                 spend_cycles(1024);\r
 548                 now = plat_get_ticks_us();\r
 549         }\r
 550 */\r
 551 }\r
 552 \r
 553 void plat_early_init(void)\r
 554 {\r
 555 }\r
 556 \r
 557 void plat_init(void)\r
 558 {\r
 559         const char *main_fb_name, *layer_fb_name;\r
 560         int fd, ret, w, h;\r
 561 \r
 562         main_fb_name = getenv("FBDEV_MAIN");\r
 563         if (main_fb_name == NULL)\r
 564                 main_fb_name = "/dev/fb0";\r
 565 \r
 566         layer_fb_name = getenv("FBDEV_LAYER");\r
 567         if (layer_fb_name == NULL)\r
 568                 layer_fb_name = "/dev/fb1";\r
 569 \r
 570         // must set the layer up first to be able to use it\r
 571         fd = open(layer_fb_name, O_RDWR);\r
 572         if (fd == -1) {\r
 573                 fprintf(stderr, "%s: ", layer_fb_name);\r
 574                 perror("open");\r
 575                 exit(1);\r
 576         }\r
 577 \r
 578         ret = pnd_setup_layer_(fd, 0, g_layer_x, g_layer_y, g_layer_w, g_layer_h);\r
 579         close(fd);\r
 580         if (ret != 0) {\r
 581                 fprintf(stderr, "failed to set up layer, exiting.\n");\r
 582                 exit(1);\r
 583         }\r
 584 \r
 585         xenv_init();\r
 586 \r
 587         w = h = 0;\r
 588         main_fb = vout_fbdev_init(main_fb_name, &w, &h, 16, 2);\r
 589         if (main_fb == NULL) {\r
 590                 fprintf(stderr, "couldn't init fb: %s\n", main_fb_name);\r
 591                 exit(1);\r
 592         }\r
 593 \r
 594         g_menuscreen_w = w;\r
 595         g_menuscreen_h = h;\r
 596         g_menuscreen_ptr = vout_fbdev_flip(main_fb);\r
 597 \r
 598         w = 320; h = 240;\r
 599         layer_fb = vout_fbdev_init(layer_fb_name, &w, &h, 16, 3);\r
 600         if (layer_fb == NULL) {\r
 601                 fprintf(stderr, "couldn't init fb: %s\n", layer_fb_name);\r
 602                 goto fail0;\r
 603         }\r
 604 \r
 605         if (w != g_screen_width || h != g_screen_height) {\r
 606                 fprintf(stderr, "%dx%d not supported on %s\n", w, h, layer_fb_name);\r
 607                 goto fail1;\r
 608         }\r
 609         g_screen_ptr = vout_fbdev_flip(layer_fb);\r
 610 \r
 611         temp_frame = calloc(g_menuscreen_w * g_menuscreen_h * 2, 1);\r
 612         if (temp_frame == NULL) {\r
 613                 fprintf(stderr, "OOM\n");\r
 614                 goto fail1;\r
 615         }\r
 616         g_menubg_ptr = temp_frame;\r
 617         g_menubg_src_ptr = temp_frame;\r
 618         PicoDraw2FB = temp_frame;\r
 619 \r
 620         sndout_oss_init();\r
 621         pnd_menu_init();\r
 622 \r
 623         in_set_config(in_name_to_id("evdev:gpio-keys"), IN_CFG_KEY_NAMES,\r
 624                       pandora_gpio_keys, sizeof(pandora_gpio_keys));\r
 625         return;\r
 626 \r
 627 fail1:\r
 628         vout_fbdev_finish(layer_fb);\r
 629 fail0:\r
 630         vout_fbdev_finish(main_fb);\r
 631         exit(1);\r
 632 }\r
 633 \r
 634 void plat_finish(void)\r
 635 {\r
 636         sndout_oss_exit();\r
 637         vout_fbdev_finish(main_fb);\r
 638         xenv_finish();\r
 639 \r
 640         printf("all done\n");\r
 641 }\r
 642 \r