1 /* 2 SDL - Simple DirectMedia Layer 3 Copyright (C) 1997-2012 Sam Lantinga 4 5 This library is free software; you can redistribute it and/or 6 modify it under the terms of the GNU Lesser General Public 7 License as published by the Free Software Foundation; either 8 version 2.1 of the License, or (at your option) any later version. 9 10 This library is distributed in the hope that it will be useful, 11 but WITHOUT ANY WARRANTY; without even the implied warranty of 12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 13 Lesser General Public License for more details. 14 15 You should have received a copy of the GNU Lesser General Public 16 License along with this library; if not, write to the Free Software 17 Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA 18 19 Sam Lantinga 20 slouken (at) libsdl.org 21 */ 22 #include "SDL_config.h" 23 24 #include <sys/types.h> 25 #include <sys/ioctl.h> 26 27 #include <unistd.h> 28 #include <fcntl.h> 29 #include <string.h> 30 #include <termios.h> 31 #include <ctype.h> 32 33 #include <linux/vt.h> 34 #include <linux/kd.h> 35 #include <linux/keyboard.h> 36 #include <linux/fb.h> 37 38 #include "SDL_video.h" 39 #include "SDL_mouse.h" 40 #include "../SDL_sysvideo.h" 41 #include "../SDL_pixels_c.h" 42 #include "../../events/SDL_events_c.h" 43 #include "SDL_sysevents.h" 44 #include "SDL_ipodvideo.h" 45 46 #define _THIS SDL_VideoDevice *this 47 48 static int iPod_VideoInit (_THIS, SDL_PixelFormat *vformat); 49 static SDL_Rect **iPod_ListModes (_THIS, SDL_PixelFormat *format, Uint32 flags); 50 static SDL_Surface *iPod_SetVideoMode (_THIS, SDL_Surface *current, int width, int height, int bpp, Uint32 flags); 51 static int iPod_SetColors (_THIS, int firstcolor, int ncolors, SDL_Color *colors); 52 static void iPod_UpdateRects (_THIS, int nrects, SDL_Rect *rects); 53 static void iPod_VideoQuit (_THIS); 54 static void iPod_PumpEvents (_THIS); 55 56 static long iPod_GetGeneration(); 57 58 static int initd = 0; 59 static int kbfd = -1; 60 static int fbfd = -1; 61 static int oldvt = -1; 62 static int curvt = -1; 63 static int old_kbmode = -1; 64 static long generation = 0; 65 static struct termios old_termios, cur_termios; 66 67 FILE *dbgout; 68 69 #define LCD_DATA 0x10 70 #define LCD_CMD 0x08 71 #define IPOD_OLD_LCD_BASE 0xc0001000 72 #define IPOD_OLD_LCD_RTC 0xcf001110 73 #define IPOD_NEW_LCD_BASE 0x70003000 74 #define IPOD_NEW_LCD_RTC 0x60005010 75 76 static unsigned long lcd_base, lcd_rtc, lcd_width, lcd_height; 77 78 static long iPod_GetGeneration() 79 { 80 int i; 81 char cpuinfo[256]; 82 char *ptr; 83 FILE *file; 84 85 if ((file = fopen("/proc/cpuinfo", "r")) != NULL) { 86 while (fgets(cpuinfo, sizeof(cpuinfo), file) != NULL) 87 if (SDL_strncmp(cpuinfo, "Revision", 8) == 0) 88 break; 89 fclose(file); 90 } 91 for (i = 0; !isspace(cpuinfo[i]); i++); 92 for (; isspace(cpuinfo[i]); i++); 93 ptr = cpuinfo + i + 2; 94 95 return SDL_strtol(ptr, NULL, 10); 96 } 97 98 static int iPod_Available() 99 { 100 return 1; 101 } 102 103 static void iPod_DeleteDevice (SDL_VideoDevice *device) 104 { 105 free (device->hidden); 106 free (device); 107 } 108 109 void iPod_InitOSKeymap (_THIS) {} 110 111 static SDL_VideoDevice *iPod_CreateDevice (int devindex) 112 { 113 SDL_VideoDevice *this; 114 115 this = (SDL_VideoDevice *)SDL_malloc (sizeof(SDL_VideoDevice)); 116 if (this) { 117 memset (this, 0, sizeof *this); 118 this->hidden = (struct SDL_PrivateVideoData *) SDL_malloc (sizeof(struct SDL_PrivateVideoData)); 119 } 120 if (!this || !this->hidden) { 121 SDL_OutOfMemory(); 122 if (this) 123 SDL_free (this); 124 return 0; 125 } 126 memset (this->hidden, 0, sizeof(struct SDL_PrivateVideoData)); 127 128 generation = iPod_GetGeneration(); 129 130 this->VideoInit = iPod_VideoInit; 131 this->ListModes = iPod_ListModes; 132 this->SetVideoMode = iPod_SetVideoMode; 133 this->SetColors = iPod_SetColors; 134 this->UpdateRects = iPod_UpdateRects; 135 this->VideoQuit = iPod_VideoQuit; 136 this->AllocHWSurface = 0; 137 this->CheckHWBlit = 0; 138 this->FillHWRect = 0; 139 this->SetHWColorKey = 0; 140 this->SetHWAlpha = 0; 141 this->LockHWSurface = 0; 142 this->UnlockHWSurface = 0; 143 this->FlipHWSurface = 0; 144 this->FreeHWSurface = 0; 145 this->SetCaption = 0; 146 this->SetIcon = 0; 147 this->IconifyWindow = 0; 148 this->GrabInput = 0; 149 this->GetWMInfo = 0; 150 this->InitOSKeymap = iPod_InitOSKeymap; 151 this->PumpEvents = iPod_PumpEvents; 152 this->free = iPod_DeleteDevice; 153 154 return this; 155 } 156 157 VideoBootStrap iPod_bootstrap = { 158 "ipod", "iPod Framebuffer Driver", 159 iPod_Available, iPod_CreateDevice 160 }; 161 162 //--// 163 164 static int iPod_VideoInit (_THIS, SDL_PixelFormat *vformat) 165 { 166 if (!initd) { 167 /*** Code adapted/copied from SDL fbcon driver. ***/ 168 169 static const char * const tty0[] = { "/dev/tty0", "/dev/vc/0", 0 }; 170 static const char * const vcs[] = { "/dev/vc/%d", "/dev/tty%d", 0 }; 171 int i, tty0_fd; 172 173 dbgout = fdopen (open ("/etc/sdlpod.log", O_WRONLY | O_SYNC | O_APPEND), "a"); 174 if (dbgout) { 175 setbuf (dbgout, 0); 176 fprintf (dbgout, "--> Started SDL <--\n"); 177 } 178 179 // Try to query for a free VT 180 tty0_fd = -1; 181 for ( i=0; tty0[i] && (tty0_fd < 0); ++i ) { 182 tty0_fd = open(tty0[i], O_WRONLY, 0); 183 } 184 if ( tty0_fd < 0 ) { 185 tty0_fd = dup(0); /* Maybe stdin is a VT? */ 186 } 187 ioctl(tty0_fd, VT_OPENQRY, &curvt); 188 close(tty0_fd); 189 190 tty0_fd = open("/dev/tty", O_RDWR, 0); 191 if ( tty0_fd >= 0 ) { 192 ioctl(tty0_fd, TIOCNOTTY, 0); 193 close(tty0_fd); 194 } 195 196 if ( (geteuid() == 0) && (curvt > 0) ) { 197 for ( i=0; vcs[i] && (kbfd < 0); ++i ) { 198 char vtpath[12]; 199 200 SDL_snprintf(vtpath, SDL_arraysize(vtpath), vcs[i], curvt); 201 kbfd = open(vtpath, O_RDWR); 202 } 203 } 204 if ( kbfd < 0 ) { 205 if (dbgout) fprintf (dbgout, "Couldn't open any VC\n"); 206 return -1; 207 } 208 if (dbgout) fprintf (stderr, "Current VT: %d\n", curvt); 209 210 if (kbfd >= 0) { 211 /* Switch to the correct virtual terminal */ 212 if ( curvt > 0 ) { 213 struct vt_stat vtstate; 214 215 if ( ioctl(kbfd, VT_GETSTATE, &vtstate) == 0 ) { 216 oldvt = vtstate.v_active; 217 } 218 if ( ioctl(kbfd, VT_ACTIVATE, curvt) == 0 ) { 219 if (dbgout) fprintf (dbgout, "Waiting for switch to this VT... "); 220 ioctl(kbfd, VT_WAITACTIVE, curvt); 221 if (dbgout) fprintf (dbgout, "done!\n"); 222 } 223 } 224 225 // Set terminal input mode 226 if (tcgetattr (kbfd, &old_termios) < 0) { 227 if (dbgout) fprintf (dbgout, "Can't get termios\n"); 228 return -1; 229 } 230 cur_termios = old_termios; 231 // cur_termios.c_iflag &= ~(ICRNL | INPCK | ISTRIP | IXON); 232 // cur_termios.c_iflag |= (BRKINT); 233 // cur_termios.c_lflag &= ~(ICANON | ECHO | ISIG | IEXTEN); 234 // cur_termios.c_oflag &= ~(OPOST); 235 // cur_termios.c_oflag |= (ONOCR | ONLRET); 236 cur_termios.c_lflag &= ~(ICANON | ECHO | ISIG); 237 cur_termios.c_iflag &= ~(ISTRIP | IGNCR | ICRNL | INLCR | IXOFF | IXON); 238 cur_termios.c_cc[VMIN] = 0; 239 cur_termios.c_cc[VTIME] = 0; 240 241 if (tcsetattr (kbfd, TCSAFLUSH, &cur_termios) < 0) { 242 if (dbgout) fprintf (dbgout, "Can't set termios\n"); 243 return -1; 244 } 245 if (ioctl (kbfd, KDSKBMODE, K_MEDIUMRAW) < 0) { 246 if (dbgout) fprintf (dbgout, "Can't set medium-raw mode\n"); 247 return -1; 248 } 249 if (ioctl (kbfd, KDSETMODE, KD_GRAPHICS) < 0) { 250 if (dbgout) fprintf (dbgout, "Can't set graphics\n"); 251 return -1; 252 } 253 } 254 255 // Open the framebuffer 256 if ((fbfd = open ("/dev/fb0", O_RDWR)) < 0) { 257 if (dbgout) fprintf (dbgout, "Can't open framebuffer\n"); 258 return -1; 259 } else { 260 struct fb_var_screeninfo vinfo; 261 262 if (dbgout) fprintf (dbgout, "Generation: %ld\n", generation); 263 264 if (generation >= 40000) { 265 lcd_base = IPOD_NEW_LCD_BASE; 266 } else { 267 lcd_base = IPOD_OLD_LCD_BASE; 268 } 269 270 ioctl (fbfd, FBIOGET_VSCREENINFO, &vinfo); 271 close (fbfd); 272 273 if (lcd_base == IPOD_OLD_LCD_BASE) 274 lcd_rtc = IPOD_OLD_LCD_RTC; 275 else if (lcd_base == IPOD_NEW_LCD_BASE) 276 lcd_rtc = IPOD_NEW_LCD_RTC; 277 else { 278 SDL_SetError ("Unknown iPod version"); 279 return -1; 280 } 281 282 lcd_width = vinfo.xres; 283 lcd_height = vinfo.yres; 284 285 if (dbgout) fprintf (dbgout, "LCD is %dx%d\n", lcd_width, lcd_height); 286 } 287 288 fcntl (kbfd, F_SETFL, O_RDWR | O_NONBLOCK); 289 290 /* Determine the current screen size */ 291 this->info.current_w = lcd_width; 292 this->info.current_h = lcd_height; 293 294 if ((generation >= 60000) && (generation < 70000)) { 295 vformat->BitsPerPixel = 16; 296 vformat->Rmask = 0xF800; 297 vformat->Gmask = 0x07E0; 298 vformat->Bmask = 0x001F; 299 } else { 300 vformat->BitsPerPixel = 8; 301 vformat->Rmask = vformat->Gmask = vformat->Bmask = 0; 302 } 303 304 initd = 1; 305 if (dbgout) fprintf (dbgout, "Initialized.\n\n"); 306 } 307 return 0; 308 } 309 310 static SDL_Rect **iPod_ListModes (_THIS, SDL_PixelFormat *format, Uint32 flags) 311 { 312 int width, height, fd; 313 static SDL_Rect r; 314 static SDL_Rect *rs[2] = { &r, 0 }; 315 316 if ((fd = open ("/dev/fb0", O_RDWR)) < 0) { 317 return 0; 318 } else { 319 struct fb_var_screeninfo vinfo; 320 321 ioctl (fbfd, FBIOGET_VSCREENINFO, &vinfo); 322 close (fbfd); 323 324 width = vinfo.xres; 325 height = vinfo.yres; 326 } 327 r.x = r.y = 0; 328 r.w = width; 329 r.h = height; 330 return rs; 331 } 332 333 334 static SDL_Surface *iPod_SetVideoMode (_THIS, SDL_Surface *current, int width, int height, int bpp, 335 Uint32 flags) 336 { 337 Uint32 Rmask, Gmask, Bmask; 338 if (bpp > 8) { 339 Rmask = 0xF800; 340 Gmask = 0x07E0; 341 Bmask = 0x001F; 342 } else { 343 Rmask = Gmask = Bmask = 0; 344 } 345 346 if (this->hidden->buffer) SDL_free (this->hidden->buffer); 347 this->hidden->buffer = SDL_malloc (width * height * (bpp / 8)); 348 if (!this->hidden->buffer) { 349 SDL_SetError ("Couldn't allocate buffer for requested mode"); 350 return 0; 351 } 352 353 memset (this->hidden->buffer, 0, width * height * (bpp / 8)); 354 355 if (!SDL_ReallocFormat (current, bpp, Rmask, Gmask, Bmask, 0)) { 356 SDL_SetError ("Couldn't allocate new pixel format"); 357 SDL_free (this->hidden->buffer); 358 this->hidden->buffer = 0; 359 return 0; 360 } 361 362 if (bpp <= 8) { 363 int i, j; 364 for (i = 0; i < 256; i += 4) { 365 for (j = 0; j < 4; j++) { 366 current->format->palette->colors[i+j].r = 85 * j; 367 current->format->palette->colors[i+j].g = 85 * j; 368 current->format->palette->colors[i+j].b = 85 * j; 369 } 370 } 371 } 372 373 current->flags = flags & SDL_FULLSCREEN; 374 this->hidden->w = current->w = width; 375 this->hidden->h = current->h = height; 376 current->pitch = current->w * (bpp / 8); 377 current->pixels = this->hidden->buffer; 378 379 return current; 380 } 381 382 static int iPod_SetColors (_THIS, int firstcolor, int ncolors, SDL_Color *colors) 383 { 384 if (SDL_VideoSurface && SDL_VideoSurface->format && SDL_VideoSurface->format->palette) { 385 int i, j; 386 for (i = 0; i < 256; i += 4) { 387 for (j = 0; j < 4; j++) { 388 SDL_VideoSurface->format->palette->colors[i+j].r = 85 * j; 389 SDL_VideoSurface->format->palette->colors[i+j].g = 85 * j; 390 SDL_VideoSurface->format->palette->colors[i+j].b = 85 * j; 391 } 392 } 393 } 394 return 0; 395 } 396 397 static void iPod_VideoQuit (_THIS) 398 { 399 ioctl (kbfd, KDSETMODE, KD_TEXT); 400 tcsetattr (kbfd, TCSAFLUSH, &old_termios); 401 old_kbmode = -1; 402 403 if (oldvt > 0) 404 ioctl (kbfd, VT_ACTIVATE, oldvt); 405 406 if (kbfd > 0) 407 close (kbfd); 408 409 if (dbgout) { 410 fprintf (dbgout, "<-- Ended SDL -->\n"); 411 fclose (dbgout); 412 } 413 414 kbfd = -1; 415 } 416 417 static char iPod_SC_keymap[] = { 418 0, /* 0 - no key */ 419 '[' - 0x40, /* ESC (Ctrl+[) */ 420 '1', '2', '3', '4', '5', '6', '7', '8', '9', 421 '-', '=', 422 '\b', '\t', /* Backspace, Tab (Ctrl+H,Ctrl+I) */ 423 'q', 'w', 'e', 'r', 't', 'y', 'u', 'i', 'o', 'p', '[', ']', 424 '\n', 0, /* Enter, Left CTRL */ 425 'a', 's', 'd', 'f', 'g', 'h', 'j', 'k', 'l', ';', '\'', '`', 426 0, '\\', /* left shift, backslash */ 427 'z', 'x', 'c', 'v', 'b', 'n', 'm', ',', '.', '/', 428 0, '*', 0, ' ', 0, /* right shift, KP mul, left alt, space, capslock */ 429 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, /* F1-10 */ 430 0, 0, /* numlock, scrollock */ 431 '7', '8', '9', '-', '4', '5', '6', '+', '1', '2', '3', '0', '.', /* numeric keypad */ 432 0, 0, /* padding */ 433 0, 0, 0, /* "less" (?), F11, F12 */ 434 0, 0, 0, 0, 0, 0, 0, /* padding */ 435 '\n', 0, '/', 0, 0, /* KP enter, Rctrl, Ctrl, KP div, PrtSc, RAlt */ 436 0, 0, 0, 0, 0, 0, 0, 0, 0, /* Break, Home, Up, PgUp, Left, Right, End, Down, PgDn */ 437 0, 0, /* Ins, Del */ 438 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, /* padding */ 439 0, 0, /* RWin, LWin */ 440 0 /* no key */ 441 }; 442 443 444 static void iPod_keyboard() 445 { 446 unsigned char keybuf[128]; 447 int i, nread; 448 SDL_keysym keysym; 449 SDL_Event ev; 450 451 keysym.mod = 0; 452 keysym.scancode = 0xff; 453 memset (&ev, 0, sizeof(SDL_Event)); 454 455 nread = read (kbfd, keybuf, 128); 456 for (i = 0; i < nread; i++) { 457 char ascii = iPod_SC_keymap[keybuf[i] & 0x7f]; 458 459 if (dbgout) fprintf (dbgout, "Key! %02x is %c %s", keybuf[i], ascii, (keybuf[i] & 0x80)? "up" : "down"); 460 461 keysym.sym = keysym.unicode = ascii; 462 ev.type = (keybuf[i] & 0x80)? SDL_KEYUP : SDL_KEYDOWN; 463 ev.key.state = 0; 464 ev.key.keysym = keysym; 465 SDL_PushEvent (&ev); 466 } 467 } 468 469 static void iPod_PumpEvents (_THIS) 470 { 471 fd_set fdset; 472 int max_fd = 0; 473 static struct timeval zero; 474 int posted; 475 476 do { 477 posted = 0; 478 479 FD_ZERO (&fdset); 480 if (kbfd >= 0) { 481 FD_SET (kbfd, &fdset); 482 max_fd = kbfd; 483 } 484 if (dbgout) fprintf (dbgout, "Selecting"); 485 if (select (max_fd + 1, &fdset, 0, 0, &zero) > 0) { 486 if (dbgout) fprintf (dbgout, " -> match!\n"); 487 iPod_keyboard(); 488 posted++; 489 } 490 if (dbgout) fprintf (dbgout, "\n"); 491 } while (posted); 492 } 493 494 // enough space for 160x128x2 495 static char ipod_scr[160 * (128/4)]; 496 497 #define outl(datum,addr) (*(volatile unsigned long *)(addr) = (datum)) 498 #define inl(addr) (*(volatile unsigned long *)(addr)) 499 500 /*** The following LCD code is taken from Linux kernel uclinux-2.4.24-uc0-ipod2, 501 file arch/armnommu/mach-ipod/fb.c. A few modifications have been made. ***/ 502 503 /* get current usec counter */ 504 static int M_timer_get_current(void) 505 { 506 return inl(lcd_rtc); 507 } 508 509 /* check if number of useconds has past */ 510 static int M_timer_check(int clock_start, int usecs) 511 { 512 unsigned long clock; 513 clock = inl(lcd_rtc); 514 515 if ( (clock - clock_start) >= usecs ) { 516 return 1; 517 } else { 518 return 0; 519 } 520 } 521 522 /* wait for LCD with timeout */ 523 static void M_lcd_wait_write(void) 524 { 525 if ( (inl(lcd_base) & 0x8000) != 0 ) { 526 int start = M_timer_get_current(); 527 528 do { 529 if ( (inl(lcd_base) & (unsigned int)0x8000) == 0 ) 530 break; 531 } while ( M_timer_check(start, 1000) == 0 ); 532 } 533 } 534 535 536 /* send LCD data */ 537 static void M_lcd_send_data(int data_lo, int data_hi) 538 { 539 M_lcd_wait_write(); 540 541 outl(data_lo, lcd_base + LCD_DATA); 542 543 M_lcd_wait_write(); 544 545 outl(data_hi, lcd_base + LCD_DATA); 546 547 } 548 549 /* send LCD command */ 550 static void 551 M_lcd_prepare_cmd(int cmd) 552 { 553 M_lcd_wait_write(); 554 555 outl(0x0, lcd_base + LCD_CMD); 556 557 M_lcd_wait_write(); 558 559 outl(cmd, lcd_base + LCD_CMD); 560 561 } 562 563 /* send LCD command and data */ 564 static void M_lcd_cmd_and_data(int cmd, int data_lo, int data_hi) 565 { 566 M_lcd_prepare_cmd(cmd); 567 568 M_lcd_send_data(data_lo, data_hi); 569 } 570 571 // Copied from uW 572 static void M_update_display(int sx, int sy, int mx, int my) 573 { 574 int y; 575 unsigned short cursor_pos; 576 577 sx >>= 3; 578 mx >>= 3; 579 580 cursor_pos = sx + (sy << 5); 581 582 for ( y = sy; y <= my; y++ ) { 583 unsigned char *img_data; 584 int x; 585 586 /* move the cursor */ 587 M_lcd_cmd_and_data(0x11, cursor_pos >> 8, cursor_pos & 0xff); 588 589 /* setup for printing */ 590 M_lcd_prepare_cmd(0x12); 591 592 img_data = ipod_scr + (sx << 1) + (y * (lcd_width/4)); 593 594 /* loops up to 160 times */ 595 for ( x = sx; x <= mx; x++ ) { 596 /* display eight pixels */ 597 M_lcd_send_data(*(img_data + 1), *img_data); 598 599 img_data += 2; 600 } 601 602 /* update cursor pos counter */ 603 cursor_pos += 0x20; 604 } 605 } 606 607 /* get current usec counter */ 608 static int C_timer_get_current(void) 609 { 610 return inl(0x60005010); 611 } 612 613 /* check if number of useconds has past */ 614 static int C_timer_check(int clock_start, int usecs) 615 { 616 unsigned long clock; 617 clock = inl(0x60005010); 618 619 if ( (clock - clock_start) >= usecs ) { 620 return 1; 621 } else { 622 return 0; 623 } 624 } 625 626 /* wait for LCD with timeout */ 627 static void C_lcd_wait_write(void) 628 { 629 if ((inl(0x70008A0C) & 0x80000000) != 0) { 630 int start = C_timer_get_current(); 631 632 do { 633 if ((inl(0x70008A0C) & 0x80000000) == 0) 634 break; 635 } while (C_timer_check(start, 1000) == 0); 636 } 637 } 638 static void C_lcd_cmd_data(int cmd, int data) 639 { 640 C_lcd_wait_write(); 641 outl(cmd | 0x80000000, 0x70008A0C); 642 643 C_lcd_wait_write(); 644 outl(data | 0x80000000, 0x70008A0C); 645 } 646 647 static void C_update_display(int sx, int sy, int mx, int my) 648 { 649 int height = (my - sy) + 1; 650 int width = (mx - sx) + 1; 651 652 char *addr = SDL_VideoSurface->pixels; 653 654 if (width & 1) width++; 655 656 /* start X and Y */ 657 C_lcd_cmd_data(0x12, (sy & 0xff)); 658 C_lcd_cmd_data(0x13, (((SDL_VideoSurface->w - 1) - sx) & 0xff)); 659 660 /* max X and Y */ 661 C_lcd_cmd_data(0x15, (((sy + height) - 1) & 0xff)); 662 C_lcd_cmd_data(0x16, (((((SDL_VideoSurface->w - 1) - sx) - width) + 1) & 0xff)); 663 664 addr += sx + sy * SDL_VideoSurface->pitch; 665 666 while (height > 0) { 667 int h, x, y, pixels_to_write; 668 669 pixels_to_write = (width * height) * 2; 670 671 /* calculate how much we can do in one go */ 672 h = height; 673 if (pixels_to_write > 64000) { 674 h = (64000/2) / width; 675 pixels_to_write = (width * h) * 2; 676 } 677 678 outl(0x10000080, 0x70008A20); 679 outl((pixels_to_write - 1) | 0xC0010000, 0x70008A24); 680 outl(0x34000000, 0x70008A20); 681 682 /* for each row */ 683 for (x = 0; x < h; x++) 684 { 685 /* for each column */ 686 for (y = 0; y < width; y += 2) { 687 unsigned two_pixels; 688 689 two_pixels = addr[0] | (addr[1] << 16); 690 addr += 2; 691 692 while ((inl(0x70008A20) & 0x1000000) == 0); 693 694 /* output 2 pixels */ 695 outl(two_pixels, 0x70008B00); 696 } 697 698 addr += SDL_VideoSurface->w - width; 699 } 700 701 while ((inl(0x70008A20) & 0x4000000) == 0); 702 703 outl(0x0, 0x70008A24); 704 705 height = height - h; 706 } 707 } 708 709 // Should work with photo. However, I don't have one, so I'm not sure. 710 static void iPod_UpdateRects (_THIS, int nrects, SDL_Rect *rects) 711 { 712 if (SDL_VideoSurface->format->BitsPerPixel == 16) { 713 C_update_display (0, 0, lcd_width, lcd_height); 714 } else { 715 int i, y, x; 716 for (i = 0; i < nrects; i++) { 717 SDL_Rect *r = rects + i; 718 if (!r) { 719 continue; 720 } 721 722 for (y = r->y; (y < r->y + r->h) && y < lcd_height; y++) { 723 for (x = r->x; (x < r->x + r->w) && x < lcd_width; x++) { 724 ipod_scr[y*(lcd_width/4) + x/4] &= ~(3 << (2 * (x%4))); 725 ipod_scr[y*(lcd_width/4) + x/4] |= 726 (((Uint8*)(SDL_VideoSurface->pixels))[ y*SDL_VideoSurface->pitch + x ] & 3) << (2 * (x%4)); 727 } 728 } 729 } 730 731 M_update_display (0, 0, lcd_width, lcd_height); 732 } 733 } 734
