src/video/wscons/SDL_wsconsvideo.c
author Edgar Simo <bobbens@gmail.com>
Mon, 04 Aug 2008 11:30:16 +0000
branchgsoc2008_force_feedback
changeset 2582 9f0f0a532343
parent 1895 c121d94672cb
child 2698 e1da92da346c
permissions -rw-r--r--
Fixed warning.

/*
    SDL - Simple DirectMedia Layer
    Copyright (C) 1997-2006 Sam Lantinga

    This library is free software; you can redistribute it and/or
    modify it under the terms of the GNU Lesser General Public
    License as published by the Free Software Foundation; either
    version 2.1 of the License, or (at your option) any later version.

    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
    Lesser General Public License for more details.

    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

    Sam Lantinga
    slouken@libsdl.org
*/
#include "SDL_config.h"

#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"
#include "../SDL_sysvideo.h"
#include "../SDL_pixels_c.h"
#include "../../events/SDL_events_c.h"

#include "SDL_wsconsvideo.h"
#include "SDL_wsconsevents_c.h"
#include "SDL_wsconsmouse_c.h"

#define WSCONSVID_DRIVER_NAME "wscons"
enum
{
    WSCONS_ROTATE_NONE = 0,
    WSCONS_ROTATE_CCW = 90,
    WSCONS_ROTATE_UD = 180,
    WSCONS_ROTATE_CW = 270
};

#define min(a,b) ((a)<(b)?(a):(b))

/* Initialization/Query functions */
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);

/* Hardware surface functions */
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);

/* etc. */
static WSCONS_bitBlit WSCONS_blit16;
static WSCONS_bitBlit WSCONS_blit16blocked;
static void WSCONS_UpdateRects(_THIS, int numrects, SDL_Rect * rects);

void
WSCONS_ReportError(char *fmt, ...)
{
    char message[200];
    va_list vaArgs;

    message[199] = '\0';

    va_start(vaArgs, fmt);
    vsnprintf(message, 199, fmt, vaArgs);
    va_end(vaArgs);

    SDL_SetError(message);
    fprintf(stderr, "WSCONS error: %s\n", message);
}

/* WSCONS driver bootstrap functions */

static int
WSCONS_Available(void)
{
    return 1;
}

static void
WSCONS_DeleteDevice(SDL_VideoDevice * device)
{
    SDL_free(device->hidden);
    SDL_free(device);
}

static SDL_VideoDevice *
WSCONS_CreateDevice(int devindex)
{
    SDL_VideoDevice *device;

    /* Initialize all variables that we clean on shutdown */
    device = (SDL_VideoDevice *) SDL_malloc(sizeof(SDL_VideoDevice));
    if (device == NULL) {
        SDL_OutOfMemory();
        return 0;
    }
    SDL_memset(device, 0, (sizeof *device));
    device->hidden =
        (struct SDL_PrivateVideoData *) SDL_malloc((sizeof *device->hidden));
    if (device->hidden == NULL) {
        SDL_OutOfMemory();
        SDL_free(device);
        return (0);
    }
    SDL_memset(device->hidden, 0, (sizeof *device->hidden));
    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;
}

VideoBootStrap WSCONS_bootstrap = {
    WSCONSVID_DRIVER_NAME,
    "SDL wscons video driver",
    WSCONS_Available,
    WSCONS_CreateDevice
};

#define WSCONSDEV_FORMAT "/dev/ttyC%01x"

