[sdl_omap.git] / src / video / wscons / SDL_wsconsvideo.c

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