pandora/plat.c

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