int
WSCONS_VideoInit(_THIS, SDL_PixelFormat * vformat)
{
    char devnamebuf[30];
    char *devname;
    char *rotation;
    int wstype;
    int wsmode = WSDISPLAYIO_MODE_DUMBFB;
    size_t len, mapsize;
    int pagemask;
    int width, height;

    devname = SDL_getenv("SDL_WSCONSDEV");
    if (devname == NULL) {
        int activeVT;
        if (ioctl(STDIN_FILENO, VT_GETACTIVE, &activeVT) == -1) {
            WSCONS_ReportError("Unable to determine active terminal: %s",
                               strerror(errno));
            return -1;
        }
        SDL_snprintf(devnamebuf, sizeof(devnamebuf), WSCONSDEV_FORMAT,
                     activeVT - 1);
        devname = devnamebuf;
    }

    private->fd = open(devname, O_RDWR | O_NONBLOCK, 0);
    if (private->fd == -1) {
        WSCONS_ReportError("open %s: %s", devname, strerror(errno));
        return -1;
    }
    if (ioctl(private->fd, WSDISPLAYIO_GINFO, &private->info) == -1) {
        WSCONS_ReportError("ioctl WSDISPLAY_GINFO: %s", strerror(errno));
        return -1;
    }
    if (ioctl(private->fd, WSDISPLAYIO_GTYPE, &wstype) == -1) {
        WSCONS_ReportError("ioctl WSDISPLAY_GTYPE: %s", strerror(errno));
        return -1;
    }
    if (ioctl(private->fd, WSDISPLAYIO_LINEBYTES, &private->physlinebytes) ==
        -1) {
        WSCONS_ReportError("ioctl WSDISPLAYIO_LINEBYTES: %s",
                           strerror(errno));
        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;
#ifdef WSDISPLAY_TYPE_PXALCD
        } else if (wstype == WSDISPLAY_TYPE_PXALCD) {
            private->redMask = 0x1f << 11;
            private->greenMask = 0x3f << 5;
            private->blueMask = 0x1f;
#endif
        } else {
            WSCONS_ReportError("Unknown video hardware");
            return -1;
        }
    } else {
        WSCONS_ReportError("Displays with 8 bpp or less are not supported");
        return -1;
    }

    private->rotate = WSCONS_ROTATE_NONE;
    rotation = SDL_getenv("SDL_VIDEO_WSCONS_ROTATION");
    if (rotation != NULL) {
        if (SDL_strlen(rotation) == 0) {
            private->shadowFB = 0;
            private->rotate = WSCONS_ROTATE_NONE;
            printf("Not rotating, no shadow\n");
        } else if (!SDL_strcmp(rotation, "NONE")) {
            private->shadowFB = 1;
            private->rotate = WSCONS_ROTATE_NONE;
            printf("Not rotating, but still using shadow\n");
        } else if (!SDL_strcmp(rotation, "CW")) {
            private->shadowFB = 1;
            private->rotate = WSCONS_ROTATE_CW;
            printf("Rotating screen clockwise\n");
        } else if (!SDL_strcmp(rotation, "CCW")) {
            private->shadowFB = 1;
            private->rotate = WSCONS_ROTATE_CCW;
            printf("Rotating screen counter clockwise\n");
        } else if (!SDL_strcmp(rotation, "UD")) {
            private->shadowFB = 1;
            private->rotate = WSCONS_ROTATE_UD;
            printf("Rotating screen upside down\n");
        } else {
            WSCONS_ReportError("\"%s\" is not a valid value for "
                               "SDL_VIDEO_WSCONS_ROTATION", rotation);
            return -1;
        }
    }

    switch (private->info.depth) {
    case 1:
    case 4:
    case 8:
        len = private->physlinebytes * private->info.height;
        break;
    case 16:
        if (private->physlinebytes == private->info.width) {
            len = private->info.width * private->info.height * sizeof(short);
        } 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;
    case 32:
        if (private->physlinebytes == private->info.width) {
            len = private->info.width * private->info.height * sizeof(int);
        } else {
            len = private->physlinebytes * private->info.height;
        }
        break;
    default:
        WSCONS_ReportError("unsupported depth %d", private->info.depth);
        return -1;
    }

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

    if (ioctl(private->fd, WSDISPLAYIO_SMODE, &wsmode) == -1) {
        WSCONS_ReportError("ioctl SMODE");
        return -1;
    }

    pagemask = getpagesize() - 1;
    mapsize = ((int) len + pagemask) & ~pagemask;
    private->physmem = (Uint8 *) mmap(NULL, mapsize,
                                      PROT_READ | PROT_WRITE, MAP_SHARED,
                                      private->fd, (off_t) 0);
    if (private->physmem == (Uint8 *) MAP_FAILED) {
        private->physmem = NULL;
        WSCONS_ReportError("mmap: %s", strerror(errno));
        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) {
        private->shadowmem = (Uint8 *) SDL_malloc(len);
        if (private->shadowmem == NULL) {
            WSCONS_ReportError("No memory for shadow");
            return -1;
        }
        private->fbstart = private->shadowmem;
        private->fblinebytes = width * ((private->info.depth + 7) / 8);
    } else {
        private->fbstart = private->physmem;
        private->fblinebytes = private->physlinebytes;
    }

    private->SDL_modelist[0] = (SDL_Rect *) SDL_malloc(sizeof(SDL_Rect));
    private->SDL_modelist[0]->w = width;
    private->SDL_modelist[0]->h = height;

    vformat->BitsPerPixel = private->info.depth;
    vformat->BytesPerPixel = private->info.depth / 8;

    if (WSCONS_InitKeyboard(this) == -1) {
        return -1;
    }

    return 0;
}

