Home | History | Annotate | Download | only in ipod
      1 /*
      2     SDL - Simple DirectMedia Layer
      3     Copyright (C) 1997-2006 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