This repository has been archived by the owner on Feb 11, 2021. It is now read-only.
/
SDL_wsconsvideo.c
631 lines (560 loc) · 18.1 KB
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
11
12
This library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13
Lesser General Public License for more details.
14
15
16
17
You should have received a copy of the GNU Lesser General Public
License along with this library; if not, write to the Free Software
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
18
19
20
21
Sam Lantinga
slouken@libsdl.org
*/
22
#include "SDL_config.h"
23
24
25
26
27
28
29
30
31
32
33
#include <sys/time.h>
#include <sys/mman.h>
#include <sys/ioctl.h>
#include <dev/wscons/wsdisplay_usl_io.h>
#include <fcntl.h>
#include <unistd.h>
#include <errno.h>
#include "SDL_video.h"
#include "SDL_mouse.h"
34
35
36
#include "../SDL_sysvideo.h"
#include "../SDL_pixels_c.h"
#include "../../events/SDL_events_c.h"
37
38
39
40
41
42
#include "SDL_wsconsvideo.h"
#include "SDL_wsconsevents_c.h"
#include "SDL_wsconsmouse_c.h"
#define WSCONSVID_DRIVER_NAME "wscons"
43
44
45
46
47
48
enum
{
WSCONS_ROTATE_NONE = 0,
WSCONS_ROTATE_CCW = 90,
WSCONS_ROTATE_UD = 180,
WSCONS_ROTATE_CW = 270
49
50
51
52
53
};
#define min(a,b) ((a)<(b)?(a):(b))
/* Initialization/Query functions */
54
55
56
57
58
59
60
61
62
static int WSCONS_VideoInit(_THIS, SDL_PixelFormat * vformat);
static SDL_Rect **WSCONS_ListModes(_THIS, SDL_PixelFormat * format,
Uint32 flags);
static SDL_Surface *WSCONS_SetVideoMode(_THIS, SDL_Surface * current,
int width, int height, int bpp,
Uint32 flags);
static int WSCONS_SetColors(_THIS, int firstcolor, int ncolors,
SDL_Color * colors);
static void WSCONS_VideoQuit(_THIS);
63
64
/* Hardware surface functions */
65
66
67
68
static int WSCONS_AllocHWSurface(_THIS, SDL_Surface * surface);
static int WSCONS_LockHWSurface(_THIS, SDL_Surface * surface);
static void WSCONS_UnlockHWSurface(_THIS, SDL_Surface * surface);
static void WSCONS_FreeHWSurface(_THIS, SDL_Surface * surface);
69
70
71
72
/* etc. */
static WSCONS_bitBlit WSCONS_blit16;
static WSCONS_bitBlit WSCONS_blit16blocked;
73
static void WSCONS_UpdateRects(_THIS, int numrects, SDL_Rect * rects);
74
75
void
76
WSCONS_ReportError(char *fmt, ...)
77
{
78
79
80
81
82
char message[200];
va_list vaArgs;
message[199] = '\0';
83
84
85
va_start(vaArgs, fmt);
vsnprintf(message, 199, fmt, vaArgs);
va_end(vaArgs);
86
87
88
SDL_SetError(message);
fprintf(stderr, "WSCONS error: %s\n", message);
89
90
91
92
}
/* WSCONS driver bootstrap functions */
93
static int
94
WSCONS_Available(void)
95
{
96
return 1;
97
98
}
99
static void
100
WSCONS_DeleteDevice(SDL_VideoDevice * device)
101
{
102
103
SDL_free(device->hidden);
SDL_free(device);
104
105
}
106
static SDL_VideoDevice *
107
WSCONS_CreateDevice(int devindex)
108
{
109
110
111
SDL_VideoDevice *device;
/* Initialize all variables that we clean on shutdown */
112
device = (SDL_VideoDevice *) SDL_malloc(sizeof(SDL_VideoDevice));
113
if (device == NULL) {
114
SDL_OutOfMemory();
115
116
return 0;
}
117
SDL_memset(device, 0, (sizeof *device));
118
device->hidden =
119
(struct SDL_PrivateVideoData *) SDL_malloc((sizeof *device->hidden));
120
if (device->hidden == NULL) {
121
122
SDL_OutOfMemory();
SDL_free(device);
123
124
return (0);
}
125
SDL_memset(device->hidden, 0, (sizeof *device->hidden));
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
device->hidden->fd = -1;
/* Set the function pointers */
device->VideoInit = WSCONS_VideoInit;
device->ListModes = WSCONS_ListModes;
device->SetVideoMode = WSCONS_SetVideoMode;
device->SetColors = WSCONS_SetColors;
device->UpdateRects = WSCONS_UpdateRects;
device->VideoQuit = WSCONS_VideoQuit;
device->AllocHWSurface = WSCONS_AllocHWSurface;
device->LockHWSurface = WSCONS_LockHWSurface;
device->UnlockHWSurface = WSCONS_UnlockHWSurface;
device->FreeHWSurface = WSCONS_FreeHWSurface;
device->InitOSKeymap = WSCONS_InitOSKeymap;
device->PumpEvents = WSCONS_PumpEvents;
device->free = WSCONS_DeleteDevice;
return device;
144
145
146
}
VideoBootStrap WSCONS_bootstrap = {
147
148
149
150
WSCONSVID_DRIVER_NAME,
"SDL wscons video driver",
WSCONS_Available,
WSCONS_CreateDevice
151
152
153
154
};
#define WSCONSDEV_FORMAT "/dev/ttyC%01x"
155
int
156
WSCONS_VideoInit(_THIS, SDL_PixelFormat * vformat)
157
{
158
159
160
161
162
163
164
165
166
char devnamebuf[30];
char *devname;
char *rotation;
int wstype;
int wsmode = WSDISPLAYIO_MODE_DUMBFB;
size_t len, mapsize;
int pagemask;
int width, height;
167
devname = SDL_getenv("SDL_WSCONSDEV");
168
169
if (devname == NULL) {
int activeVT;
170
171
172
if (ioctl(STDIN_FILENO, VT_GETACTIVE, &activeVT) == -1) {
WSCONS_ReportError("Unable to determine active terminal: %s",
strerror(errno));
173
174
return -1;
}
175
176
SDL_snprintf(devnamebuf, sizeof(devnamebuf), WSCONSDEV_FORMAT,
activeVT - 1);
177
devname = devnamebuf;
178
179
}
180
private->fd = open(devname, O_RDWR | O_NONBLOCK, 0);
181
if (private->fd == -1) {
182
WSCONS_ReportError("open %s: %s", devname, strerror(errno));
183
184
return -1;
}
185
186
if (ioctl(private->fd, WSDISPLAYIO_GINFO, &private->info) == -1) {
WSCONS_ReportError("ioctl WSDISPLAY_GINFO: %s", strerror(errno));
187
188
return -1;
}
189
190
if (ioctl(private->fd, WSDISPLAYIO_GTYPE, &wstype) == -1) {
WSCONS_ReportError("ioctl WSDISPLAY_GTYPE: %s", strerror(errno));
191
192
return -1;
}
193
if (ioctl(private->fd, WSDISPLAYIO_LINEBYTES, &private->physlinebytes) ==
194
-1) {
195
196
WSCONS_ReportError("ioctl WSDISPLAYIO_LINEBYTES: %s",
strerror(errno));
197
198
199
200
201
202
203
204
205
206
207
return -1;
}
if (private->info.depth > 8) {
if (wstype == WSDISPLAY_TYPE_SUN24 ||
wstype == WSDISPLAY_TYPE_SUNCG12 ||
wstype == WSDISPLAY_TYPE_SUNCG14 ||
wstype == WSDISPLAY_TYPE_SUNTCX ||
wstype == WSDISPLAY_TYPE_SUNFFB) {
private->redMask = 0x0000ff;
private->greenMask = 0x00ff00;
private->blueMask = 0xff0000;
208
#ifdef WSDISPLAY_TYPE_PXALCD
209
210
211
212
} else if (wstype == WSDISPLAY_TYPE_PXALCD) {
private->redMask = 0x1f << 11;
private->greenMask = 0x3f << 5;
private->blueMask = 0x1f;
213
#endif
214
} else {
215
WSCONS_ReportError("Unknown video hardware");
216
217
return -1;
}
218
} else {
219
WSCONS_ReportError("Displays with 8 bpp or less are not supported");
220
return -1;
221
}
222
223
private->rotate = WSCONS_ROTATE_NONE;
224
rotation = SDL_getenv("SDL_VIDEO_WSCONS_ROTATION");
225
if (rotation != NULL) {
226
if (SDL_strlen(rotation) == 0) {
227
228
private->shadowFB = 0;
private->rotate = WSCONS_ROTATE_NONE;
229
230
printf("Not rotating, no shadow\n");
} else if (!SDL_strcmp(rotation, "NONE")) {
231
232
private->shadowFB = 1;
private->rotate = WSCONS_ROTATE_NONE;
233
234
printf("Not rotating, but still using shadow\n");
} else if (!SDL_strcmp(rotation, "CW")) {
235
236
private->shadowFB = 1;
private->rotate = WSCONS_ROTATE_CW;
237
238
printf("Rotating screen clockwise\n");
} else if (!SDL_strcmp(rotation, "CCW")) {
239
240
private->shadowFB = 1;
private->rotate = WSCONS_ROTATE_CCW;
241
242
printf("Rotating screen counter clockwise\n");
} else if (!SDL_strcmp(rotation, "UD")) {
243
244
private->shadowFB = 1;
private->rotate = WSCONS_ROTATE_UD;
245
printf("Rotating screen upside down\n");
246
} else {
247
248
WSCONS_ReportError("\"%s\" is not a valid value for "
"SDL_VIDEO_WSCONS_ROTATION", rotation);
249
250
return -1;
}
251
252
}
253
switch (private->info.depth) {
254
255
256
case 1:
case 4:
case 8:
257
258
len = private->physlinebytes * private->info.height;
break;
259
case 16:
260
if (private->physlinebytes == private->info.width) {
261
len = private->info.width * private->info.height * sizeof(short);
262
263
264
265
266
267
268
269
270
271
} else {
len = private->physlinebytes * private->info.height;
}
if (private->rotate == WSCONS_ROTATE_NONE ||
private->rotate == WSCONS_ROTATE_UD) {
private->blitFunc = WSCONS_blit16;
} else {
private->blitFunc = WSCONS_blit16blocked;
}
break;
272
case 32:
273
if (private->physlinebytes == private->info.width) {
274
len = private->info.width * private->info.height * sizeof(int);
275
276
277
278
} else {
len = private->physlinebytes * private->info.height;
}
break;
279
default:
280
WSCONS_ReportError("unsupported depth %d", private->info.depth);
281
282
return -1;
}
283
284
285
286
287
288
289
if (private->shadowFB && private->blitFunc == NULL) {
WSCONS_ReportError
("Using software buffer, but no blitter function is "
"available for this %d bpp.", private->info.depth);
return -1;
}
290
291
292
if (ioctl(private->fd, WSDISPLAYIO_SMODE, &wsmode) == -1) {
WSCONS_ReportError("ioctl SMODE");
293
return -1;
294
}
295
296
pagemask = getpagesize() - 1;
297
mapsize = ((int) len + pagemask) & ~pagemask;
298
299
300
private->physmem = (Uint8 *) mmap(NULL, mapsize,
PROT_READ | PROT_WRITE, MAP_SHARED,
private->fd, (off_t) 0);
301
302
if (private->physmem == (Uint8 *) MAP_FAILED) {
private->physmem = NULL;
303
WSCONS_ReportError("mmap: %s", strerror(errno));
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
return -1;
}
private->fbmem_len = len;
if (private->rotate == WSCONS_ROTATE_CW ||
private->rotate == WSCONS_ROTATE_CCW) {
width = private->info.height;
height = private->info.width;
} else {
width = private->info.width;
height = private->info.height;
}
this->info.current_w = width;
this->info.current_h = height;
if (private->shadowFB) {
321
private->shadowmem = (Uint8 *) SDL_malloc(len);
322
if (private->shadowmem == NULL) {
323
WSCONS_ReportError("No memory for shadow");
324
325
326
327
328
329
330
331
332
return -1;
}
private->fbstart = private->shadowmem;
private->fblinebytes = width * ((private->info.depth + 7) / 8);
} else {
private->fbstart = private->physmem;
private->fblinebytes = private->physlinebytes;
}
333
private->SDL_modelist[0] = (SDL_Rect *) SDL_malloc(sizeof(SDL_Rect));
334
335
336
337
338
339
private->SDL_modelist[0]->w = width;
private->SDL_modelist[0]->h = height;
vformat->BitsPerPixel = private->info.depth;
vformat->BytesPerPixel = private->info.depth / 8;
340
if (WSCONS_InitKeyboard(this) == -1) {
341
342
343
344
return -1;
}
return 0;
345
346
}
347
SDL_Rect **
348
WSCONS_ListModes(_THIS, SDL_PixelFormat * format, Uint32 flags)
349
{
350
351
352
353
354
if (format->BitsPerPixel == private->info.depth) {
return private->SDL_modelist;
} else {
return NULL;
}
355
356
}
357
SDL_Surface *
358
359
WSCONS_SetVideoMode(_THIS, SDL_Surface * current,
int width, int height, int bpp, Uint32 flags)
360
{
361
362
if (width != private->SDL_modelist[0]->w ||
height != private->SDL_modelist[0]->h) {
363
364
WSCONS_ReportError("Requested video mode %dx%d not supported.",
width, height);
365
366
367
return NULL;
}
if (bpp != private->info.depth) {
368
369
WSCONS_ReportError("Requested video depth %d bpp not supported.",
bpp);
370
371
372
return NULL;
}
373
374
375
376
377
if (!SDL_ReallocFormat(current,
bpp,
private->redMask,
private->greenMask, private->blueMask, 0)) {
WSCONS_ReportError("Couldn't allocate new pixel format");
378
379
380
381
382
383
384
385
386
387
388
389
390
391
return NULL;
}
current->flags &= SDL_FULLSCREEN;
if (private->shadowFB) {
current->flags |= SDL_SWSURFACE;
} else {
current->flags |= SDL_HWSURFACE;
}
current->w = width;
current->h = height;
current->pitch = private->fblinebytes;
current->pixels = private->fbstart;
392
SDL_memset(private->fbstart, 0, private->fbmem_len);
393
394
return current;
395
396
}
397
static int
398
WSCONS_AllocHWSurface(_THIS, SDL_Surface * surface)
399
{
400
return -1;
401
}
402
static void
403
WSCONS_FreeHWSurface(_THIS, SDL_Surface * surface)
404
405
406
{
}
407
static int
408
WSCONS_LockHWSurface(_THIS, SDL_Surface * surface)
409
{
410
return 0;
411
412
}
413
static void
414
WSCONS_UnlockHWSurface(_THIS, SDL_Surface * surface)
415
416
417
{
}
418
static void
419
420
421
422
WSCONS_blit16(Uint8 * byte_src_pos,
int srcRightDelta,
int srcDownDelta,
Uint8 * byte_dst_pos, int dst_linebytes, int width, int height)
423
{
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
int w;
Uint16 *src_pos = (Uint16 *) byte_src_pos;
Uint16 *dst_pos = (Uint16 *) byte_dst_pos;
while (height) {
Uint16 *src = src_pos;
Uint16 *dst = dst_pos;
for (w = width; w != 0; w--) {
*dst = *src;
src += srcRightDelta;
dst++;
}
dst_pos = (Uint16 *) ((Uint8 *) dst_pos + dst_linebytes);
src_pos += srcDownDelta;
height--;
439
440
441
442
443
444
}
}
#define BLOCKSIZE_W 32
#define BLOCKSIZE_H 32
445
static void
446
447
448
449
450
WSCONS_blit16blocked(Uint8 * byte_src_pos,
int srcRightDelta,
int srcDownDelta,
Uint8 * byte_dst_pos,
int dst_linebytes, int width, int height)
451
{
452
453
454
455
456
457
458
459
int w;
Uint16 *src_pos = (Uint16 *) byte_src_pos;
Uint16 *dst_pos = (Uint16 *) byte_dst_pos;
while (height > 0) {
Uint16 *src = src_pos;
Uint16 *dst = dst_pos;
for (w = width; w > 0; w -= BLOCKSIZE_W) {
460
461
462
463
464
465
WSCONS_blit16((Uint8 *) src,
srcRightDelta,
srcDownDelta,
(Uint8 *) dst,
dst_linebytes,
min(w, BLOCKSIZE_W), min(height, BLOCKSIZE_H));
466
467
468
469
470
471
472
src += srcRightDelta * BLOCKSIZE_W;
dst += BLOCKSIZE_W;
}
dst_pos =
(Uint16 *) ((Uint8 *) dst_pos + dst_linebytes * BLOCKSIZE_H);
src_pos += srcDownDelta * BLOCKSIZE_H;
height -= BLOCKSIZE_H;
473
474
475
}
}
476
static void
477
WSCONS_UpdateRects(_THIS, int numrects, SDL_Rect * rects)
478
{
479
480
481
482
483
484
485
int width = private->SDL_modelist[0]->w;
int height = private->SDL_modelist[0]->h;
int bytesPerPixel = (private->info.depth + 7) / 8;
int i;
if (!private->shadowFB) {
return;
486
487
}
488
if (private->info.depth != 16) {
489
WSCONS_ReportError("Shadow copy only implemented for 16 bpp");
490
return;
491
492
}
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
for (i = 0; i < numrects; i++) {
int x1, y1, x2, y2;
int scr_x1, scr_y1, scr_x2, scr_y2;
int sha_x1, sha_y1;
int shadowRightDelta; /* Address change when moving right in dest */
int shadowDownDelta; /* Address change when moving down in dest */
Uint8 *src_start;
Uint8 *dst_start;
x1 = rects[i].x;
y1 = rects[i].y;
x2 = x1 + rects[i].w;
y2 = y1 + rects[i].h;
if (x1 < 0) {
x1 = 0;
} else if (x1 > width) {
x1 = width;
}
if (x2 < 0) {
x2 = 0;
} else if (x2 > width) {
x2 = width;
}
if (y1 < 0) {
y1 = 0;
} else if (y1 > height) {
y1 = height;
}
if (y2 < 0) {
y2 = 0;
} else if (y2 > height) {
y2 = height;
}
if (x2 <= x1 || y2 <= y1) {
continue;
}
switch (private->rotate) {
case WSCONS_ROTATE_NONE:
sha_x1 = scr_x1 = x1;
sha_y1 = scr_y1 = y1;
scr_x2 = x2;
scr_y2 = y2;
shadowRightDelta = 1;
shadowDownDelta = width;
break;
case WSCONS_ROTATE_CCW:
scr_x1 = y1;
scr_y1 = width - x2;
scr_x2 = y2;
scr_y2 = width - x1;
sha_x1 = x2 - 1;
sha_y1 = y1;
shadowRightDelta = width;
shadowDownDelta = -1;
break;
case WSCONS_ROTATE_UD:
scr_x1 = width - x2;
scr_y1 = height - y2;
scr_x2 = width - x1;
scr_y2 = height - y1;
sha_x1 = x2 - 1;
sha_y1 = y2 - 1;
shadowRightDelta = -1;
shadowDownDelta = -width;
break;
case WSCONS_ROTATE_CW:
scr_x1 = height - y2;
scr_y1 = x1;
scr_x2 = height - y1;
scr_y2 = x2;
sha_x1 = x1;
sha_y1 = y2 - 1;
shadowRightDelta = -width;
shadowDownDelta = 1;
break;
default:
571
WSCONS_ReportError("Unknown rotation");
572
573
574
575
576
577
578
579
580
return;
}
src_start =
private->shadowmem + (sha_y1 * width + sha_x1) * bytesPerPixel;
dst_start =
private->physmem + scr_y1 * private->physlinebytes +
scr_x1 * bytesPerPixel;
581
582
583
584
585
586
private->blitFunc(src_start,
shadowRightDelta,
shadowDownDelta,
dst_start,
private->physlinebytes,
scr_x2 - scr_x1, scr_y2 - scr_y1);
587
}
588
589
}
590
int
591
WSCONS_SetColors(_THIS, int firstcolor, int ncolors, SDL_Color * colors)
592
{
593
return 0;
594
595
596
597
598
599
}
/*
* Note: If we are terminated, this could be called in the middle of
* another SDL video routine -- notably UpdateRects.
*/
600
void
601
WSCONS_VideoQuit(_THIS)
602
{
603
604
605
int mode = WSDISPLAYIO_MODE_EMUL;
if (private->shadowmem != NULL) {
606
SDL_free(private->shadowmem);
607
608
609
610
611
612
613
614
private->shadowmem = NULL;
}
private->fbstart = NULL;
if (this->screen != NULL) {
this->screen->pixels = NULL;
}
if (private->SDL_modelist[0] != NULL) {
615
SDL_free(private->SDL_modelist[0]);
616
617
618
private->SDL_modelist[0] = NULL;
}
619
620
if (ioctl(private->fd, WSDISPLAYIO_SMODE, &mode) == -1) {
WSCONS_ReportError("ioctl SMODE");
621
622
}
623
WSCONS_ReleaseKeyboard(this);
624
625
if (private->fd != -1) {
626
close(private->fd);
627
628
private->fd = -1;
}
629
}
630
631
/* vi: set ts=4 sw=4 expandtab: */