0ec348b9 |
1 | #include <stdio.h> |
2 | #include <stdlib.h> |
3 | #include <string.h> |
4 | #include <sys/time.h> |
5 | #include <SDL/SDL.h> |
6 | |
7 | #include "pmsdl.h" |
8 | #include "linux/fbdev.h" |
9 | |
10 | #define err(fmt, ...) fprintf(stderr, "psdl: " fmt "\n", ##__VA_ARGS__) |
11 | #if 0 |
12 | #define trace(fmt, ...) printf(" %s(" fmt ")\n", __FUNCTION__, ##__VA_ARGS__) |
13 | #define dbg err |
14 | #else |
15 | #define trace(...) |
16 | #define dbg(...) |
17 | #endif |
18 | |
19 | static SDL_Surface *g_screen; |
20 | static void *g_screen_fbp; |
21 | static Uint16 g_8bpp_pal[256]; |
22 | static Uint32 g_start_ticks; |
23 | static Uint8 g_keystate[SDLK_LAST]; |
24 | |
25 | static inline int min(int v1, int v2) |
26 | { |
27 | return v1 < v2 ? v1 : v2; |
28 | } |
29 | |
30 | #define ARRAY_SIZE(x) (sizeof(x) / sizeof(x[0])) |
31 | |
32 | static SDL_Surface *alloc_surface(int w, int h, int bpp) |
33 | { |
34 | // SDL has some pointer overuse, every surface has a format, |
35 | // why make format accessible through pointer? |
36 | struct { |
37 | SDL_Surface s; |
38 | SDL_PixelFormat f; |
39 | } *ret; |
40 | |
41 | ret = calloc(1, sizeof(*ret)); |
42 | if (ret == NULL) |
43 | return NULL; |
44 | |
45 | ret->s.format = &ret->f; |
46 | ret->f.BitsPerPixel = bpp; |
47 | ret->f.BytesPerPixel = (bpp + 7) / 8; |
48 | |
49 | ret->s.w = w; |
50 | ret->s.h = h; |
51 | ret->s.pitch = w * ret->f.BytesPerPixel; |
52 | // XXX: more fields |
53 | |
54 | return &ret->s; |
55 | } |
56 | |
57 | DECLSPEC int SDLCALL |
58 | SDL_Init(Uint32 flags) |
59 | { |
60 | trace("%08x", flags); |
61 | |
62 | g_start_ticks = 0; |
63 | g_start_ticks = SDL_GetTicks(); |
64 | |
65 | return 0; |
66 | } |
67 | |
68 | DECLSPEC void SDLCALL |
69 | SDL_Quit(void) |
70 | { |
71 | trace(""); |
72 | } |
73 | |
74 | DECLSPEC int SDLCALL |
75 | SDL_InitSubSystem(Uint32 flags) |
76 | { |
77 | trace("%08x", flags); |
78 | return 0; |
79 | } |
80 | |
81 | DECLSPEC void SDLCALL |
82 | SDL_QuitSubSystem(Uint32 flags) |
83 | { |
84 | trace("%08x", flags); |
85 | } |
86 | |
87 | DECLSPEC Uint32 SDLCALL |
88 | SDL_GetTicks(void) |
89 | { |
90 | struct timeval tv; |
91 | Uint32 ret; |
92 | |
93 | gettimeofday(&tv, NULL); |
94 | ret = tv.tv_sec * 1000; |
95 | ret += tv.tv_usec * 1048 >> 20; |
96 | |
97 | ret -= g_start_ticks; |
98 | dbg(" SDL_GetTicks %d", ret); |
99 | return ret; |
100 | } |
101 | |
102 | DECLSPEC SDL_Surface * SDLCALL |
103 | SDL_SetVideoMode(int width, int height, int bpp, Uint32 flags) |
104 | { |
105 | struct vout_fbdev *fbdev; |
106 | |
107 | trace("%d, %d, %d, %08x", width, height, bpp, flags); |
108 | |
109 | if (bpp != 8 && bpp != 16) { |
110 | err("unsupported bpp: %d\n", bpp); |
111 | return NULL; |
112 | } |
113 | |
114 | // XXX: destroy old g_screen? |
115 | |
116 | g_screen = alloc_surface(width, height, bpp); |
117 | if (g_screen == NULL) |
118 | return NULL; |
119 | |
120 | fbdev = vout_fbdev_init("/dev/fb0", &width, &height, 0); |
121 | if (fbdev == NULL) |
122 | goto fail_fbdev_init; |
123 | |
124 | g_screen_fbp = vout_fbdev_flip(fbdev); |
125 | if (bpp == 16) |
126 | g_screen->pixels = g_screen_fbp; |
127 | else |
128 | // we have to fake this for now.. |
129 | g_screen->pixels = calloc(g_screen->pitch * height, 1); |
130 | |
131 | if (g_screen->pixels == NULL) { |
132 | err("fb NULL"); |
133 | goto fail_pixels; |
134 | } |
135 | g_screen->hwdata = (void *)fbdev; |
136 | |
137 | dbg("returning %p", g_screen); |
138 | return g_screen; |
139 | |
140 | fail_pixels: |
141 | vout_fbdev_finish(fbdev); |
142 | fail_fbdev_init: |
143 | free(g_screen); |
144 | g_screen = NULL; |
145 | return NULL; |
146 | } |
147 | |
148 | DECLSPEC int SDLCALL |
149 | SDL_Flip(SDL_Surface *screen) |
150 | { |
151 | struct vout_fbdev *fbdev; |
152 | |
153 | trace("%p", screen); |
154 | |
155 | if (screen != g_screen) { |
156 | err("flip not on screen surface?"); |
157 | return -1; |
158 | } |
159 | |
160 | if (screen->format->BitsPerPixel == 8) { |
161 | int l = screen->pitch * screen->h; |
162 | #if 1 |
163 | do_clut(g_screen_fbp, screen->pixels, g_8bpp_pal, l); |
164 | #else |
165 | Uint16 *d = g_screen_fbp; |
166 | Uint8 *s = screen->pixels; |
167 | |
168 | // XXX: perhaps optimize this sh*t |
169 | for (; l > 0; d++, s++, l--) |
170 | *d = g_8bpp_pal[*s]; |
171 | #endif |
172 | } |
173 | |
174 | fbdev = (void *)screen->hwdata; |
175 | g_screen_fbp = vout_fbdev_flip(fbdev); |
176 | |
177 | if (screen->format->BitsPerPixel != 8) |
178 | screen->pixels = g_screen_fbp; |
179 | |
180 | return 0; |
181 | } |
182 | |
183 | static int do_rect_clip(const SDL_Surface *s, SDL_Rect *r) |
184 | { |
185 | int x = r->x, y = r->y, w = r->w, h = r->h; |
186 | |
187 | if (x < 0) { |
188 | w += x; |
189 | if (w < 0) |
190 | w = 0; |
191 | x = 0; |
192 | } |
193 | if (y < 0) { |
194 | h += y; |
195 | if (h < 0) |
196 | h = 0; |
197 | y = 0; |
198 | } |
199 | if (x + w > s->w) { |
200 | w = s->w - x; |
201 | if (w < 0) |
202 | w = 0; |
203 | } |
204 | if (y + h > s->h) { |
205 | h = s->h - y; |
206 | if (h < 0) |
207 | h = 0; |
208 | } |
209 | |
210 | r->x = x; r->y = y; r->w = w; r->h = h; |
211 | return (w > 0 && h > 0) ? 0 : -1; |
212 | } |
213 | |
214 | DECLSPEC int SDLCALL |
215 | SDL_UpperBlit(SDL_Surface *src, SDL_Rect *srcrect, |
216 | SDL_Surface *dst, SDL_Rect *dstrect) |
217 | { |
218 | int sx = 0, sy = 0, sw, sh; |
219 | int dx = 0, dy = 0; |
220 | SDL_Rect tmprect = { 0, }; |
221 | |
222 | trace("%p, %p, %p, %p", src, srcrect, dst, dstrect); |
223 | |
224 | if (src == NULL || dst == NULL) |
225 | return -1; |
226 | |
227 | if (srcrect != NULL) { |
228 | // XXX: dst pos may need to be adjusted in some corner cases |
229 | if (do_rect_clip(src, srcrect) < 0) |
230 | return -1; |
231 | sx = srcrect->x; |
232 | sy = srcrect->y; |
233 | sw = srcrect->w; |
234 | sh = srcrect->h; |
235 | } else { |
236 | sw = src->w; |
237 | sh = src->h; |
238 | } |
239 | |
240 | if (dstrect == NULL) |
241 | dstrect = &tmprect; |
242 | |
243 | // SDL just uses source w and h |
244 | dstrect->w = sw; |
245 | dstrect->h = sh; |
246 | if (do_rect_clip(dst, dstrect) < 0) |
247 | return -1; |
248 | dx = dstrect->x; |
249 | dy = dstrect->y; |
250 | sw = dstrect->w; |
251 | sh = dstrect->h; |
252 | |
253 | dbg("(%d %d %d %d) -> (%d %d %d %d)", sx, sy, sw, sh, dx, dy, sw, sh); |
254 | |
255 | if (src->format->BitsPerPixel == dst->format->BitsPerPixel) { |
256 | int Bpp = src->format->BytesPerPixel; |
257 | int dpitch = dst->pitch; |
258 | int spitch = src->pitch; |
259 | Uint8 *d = (Uint8 *)dst->pixels + dpitch * dy + dx * Bpp; |
260 | Uint8 *s = (Uint8 *)src->pixels + spitch * sy + sx * Bpp; |
261 | |
262 | for (sw *= Bpp; sh > 0; d += dpitch, s += spitch, sh--) |
263 | memcpy(d, s, sw); |
264 | } |
265 | // else TODO |
266 | |
267 | return 0; |
268 | } |
269 | |
270 | DECLSPEC SDL_Surface * SDLCALL |
271 | SDL_CreateRGBSurface(Uint32 flags, int width, int height, int depth, |
272 | Uint32 Rmask, Uint32 Gmask, Uint32 Bmask, Uint32 Amask) |
273 | { |
274 | SDL_Surface *ret; |
275 | |
276 | trace("%08x, %d, %d, %d, %04x, %04x, %04x, %04x", |
277 | flags, width, height, depth, Rmask, Gmask, Bmask, Amask); |
278 | |
279 | ret = alloc_surface(width, height, depth); |
280 | if (ret == NULL) |
281 | return NULL; |
282 | |
283 | ret->pixels = calloc(ret->pitch * height, 1); |
284 | if (ret->pixels == NULL) |
285 | goto fail; |
286 | |
287 | dbg("returning %p", ret); |
288 | return ret; |
289 | |
290 | fail: |
291 | free(ret); |
292 | return NULL; |
293 | } |
294 | |
295 | DECLSPEC int SDLCALL |
296 | SDL_SetColors(SDL_Surface *surface, SDL_Color *colors, int firstcolor, int ncolors) |
297 | { |
298 | int i, to; |
299 | |
300 | trace("%p, %p, %d, %d", surface, colors, firstcolor, ncolors); |
301 | |
302 | if (surface != g_screen) |
303 | return 0; |
304 | |
305 | to = min(ARRAY_SIZE(g_8bpp_pal), firstcolor + ncolors); |
306 | for (i = firstcolor; i < to; i++) { |
307 | SDL_Color *c = &colors[i - firstcolor]; |
308 | int r = c->r, g = c->g, b = c->b; |
309 | // noiz2sa gets a good deal darker that real SDL, |
310 | // don't know what's going on there |
311 | /* |
312 | if (r < 0xf8 && (r & 7) > 3) r += 8; |
313 | if (g < 0xfc && (g & 3) > 1) g += 4; |
314 | if (b < 0xf8 && (b & 7) > 3) b += 8; |
315 | */ |
316 | g_8bpp_pal[i] = ((r << 8) & 0xf800) | ((g << 3) & 0x07e0) | (b >> 3); |
317 | // g_8bpp_pal[i] += 0x0821; |
318 | } |
319 | |
320 | return 0; |
321 | } |
322 | |
323 | DECLSPEC int SDLCALL |
324 | SDL_FillRect(SDL_Surface *dst, SDL_Rect *dstrect, Uint32 color) |
325 | { |
326 | trace("%p, %p, %04x", dst, dstrect, color); |
327 | |
328 | if (dst->format->BytesPerPixel == 2) { |
329 | err("SDL_FillRect TODO"); |
330 | return -1; |
331 | } |
332 | else |
333 | memset(dst->pixels, color, dst->pitch * dst->h); |
334 | |
335 | return 0; |
336 | } |
337 | |
338 | /* |
339 | DECLSPEC SDL_Surface * SDLCALL |
340 | SDL_CreateRGBSurfaceFrom(void *pixels, int width, int height, int depth, int pitch, |
341 | Uint32 Rmask, Uint32 Gmask, Uint32 Bmask, Uint32 Amask) |
342 | { |
343 | } |
344 | */ |
345 | |
346 | DECLSPEC SDL_RWops * SDLCALL |
347 | SDL_RWFromFile(const char *file, const char *mode) |
348 | { |
349 | SDL_RWops *ret; |
350 | FILE *f; |
351 | |
352 | trace("%s, %s", file, mode); |
353 | |
354 | f = fopen(file, mode); |
355 | if (f == NULL) |
356 | return NULL; |
357 | |
358 | ret = calloc(1, sizeof(*ret)); |
359 | if (ret == NULL) { |
360 | fclose(f); |
361 | return NULL; |
362 | } |
363 | ret->hidden.stdio.fp = f; |
364 | |
365 | return ret; |
366 | } |
367 | |
368 | DECLSPEC void SDLCALL |
369 | SDL_FreeRW(SDL_RWops *area) |
370 | { |
371 | if (area->hidden.stdio.fp) { |
372 | fclose(area->hidden.stdio.fp); |
373 | area->hidden.stdio.fp = NULL; |
374 | } |
375 | free(area); |
376 | } |
377 | |
378 | DECLSPEC SDL_Surface * SDLCALL |
379 | SDL_LoadBMP_RW(SDL_RWops *src, int freesrc) |
380 | { |
381 | struct bmp_dib_v3 { |
382 | unsigned char magic[2]; |
383 | uint32_t filesz; |
384 | uint16_t creator1; |
385 | uint16_t creator2; |
386 | uint32_t bmp_offset; |
387 | uint32_t header_sz; |
388 | int32_t width; |
389 | int32_t height; |
390 | uint16_t nplanes; |
391 | uint16_t bitspp; |
392 | uint32_t compress_type; |
393 | uint32_t bmp_bytesz; |
394 | int32_t hres; |
395 | int32_t vres; |
396 | uint32_t ncolors; |
397 | uint32_t nimpcolors; |
398 | } __attribute__((packed)) bmp; |
399 | SDL_Surface *ret = NULL; |
400 | int data_size, read_size; |
401 | uint8_t *tmp_buf; |
402 | int i, bytespp; |
403 | FILE *f; |
404 | |
405 | trace("%p, %d", src, freesrc); |
406 | |
407 | f = src->hidden.stdio.fp; |
408 | if (f == NULL) |
409 | goto out; |
410 | |
411 | if (fread(&bmp, 1, sizeof(bmp), f) != sizeof(bmp)) { |
412 | err("bmp read error"); |
413 | goto out; |
414 | } |
415 | |
416 | if (bmp.magic[0] != 'B' || bmp.magic[1] != 'M' || bmp.header_sz != 40) { |
417 | err("unhandled BMP format, sz=%d", bmp.header_sz); |
418 | goto out; |
419 | } |
420 | |
421 | if ((unsigned)bmp.width > 0xffff || (unsigned)bmp.height > 0xffff) { |
422 | err("BMP size %dx%d out of range", bmp.width, bmp.height); |
423 | goto out; |
424 | } |
425 | |
426 | if (bmp.bitspp != 4) { |
427 | err("BMP unhandled bpp: %d", bmp.bitspp); |
428 | goto out; |
429 | } |
430 | |
431 | bytespp = bmp.bitspp < 8 ? 1 : (bmp.bitspp + 7) / 8; |
432 | data_size = bmp.width * bmp.height * bytespp; |
433 | tmp_buf = malloc(data_size); |
434 | if (tmp_buf == NULL) |
435 | goto out; |
436 | |
437 | if (fseek(f, bmp.bmp_offset, SEEK_SET) != 0) { |
438 | err("BMP seek error"); |
439 | goto out; |
440 | } |
441 | |
442 | read_size = bmp.width * bmp.bitspp / 8; |
443 | for (i = bmp.height - 1; i > 0; i--) { |
444 | if (fread((char *)tmp_buf + i * read_size, 1, read_size, f) != read_size) { |
445 | err("BMP read error"); |
446 | goto out; |
447 | } |
448 | } |
449 | |
450 | if (bmp.bitspp == 4) { |
451 | // just convert to 8bpp now |
452 | int c = bmp.width * bmp.height / 2; |
453 | uint8_t *p = tmp_buf; |
454 | for (i = c - 1; i >= 0; i--) { |
455 | p[i * 2 + 1] = p[i] & 0xf; |
456 | p[i * 2] = p[i] >> 4; |
457 | } |
458 | } |
459 | |
460 | ret = alloc_surface(bmp.width, bmp.height, 8); |
461 | if (ret == NULL) |
462 | goto out; |
463 | |
464 | ret->pixels = tmp_buf; |
465 | tmp_buf = NULL; |
466 | |
467 | out: |
468 | if (tmp_buf != NULL) |
469 | free(tmp_buf); |
470 | if (freesrc) |
471 | SDL_FreeRW(src); |
472 | |
473 | return ret; |
474 | } |
475 | |
476 | DECLSPEC SDL_Surface * SDLCALL |
477 | SDL_ConvertSurface(SDL_Surface *src, SDL_PixelFormat *fmt, Uint32 flags) |
478 | { |
479 | SDL_Surface *ret; |
480 | void *data; |
481 | |
482 | trace("%p, %p, %08x", src, fmt, flags); |
483 | |
484 | if (src->format->BitsPerPixel != fmt->BitsPerPixel) { |
485 | err("convert: not implemented"); |
486 | return NULL; |
487 | } |
488 | |
489 | data = malloc(src->pitch * src->h); |
490 | if (data == NULL) |
491 | return NULL; |
492 | memcpy(data, src->pixels, src->pitch * src->h); |
493 | |
494 | ret = alloc_surface(src->w, src->h, fmt->BitsPerPixel); |
495 | if (ret == NULL) { |
496 | free(data); |
497 | return NULL; |
498 | } |
499 | ret->pixels = data; |
500 | return ret; |
501 | } |
502 | |
503 | DECLSPEC int SDLCALL |
504 | SDL_SetColorKey(SDL_Surface *surface, Uint32 flag, Uint32 key) |
505 | { |
506 | trace("%p, %08x, %04x", surface, flag, key); |
507 | return 0; |
508 | } |
509 | |
510 | DECLSPEC SDL_Joystick * SDLCALL |
511 | SDL_JoystickOpen(int device_index) |
512 | { |
513 | trace("%d", device_index); |
514 | return NULL; |
515 | } |
516 | |
517 | DECLSPEC int SDLCALL |
518 | SDL_PollEvent(SDL_Event *event) |
519 | { |
520 | trace("%p", event); |
521 | return 0; |
522 | } |
523 | |
524 | DECLSPEC Uint8 * SDLCALL |
525 | SDL_GetKeyState(int *numkeys) |
526 | { |
527 | trace("%p", numkeys); |
528 | |
529 | if (numkeys != NULL) |
530 | *numkeys = ARRAY_SIZE(g_keystate); |
531 | return g_keystate; |
532 | } |
533 | |
534 | DECLSPEC void SDLCALL |
535 | SDL_WM_SetCaption(const char *title, const char *icon) |
536 | { |
537 | trace("%s, %s", title, icon); |
538 | } |
539 | |
540 | DECLSPEC int SDLCALL |
541 | SDL_ShowCursor(int toggle) |
542 | { |
543 | trace("%d", toggle); |
544 | return 0; |
545 | } |
546 | |
547 | DECLSPEC char * SDLCALL |
548 | SDL_GetError(void) |
549 | { |
550 | trace(""); |
551 | |
552 | return ""; |
553 | } |
554 | |