e14743d1 |
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 | } |