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