| 1 | /* |
| 2 | SDL - Simple DirectMedia Layer |
| 3 | Copyright (C) 1997-2009 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@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 | } |