wsfb_driver.c revision 8fc0431c
164f08a18Smrg/* $OpenBSD: wsfb_driver.c,v 1.16 2009/09/13 19:33:49 matthieu Exp $ */
2357bfbb2Smrg/*
3357bfbb2Smrg * Copyright (c) 2001 Matthieu Herrb
4357bfbb2Smrg * All rights reserved.
5357bfbb2Smrg *
6357bfbb2Smrg * Redistribution and use in source and binary forms, with or without
7357bfbb2Smrg * modification, are permitted provided that the following conditions
8357bfbb2Smrg * are met:
9357bfbb2Smrg *
10357bfbb2Smrg *    - Redistributions of source code must retain the above copyright
11357bfbb2Smrg *      notice, this list of conditions and the following disclaimer.
12357bfbb2Smrg *    - Redistributions in binary form must reproduce the above
13357bfbb2Smrg *      copyright notice, this list of conditions and the following
14357bfbb2Smrg *      disclaimer in the documentation and/or other materials provided
15357bfbb2Smrg *      with the distribution.
16357bfbb2Smrg *
17357bfbb2Smrg * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
18357bfbb2Smrg * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
19357bfbb2Smrg * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
20357bfbb2Smrg * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
21357bfbb2Smrg * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
22357bfbb2Smrg * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
23357bfbb2Smrg * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
24357bfbb2Smrg * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
25357bfbb2Smrg * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26357bfbb2Smrg * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
27357bfbb2Smrg * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28357bfbb2Smrg * POSSIBILITY OF SUCH DAMAGE.
29357bfbb2Smrg *
30357bfbb2Smrg */
31357bfbb2Smrg
32357bfbb2Smrg/*
33357bfbb2Smrg * Based on fbdev.c written by:
34357bfbb2Smrg *
35357bfbb2Smrg * Authors:  Alan Hourihane, <alanh@fairlite.demon.co.uk>
36357bfbb2Smrg *	     Michel Dänzer, <michdaen@iiic.ethz.ch>
37357bfbb2Smrg */
38357bfbb2Smrg
39357bfbb2Smrg#ifdef HAVE_CONFIG_H
40357bfbb2Smrg#include "config.h"
41357bfbb2Smrg#endif
42357bfbb2Smrg
4364f08a18Smrg#include <errno.h>
44357bfbb2Smrg#include <fcntl.h>
45357bfbb2Smrg#include <sys/types.h>
4664f08a18Smrg#include <sys/mman.h>
47357bfbb2Smrg#include <sys/time.h>
482b2b17b3Smrg#include <errno.h>
49357bfbb2Smrg#include <dev/wscons/wsconsio.h>
50357bfbb2Smrg
5164f08a18Smrg/* All drivers need this. */
52357bfbb2Smrg#include "xf86.h"
53357bfbb2Smrg#include "xf86_OSproc.h"
54a9060c92Schristos#include "xf86_OSlib.h"
55357bfbb2Smrg
56357bfbb2Smrg#include "mipointer.h"
57357bfbb2Smrg#include "mibstore.h"
58357bfbb2Smrg#include "micmap.h"
59357bfbb2Smrg#include "colormapst.h"
60357bfbb2Smrg#include "xf86cmap.h"
61357bfbb2Smrg#include "shadow.h"
62357bfbb2Smrg#include "dgaproc.h"
63357bfbb2Smrg
6464f08a18Smrg/* For visuals */
65357bfbb2Smrg#include "fb.h"
66357bfbb2Smrg
6764f08a18Smrg#if GET_ABI_MAJOR(ABI_VIDEODRV_VERSION) < 6
68357bfbb2Smrg#include "xf86Resources.h"
69357bfbb2Smrg#include "xf86RAC.h"
7064f08a18Smrg#endif
71357bfbb2Smrg
72357bfbb2Smrg#ifdef XvExtension
73357bfbb2Smrg#include "xf86xv.h"
74357bfbb2Smrg#endif
75357bfbb2Smrg
765d492fd2Smacallan#include "wsfb.h"
775d492fd2Smacallan
78357bfbb2Smrg/* #include "wsconsio.h" */
79357bfbb2Smrg
80357bfbb2Smrg#include <sys/mman.h>
81357bfbb2Smrg
8264f08a18Smrg#ifdef X_PRIVSEP
83357bfbb2Smrgextern int priv_open_device(const char *);
84357bfbb2Smrg#else
85357bfbb2Smrg#define priv_open_device(n)    open(n,O_RDWR|O_NONBLOCK|O_EXCL)
86357bfbb2Smrg#endif
87357bfbb2Smrg
88357bfbb2Smrg#if defined(__NetBSD__)
89357bfbb2Smrg#define WSFB_DEFAULT_DEV "/dev/ttyE0"
90357bfbb2Smrg#else
91357bfbb2Smrg#define WSFB_DEFAULT_DEV "/dev/ttyC0"
92357bfbb2Smrg#endif
93357bfbb2Smrg
94c59a3c9dSmrg#if GET_ABI_MAJOR(ABI_VIDEODRV_VERSION) > 6
951b41fcf5Smrg#define xf86LoaderReqSymLists(...) do {} while (0)
961b41fcf5Smrg#define LoaderRefSymLists(...) do {} while (0)
970dc4bc9bSmacallan#define xf86LoaderReqSymbols(...) do {} while (0)
981b41fcf5Smrg#endif
991b41fcf5Smrg
100357bfbb2Smrg#define DEBUG 0
101357bfbb2Smrg
102357bfbb2Smrg#if DEBUG
103357bfbb2Smrg# define TRACE_ENTER(str)       ErrorF("wsfb: " str " %d\n",pScrn->scrnIndex)
104357bfbb2Smrg# define TRACE_EXIT(str)        ErrorF("wsfb: " str " done\n")
105357bfbb2Smrg# define TRACE(str)             ErrorF("wsfb trace: " str "\n")
106357bfbb2Smrg#else
107357bfbb2Smrg# define TRACE_ENTER(str)
108357bfbb2Smrg# define TRACE_EXIT(str)
109357bfbb2Smrg# define TRACE(str)
110357bfbb2Smrg#endif
111357bfbb2Smrg
112357bfbb2Smrg/* Prototypes */
113357bfbb2Smrg#ifdef XFree86LOADER
114357bfbb2Smrgstatic pointer WsfbSetup(pointer, pointer, int *, int *);
115357bfbb2Smrg#endif
116357bfbb2Smrgstatic Bool WsfbGetRec(ScrnInfoPtr);
117357bfbb2Smrgstatic void WsfbFreeRec(ScrnInfoPtr);
118357bfbb2Smrgstatic const OptionInfoRec * WsfbAvailableOptions(int, int);
119357bfbb2Smrgstatic void WsfbIdentify(int);
120357bfbb2Smrgstatic Bool WsfbProbe(DriverPtr, int);
121357bfbb2Smrgstatic Bool WsfbPreInit(ScrnInfoPtr, int);
122357bfbb2Smrgstatic Bool WsfbScreenInit(int, ScreenPtr, int, char **);
123357bfbb2Smrgstatic Bool WsfbCloseScreen(int, ScreenPtr);
124357bfbb2Smrgstatic void *WsfbWindowLinear(ScreenPtr, CARD32, CARD32, int, CARD32 *,
125357bfbb2Smrg			      void *);
126357bfbb2Smrgstatic void WsfbPointerMoved(int, int, int);
127357bfbb2Smrgstatic Bool WsfbEnterVT(int, int);
128357bfbb2Smrgstatic void WsfbLeaveVT(int, int);
129357bfbb2Smrgstatic Bool WsfbSwitchMode(int, DisplayModePtr, int);
130357bfbb2Smrgstatic int WsfbValidMode(int, DisplayModePtr, Bool, int);
131357bfbb2Smrgstatic void WsfbLoadPalette(ScrnInfoPtr, int, int *, LOCO *, VisualPtr);
132357bfbb2Smrgstatic Bool WsfbSaveScreen(ScreenPtr, int);
133357bfbb2Smrgstatic void WsfbSave(ScrnInfoPtr);
134357bfbb2Smrgstatic void WsfbRestore(ScrnInfoPtr);
135357bfbb2Smrg
13664f08a18Smrg/* DGA stuff */
137357bfbb2Smrg#ifdef XFreeXDGA
138357bfbb2Smrgstatic Bool WsfbDGAOpenFramebuffer(ScrnInfoPtr, char **, unsigned char **,
139357bfbb2Smrg				   int *, int *, int *);
140357bfbb2Smrgstatic Bool WsfbDGASetMode(ScrnInfoPtr, DGAModePtr);
141357bfbb2Smrgstatic void WsfbDGASetViewport(ScrnInfoPtr, int, int, int);
142357bfbb2Smrgstatic Bool WsfbDGAInit(ScrnInfoPtr, ScreenPtr);
143357bfbb2Smrg#endif
144357bfbb2Smrgstatic Bool WsfbDriverFunc(ScrnInfoPtr pScrn, xorgDriverFuncOp op,
145357bfbb2Smrg				pointer ptr);
146357bfbb2Smrg
14764f08a18Smrg/* Helper functions */
148357bfbb2Smrgstatic int wsfb_open(char *);
149357bfbb2Smrgstatic pointer wsfb_mmap(size_t, off_t, int);
150357bfbb2Smrg
151357bfbb2Smrgenum { WSFB_ROTATE_NONE = 0,
152357bfbb2Smrg       WSFB_ROTATE_CCW = 90,
153357bfbb2Smrg       WSFB_ROTATE_UD = 180,
154357bfbb2Smrg       WSFB_ROTATE_CW = 270
155357bfbb2Smrg};
156357bfbb2Smrg
157357bfbb2Smrg/*
15864f08a18Smrg * This is intentionally screen-independent.
15964f08a18Smrg * It indicates the binding choice made in the first PreInit.
160357bfbb2Smrg */
161357bfbb2Smrgstatic int pix24bpp = 0;
162357bfbb2Smrg
163357bfbb2Smrg#define WSFB_VERSION 		4000
164357bfbb2Smrg#define WSFB_NAME		"wsfb"
165357bfbb2Smrg#define WSFB_DRIVER_NAME	"wsfb"
166357bfbb2Smrg
167357bfbb2Smrg_X_EXPORT DriverRec WSFB = {
168357bfbb2Smrg	WSFB_VERSION,
169357bfbb2Smrg	WSFB_DRIVER_NAME,
170357bfbb2Smrg	WsfbIdentify,
171357bfbb2Smrg	WsfbProbe,
172357bfbb2Smrg	WsfbAvailableOptions,
173357bfbb2Smrg	NULL,
174357bfbb2Smrg	0,
175357bfbb2Smrg	WsfbDriverFunc
176357bfbb2Smrg};
177357bfbb2Smrg
178357bfbb2Smrg/* Supported "chipsets" */
179357bfbb2Smrgstatic SymTabRec WsfbChipsets[] = {
180357bfbb2Smrg	{ 0, "wsfb" },
181357bfbb2Smrg	{ -1, NULL }
182357bfbb2Smrg};
183357bfbb2Smrg
184357bfbb2Smrg/* Supported options */
185357bfbb2Smrgtypedef enum {
186357bfbb2Smrg	OPTION_SHADOW_FB,
1875d492fd2Smacallan	OPTION_ROTATE,
1885d492fd2Smacallan	OPTION_HW_CURSOR,
1895d492fd2Smacallan	OPTION_SW_CURSOR
190357bfbb2Smrg} WsfbOpts;
191357bfbb2Smrg
192357bfbb2Smrgstatic const OptionInfoRec WsfbOptions[] = {
193357bfbb2Smrg	{ OPTION_SHADOW_FB, "ShadowFB", OPTV_BOOLEAN, {0}, FALSE},
194357bfbb2Smrg	{ OPTION_ROTATE, "Rotate", OPTV_STRING, {0}, FALSE},
195357bfbb2Smrg	{ -1, NULL, OPTV_NONE, {0}, FALSE}
196357bfbb2Smrg};
197357bfbb2Smrg
198357bfbb2Smrg/* Symbols needed from other modules */
199357bfbb2Smrgstatic const char *fbSymbols[] = {
200357bfbb2Smrg	"fbPictureInit",
201357bfbb2Smrg	"fbScreenInit",
202357bfbb2Smrg	NULL
203357bfbb2Smrg};
204357bfbb2Smrgstatic const char *shadowSymbols[] = {
205357bfbb2Smrg	"shadowAdd",
206357bfbb2Smrg	"shadowSetup",
207357bfbb2Smrg	"shadowUpdatePacked",
208357bfbb2Smrg	"shadowUpdatePackedWeak",
209357bfbb2Smrg	"shadowUpdateRotatePacked",
210357bfbb2Smrg	"shadowUpdateRotatePackedWeak",
211357bfbb2Smrg	NULL
212357bfbb2Smrg};
213357bfbb2Smrg
2145d492fd2Smacallanstatic const char *ramdacSymbols[] = {
2155d492fd2Smacallan	"xf86CreateCursorInfoRec",
2165d492fd2Smacallan	"xf86DestroyCursorInfoRec",
2175d492fd2Smacallan	"xf86InitCursor",
2185d492fd2Smacallan	NULL
2195d492fd2Smacallan};
2205d492fd2Smacallan
221357bfbb2Smrg#ifdef XFree86LOADER
222357bfbb2Smrgstatic XF86ModuleVersionInfo WsfbVersRec = {
223357bfbb2Smrg	"wsfb",
224357bfbb2Smrg	MODULEVENDORSTRING,
225357bfbb2Smrg	MODINFOSTRING1,
226357bfbb2Smrg	MODINFOSTRING2,
227357bfbb2Smrg	XORG_VERSION_CURRENT,
228357bfbb2Smrg	PACKAGE_VERSION_MAJOR,
229357bfbb2Smrg	PACKAGE_VERSION_MINOR,
230357bfbb2Smrg	PACKAGE_VERSION_PATCHLEVEL,
231357bfbb2Smrg	ABI_CLASS_VIDEODRV,
232357bfbb2Smrg	ABI_VIDEODRV_VERSION,
233357bfbb2Smrg	NULL,
234357bfbb2Smrg	{0, 0, 0, 0}
235357bfbb2Smrg};
236357bfbb2Smrg
237357bfbb2Smrg_X_EXPORT XF86ModuleData wsfbModuleData = { &WsfbVersRec, WsfbSetup, NULL };
238357bfbb2Smrg
239357bfbb2Smrgstatic pointer
240357bfbb2SmrgWsfbSetup(pointer module, pointer opts, int *errmaj, int *errmin)
241357bfbb2Smrg{
242357bfbb2Smrg	static Bool setupDone = FALSE;
243357bfbb2Smrg	const char *osname;
244357bfbb2Smrg
24564f08a18Smrg	/* Check that we're being loaded on a OpenBSD or NetBSD system. */
246357bfbb2Smrg	LoaderGetOS(&osname, NULL, NULL, NULL);
247357bfbb2Smrg	if (!osname || (strcmp(osname, "openbsd") != 0 &&
248357bfbb2Smrg	                strcmp(osname, "netbsd") != 0)) {
249357bfbb2Smrg		if (errmaj)
250357bfbb2Smrg			*errmaj = LDR_BADOS;
251357bfbb2Smrg		if (errmin)
252357bfbb2Smrg			*errmin = 0;
253357bfbb2Smrg		return NULL;
254357bfbb2Smrg	}
255357bfbb2Smrg	if (!setupDone) {
256357bfbb2Smrg		setupDone = TRUE;
257357bfbb2Smrg		xf86AddDriver(&WSFB, module, HaveDriverFuncs);
2585d492fd2Smacallan		LoaderRefSymLists(fbSymbols, shadowSymbols, ramdacSymbols,
2595d492fd2Smacallan		    NULL);
260357bfbb2Smrg		return (pointer)1;
261357bfbb2Smrg	} else {
262357bfbb2Smrg		if (errmaj != NULL)
263357bfbb2Smrg			*errmaj = LDR_ONCEONLY;
264357bfbb2Smrg		return NULL;
265357bfbb2Smrg	}
266357bfbb2Smrg}
267357bfbb2Smrg#endif /* XFree86LOADER */
268357bfbb2Smrg
269357bfbb2Smrgstatic Bool
270357bfbb2SmrgWsfbGetRec(ScrnInfoPtr pScrn)
271357bfbb2Smrg{
272357bfbb2Smrg
273357bfbb2Smrg	if (pScrn->driverPrivate != NULL)
274357bfbb2Smrg		return TRUE;
275357bfbb2Smrg
276357bfbb2Smrg	pScrn->driverPrivate = xnfcalloc(sizeof(WsfbRec), 1);
277357bfbb2Smrg	return TRUE;
278357bfbb2Smrg}
279357bfbb2Smrg
280357bfbb2Smrgstatic void
281357bfbb2SmrgWsfbFreeRec(ScrnInfoPtr pScrn)
282357bfbb2Smrg{
283357bfbb2Smrg
284357bfbb2Smrg	if (pScrn->driverPrivate == NULL)
285357bfbb2Smrg		return;
286357bfbb2Smrg	xfree(pScrn->driverPrivate);
287357bfbb2Smrg	pScrn->driverPrivate = NULL;
288357bfbb2Smrg}
289357bfbb2Smrg
290357bfbb2Smrgstatic const OptionInfoRec *
291357bfbb2SmrgWsfbAvailableOptions(int chipid, int busid)
292357bfbb2Smrg{
293357bfbb2Smrg	return WsfbOptions;
294357bfbb2Smrg}
295357bfbb2Smrg
296357bfbb2Smrgstatic void
297357bfbb2SmrgWsfbIdentify(int flags)
298357bfbb2Smrg{
299357bfbb2Smrg	xf86PrintChipsets(WSFB_NAME, "driver for wsdisplay framebuffer",
300357bfbb2Smrg			  WsfbChipsets);
301357bfbb2Smrg}
302357bfbb2Smrg
30364f08a18Smrg/* Open the framebuffer device. */
304357bfbb2Smrgstatic int
305357bfbb2Smrgwsfb_open(char *dev)
306357bfbb2Smrg{
307357bfbb2Smrg	int fd = -1;
308357bfbb2Smrg
30964f08a18Smrg	/* Try argument from XF86Config first. */
310357bfbb2Smrg	if (dev == NULL || ((fd = priv_open_device(dev)) == -1)) {
31164f08a18Smrg		/* Second: environment variable. */
312357bfbb2Smrg		dev = getenv("XDEVICE");
313357bfbb2Smrg		if (dev == NULL || ((fd = priv_open_device(dev)) == -1)) {
31464f08a18Smrg			/* Last try: default device. */
315357bfbb2Smrg			dev = WSFB_DEFAULT_DEV;
316357bfbb2Smrg			if ((fd = priv_open_device(dev)) == -1) {
317357bfbb2Smrg				return -1;
318357bfbb2Smrg			}
319357bfbb2Smrg		}
320357bfbb2Smrg	}
321357bfbb2Smrg	return fd;
322357bfbb2Smrg}
323357bfbb2Smrg
32464f08a18Smrg/* Map the framebuffer's memory. */
325357bfbb2Smrgstatic pointer
326357bfbb2Smrgwsfb_mmap(size_t len, off_t off, int fd)
327357bfbb2Smrg{
328357bfbb2Smrg	int pagemask, mapsize;
329357bfbb2Smrg	caddr_t addr;
330357bfbb2Smrg	pointer mapaddr;
331357bfbb2Smrg
332357bfbb2Smrg	pagemask = getpagesize() - 1;
333357bfbb2Smrg	mapsize = ((int) len + pagemask) & ~pagemask;
334357bfbb2Smrg	addr = 0;
335357bfbb2Smrg
336357bfbb2Smrg	/*
33764f08a18Smrg	 * Try and make it private first, that way once we get it, an
338357bfbb2Smrg	 * interloper, e.g. another server, can't get this frame buffer,
339357bfbb2Smrg	 * and if another server already has it, this one won't.
340357bfbb2Smrg	 */
341357bfbb2Smrg	mapaddr = (pointer) mmap(addr, mapsize,
342357bfbb2Smrg				 PROT_READ | PROT_WRITE, MAP_SHARED,
343357bfbb2Smrg				 fd, off);
3445d492fd2Smacallan	if (mapaddr == MAP_FAILED) {
345357bfbb2Smrg		mapaddr = NULL;
346357bfbb2Smrg	}
347357bfbb2Smrg#if DEBUG
348357bfbb2Smrg	ErrorF("mmap returns: addr %p len 0x%x\n", mapaddr, mapsize);
349357bfbb2Smrg#endif
350357bfbb2Smrg	return mapaddr;
351357bfbb2Smrg}
352357bfbb2Smrg
353357bfbb2Smrgstatic Bool
354357bfbb2SmrgWsfbProbe(DriverPtr drv, int flags)
355357bfbb2Smrg{
356357bfbb2Smrg	int i, fd, entity;
357357bfbb2Smrg       	GDevPtr *devSections;
358357bfbb2Smrg	int numDevSections;
359357bfbb2Smrg	char *dev;
360357bfbb2Smrg	Bool foundScreen = FALSE;
361357bfbb2Smrg
362357bfbb2Smrg	TRACE("probe start");
363357bfbb2Smrg
364357bfbb2Smrg	/* For now, just bail out for PROBE_DETECT. */
365357bfbb2Smrg	if (flags & PROBE_DETECT)
366357bfbb2Smrg		return FALSE;
367357bfbb2Smrg
368357bfbb2Smrg	if ((numDevSections = xf86MatchDevice(WSFB_DRIVER_NAME,
369357bfbb2Smrg					      &devSections)) <= 0)
370357bfbb2Smrg		return FALSE;
371357bfbb2Smrg
372357bfbb2Smrg	for (i = 0; i < numDevSections; i++) {
373357bfbb2Smrg		ScrnInfoPtr pScrn = NULL;
374357bfbb2Smrg
375357bfbb2Smrg		dev = xf86FindOptionValue(devSections[i]->options, "device");
376357bfbb2Smrg		if ((fd = wsfb_open(dev)) >= 0) {
377357bfbb2Smrg			entity = xf86ClaimFbSlot(drv, 0, devSections[i], TRUE);
378357bfbb2Smrg			pScrn = xf86ConfigFbEntity(NULL,0,entity,
379357bfbb2Smrg						   NULL,NULL,NULL,NULL);
380357bfbb2Smrg			if (pScrn != NULL) {
381357bfbb2Smrg				foundScreen = TRUE;
382357bfbb2Smrg				pScrn->driverVersion = WSFB_VERSION;
383357bfbb2Smrg				pScrn->driverName = WSFB_DRIVER_NAME;
384357bfbb2Smrg				pScrn->name = WSFB_NAME;
385357bfbb2Smrg				pScrn->Probe = WsfbProbe;
386357bfbb2Smrg				pScrn->PreInit = WsfbPreInit;
387357bfbb2Smrg				pScrn->ScreenInit = WsfbScreenInit;
388357bfbb2Smrg				pScrn->SwitchMode = WsfbSwitchMode;
389357bfbb2Smrg				pScrn->AdjustFrame = NULL;
390357bfbb2Smrg				pScrn->EnterVT = WsfbEnterVT;
391357bfbb2Smrg				pScrn->LeaveVT = WsfbLeaveVT;
392357bfbb2Smrg				pScrn->ValidMode = WsfbValidMode;
393357bfbb2Smrg
394357bfbb2Smrg				xf86DrvMsg(pScrn->scrnIndex, X_INFO,
395357bfbb2Smrg				    "using %s\n", dev != NULL ? dev :
396357bfbb2Smrg				    "default device");
397357bfbb2Smrg			}
398357bfbb2Smrg		}
399357bfbb2Smrg	}
400357bfbb2Smrg	xfree(devSections);
401357bfbb2Smrg	TRACE("probe done");
402357bfbb2Smrg	return foundScreen;
403357bfbb2Smrg}
404357bfbb2Smrg
405357bfbb2Smrgstatic Bool
406357bfbb2SmrgWsfbPreInit(ScrnInfoPtr pScrn, int flags)
407357bfbb2Smrg{
408357bfbb2Smrg	WsfbPtr fPtr;
409357bfbb2Smrg	int default_depth, wstype;
410357bfbb2Smrg	char *dev, *s;
411357bfbb2Smrg	char *mod = NULL;
412357bfbb2Smrg	const char *reqSym = NULL;
413357bfbb2Smrg	Gamma zeros = {0.0, 0.0, 0.0};
414357bfbb2Smrg	DisplayModePtr mode;
4155d492fd2Smacallan	MessageType from;
416357bfbb2Smrg
417357bfbb2Smrg	if (flags & PROBE_DETECT) return FALSE;
418357bfbb2Smrg
419357bfbb2Smrg	TRACE_ENTER("PreInit");
420357bfbb2Smrg
421357bfbb2Smrg	if (pScrn->numEntities != 1) return FALSE;
422357bfbb2Smrg
423357bfbb2Smrg	pScrn->monitor = pScrn->confScreen->monitor;
424357bfbb2Smrg
425357bfbb2Smrg	WsfbGetRec(pScrn);
426357bfbb2Smrg	fPtr = WSFBPTR(pScrn);
427357bfbb2Smrg
428357bfbb2Smrg	fPtr->pEnt = xf86GetEntityInfo(pScrn->entityList[0]);
429357bfbb2Smrg
43064f08a18Smrg#if GET_ABI_MAJOR(ABI_VIDEODRV_VERSION) < 6
431357bfbb2Smrg	pScrn->racMemFlags = RAC_FB | RAC_COLORMAP | RAC_CURSOR | RAC_VIEWPORT;
432357bfbb2Smrg	pScrn->racIoFlags = pScrn->racMemFlags;
43364f08a18Smrg#endif
434357bfbb2Smrg
435357bfbb2Smrg	dev = xf86FindOptionValue(fPtr->pEnt->device->options, "device");
436357bfbb2Smrg	fPtr->fd = wsfb_open(dev);
437357bfbb2Smrg	if (fPtr->fd == -1) {
438357bfbb2Smrg		return FALSE;
439357bfbb2Smrg	}
440357bfbb2Smrg
441357bfbb2Smrg	if (ioctl(fPtr->fd, WSDISPLAYIO_GINFO, &fPtr->info) == -1) {
442357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
443357bfbb2Smrg			   "ioctl WSDISPLAY_GINFO: %s\n",
444357bfbb2Smrg			   strerror(errno));
445357bfbb2Smrg		return FALSE;
446357bfbb2Smrg	}
447357bfbb2Smrg	if (ioctl(fPtr->fd, WSDISPLAYIO_GTYPE, &wstype) == -1) {
448357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
449357bfbb2Smrg			   "ioctl WSDISPLAY_GTYPE: %s\n",
450357bfbb2Smrg			   strerror(errno));
451357bfbb2Smrg		return FALSE;
452357bfbb2Smrg	}
453357bfbb2Smrg	if (ioctl(fPtr->fd, WSDISPLAYIO_LINEBYTES, &fPtr->linebytes) == -1) {
454357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
455357bfbb2Smrg			   "ioctl WSDISPLAYIO_LINEBYTES: %s\n",
456357bfbb2Smrg			   strerror(errno));
457357bfbb2Smrg		return FALSE;
458357bfbb2Smrg	}
459357bfbb2Smrg	/*
46064f08a18Smrg	 * Allocate room for saving the colormap.
461357bfbb2Smrg	 */
462357bfbb2Smrg	if (fPtr->info.cmsize != 0) {
463357bfbb2Smrg		fPtr->saved_cmap.red =
464357bfbb2Smrg		    (unsigned char *)xalloc(fPtr->info.cmsize);
465357bfbb2Smrg		if (fPtr->saved_cmap.red == NULL) {
466357bfbb2Smrg			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
467357bfbb2Smrg			    "Cannot malloc %d bytes\n", fPtr->info.cmsize);
468357bfbb2Smrg			return FALSE;
469357bfbb2Smrg		}
470357bfbb2Smrg		fPtr->saved_cmap.green =
471357bfbb2Smrg		    (unsigned char *)xalloc(fPtr->info.cmsize);
472357bfbb2Smrg		if (fPtr->saved_cmap.green == NULL) {
473357bfbb2Smrg			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
474357bfbb2Smrg			    "Cannot malloc %d bytes\n", fPtr->info.cmsize);
475357bfbb2Smrg			xfree(fPtr->saved_cmap.red);
476357bfbb2Smrg			return FALSE;
477357bfbb2Smrg		}
478357bfbb2Smrg		fPtr->saved_cmap.blue =
479357bfbb2Smrg		    (unsigned char *)xalloc(fPtr->info.cmsize);
480357bfbb2Smrg		if (fPtr->saved_cmap.blue == NULL) {
481357bfbb2Smrg			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
482357bfbb2Smrg			    "Cannot malloc %d bytes\n", fPtr->info.cmsize);
483357bfbb2Smrg			xfree(fPtr->saved_cmap.red);
484357bfbb2Smrg			xfree(fPtr->saved_cmap.green);
485357bfbb2Smrg			return FALSE;
486357bfbb2Smrg		}
487357bfbb2Smrg	}
488357bfbb2Smrg
489357bfbb2Smrg	/* Handle depth */
490357bfbb2Smrg	default_depth = fPtr->info.depth <= 24 ? fPtr->info.depth : 24;
491357bfbb2Smrg	if (!xf86SetDepthBpp(pScrn, default_depth, default_depth,
492357bfbb2Smrg		fPtr->info.depth,
493357bfbb2Smrg		fPtr->info.depth >= 24 ? Support24bppFb|Support32bppFb : 0))
494357bfbb2Smrg		return FALSE;
495357bfbb2Smrg
49664f08a18Smrg	/* Check consistency. */
497357bfbb2Smrg	if (pScrn->bitsPerPixel != fPtr->info.depth) {
498357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
499357bfbb2Smrg		    "specified depth (%d) or bpp (%d) doesn't match "
500357bfbb2Smrg		    "framebuffer depth (%d)\n", pScrn->depth,
501357bfbb2Smrg		    pScrn->bitsPerPixel, fPtr->info.depth);
502357bfbb2Smrg		return FALSE;
503357bfbb2Smrg	}
504357bfbb2Smrg	xf86PrintDepthBpp(pScrn);
505357bfbb2Smrg
50664f08a18Smrg	/* Get the depth24 pixmap format. */
507357bfbb2Smrg	if (pScrn->depth == 24 && pix24bpp == 0)
508357bfbb2Smrg		pix24bpp = xf86GetBppFromDepth(pScrn, 24);
509357bfbb2Smrg
51064f08a18Smrg	/* Color weight */
511357bfbb2Smrg	if (pScrn->depth > 8) {
512357bfbb2Smrg		rgb zeros = { 0, 0, 0 }, masks;
513357bfbb2Smrg
514357bfbb2Smrg		if (wstype == WSDISPLAY_TYPE_SUN24 ||
515357bfbb2Smrg		    wstype == WSDISPLAY_TYPE_SUNCG12 ||
516357bfbb2Smrg		    wstype == WSDISPLAY_TYPE_SUNCG14 ||
517357bfbb2Smrg		    wstype == WSDISPLAY_TYPE_SUNTCX ||
51897833113Smacallan		    wstype == WSDISPLAY_TYPE_SUNFFB ||
51997833113Smacallan		    wstype == WSDISPLAY_TYPE_XVR1000) {
520357bfbb2Smrg			masks.red = 0x0000ff;
521357bfbb2Smrg			masks.green = 0x00ff00;
522357bfbb2Smrg			masks.blue = 0xff0000;
523357bfbb2Smrg		} else {
524357bfbb2Smrg			masks.red = 0;
525357bfbb2Smrg			masks.green = 0;
526357bfbb2Smrg			masks.blue = 0;
527357bfbb2Smrg		}
528357bfbb2Smrg
529357bfbb2Smrg		if (!xf86SetWeight(pScrn, zeros, masks))
530357bfbb2Smrg			return FALSE;
531357bfbb2Smrg	}
532357bfbb2Smrg
53364f08a18Smrg	/* Visual init */
534357bfbb2Smrg	if (!xf86SetDefaultVisual(pScrn, -1))
535357bfbb2Smrg		return FALSE;
536357bfbb2Smrg
53764f08a18Smrg	/* We don't currently support DirectColor at > 8bpp . */
538357bfbb2Smrg	if (pScrn->depth > 8 && pScrn->defaultVisual != TrueColor) {
539357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR, "Given default visual"
540357bfbb2Smrg			   " (%s) is not supported at depth %d\n",
541357bfbb2Smrg			   xf86GetVisualName(pScrn->defaultVisual),
542357bfbb2Smrg			   pScrn->depth);
543357bfbb2Smrg		return FALSE;
544357bfbb2Smrg	}
545357bfbb2Smrg
546357bfbb2Smrg	xf86SetGamma(pScrn,zeros);
547357bfbb2Smrg
548357bfbb2Smrg	pScrn->progClock = TRUE;
5498fc0431cStsutsui	pScrn->rgbBits   = (pScrn->depth >= 8) ? 8 : pScrn->depth;
550357bfbb2Smrg	pScrn->chipset   = "wsfb";
551357bfbb2Smrg	pScrn->videoRam  = fPtr->linebytes * fPtr->info.height;
552357bfbb2Smrg
553357bfbb2Smrg	xf86DrvMsg(pScrn->scrnIndex, X_INFO, "Vidmem: %dk\n",
554357bfbb2Smrg		   pScrn->videoRam/1024);
555357bfbb2Smrg
55664f08a18Smrg	/* Handle options. */
557357bfbb2Smrg	xf86CollectOptions(pScrn, NULL);
558357bfbb2Smrg	if (!(fPtr->Options = xalloc(sizeof(WsfbOptions))))
559357bfbb2Smrg		return FALSE;
560357bfbb2Smrg	memcpy(fPtr->Options, WsfbOptions, sizeof(WsfbOptions));
561357bfbb2Smrg	xf86ProcessOptions(pScrn->scrnIndex, fPtr->pEnt->device->options,
562357bfbb2Smrg			   fPtr->Options);
563357bfbb2Smrg
56464f08a18Smrg	/* Use shadow framebuffer by default, on depth >= 8 */
565357bfbb2Smrg	if (pScrn->depth >= 8)
566357bfbb2Smrg		fPtr->shadowFB = xf86ReturnOptValBool(fPtr->Options,
567357bfbb2Smrg						      OPTION_SHADOW_FB, TRUE);
568357bfbb2Smrg	else
569357bfbb2Smrg		if (xf86ReturnOptValBool(fPtr->Options,
570357bfbb2Smrg					 OPTION_SHADOW_FB, FALSE)) {
571357bfbb2Smrg			xf86DrvMsg(pScrn->scrnIndex, X_WARNING,
572357bfbb2Smrg				   "Shadow FB option ignored on depth < 8");
573357bfbb2Smrg		}
574357bfbb2Smrg
57564f08a18Smrg	/* Rotation */
576357bfbb2Smrg	fPtr->rotate = WSFB_ROTATE_NONE;
577357bfbb2Smrg	if ((s = xf86GetOptValString(fPtr->Options, OPTION_ROTATE))) {
578357bfbb2Smrg		if (pScrn->depth >= 8) {
579357bfbb2Smrg			if (!xf86NameCmp(s, "CW")) {
580357bfbb2Smrg				fPtr->shadowFB = TRUE;
581357bfbb2Smrg				fPtr->rotate = WSFB_ROTATE_CW;
582357bfbb2Smrg				xf86DrvMsg(pScrn->scrnIndex, X_CONFIG,
583357bfbb2Smrg				    "Rotating screen clockwise\n");
584357bfbb2Smrg			} else if (!xf86NameCmp(s, "CCW")) {
585357bfbb2Smrg				fPtr->shadowFB = TRUE;
586357bfbb2Smrg				fPtr->rotate = WSFB_ROTATE_CCW;
587357bfbb2Smrg				xf86DrvMsg(pScrn->scrnIndex, X_CONFIG,
588357bfbb2Smrg				    "Rotating screen counter clockwise\n");
589357bfbb2Smrg			} else if (!xf86NameCmp(s, "UD")) {
590357bfbb2Smrg				fPtr->shadowFB = TRUE;
591357bfbb2Smrg				fPtr->rotate = WSFB_ROTATE_UD;
592357bfbb2Smrg				xf86DrvMsg(pScrn->scrnIndex, X_CONFIG,
593357bfbb2Smrg				    "Rotating screen upside down\n");
594357bfbb2Smrg			} else {
595357bfbb2Smrg				xf86DrvMsg(pScrn->scrnIndex, X_CONFIG,
596357bfbb2Smrg				    "\"%s\" is not a valid value for Option "
597357bfbb2Smrg				    "\"Rotate\"\n", s);
598357bfbb2Smrg				xf86DrvMsg(pScrn->scrnIndex, X_INFO,
599357bfbb2Smrg				    "Valid options are \"CW\", \"CCW\","
600357bfbb2Smrg				    " or \"UD\"\n");
601357bfbb2Smrg			}
602357bfbb2Smrg		} else {
603357bfbb2Smrg			xf86DrvMsg(pScrn->scrnIndex, X_WARNING,
604357bfbb2Smrg			    "Option \"Rotate\" ignored on depth < 8");
605357bfbb2Smrg		}
606357bfbb2Smrg	}
607357bfbb2Smrg
60864f08a18Smrg	/* Fake video mode struct. */
609357bfbb2Smrg	mode = (DisplayModePtr)xalloc(sizeof(DisplayModeRec));
610357bfbb2Smrg	mode->prev = mode;
611357bfbb2Smrg	mode->next = mode;
612357bfbb2Smrg	mode->name = "wsfb current mode";
613357bfbb2Smrg	mode->status = MODE_OK;
614357bfbb2Smrg	mode->type = M_T_BUILTIN;
615357bfbb2Smrg	mode->Clock = 0;
616357bfbb2Smrg	mode->HDisplay = fPtr->info.width;
617357bfbb2Smrg	mode->HSyncStart = 0;
618357bfbb2Smrg	mode->HSyncEnd = 0;
619357bfbb2Smrg	mode->HTotal = 0;
620357bfbb2Smrg	mode->HSkew = 0;
621357bfbb2Smrg	mode->VDisplay = fPtr->info.height;
622357bfbb2Smrg	mode->VSyncStart = 0;
623357bfbb2Smrg	mode->VSyncEnd = 0;
624357bfbb2Smrg	mode->VTotal = 0;
625357bfbb2Smrg	mode->VScan = 0;
626357bfbb2Smrg	mode->Flags = 0;
627357bfbb2Smrg	if (pScrn->modes != NULL) {
628357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_INFO,
629357bfbb2Smrg		   "Ignoring mode specification from screen section\n");
630357bfbb2Smrg	}
631357bfbb2Smrg	pScrn->currentMode = pScrn->modes = mode;
632357bfbb2Smrg	pScrn->virtualX = fPtr->info.width;
633357bfbb2Smrg	pScrn->virtualY = fPtr->info.height;
634357bfbb2Smrg	pScrn->displayWidth = pScrn->virtualX;
635357bfbb2Smrg
63664f08a18Smrg	/* Set the display resolution. */
637357bfbb2Smrg	xf86SetDpi(pScrn, 0, 0);
638357bfbb2Smrg
6395d492fd2Smacallan	from = X_DEFAULT;
6405d492fd2Smacallan	fPtr->HWCursor = TRUE;
6415d492fd2Smacallan	if (xf86GetOptValBool(fPtr->Options, OPTION_HW_CURSOR, &fPtr->HWCursor))
6425d492fd2Smacallan		from = X_CONFIG;
6435d492fd2Smacallan	if (xf86ReturnOptValBool(fPtr->Options, OPTION_SW_CURSOR, FALSE)) {
6445d492fd2Smacallan		from = X_CONFIG;
6455d492fd2Smacallan		fPtr->HWCursor = FALSE;
6465d492fd2Smacallan	}
6475d492fd2Smacallan	xf86DrvMsg(pScrn->scrnIndex, from, "Using %s cursor\n",
6485d492fd2Smacallan		fPtr->HWCursor ? "HW" : "SW");
6495d492fd2Smacallan
65064f08a18Smrg	/* Load bpp-specific modules. */
651357bfbb2Smrg	switch(pScrn->bitsPerPixel) {
65264f08a18Smrg	case 1:
65364f08a18Smrg	case 4:
654357bfbb2Smrg	default:
655357bfbb2Smrg		mod = "fb";
656357bfbb2Smrg		break;
657357bfbb2Smrg	}
658357bfbb2Smrg
659357bfbb2Smrg
66064f08a18Smrg	/* Load shadow if needed. */
661357bfbb2Smrg	if (fPtr->shadowFB) {
662357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_CONFIG,
663357bfbb2Smrg			   "Using \"Shadow Framebuffer\"\n");
664357bfbb2Smrg		if (xf86LoadSubModule(pScrn, "shadow") == NULL) {
665357bfbb2Smrg			WsfbFreeRec(pScrn);
666357bfbb2Smrg			return FALSE;
667357bfbb2Smrg		}
668357bfbb2Smrg	}
6695d492fd2Smacallan
670357bfbb2Smrg	if (mod && xf86LoadSubModule(pScrn, mod) == NULL) {
671357bfbb2Smrg		WsfbFreeRec(pScrn);
672357bfbb2Smrg		return FALSE;
673357bfbb2Smrg	}
6745d492fd2Smacallan
6755d492fd2Smacallan	if (xf86LoadSubModule(pScrn, "ramdac") == NULL) {
6765d492fd2Smacallan		WsfbFreeRec(pScrn);
6775d492fd2Smacallan		return FALSE;
6785d492fd2Smacallan        }
6795d492fd2Smacallan
680357bfbb2Smrg	if (mod) {
681357bfbb2Smrg		if (reqSym) {
682357bfbb2Smrg			xf86LoaderReqSymbols(reqSym, NULL);
683357bfbb2Smrg		} else {
684357bfbb2Smrg			xf86LoaderReqSymLists(fbSymbols, NULL);
685357bfbb2Smrg		}
686357bfbb2Smrg	}
687357bfbb2Smrg	TRACE_EXIT("PreInit");
688357bfbb2Smrg	return TRUE;
689357bfbb2Smrg}
690357bfbb2Smrg
691357bfbb2Smrgstatic Bool
692357bfbb2SmrgWsfbCreateScreenResources(ScreenPtr pScreen)
693357bfbb2Smrg{
694357bfbb2Smrg	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
695357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
696357bfbb2Smrg	PixmapPtr pPixmap;
697357bfbb2Smrg	Bool ret;
698357bfbb2Smrg
699357bfbb2Smrg	pScreen->CreateScreenResources = fPtr->CreateScreenResources;
700357bfbb2Smrg	ret = pScreen->CreateScreenResources(pScreen);
701357bfbb2Smrg	pScreen->CreateScreenResources = WsfbCreateScreenResources;
702357bfbb2Smrg
703357bfbb2Smrg	if (!ret)
704357bfbb2Smrg		return FALSE;
705357bfbb2Smrg
706357bfbb2Smrg	pPixmap = pScreen->GetScreenPixmap(pScreen);
707357bfbb2Smrg
708357bfbb2Smrg	if (!shadowAdd(pScreen, pPixmap, fPtr->rotate ?
709357bfbb2Smrg		shadowUpdateRotatePackedWeak() : shadowUpdatePackedWeak(),
710357bfbb2Smrg		WsfbWindowLinear, fPtr->rotate, NULL)) {
711357bfbb2Smrg		return FALSE;
712357bfbb2Smrg	}
713357bfbb2Smrg	return TRUE;
714357bfbb2Smrg}
715357bfbb2Smrg
716357bfbb2Smrg
717357bfbb2Smrgstatic Bool
718357bfbb2SmrgWsfbShadowInit(ScreenPtr pScreen)
719357bfbb2Smrg{
720357bfbb2Smrg	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
721357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
722357bfbb2Smrg
723357bfbb2Smrg	if (!shadowSetup(pScreen))
724357bfbb2Smrg		return FALSE;
725357bfbb2Smrg	fPtr->CreateScreenResources = pScreen->CreateScreenResources;
726357bfbb2Smrg	pScreen->CreateScreenResources = WsfbCreateScreenResources;
727357bfbb2Smrg
728357bfbb2Smrg	return TRUE;
729357bfbb2Smrg}
730357bfbb2Smrg
731357bfbb2Smrgstatic Bool
732357bfbb2SmrgWsfbScreenInit(int scrnIndex, ScreenPtr pScreen, int argc, char **argv)
733357bfbb2Smrg{
734357bfbb2Smrg	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
735357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
736357bfbb2Smrg	VisualPtr visual;
737357bfbb2Smrg	int ret, flags, ncolors;
738357bfbb2Smrg	int wsmode = WSDISPLAYIO_MODE_DUMBFB;
7398fc0431cStsutsui	int wstype;
740357bfbb2Smrg	size_t len;
741357bfbb2Smrg
742357bfbb2Smrg	TRACE_ENTER("WsfbScreenInit");
743357bfbb2Smrg#if DEBUG
744357bfbb2Smrg	ErrorF("\tbitsPerPixel=%d, depth=%d, defaultVisual=%s\n"
745357bfbb2Smrg	       "\tmask: %x,%x,%x, offset: %u,%u,%u\n",
746357bfbb2Smrg	       pScrn->bitsPerPixel,
747357bfbb2Smrg	       pScrn->depth,
748357bfbb2Smrg	       xf86GetVisualName(pScrn->defaultVisual),
749357bfbb2Smrg	       pScrn->mask.red,pScrn->mask.green,pScrn->mask.blue,
750357bfbb2Smrg	       pScrn->offset.red,pScrn->offset.green,pScrn->offset.blue);
751357bfbb2Smrg#endif
752357bfbb2Smrg	switch (fPtr->info.depth) {
753357bfbb2Smrg	case 1:
754357bfbb2Smrg	case 4:
755357bfbb2Smrg	case 8:
756357bfbb2Smrg		len = fPtr->linebytes*fPtr->info.height;
757357bfbb2Smrg		break;
758357bfbb2Smrg	case 16:
759357bfbb2Smrg		if (fPtr->linebytes == fPtr->info.width) {
760357bfbb2Smrg			len = fPtr->info.width*fPtr->info.height*sizeof(short);
761357bfbb2Smrg		} else {
762357bfbb2Smrg			len = fPtr->linebytes*fPtr->info.height;
763357bfbb2Smrg		}
764357bfbb2Smrg		break;
765357bfbb2Smrg	case 24:
766357bfbb2Smrg		if (fPtr->linebytes == fPtr->info.width) {
767357bfbb2Smrg			len = fPtr->info.width*fPtr->info.height*3;
768357bfbb2Smrg		} else {
769357bfbb2Smrg			len = fPtr->linebytes*fPtr->info.height;
770357bfbb2Smrg		}
771357bfbb2Smrg		break;
772357bfbb2Smrg	case 32:
773357bfbb2Smrg		if (fPtr->linebytes == fPtr->info.width) {
774357bfbb2Smrg			len = fPtr->info.width*fPtr->info.height*sizeof(int);
775357bfbb2Smrg		} else {
776357bfbb2Smrg			len = fPtr->linebytes*fPtr->info.height;
777357bfbb2Smrg		}
778357bfbb2Smrg		break;
779357bfbb2Smrg	default:
780357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
781357bfbb2Smrg			   "unsupported depth %d\n", fPtr->info.depth);
782357bfbb2Smrg		return FALSE;
783357bfbb2Smrg	}
78464f08a18Smrg	/* Switch to graphics mode - required before mmap. */
785357bfbb2Smrg	if (ioctl(fPtr->fd, WSDISPLAYIO_SMODE, &wsmode) == -1) {
786357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
787357bfbb2Smrg			   "ioctl WSDISPLAYIO_SMODE: %s\n",
788357bfbb2Smrg			   strerror(errno));
789357bfbb2Smrg		return FALSE;
790357bfbb2Smrg	}
7918fc0431cStsutsui	/* Get wsdisplay type to handle quirks */
7928fc0431cStsutsui	if (ioctl(fPtr->fd, WSDISPLAYIO_GTYPE, &wstype) == -1) {
7938fc0431cStsutsui		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
7948fc0431cStsutsui			   "ioctl WSDISPLAY_GTYPE: %s\n",
7958fc0431cStsutsui			   strerror(errno));
7968fc0431cStsutsui		return FALSE;
7978fc0431cStsutsui	}
798357bfbb2Smrg	fPtr->fbmem = wsfb_mmap(len, 0, fPtr->fd);
799357bfbb2Smrg
800357bfbb2Smrg	if (fPtr->fbmem == NULL) {
801357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
802357bfbb2Smrg			   "wsfb_mmap: %s\n", strerror(errno));
803357bfbb2Smrg		return FALSE;
804357bfbb2Smrg	}
805357bfbb2Smrg	fPtr->fbmem_len = len;
806357bfbb2Smrg
807357bfbb2Smrg	WsfbSave(pScrn);
808357bfbb2Smrg	pScrn->vtSema = TRUE;
809357bfbb2Smrg
81064f08a18Smrg	/* MI layer */
811357bfbb2Smrg	miClearVisualTypes();
812357bfbb2Smrg	if (pScrn->bitsPerPixel > 8) {
813357bfbb2Smrg		if (!miSetVisualTypes(pScrn->depth, TrueColorMask,
814357bfbb2Smrg				      pScrn->rgbBits, TrueColor))
815357bfbb2Smrg			return FALSE;
816357bfbb2Smrg	} else {
817357bfbb2Smrg		if (!miSetVisualTypes(pScrn->depth,
818357bfbb2Smrg				      miGetDefaultVisualMask(pScrn->depth),
819357bfbb2Smrg				      pScrn->rgbBits, pScrn->defaultVisual))
820357bfbb2Smrg			return FALSE;
821357bfbb2Smrg	}
822357bfbb2Smrg	if (!miSetPixmapDepths())
823357bfbb2Smrg		return FALSE;
824357bfbb2Smrg
825357bfbb2Smrg	if (fPtr->rotate == WSFB_ROTATE_CW
826357bfbb2Smrg	    || fPtr->rotate == WSFB_ROTATE_CCW) {
827357bfbb2Smrg		int tmp = pScrn->virtualX;
828357bfbb2Smrg		pScrn->virtualX = pScrn->displayWidth = pScrn->virtualY;
829357bfbb2Smrg		pScrn->virtualY = tmp;
830357bfbb2Smrg	}
831357bfbb2Smrg	if (fPtr->rotate && !fPtr->PointerMoved) {
832357bfbb2Smrg		fPtr->PointerMoved = pScrn->PointerMoved;
833357bfbb2Smrg		pScrn->PointerMoved = WsfbPointerMoved;
834357bfbb2Smrg	}
835357bfbb2Smrg
836357bfbb2Smrg	fPtr->fbstart = fPtr->fbmem;
8378fc0431cStsutsui#ifdef	WSDISPLAY_TYPE_LUNA
8388fc0431cStsutsui	if (wstype == WSDISPLAY_TYPE_LUNA) {
8398fc0431cStsutsui		/*
8408fc0431cStsutsui		 * XXX
8418fc0431cStsutsui		 * LUNA's FB seems to have 64 dot (8 byte) offset.
8428fc0431cStsutsui		 * This might be able to be changed in kernel lunafb driver,
8438fc0431cStsutsui		 * but current setting was pulled from 4.4BSD-Lite2/luna68k.
8448fc0431cStsutsui		 */
8458fc0431cStsutsui		fPtr->fbstart += 8;
8468fc0431cStsutsui	}
8478fc0431cStsutsui#endif
848357bfbb2Smrg
84964f08a18Smrg	if (fPtr->shadowFB) {
85064f08a18Smrg		fPtr->shadow = xcalloc(1, pScrn->virtualX * pScrn->virtualY *
85164f08a18Smrg		    pScrn->bitsPerPixel);
85264f08a18Smrg
85364f08a18Smrg		if (!fPtr->shadow) {
85464f08a18Smrg			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
85564f08a18Smrg			    "Failed to allocate shadow framebuffer\n");
85664f08a18Smrg			return FALSE;
85764f08a18Smrg		}
85864f08a18Smrg	}
85964f08a18Smrg
860357bfbb2Smrg	switch (pScrn->bitsPerPixel) {
86164f08a18Smrg	case 1:
8628fc0431cStsutsui		ret = fbScreenInit(pScreen,
8638fc0431cStsutsui		    fPtr->fbstart,
8648fc0431cStsutsui		    pScrn->virtualX, pScrn->virtualY,
8658fc0431cStsutsui		    pScrn->xDpi, pScrn->yDpi,
8668fc0431cStsutsui		    fPtr->linebytes * 8, pScrn->bitsPerPixel);
8678fc0431cStsutsui		break;
86864f08a18Smrg	case 4:
869357bfbb2Smrg	case 8:
870357bfbb2Smrg	case 16:
871357bfbb2Smrg	case 24:
872357bfbb2Smrg	case 32:
873357bfbb2Smrg		ret = fbScreenInit(pScreen,
874b603b469Snonaka		    fPtr->shadowFB ? fPtr->shadow : fPtr->fbstart,
875357bfbb2Smrg		    pScrn->virtualX, pScrn->virtualY,
876357bfbb2Smrg		    pScrn->xDpi, pScrn->yDpi,
877357bfbb2Smrg		    pScrn->displayWidth, pScrn->bitsPerPixel);
878357bfbb2Smrg		break;
879357bfbb2Smrg	default:
880357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
881357bfbb2Smrg			   "Unsupported bpp: %d", pScrn->bitsPerPixel);
882357bfbb2Smrg		return FALSE;
883357bfbb2Smrg	} /* case */
884357bfbb2Smrg
885357bfbb2Smrg	if (!ret)
886357bfbb2Smrg		return FALSE;
887357bfbb2Smrg
888357bfbb2Smrg	if (pScrn->bitsPerPixel > 8) {
88964f08a18Smrg		/* Fixup RGB ordering. */
890357bfbb2Smrg		visual = pScreen->visuals + pScreen->numVisuals;
891357bfbb2Smrg		while (--visual >= pScreen->visuals) {
892357bfbb2Smrg			if ((visual->class | DynamicClass) == DirectColor) {
893357bfbb2Smrg				visual->offsetRed   = pScrn->offset.red;
894357bfbb2Smrg				visual->offsetGreen = pScrn->offset.green;
895357bfbb2Smrg				visual->offsetBlue  = pScrn->offset.blue;
896357bfbb2Smrg				visual->redMask     = pScrn->mask.red;
897357bfbb2Smrg				visual->greenMask   = pScrn->mask.green;
898357bfbb2Smrg				visual->blueMask    = pScrn->mask.blue;
899357bfbb2Smrg			}
900357bfbb2Smrg		}
901357bfbb2Smrg	}
902357bfbb2Smrg
903357bfbb2Smrg	if (pScrn->bitsPerPixel >= 8) {
904357bfbb2Smrg		if (!fbPictureInit(pScreen, NULL, 0))
905357bfbb2Smrg			xf86DrvMsg(pScrn->scrnIndex, X_WARNING,
906357bfbb2Smrg				   "RENDER extension initialisation failed.");
907357bfbb2Smrg	}
908357bfbb2Smrg	if (fPtr->shadowFB && !WsfbShadowInit(pScreen)) {
909357bfbb2Smrg		xf86DrvMsg(scrnIndex, X_ERROR,
910357bfbb2Smrg		    "shadow framebuffer initialization failed\n");
911357bfbb2Smrg		return FALSE;
912357bfbb2Smrg	}
913357bfbb2Smrg
914357bfbb2Smrg#ifdef XFreeXDGA
915357bfbb2Smrg	if (!fPtr->rotate)
916357bfbb2Smrg		WsfbDGAInit(pScrn, pScreen);
917357bfbb2Smrg	else
918357bfbb2Smrg		xf86DrvMsg(scrnIndex, X_INFO, "Rotated display, "
919357bfbb2Smrg		    "disabling DGA\n");
920357bfbb2Smrg#endif
921357bfbb2Smrg	if (fPtr->rotate) {
922357bfbb2Smrg		xf86DrvMsg(scrnIndex, X_INFO, "Enabling Driver Rotation, "
923357bfbb2Smrg		    "disabling RandR\n");
924357bfbb2Smrg		xf86DisableRandR();
925357bfbb2Smrg		if (pScrn->bitsPerPixel == 24)
926357bfbb2Smrg			xf86DrvMsg(scrnIndex, X_WARNING,
927357bfbb2Smrg			    "Rotation might be broken in 24 bpp\n");
928357bfbb2Smrg	}
929357bfbb2Smrg
930357bfbb2Smrg	xf86SetBlackWhitePixels(pScreen);
931357bfbb2Smrg	miInitializeBackingStore(pScreen);
932357bfbb2Smrg	xf86SetBackingStore(pScreen);
933357bfbb2Smrg
93464f08a18Smrg	/* Software cursor. */
935357bfbb2Smrg	miDCInitialize(pScreen, xf86GetPointerScreenFuncs());
936357bfbb2Smrg
9375d492fd2Smacallan	/* check for hardware cursor support */
9385d492fd2Smacallan	if (fPtr->HWCursor)
9395d492fd2Smacallan		WsfbSetupCursor(pScreen);
9405d492fd2Smacallan
94164f08a18Smrg	/*
94264f08a18Smrg	 * Colormap
94364f08a18Smrg	 *
94464f08a18Smrg	 * Note that, even on less than 8 bit depth frame buffers, we
94564f08a18Smrg	 * expect the colormap to be programmable with 8 bit values.
94664f08a18Smrg	 * As of now, this is indeed the case on all OpenBSD supported
94764f08a18Smrg	 * graphics hardware.
94864f08a18Smrg	 */
949357bfbb2Smrg	if (!miCreateDefColormap(pScreen))
950357bfbb2Smrg		return FALSE;
951357bfbb2Smrg	flags = CMAP_RELOAD_ON_MODE_SWITCH;
952357bfbb2Smrg	ncolors = fPtr->info.cmsize;
95364f08a18Smrg	/* On StaticGray visuals, fake a 256 entries colormap. */
954357bfbb2Smrg	if (ncolors == 0)
955357bfbb2Smrg		ncolors = 256;
956357bfbb2Smrg	if(!xf86HandleColormaps(pScreen, ncolors, 8, WsfbLoadPalette,
957357bfbb2Smrg				NULL, flags))
958357bfbb2Smrg		return FALSE;
959357bfbb2Smrg
960357bfbb2Smrg	pScreen->SaveScreen = WsfbSaveScreen;
961357bfbb2Smrg
962357bfbb2Smrg#ifdef XvExtension
963357bfbb2Smrg	{
964357bfbb2Smrg		XF86VideoAdaptorPtr *ptr;
965357bfbb2Smrg
966357bfbb2Smrg		int n = xf86XVListGenericAdaptors(pScrn,&ptr);
967357bfbb2Smrg		if (n) {
968357bfbb2Smrg			xf86XVScreenInit(pScreen,ptr,n);
969357bfbb2Smrg		}
970357bfbb2Smrg	}
971357bfbb2Smrg#endif
972357bfbb2Smrg
97364f08a18Smrg	/* Wrap the current CloseScreen function. */
974357bfbb2Smrg	fPtr->CloseScreen = pScreen->CloseScreen;
975357bfbb2Smrg	pScreen->CloseScreen = WsfbCloseScreen;
976357bfbb2Smrg
977357bfbb2Smrg	TRACE_EXIT("WsfbScreenInit");
978357bfbb2Smrg	return TRUE;
979357bfbb2Smrg}
980357bfbb2Smrg
981357bfbb2Smrgstatic Bool
982357bfbb2SmrgWsfbCloseScreen(int scrnIndex, ScreenPtr pScreen)
983357bfbb2Smrg{
984357bfbb2Smrg	ScrnInfoPtr pScrn = xf86Screens[scrnIndex];
98564f08a18Smrg	PixmapPtr pPixmap;
986357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
987357bfbb2Smrg
98864f08a18Smrg
989357bfbb2Smrg	TRACE_ENTER("WsfbCloseScreen");
990357bfbb2Smrg
99164f08a18Smrg	pPixmap = pScreen->GetScreenPixmap(pScreen);
99264f08a18Smrg	shadowRemove(pScreen, pPixmap);
99364f08a18Smrg
994357bfbb2Smrg	if (pScrn->vtSema) {
995357bfbb2Smrg		WsfbRestore(pScrn);
996357bfbb2Smrg		if (munmap(fPtr->fbmem, fPtr->fbmem_len) == -1) {
997357bfbb2Smrg			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
998357bfbb2Smrg				   "munmap: %s\n", strerror(errno));
999357bfbb2Smrg		}
1000357bfbb2Smrg
1001357bfbb2Smrg		fPtr->fbmem = NULL;
1002357bfbb2Smrg	}
1003357bfbb2Smrg#ifdef XFreeXDGA
1004357bfbb2Smrg	if (fPtr->pDGAMode) {
1005357bfbb2Smrg		xfree(fPtr->pDGAMode);
1006357bfbb2Smrg		fPtr->pDGAMode = NULL;
1007357bfbb2Smrg		fPtr->nDGAMode = 0;
1008357bfbb2Smrg	}
1009357bfbb2Smrg#endif
1010357bfbb2Smrg	pScrn->vtSema = FALSE;
1011357bfbb2Smrg
101264f08a18Smrg	/* Unwrap CloseScreen. */
1013357bfbb2Smrg	pScreen->CloseScreen = fPtr->CloseScreen;
101464f08a18Smrg	TRACE_EXIT("WsfbCloseScreen");
1015357bfbb2Smrg	return (*pScreen->CloseScreen)(scrnIndex, pScreen);
1016357bfbb2Smrg}
1017357bfbb2Smrg
1018357bfbb2Smrgstatic void *
1019357bfbb2SmrgWsfbWindowLinear(ScreenPtr pScreen, CARD32 row, CARD32 offset, int mode,
1020357bfbb2Smrg		CARD32 *size, void *closure)
1021357bfbb2Smrg{
1022357bfbb2Smrg	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
1023357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
1024357bfbb2Smrg
1025357bfbb2Smrg	if (fPtr->linebytes)
1026357bfbb2Smrg		*size = fPtr->linebytes;
1027357bfbb2Smrg	else {
1028357bfbb2Smrg		if (ioctl(fPtr->fd, WSDISPLAYIO_LINEBYTES, size) == -1)
1029357bfbb2Smrg			return NULL;
1030357bfbb2Smrg		fPtr->linebytes = *size;
1031357bfbb2Smrg	}
1032357bfbb2Smrg	return ((CARD8 *)fPtr->fbmem + row *fPtr->linebytes + offset);
1033357bfbb2Smrg}
1034357bfbb2Smrg
1035357bfbb2Smrgstatic void
1036357bfbb2SmrgWsfbPointerMoved(int index, int x, int y)
1037357bfbb2Smrg{
1038357bfbb2Smrg    ScrnInfoPtr pScrn = xf86Screens[index];
1039357bfbb2Smrg    WsfbPtr fPtr = WSFBPTR(pScrn);
1040357bfbb2Smrg    int newX, newY;
1041357bfbb2Smrg
1042357bfbb2Smrg    switch (fPtr->rotate)
1043357bfbb2Smrg    {
1044357bfbb2Smrg    case WSFB_ROTATE_CW:
1045357bfbb2Smrg	/* 90 degrees CW rotation. */
1046357bfbb2Smrg	newX = pScrn->pScreen->height - y - 1;
1047357bfbb2Smrg	newY = x;
1048357bfbb2Smrg	break;
1049357bfbb2Smrg
1050357bfbb2Smrg    case WSFB_ROTATE_CCW:
1051357bfbb2Smrg	/* 90 degrees CCW rotation. */
1052357bfbb2Smrg	newX = y;
1053357bfbb2Smrg	newY = pScrn->pScreen->width - x - 1;
1054357bfbb2Smrg	break;
1055357bfbb2Smrg
1056357bfbb2Smrg    case WSFB_ROTATE_UD:
1057357bfbb2Smrg	/* 180 degrees UD rotation. */
1058357bfbb2Smrg	newX = pScrn->pScreen->width - x - 1;
1059357bfbb2Smrg	newY = pScrn->pScreen->height - y - 1;
1060357bfbb2Smrg	break;
1061357bfbb2Smrg
1062357bfbb2Smrg    default:
1063357bfbb2Smrg	/* No rotation. */
1064357bfbb2Smrg	newX = x;
1065357bfbb2Smrg	newY = y;
1066357bfbb2Smrg	break;
1067357bfbb2Smrg    }
1068357bfbb2Smrg
1069357bfbb2Smrg    /* Pass adjusted pointer coordinates to wrapped PointerMoved function. */
1070357bfbb2Smrg    (*fPtr->PointerMoved)(index, newX, newY);
1071357bfbb2Smrg}
1072357bfbb2Smrg
1073357bfbb2Smrgstatic Bool
1074357bfbb2SmrgWsfbEnterVT(int scrnIndex, int flags)
1075357bfbb2Smrg{
1076357bfbb2Smrg	ScrnInfoPtr pScrn = xf86Screens[scrnIndex];
1077357bfbb2Smrg
1078357bfbb2Smrg	TRACE_ENTER("EnterVT");
1079357bfbb2Smrg	pScrn->vtSema = TRUE;
108064f08a18Smrg	TRACE_EXIT("EnterVT");
1081357bfbb2Smrg	return TRUE;
1082357bfbb2Smrg}
1083357bfbb2Smrg
1084357bfbb2Smrgstatic void
1085357bfbb2SmrgWsfbLeaveVT(int scrnIndex, int flags)
1086357bfbb2Smrg{
1087357bfbb2Smrg#if DEBUG
1088357bfbb2Smrg	ScrnInfoPtr pScrn = xf86Screens[scrnIndex];
1089357bfbb2Smrg#endif
1090357bfbb2Smrg
1091357bfbb2Smrg	TRACE_ENTER("LeaveVT");
1092357bfbb2Smrg}
1093357bfbb2Smrg
1094357bfbb2Smrgstatic Bool
1095357bfbb2SmrgWsfbSwitchMode(int scrnIndex, DisplayModePtr mode, int flags)
1096357bfbb2Smrg{
1097357bfbb2Smrg#if DEBUG
1098357bfbb2Smrg	ScrnInfoPtr pScrn = xf86Screens[scrnIndex];
1099357bfbb2Smrg#endif
1100357bfbb2Smrg
1101357bfbb2Smrg	TRACE_ENTER("SwitchMode");
110264f08a18Smrg	/* Nothing else to do. */
1103357bfbb2Smrg	return TRUE;
1104357bfbb2Smrg}
1105357bfbb2Smrg
1106357bfbb2Smrgstatic int
1107357bfbb2SmrgWsfbValidMode(int scrnIndex, DisplayModePtr mode, Bool verbose, int flags)
1108357bfbb2Smrg{
1109357bfbb2Smrg#if DEBUG
1110357bfbb2Smrg	ScrnInfoPtr pScrn = xf86Screens[scrnIndex];
1111357bfbb2Smrg#endif
1112357bfbb2Smrg
1113357bfbb2Smrg	TRACE_ENTER("ValidMode");
1114357bfbb2Smrg	return MODE_OK;
1115357bfbb2Smrg}
1116357bfbb2Smrg
1117357bfbb2Smrgstatic void
1118357bfbb2SmrgWsfbLoadPalette(ScrnInfoPtr pScrn, int numColors, int *indices,
1119357bfbb2Smrg	       LOCO *colors, VisualPtr pVisual)
1120357bfbb2Smrg{
1121357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
1122357bfbb2Smrg	struct wsdisplay_cmap cmap;
1123357bfbb2Smrg	unsigned char red[256],green[256],blue[256];
1124357bfbb2Smrg	int i, indexMin=256, indexMax=0;
1125357bfbb2Smrg
1126357bfbb2Smrg	TRACE_ENTER("LoadPalette");
1127357bfbb2Smrg
1128357bfbb2Smrg	cmap.count   = 1;
1129357bfbb2Smrg	cmap.red   = red;
1130357bfbb2Smrg	cmap.green = green;
1131357bfbb2Smrg	cmap.blue  = blue;
1132357bfbb2Smrg
1133357bfbb2Smrg	if (numColors == 1) {
1134357bfbb2Smrg		/* Optimisation */
1135357bfbb2Smrg		cmap.index = indices[0];
1136357bfbb2Smrg		red[0]   = colors[indices[0]].red;
1137357bfbb2Smrg		green[0] = colors[indices[0]].green;
1138357bfbb2Smrg		blue[0]  = colors[indices[0]].blue;
1139357bfbb2Smrg		if (ioctl(fPtr->fd,WSDISPLAYIO_PUTCMAP, &cmap) == -1)
1140357bfbb2Smrg			ErrorF("ioctl FBIOPUTCMAP: %s\n", strerror(errno));
1141357bfbb2Smrg	} else {
114264f08a18Smrg		/*
114364f08a18Smrg		 * Change all colors in 2 ioctls
114464f08a18Smrg		 * and limit the data to be transfered.
114564f08a18Smrg		 */
1146357bfbb2Smrg		for (i = 0; i < numColors; i++) {
1147357bfbb2Smrg			if (indices[i] < indexMin)
1148357bfbb2Smrg				indexMin = indices[i];
1149357bfbb2Smrg			if (indices[i] > indexMax)
1150357bfbb2Smrg				indexMax = indices[i];
1151357bfbb2Smrg		}
1152357bfbb2Smrg		cmap.index = indexMin;
1153357bfbb2Smrg		cmap.count = indexMax - indexMin + 1;
1154357bfbb2Smrg		cmap.red = &red[indexMin];
1155357bfbb2Smrg		cmap.green = &green[indexMin];
1156357bfbb2Smrg		cmap.blue = &blue[indexMin];
115764f08a18Smrg		/* Get current map. */
1158357bfbb2Smrg		if (ioctl(fPtr->fd, WSDISPLAYIO_GETCMAP, &cmap) == -1)
1159357bfbb2Smrg			ErrorF("ioctl FBIOGETCMAP: %s\n", strerror(errno));
116064f08a18Smrg		/* Change the colors that require updating. */
1161357bfbb2Smrg		for (i = 0; i < numColors; i++) {
1162357bfbb2Smrg			red[indices[i]]   = colors[indices[i]].red;
1163357bfbb2Smrg			green[indices[i]] = colors[indices[i]].green;
1164357bfbb2Smrg			blue[indices[i]]  = colors[indices[i]].blue;
1165357bfbb2Smrg		}
116664f08a18Smrg		/* Write the colormap back. */
1167357bfbb2Smrg		if (ioctl(fPtr->fd,WSDISPLAYIO_PUTCMAP, &cmap) == -1)
1168357bfbb2Smrg			ErrorF("ioctl FBIOPUTCMAP: %s\n", strerror(errno));
1169357bfbb2Smrg	}
1170357bfbb2Smrg	TRACE_EXIT("LoadPalette");
1171357bfbb2Smrg}
1172357bfbb2Smrg
1173357bfbb2Smrgstatic Bool
1174357bfbb2SmrgWsfbSaveScreen(ScreenPtr pScreen, int mode)
1175357bfbb2Smrg{
1176357bfbb2Smrg	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
1177357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
1178357bfbb2Smrg	int state;
1179357bfbb2Smrg
1180357bfbb2Smrg	TRACE_ENTER("SaveScreen");
1181357bfbb2Smrg
1182357bfbb2Smrg	if (!pScrn->vtSema)
1183357bfbb2Smrg		return TRUE;
1184357bfbb2Smrg
1185357bfbb2Smrg	if (mode != SCREEN_SAVER_FORCER) {
1186357bfbb2Smrg		state = xf86IsUnblank(mode)?WSDISPLAYIO_VIDEO_ON:
1187357bfbb2Smrg		                            WSDISPLAYIO_VIDEO_OFF;
1188357bfbb2Smrg		ioctl(fPtr->fd,
1189357bfbb2Smrg		      WSDISPLAYIO_SVIDEO, &state);
1190357bfbb2Smrg	}
119164f08a18Smrg	TRACE_EXIT("SaveScreen");
1192357bfbb2Smrg	return TRUE;
1193357bfbb2Smrg}
1194357bfbb2Smrg
1195357bfbb2Smrg
1196357bfbb2Smrgstatic void
1197357bfbb2SmrgWsfbSave(ScrnInfoPtr pScrn)
1198357bfbb2Smrg{
1199357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
1200357bfbb2Smrg
1201357bfbb2Smrg	TRACE_ENTER("WsfbSave");
1202357bfbb2Smrg
1203357bfbb2Smrg	if (fPtr->info.cmsize == 0)
1204357bfbb2Smrg		return;
1205357bfbb2Smrg
1206357bfbb2Smrg	fPtr->saved_cmap.index = 0;
1207357bfbb2Smrg	fPtr->saved_cmap.count = fPtr->info.cmsize;
1208357bfbb2Smrg	if (ioctl(fPtr->fd, WSDISPLAYIO_GETCMAP,
1209357bfbb2Smrg		  &(fPtr->saved_cmap)) == -1) {
1210357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
1211357bfbb2Smrg			   "error saving colormap %s\n", strerror(errno));
1212357bfbb2Smrg	}
121364f08a18Smrg	TRACE_EXIT("WsfbSave");
1214357bfbb2Smrg
1215357bfbb2Smrg}
1216357bfbb2Smrg
1217357bfbb2Smrgstatic void
1218357bfbb2SmrgWsfbRestore(ScrnInfoPtr pScrn)
1219357bfbb2Smrg{
1220357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
1221357bfbb2Smrg	int mode;
1222357bfbb2Smrg
1223357bfbb2Smrg	TRACE_ENTER("WsfbRestore");
1224357bfbb2Smrg
1225357bfbb2Smrg	if (fPtr->info.cmsize != 0) {
1226357bfbb2Smrg		/* reset colormap for text mode */
1227357bfbb2Smrg		if (ioctl(fPtr->fd, WSDISPLAYIO_PUTCMAP,
1228357bfbb2Smrg			  &(fPtr->saved_cmap)) == -1) {
1229357bfbb2Smrg			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
1230357bfbb2Smrg				   "error restoring colormap %s\n",
1231357bfbb2Smrg				   strerror(errno));
1232357bfbb2Smrg		}
1233357bfbb2Smrg	}
1234357bfbb2Smrg
123564f08a18Smrg	/* Clear the screen. */
1236357bfbb2Smrg	memset(fPtr->fbmem, 0, fPtr->fbmem_len);
1237357bfbb2Smrg
123864f08a18Smrg	/* Restore the text mode. */
1239357bfbb2Smrg	mode = WSDISPLAYIO_MODE_EMUL;
1240357bfbb2Smrg	if (ioctl(fPtr->fd, WSDISPLAYIO_SMODE, &mode) == -1) {
1241357bfbb2Smrg		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
1242357bfbb2Smrg			   "error setting text mode %s\n", strerror(errno));
1243357bfbb2Smrg	}
1244357bfbb2Smrg	TRACE_EXIT("WsfbRestore");
1245357bfbb2Smrg}
1246357bfbb2Smrg
1247357bfbb2Smrg#ifdef XFreeXDGA
1248357bfbb2Smrg/***********************************************************************
1249357bfbb2Smrg * DGA stuff
1250357bfbb2Smrg ***********************************************************************/
1251357bfbb2Smrg
1252357bfbb2Smrgstatic Bool
1253357bfbb2SmrgWsfbDGAOpenFramebuffer(ScrnInfoPtr pScrn, char **DeviceName,
1254357bfbb2Smrg		       unsigned char **ApertureBase, int *ApertureSize,
1255357bfbb2Smrg		       int *ApertureOffset, int *flags)
1256357bfbb2Smrg{
1257357bfbb2Smrg	*DeviceName = NULL;		/* No special device */
1258357bfbb2Smrg	*ApertureBase = (unsigned char *)(pScrn->memPhysBase);
1259357bfbb2Smrg	*ApertureSize = pScrn->videoRam;
1260357bfbb2Smrg	*ApertureOffset = pScrn->fbOffset;
1261357bfbb2Smrg	*flags = 0;
1262357bfbb2Smrg
1263357bfbb2Smrg	return TRUE;
1264357bfbb2Smrg}
1265357bfbb2Smrg
1266357bfbb2Smrgstatic Bool
1267357bfbb2SmrgWsfbDGASetMode(ScrnInfoPtr pScrn, DGAModePtr pDGAMode)
1268357bfbb2Smrg{
1269357bfbb2Smrg	DisplayModePtr pMode;
1270357bfbb2Smrg	int scrnIdx = pScrn->pScreen->myNum;
1271357bfbb2Smrg	int frameX0, frameY0;
1272357bfbb2Smrg
1273357bfbb2Smrg	if (pDGAMode) {
1274357bfbb2Smrg		pMode = pDGAMode->mode;
1275357bfbb2Smrg		frameX0 = frameY0 = 0;
1276357bfbb2Smrg	} else {
1277357bfbb2Smrg		if (!(pMode = pScrn->currentMode))
1278357bfbb2Smrg			return TRUE;
1279357bfbb2Smrg
1280357bfbb2Smrg		frameX0 = pScrn->frameX0;
1281357bfbb2Smrg		frameY0 = pScrn->frameY0;
1282357bfbb2Smrg	}
1283357bfbb2Smrg
1284357bfbb2Smrg	if (!(*pScrn->SwitchMode)(scrnIdx, pMode, 0))
1285357bfbb2Smrg		return FALSE;
1286357bfbb2Smrg	(*pScrn->AdjustFrame)(scrnIdx, frameX0, frameY0, 0);
1287357bfbb2Smrg
1288357bfbb2Smrg	return TRUE;
1289357bfbb2Smrg}
1290357bfbb2Smrg
1291357bfbb2Smrgstatic void
1292357bfbb2SmrgWsfbDGASetViewport(ScrnInfoPtr pScrn, int x, int y, int flags)
1293357bfbb2Smrg{
1294357bfbb2Smrg	(*pScrn->AdjustFrame)(pScrn->pScreen->myNum, x, y, flags);
1295357bfbb2Smrg}
1296357bfbb2Smrg
1297357bfbb2Smrgstatic int
1298357bfbb2SmrgWsfbDGAGetViewport(ScrnInfoPtr pScrn)
1299357bfbb2Smrg{
1300357bfbb2Smrg	return (0);
1301357bfbb2Smrg}
1302357bfbb2Smrg
1303357bfbb2Smrgstatic DGAFunctionRec WsfbDGAFunctions =
1304357bfbb2Smrg{
1305357bfbb2Smrg	WsfbDGAOpenFramebuffer,
1306357bfbb2Smrg	NULL,       /* CloseFramebuffer */
1307357bfbb2Smrg	WsfbDGASetMode,
1308357bfbb2Smrg	WsfbDGASetViewport,
1309357bfbb2Smrg	WsfbDGAGetViewport,
1310357bfbb2Smrg	NULL,       /* Sync */
1311357bfbb2Smrg	NULL,       /* FillRect */
1312357bfbb2Smrg	NULL,       /* BlitRect */
1313357bfbb2Smrg	NULL,       /* BlitTransRect */
1314357bfbb2Smrg};
1315357bfbb2Smrg
1316357bfbb2Smrgstatic void
1317357bfbb2SmrgWsfbDGAAddModes(ScrnInfoPtr pScrn)
1318357bfbb2Smrg{
1319357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
1320357bfbb2Smrg	DisplayModePtr pMode = pScrn->modes;
1321357bfbb2Smrg	DGAModePtr pDGAMode;
1322357bfbb2Smrg
1323357bfbb2Smrg	do {
1324357bfbb2Smrg		pDGAMode = xrealloc(fPtr->pDGAMode,
1325357bfbb2Smrg				    (fPtr->nDGAMode + 1) * sizeof(DGAModeRec));
1326357bfbb2Smrg		if (!pDGAMode)
1327357bfbb2Smrg			break;
1328357bfbb2Smrg
1329357bfbb2Smrg		fPtr->pDGAMode = pDGAMode;
1330357bfbb2Smrg		pDGAMode += fPtr->nDGAMode;
1331357bfbb2Smrg		(void)memset(pDGAMode, 0, sizeof(DGAModeRec));
1332357bfbb2Smrg
1333357bfbb2Smrg		++fPtr->nDGAMode;
1334357bfbb2Smrg		pDGAMode->mode = pMode;
1335357bfbb2Smrg		pDGAMode->flags = DGA_CONCURRENT_ACCESS | DGA_PIXMAP_AVAILABLE;
1336357bfbb2Smrg		pDGAMode->byteOrder = pScrn->imageByteOrder;
1337357bfbb2Smrg		pDGAMode->depth = pScrn->depth;
1338357bfbb2Smrg		pDGAMode->bitsPerPixel = pScrn->bitsPerPixel;
1339357bfbb2Smrg		pDGAMode->red_mask = pScrn->mask.red;
1340357bfbb2Smrg		pDGAMode->green_mask = pScrn->mask.green;
1341357bfbb2Smrg		pDGAMode->blue_mask = pScrn->mask.blue;
1342357bfbb2Smrg		pDGAMode->visualClass = pScrn->bitsPerPixel > 8 ?
1343357bfbb2Smrg			TrueColor : PseudoColor;
1344357bfbb2Smrg		pDGAMode->xViewportStep = 1;
1345357bfbb2Smrg		pDGAMode->yViewportStep = 1;
1346357bfbb2Smrg		pDGAMode->viewportWidth = pMode->HDisplay;
1347357bfbb2Smrg		pDGAMode->viewportHeight = pMode->VDisplay;
1348357bfbb2Smrg
1349357bfbb2Smrg		if (fPtr->linebytes)
1350357bfbb2Smrg			pDGAMode->bytesPerScanline = fPtr->linebytes;
1351357bfbb2Smrg		else {
1352357bfbb2Smrg			ioctl(fPtr->fd, WSDISPLAYIO_LINEBYTES,
1353357bfbb2Smrg			      &fPtr->linebytes);
1354357bfbb2Smrg			pDGAMode->bytesPerScanline = fPtr->linebytes;
1355357bfbb2Smrg		}
1356357bfbb2Smrg
1357357bfbb2Smrg		pDGAMode->imageWidth = pMode->HDisplay;
1358357bfbb2Smrg		pDGAMode->imageHeight =  pMode->VDisplay;
1359357bfbb2Smrg		pDGAMode->pixmapWidth = pDGAMode->imageWidth;
1360357bfbb2Smrg		pDGAMode->pixmapHeight = pDGAMode->imageHeight;
1361357bfbb2Smrg		pDGAMode->maxViewportX = pScrn->virtualX -
1362357bfbb2Smrg			pDGAMode->viewportWidth;
1363357bfbb2Smrg		pDGAMode->maxViewportY = pScrn->virtualY -
1364357bfbb2Smrg			pDGAMode->viewportHeight;
1365357bfbb2Smrg
1366357bfbb2Smrg		pDGAMode->address = fPtr->fbstart;
1367357bfbb2Smrg
1368357bfbb2Smrg		pMode = pMode->next;
1369357bfbb2Smrg	} while (pMode != pScrn->modes);
1370357bfbb2Smrg}
1371357bfbb2Smrg
1372357bfbb2Smrgstatic Bool
1373357bfbb2SmrgWsfbDGAInit(ScrnInfoPtr pScrn, ScreenPtr pScreen)
1374357bfbb2Smrg{
1375357bfbb2Smrg	WsfbPtr fPtr = WSFBPTR(pScrn);
1376357bfbb2Smrg
1377357bfbb2Smrg	if (pScrn->depth < 8)
1378357bfbb2Smrg		return FALSE;
1379357bfbb2Smrg
1380357bfbb2Smrg	if (!fPtr->nDGAMode)
1381357bfbb2Smrg		WsfbDGAAddModes(pScrn);
1382357bfbb2Smrg
1383357bfbb2Smrg	return (DGAInit(pScreen, &WsfbDGAFunctions,
1384357bfbb2Smrg			fPtr->pDGAMode, fPtr->nDGAMode));
1385357bfbb2Smrg}
1386357bfbb2Smrg#endif
1387357bfbb2Smrg
1388357bfbb2Smrgstatic Bool
1389357bfbb2SmrgWsfbDriverFunc(ScrnInfoPtr pScrn, xorgDriverFuncOp op,
1390357bfbb2Smrg    pointer ptr)
1391357bfbb2Smrg{
1392357bfbb2Smrg	xorgHWFlags *flag;
1393357bfbb2Smrg
1394357bfbb2Smrg	switch (op) {
1395357bfbb2Smrg	case GET_REQUIRED_HW_INTERFACES:
1396357bfbb2Smrg		flag = (CARD32*)ptr;
1397357bfbb2Smrg		(*flag) = 0;
1398357bfbb2Smrg		return TRUE;
1399357bfbb2Smrg	default:
1400357bfbb2Smrg		return FALSE;
1401357bfbb2Smrg	}
1402357bfbb2Smrg}
1403357bfbb2Smrg
1404