SDL_Rect **
WSCONS_ListModes(_THIS, SDL_PixelFormat * format, Uint32 flags)
{
    if (format->BitsPerPixel == private->info.depth) {
        return private->SDL_modelist;
    } else {
        return NULL;
    }
}

SDL_Surface *
WSCONS_SetVideoMode(_THIS, SDL_Surface * current,
                    int width, int height, int bpp, Uint32 flags)
{
    if (width != private->SDL_modelist[0]->w ||
        height != private->SDL_modelist[0]->h) {
        WSCONS_ReportError("Requested video mode %dx%d not supported.",
                           width, height);
        return NULL;
    }
    if (bpp != private->info.depth) {
        WSCONS_ReportError("Requested video depth %d bpp not supported.",
                           bpp);
        return NULL;
    }

    if (!SDL_ReallocFormat(current,
                           bpp,
                           private->redMask,
                           private->greenMask, private->blueMask, 0)) {
        WSCONS_ReportError("Couldn't allocate new pixel format");
        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;

    SDL_memset(private->fbstart, 0, private->fbmem_len);

    return current;
}

static int
WSCONS_AllocHWSurface(_THIS, SDL_Surface * surface)
{
    return -1;
}
static void
WSCONS_FreeHWSurface(_THIS, SDL_Surface * surface)
{
}

static int
WSCONS_LockHWSurface(_THIS, SDL_Surface * surface)
{
    return 0;
}

static void
WSCONS_UnlockHWSurface(_THIS, SDL_Surface * surface)
{
}

static void
WSCONS_blit16(Uint8 * byte_src_pos,
              int srcRightDelta,
              int srcDownDelta,
              Uint8 * byte_dst_pos, int dst_linebytes, int width, int height)
{
    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--;
    }
}

#define BLOCKSIZE_W 32
#define BLOCKSIZE_H 32

static void
WSCONS_blit16blocked(Uint8 * byte_src_pos,
                     int srcRightDelta,
                     int srcDownDelta,
                     Uint8 * byte_dst_pos,
                     int dst_linebytes, int width, int height)
{
    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) {
            WSCONS_blit16((Uint8 *) src,
                          srcRightDelta,
                          srcDownDelta,
                          (Uint8 *) dst,
                          dst_linebytes,
                          min(w, BLOCKSIZE_W), min(height, BLOCKSIZE_H));
            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;
    }
}

static void
WSCONS_UpdateRects(_THIS, int numrects, SDL_Rect * rects)
{
    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;
    }

    if (private->info.depth != 16) {
        WSCONS_ReportError("Shadow copy only implemented for 16 bpp");
        return;
    }

    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:
            WSCONS_ReportError("Unknown rotation");
            return;
        }

        src_start =
            private->shadowmem + (sha_y1 * width + sha_x1) * bytesPerPixel;
        dst_start =
            private->physmem + scr_y1 * private->physlinebytes +
            scr_x1 * bytesPerPixel;

        private->blitFunc(src_start,
                          shadowRightDelta,
                          shadowDownDelta,
                          dst_start,
                          private->physlinebytes,
                          scr_x2 - scr_x1, scr_y2 - scr_y1);
    }
}

int
WSCONS_SetColors(_THIS, int firstcolor, int ncolors, SDL_Color * colors)
{
    return 0;
}

/*
 * Note: If we are terminated, this could be called in the middle of
 * another SDL video routine -- notably UpdateRects.
 */
void
WSCONS_VideoQuit(_THIS)
{
    int mode = WSDISPLAYIO_MODE_EMUL;

    if (private->shadowmem != NULL) {
        SDL_free(private->shadowmem);
        private->shadowmem = NULL;
    }
    private->fbstart = NULL;
    if (this->screen != NULL) {
        this->screen->pixels = NULL;
    }

    if (private->SDL_modelist[0] != NULL) {
        SDL_free(private->SDL_modelist[0]);
        private->SDL_modelist[0] = NULL;
    }

    if (ioctl(private->fd, WSDISPLAYIO_SMODE, &mode) == -1) {
        WSCONS_ReportError("ioctl SMODE");
    }

    WSCONS_ReleaseKeyboard(this);

    if (private->fd != -1) {
        close(private->fd);
        private->fd = -1;
    }
}

/* vi: set ts=4 sw=4 expandtab: */