wsfb_driver.c revision ce8ce673
1/* $OpenBSD: wsfb_driver.c,v 1.16 2009/09/13 19:33:49 matthieu Exp $ */
2/*
3 * Copyright (c) 2001 Matthieu Herrb
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 *    - Redistributions of source code must retain the above copyright
11 *      notice, this list of conditions and the following disclaimer.
12 *    - Redistributions in binary form must reproduce the above
13 *      copyright notice, this list of conditions and the following
14 *      disclaimer in the documentation and/or other materials provided
15 *      with the distribution.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
18 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
19 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
20 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
21 * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
23 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
24 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
25 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
27 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 * POSSIBILITY OF SUCH DAMAGE.
29 *
30 */
31
32/*
33 * Based on fbdev.c written by:
34 *
35 * Authors:  Alan Hourihane, <alanh@fairlite.demon.co.uk>
36 *	     Michel Dänzer, <michdaen@iiic.ethz.ch>
37 */
38
39#ifdef HAVE_CONFIG_H
40#include "config.h"
41#endif
42
43#include <errno.h>
44#include <fcntl.h>
45#include <sys/types.h>
46#include <sys/mman.h>
47#include <sys/time.h>
48#include <errno.h>
49#include <dev/wscons/wsconsio.h>
50
51/* All drivers need this. */
52#include "xf86.h"
53#include "xf86_OSproc.h"
54#include "xf86_OSlib.h"
55
56#include "mipointer.h"
57#include "mibstore.h"
58#include "micmap.h"
59#include "colormapst.h"
60#include "xf86cmap.h"
61#include "shadow.h"
62#include "dgaproc.h"
63
64/* For visuals */
65#include "fb.h"
66
67#if GET_ABI_MAJOR(ABI_VIDEODRV_VERSION) < 6
68#include "xf86Resources.h"
69#include "xf86RAC.h"
70#endif
71
72#ifdef XvExtension
73#include "xf86xv.h"
74#endif
75
76#include "wsfb.h"
77
78/* #include "wsconsio.h" */
79
80#include <sys/mman.h>
81
82#ifdef X_PRIVSEP
83extern int priv_open_device(const char *);
84#else
85#define priv_open_device(n)    open(n,O_RDWR|O_NONBLOCK|O_EXCL)
86#endif
87
88#if defined(__NetBSD__)
89#define WSFB_DEFAULT_DEV "/dev/ttyE0"
90#else
91#define WSFB_DEFAULT_DEV "/dev/ttyC0"
92#endif
93
94#if GET_ABI_MAJOR(ABI_VIDEODRV_VERSION) > 6
95#define xf86LoaderReqSymLists(...) do {} while (0)
96#define LoaderRefSymLists(...) do {} while (0)
97#define xf86LoaderReqSymbols(...) do {} while (0)
98#endif
99
100#define DEBUG 0
101
102#if DEBUG
103# define TRACE_ENTER(str)       ErrorF("wsfb: " str " %d\n",pScrn->scrnIndex)
104# define TRACE_EXIT(str)        ErrorF("wsfb: " str " done\n")
105# define TRACE(str)             ErrorF("wsfb trace: " str "\n")
106#else
107# define TRACE_ENTER(str)
108# define TRACE_EXIT(str)
109# define TRACE(str)
110#endif
111
112/* Prototypes */
113#ifdef XFree86LOADER
114static pointer WsfbSetup(pointer, pointer, int *, int *);
115#endif
116static Bool WsfbGetRec(ScrnInfoPtr);
117static void WsfbFreeRec(ScrnInfoPtr);
118static const OptionInfoRec * WsfbAvailableOptions(int, int);
119static void WsfbIdentify(int);
120static Bool WsfbProbe(DriverPtr, int);
121static Bool WsfbPreInit(ScrnInfoPtr, int);
122static Bool WsfbScreenInit(int, ScreenPtr, int, char **);
123static Bool WsfbCloseScreen(int, ScreenPtr);
124static void *WsfbWindowLinear(ScreenPtr, CARD32, CARD32, int, CARD32 *,
125			      void *);
126static void WsfbPointerMoved(int, int, int);
127static Bool WsfbEnterVT(int, int);
128static void WsfbLeaveVT(int, int);
129static Bool WsfbSwitchMode(int, DisplayModePtr, int);
130static int WsfbValidMode(int, DisplayModePtr, Bool, int);
131static void WsfbLoadPalette(ScrnInfoPtr, int, int *, LOCO *, VisualPtr);
132static Bool WsfbSaveScreen(ScreenPtr, int);
133static void WsfbSave(ScrnInfoPtr);
134static void WsfbRestore(ScrnInfoPtr);
135
136/* DGA stuff */
137#ifdef XFreeXDGA
138static Bool WsfbDGAOpenFramebuffer(ScrnInfoPtr, char **, unsigned char **,
139				   int *, int *, int *);
140static Bool WsfbDGASetMode(ScrnInfoPtr, DGAModePtr);
141static void WsfbDGASetViewport(ScrnInfoPtr, int, int, int);
142static Bool WsfbDGAInit(ScrnInfoPtr, ScreenPtr);
143#endif
144static Bool WsfbDriverFunc(ScrnInfoPtr pScrn, xorgDriverFuncOp op,
145				pointer ptr);
146
147/* Helper functions */
148static int wsfb_open(char *);
149static pointer wsfb_mmap(size_t, off_t, int);
150
151enum { WSFB_ROTATE_NONE = 0,
152       WSFB_ROTATE_CCW = 90,
153       WSFB_ROTATE_UD = 180,
154       WSFB_ROTATE_CW = 270
155};
156
157/*
158 * This is intentionally screen-independent.
159 * It indicates the binding choice made in the first PreInit.
160 */
161static int pix24bpp = 0;
162
163#define WSFB_VERSION 		4000
164#define WSFB_NAME		"wsfb"
165#define WSFB_DRIVER_NAME	"wsfb"
166
167_X_EXPORT DriverRec WSFB = {
168	WSFB_VERSION,
169	WSFB_DRIVER_NAME,
170	WsfbIdentify,
171	WsfbProbe,
172	WsfbAvailableOptions,
173	NULL,
174	0,
175	WsfbDriverFunc
176};
177
178/* Supported "chipsets" */
179static SymTabRec WsfbChipsets[] = {
180	{ 0, "wsfb" },
181	{ -1, NULL }
182};
183
184/* Supported options */
185typedef enum {
186	OPTION_SHADOW_FB,
187	OPTION_ROTATE,
188	OPTION_HW_CURSOR,
189	OPTION_SW_CURSOR
190} WsfbOpts;
191
192static const OptionInfoRec WsfbOptions[] = {
193	{ OPTION_SHADOW_FB, "ShadowFB", OPTV_BOOLEAN, {0}, FALSE},
194	{ OPTION_ROTATE, "Rotate", OPTV_STRING, {0}, FALSE},
195	{ -1, NULL, OPTV_NONE, {0}, FALSE}
196};
197
198/* Symbols needed from other modules */
199static const char *fbSymbols[] = {
200	"fbPictureInit",
201	"fbScreenInit",
202	NULL
203};
204static const char *shadowSymbols[] = {
205	"shadowAdd",
206	"shadowSetup",
207	"shadowUpdatePacked",
208	"shadowUpdatePackedWeak",
209	"shadowUpdateRotatePacked",
210	"shadowUpdateRotatePackedWeak",
211	NULL
212};
213
214static const char *ramdacSymbols[] = {
215	"xf86CreateCursorInfoRec",
216	"xf86DestroyCursorInfoRec",
217	"xf86InitCursor",
218	NULL
219};
220
221#ifdef XFree86LOADER
222static XF86ModuleVersionInfo WsfbVersRec = {
223	"wsfb",
224	MODULEVENDORSTRING,
225	MODINFOSTRING1,
226	MODINFOSTRING2,
227	XORG_VERSION_CURRENT,
228	PACKAGE_VERSION_MAJOR,
229	PACKAGE_VERSION_MINOR,
230	PACKAGE_VERSION_PATCHLEVEL,
231	ABI_CLASS_VIDEODRV,
232	ABI_VIDEODRV_VERSION,
233	NULL,
234	{0, 0, 0, 0}
235};
236
237_X_EXPORT XF86ModuleData wsfbModuleData = { &WsfbVersRec, WsfbSetup, NULL };
238
239static pointer
240WsfbSetup(pointer module, pointer opts, int *errmaj, int *errmin)
241{
242	static Bool setupDone = FALSE;
243	const char *osname;
244
245	/* Check that we're being loaded on a OpenBSD or NetBSD system. */
246	LoaderGetOS(&osname, NULL, NULL, NULL);
247	if (!osname || (strcmp(osname, "openbsd") != 0 &&
248	                strcmp(osname, "netbsd") != 0)) {
249		if (errmaj)
250			*errmaj = LDR_BADOS;
251		if (errmin)
252			*errmin = 0;
253		return NULL;
254	}
255	if (!setupDone) {
256		setupDone = TRUE;
257		xf86AddDriver(&WSFB, module, HaveDriverFuncs);
258		LoaderRefSymLists(fbSymbols, shadowSymbols, ramdacSymbols,
259		    NULL);
260		return (pointer)1;
261	} else {
262		if (errmaj != NULL)
263			*errmaj = LDR_ONCEONLY;
264		return NULL;
265	}
266}
267#endif /* XFree86LOADER */
268
269static Bool
270WsfbGetRec(ScrnInfoPtr pScrn)
271{
272
273	if (pScrn->driverPrivate != NULL)
274		return TRUE;
275
276	pScrn->driverPrivate = xnfcalloc(sizeof(WsfbRec), 1);
277	return TRUE;
278}
279
280static void
281WsfbFreeRec(ScrnInfoPtr pScrn)
282{
283
284	if (pScrn->driverPrivate == NULL)
285		return;
286	xfree(pScrn->driverPrivate);
287	pScrn->driverPrivate = NULL;
288}
289
290static const OptionInfoRec *
291WsfbAvailableOptions(int chipid, int busid)
292{
293	return WsfbOptions;
294}
295
296static void
297WsfbIdentify(int flags)
298{
299	xf86PrintChipsets(WSFB_NAME, "driver for wsdisplay framebuffer",
300			  WsfbChipsets);
301}
302
303/* Open the framebuffer device. */
304static int
305wsfb_open(char *dev)
306{
307	int fd = -1;
308
309	/* Try argument from XF86Config first. */
310	if (dev == NULL || ((fd = priv_open_device(dev)) == -1)) {
311		/* Second: environment variable. */
312		dev = getenv("XDEVICE");
313		if (dev == NULL || ((fd = priv_open_device(dev)) == -1)) {
314			/* Last try: default device. */
315			dev = WSFB_DEFAULT_DEV;
316			if ((fd = priv_open_device(dev)) == -1) {
317				return -1;
318			}
319		}
320	}
321	return fd;
322}
323
324/* Map the framebuffer's memory. */
325static pointer
326wsfb_mmap(size_t len, off_t off, int fd)
327{
328	int pagemask, mapsize;
329	caddr_t addr;
330	pointer mapaddr;
331
332	pagemask = getpagesize() - 1;
333	mapsize = ((int) len + pagemask) & ~pagemask;
334	addr = 0;
335
336	/*
337	 * Try and make it private first, that way once we get it, an
338	 * interloper, e.g. another server, can't get this frame buffer,
339	 * and if another server already has it, this one won't.
340	 */
341	mapaddr = (pointer) mmap(addr, mapsize,
342				 PROT_READ | PROT_WRITE, MAP_SHARED,
343				 fd, off);
344	if (mapaddr == MAP_FAILED) {
345		mapaddr = NULL;
346	}
347#if DEBUG
348	ErrorF("mmap returns: addr %p len 0x%x\n", mapaddr, mapsize);
349#endif
350	return mapaddr;
351}
352
353static Bool
354WsfbProbe(DriverPtr drv, int flags)
355{
356	int i, fd, entity;
357       	GDevPtr *devSections;
358	int numDevSections;
359	char *dev;
360	Bool foundScreen = FALSE;
361
362	TRACE("probe start");
363
364	/* For now, just bail out for PROBE_DETECT. */
365	if (flags & PROBE_DETECT)
366		return FALSE;
367
368	if ((numDevSections = xf86MatchDevice(WSFB_DRIVER_NAME,
369					      &devSections)) <= 0)
370		return FALSE;
371
372	for (i = 0; i < numDevSections; i++) {
373		ScrnInfoPtr pScrn = NULL;
374
375		dev = xf86FindOptionValue(devSections[i]->options, "device");
376		if ((fd = wsfb_open(dev)) >= 0) {
377			entity = xf86ClaimFbSlot(drv, 0, devSections[i], TRUE);
378			pScrn = xf86ConfigFbEntity(NULL,0,entity,
379						   NULL,NULL,NULL,NULL);
380			if (pScrn != NULL) {
381				foundScreen = TRUE;
382				pScrn->driverVersion = WSFB_VERSION;
383				pScrn->driverName = WSFB_DRIVER_NAME;
384				pScrn->name = WSFB_NAME;
385				pScrn->Probe = WsfbProbe;
386				pScrn->PreInit = WsfbPreInit;
387				pScrn->ScreenInit = WsfbScreenInit;
388				pScrn->SwitchMode = WsfbSwitchMode;
389				pScrn->AdjustFrame = NULL;
390				pScrn->EnterVT = WsfbEnterVT;
391				pScrn->LeaveVT = WsfbLeaveVT;
392				pScrn->ValidMode = WsfbValidMode;
393
394				xf86DrvMsg(pScrn->scrnIndex, X_INFO,
395				    "using %s\n", dev != NULL ? dev :
396				    "default device");
397			}
398		}
399	}
400	xfree(devSections);
401	TRACE("probe done");
402	return foundScreen;
403}
404
405static Bool
406WsfbPreInit(ScrnInfoPtr pScrn, int flags)
407{
408	WsfbPtr fPtr;
409	int default_depth, wstype;
410	char *dev, *s;
411	char *mod = NULL;
412	const char *reqSym = NULL;
413	Gamma zeros = {0.0, 0.0, 0.0};
414	DisplayModePtr mode;
415	MessageType from;
416
417	if (flags & PROBE_DETECT) return FALSE;
418
419	TRACE_ENTER("PreInit");
420
421	if (pScrn->numEntities != 1) return FALSE;
422
423	pScrn->monitor = pScrn->confScreen->monitor;
424
425	WsfbGetRec(pScrn);
426	fPtr = WSFBPTR(pScrn);
427
428	fPtr->pEnt = xf86GetEntityInfo(pScrn->entityList[0]);
429
430#if GET_ABI_MAJOR(ABI_VIDEODRV_VERSION) < 6
431	pScrn->racMemFlags = RAC_FB | RAC_COLORMAP | RAC_CURSOR | RAC_VIEWPORT;
432	pScrn->racIoFlags = pScrn->racMemFlags;
433#endif
434
435	dev = xf86FindOptionValue(fPtr->pEnt->device->options, "device");
436	fPtr->fd = wsfb_open(dev);
437	if (fPtr->fd == -1) {
438		return FALSE;
439	}
440
441	if (ioctl(fPtr->fd, WSDISPLAYIO_GINFO, &fPtr->info) == -1) {
442		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
443			   "ioctl WSDISPLAY_GINFO: %s\n",
444			   strerror(errno));
445		return FALSE;
446	}
447	if (ioctl(fPtr->fd, WSDISPLAYIO_GTYPE, &wstype) == -1) {
448		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
449			   "ioctl WSDISPLAY_GTYPE: %s\n",
450			   strerror(errno));
451		return FALSE;
452	}
453	if (ioctl(fPtr->fd, WSDISPLAYIO_LINEBYTES, &fPtr->linebytes) == -1) {
454		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
455			   "ioctl WSDISPLAYIO_LINEBYTES: %s\n",
456			   strerror(errno));
457		return FALSE;
458	}
459	/*
460	 * Allocate room for saving the colormap.
461	 */
462	if (fPtr->info.cmsize != 0) {
463		fPtr->saved_cmap.red =
464		    (unsigned char *)xalloc(fPtr->info.cmsize);
465		if (fPtr->saved_cmap.red == NULL) {
466			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
467			    "Cannot malloc %d bytes\n", fPtr->info.cmsize);
468			return FALSE;
469		}
470		fPtr->saved_cmap.green =
471		    (unsigned char *)xalloc(fPtr->info.cmsize);
472		if (fPtr->saved_cmap.green == NULL) {
473			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
474			    "Cannot malloc %d bytes\n", fPtr->info.cmsize);
475			xfree(fPtr->saved_cmap.red);
476			return FALSE;
477		}
478		fPtr->saved_cmap.blue =
479		    (unsigned char *)xalloc(fPtr->info.cmsize);
480		if (fPtr->saved_cmap.blue == NULL) {
481			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
482			    "Cannot malloc %d bytes\n", fPtr->info.cmsize);
483			xfree(fPtr->saved_cmap.red);
484			xfree(fPtr->saved_cmap.green);
485			return FALSE;
486		}
487	}
488
489	/* Handle depth */
490	default_depth = fPtr->info.depth <= 24 ? fPtr->info.depth : 24;
491	if (!xf86SetDepthBpp(pScrn, default_depth, default_depth,
492		fPtr->info.depth,
493		fPtr->info.depth >= 24 ? Support24bppFb|Support32bppFb : 0))
494		return FALSE;
495
496	/* Check consistency. */
497	if (pScrn->bitsPerPixel != fPtr->info.depth) {
498		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
499		    "specified depth (%d) or bpp (%d) doesn't match "
500		    "framebuffer depth (%d)\n", pScrn->depth,
501		    pScrn->bitsPerPixel, fPtr->info.depth);
502		return FALSE;
503	}
504	xf86PrintDepthBpp(pScrn);
505
506	/* Get the depth24 pixmap format. */
507	if (pScrn->depth == 24 && pix24bpp == 0)
508		pix24bpp = xf86GetBppFromDepth(pScrn, 24);
509
510	/* Color weight */
511	if (pScrn->depth > 8) {
512		rgb zeros = { 0, 0, 0 }, masks;
513
514		if (wstype == WSDISPLAY_TYPE_SUN24 ||
515		    wstype == WSDISPLAY_TYPE_SUNCG12 ||
516		    wstype == WSDISPLAY_TYPE_SUNCG14 ||
517		    wstype == WSDISPLAY_TYPE_SUNTCX ||
518		    wstype == WSDISPLAY_TYPE_SUNFFB ||
519		    wstype == WSDISPLAY_TYPE_XVR1000 ||
520		    wstype == WSDISPLAY_TYPE_VC4) {
521			masks.red = 0x0000ff;
522			masks.green = 0x00ff00;
523			masks.blue = 0xff0000;
524		} else {
525			masks.red = 0;
526			masks.green = 0;
527			masks.blue = 0;
528		}
529
530		if (!xf86SetWeight(pScrn, zeros, masks))
531			return FALSE;
532	}
533
534	/* Visual init */
535	if (!xf86SetDefaultVisual(pScrn, -1))
536		return FALSE;
537
538	/* We don't currently support DirectColor at > 8bpp . */
539	if (pScrn->depth > 8 && pScrn->defaultVisual != TrueColor) {
540		xf86DrvMsg(pScrn->scrnIndex, X_ERROR, "Given default visual"
541			   " (%s) is not supported at depth %d\n",
542			   xf86GetVisualName(pScrn->defaultVisual),
543			   pScrn->depth);
544		return FALSE;
545	}
546
547	xf86SetGamma(pScrn,zeros);
548
549	pScrn->progClock = TRUE;
550	pScrn->rgbBits   = (pScrn->depth >= 8) ? 8 : pScrn->depth;
551	pScrn->chipset   = "wsfb";
552	pScrn->videoRam  = fPtr->linebytes * fPtr->info.height;
553
554	xf86DrvMsg(pScrn->scrnIndex, X_INFO, "Vidmem: %dk\n",
555		   pScrn->videoRam/1024);
556
557	/* Handle options. */
558	xf86CollectOptions(pScrn, NULL);
559	if (!(fPtr->Options = xalloc(sizeof(WsfbOptions))))
560		return FALSE;
561	memcpy(fPtr->Options, WsfbOptions, sizeof(WsfbOptions));
562	xf86ProcessOptions(pScrn->scrnIndex, fPtr->pEnt->device->options,
563			   fPtr->Options);
564
565	/* Use shadow framebuffer by default, on depth >= 8 */
566	if (pScrn->depth >= 8)
567		fPtr->shadowFB = xf86ReturnOptValBool(fPtr->Options,
568						      OPTION_SHADOW_FB, TRUE);
569	else
570		if (xf86ReturnOptValBool(fPtr->Options,
571					 OPTION_SHADOW_FB, FALSE)) {
572			xf86DrvMsg(pScrn->scrnIndex, X_WARNING,
573				   "Shadow FB option ignored on depth < 8");
574		}
575
576	/* Rotation */
577	fPtr->rotate = WSFB_ROTATE_NONE;
578	if ((s = xf86GetOptValString(fPtr->Options, OPTION_ROTATE))) {
579		if (pScrn->depth >= 8) {
580			if (!xf86NameCmp(s, "CW")) {
581				fPtr->shadowFB = TRUE;
582				fPtr->rotate = WSFB_ROTATE_CW;
583				xf86DrvMsg(pScrn->scrnIndex, X_CONFIG,
584				    "Rotating screen clockwise\n");
585			} else if (!xf86NameCmp(s, "CCW")) {
586				fPtr->shadowFB = TRUE;
587				fPtr->rotate = WSFB_ROTATE_CCW;
588				xf86DrvMsg(pScrn->scrnIndex, X_CONFIG,
589				    "Rotating screen counter clockwise\n");
590			} else if (!xf86NameCmp(s, "UD")) {
591				fPtr->shadowFB = TRUE;
592				fPtr->rotate = WSFB_ROTATE_UD;
593				xf86DrvMsg(pScrn->scrnIndex, X_CONFIG,
594				    "Rotating screen upside down\n");
595			} else {
596				xf86DrvMsg(pScrn->scrnIndex, X_CONFIG,
597				    "\"%s\" is not a valid value for Option "
598				    "\"Rotate\"\n", s);
599				xf86DrvMsg(pScrn->scrnIndex, X_INFO,
600				    "Valid options are \"CW\", \"CCW\","
601				    " or \"UD\"\n");
602			}
603		} else {
604			xf86DrvMsg(pScrn->scrnIndex, X_WARNING,
605			    "Option \"Rotate\" ignored on depth < 8");
606		}
607	}
608
609	/* Fake video mode struct. */
610	mode = (DisplayModePtr)xalloc(sizeof(DisplayModeRec));
611	mode->prev = mode;
612	mode->next = mode;
613	mode->name = "wsfb current mode";
614	mode->status = MODE_OK;
615	mode->type = M_T_BUILTIN;
616	mode->Clock = 0;
617	mode->HDisplay = fPtr->info.width;
618	mode->HSyncStart = 0;
619	mode->HSyncEnd = 0;
620	mode->HTotal = 0;
621	mode->HSkew = 0;
622	mode->VDisplay = fPtr->info.height;
623	mode->VSyncStart = 0;
624	mode->VSyncEnd = 0;
625	mode->VTotal = 0;
626	mode->VScan = 0;
627	mode->Flags = 0;
628	if (pScrn->modes != NULL) {
629		xf86DrvMsg(pScrn->scrnIndex, X_INFO,
630		   "Ignoring mode specification from screen section\n");
631	}
632	pScrn->currentMode = pScrn->modes = mode;
633	pScrn->virtualX = fPtr->info.width;
634	pScrn->virtualY = fPtr->info.height;
635	pScrn->displayWidth = pScrn->virtualX;
636
637	/* Set the display resolution. */
638	xf86SetDpi(pScrn, 0, 0);
639
640	from = X_DEFAULT;
641	fPtr->HWCursor = TRUE;
642	if (xf86GetOptValBool(fPtr->Options, OPTION_HW_CURSOR, &fPtr->HWCursor))
643		from = X_CONFIG;
644	if (xf86ReturnOptValBool(fPtr->Options, OPTION_SW_CURSOR, FALSE)) {
645		from = X_CONFIG;
646		fPtr->HWCursor = FALSE;
647	}
648	xf86DrvMsg(pScrn->scrnIndex, from, "Using %s cursor\n",
649		fPtr->HWCursor ? "HW" : "SW");
650
651	/* Load bpp-specific modules. */
652	switch(pScrn->bitsPerPixel) {
653	case 1:
654	case 4:
655	default:
656		mod = "fb";
657		break;
658	}
659
660
661	/* Load shadow if needed. */
662	if (fPtr->shadowFB) {
663		xf86DrvMsg(pScrn->scrnIndex, X_CONFIG,
664			   "Using \"Shadow Framebuffer\"\n");
665		if (xf86LoadSubModule(pScrn, "shadow") == NULL) {
666			WsfbFreeRec(pScrn);
667			return FALSE;
668		}
669	}
670
671	if (mod && xf86LoadSubModule(pScrn, mod) == NULL) {
672		WsfbFreeRec(pScrn);
673		return FALSE;
674	}
675
676	if (xf86LoadSubModule(pScrn, "ramdac") == NULL) {
677		WsfbFreeRec(pScrn);
678		return FALSE;
679        }
680
681	if (mod) {
682		if (reqSym) {
683			xf86LoaderReqSymbols(reqSym, NULL);
684		} else {
685			xf86LoaderReqSymLists(fbSymbols, NULL);
686		}
687	}
688	TRACE_EXIT("PreInit");
689	return TRUE;
690}
691
692static Bool
693WsfbCreateScreenResources(ScreenPtr pScreen)
694{
695	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
696	WsfbPtr fPtr = WSFBPTR(pScrn);
697	PixmapPtr pPixmap;
698	Bool ret;
699
700	pScreen->CreateScreenResources = fPtr->CreateScreenResources;
701	ret = pScreen->CreateScreenResources(pScreen);
702	pScreen->CreateScreenResources = WsfbCreateScreenResources;
703
704	if (!ret)
705		return FALSE;
706
707	pPixmap = pScreen->GetScreenPixmap(pScreen);
708
709	if (!shadowAdd(pScreen, pPixmap, fPtr->rotate ?
710		shadowUpdateRotatePackedWeak() : shadowUpdatePackedWeak(),
711		WsfbWindowLinear, fPtr->rotate, NULL)) {
712		return FALSE;
713	}
714	return TRUE;
715}
716
717
718static Bool
719WsfbShadowInit(ScreenPtr pScreen)
720{
721	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
722	WsfbPtr fPtr = WSFBPTR(pScrn);
723
724	if (!shadowSetup(pScreen))
725		return FALSE;
726	fPtr->CreateScreenResources = pScreen->CreateScreenResources;
727	pScreen->CreateScreenResources = WsfbCreateScreenResources;
728
729	return TRUE;
730}
731
732static Bool
733WsfbScreenInit(int scrnIndex, ScreenPtr pScreen, int argc, char **argv)
734{
735	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
736	WsfbPtr fPtr = WSFBPTR(pScrn);
737	VisualPtr visual;
738	int ret, flags, ncolors;
739	int wsmode = WSDISPLAYIO_MODE_DUMBFB;
740	int wstype;
741	size_t len;
742
743	TRACE_ENTER("WsfbScreenInit");
744#if DEBUG
745	ErrorF("\tbitsPerPixel=%d, depth=%d, defaultVisual=%s\n"
746	       "\tmask: %x,%x,%x, offset: %u,%u,%u\n",
747	       pScrn->bitsPerPixel,
748	       pScrn->depth,
749	       xf86GetVisualName(pScrn->defaultVisual),
750	       pScrn->mask.red,pScrn->mask.green,pScrn->mask.blue,
751	       pScrn->offset.red,pScrn->offset.green,pScrn->offset.blue);
752#endif
753	switch (fPtr->info.depth) {
754	case 1:
755	case 4:
756	case 8:
757		len = fPtr->linebytes*fPtr->info.height;
758		break;
759	case 16:
760		if (fPtr->linebytes == fPtr->info.width) {
761			len = fPtr->info.width*fPtr->info.height*sizeof(short);
762		} else {
763			len = fPtr->linebytes*fPtr->info.height;
764		}
765		break;
766	case 24:
767		if (fPtr->linebytes == fPtr->info.width) {
768			len = fPtr->info.width*fPtr->info.height*3;
769		} else {
770			len = fPtr->linebytes*fPtr->info.height;
771		}
772		break;
773	case 32:
774		if (fPtr->linebytes == fPtr->info.width) {
775			len = fPtr->info.width*fPtr->info.height*sizeof(int);
776		} else {
777			len = fPtr->linebytes*fPtr->info.height;
778		}
779		break;
780	default:
781		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
782			   "unsupported depth %d\n", fPtr->info.depth);
783		return FALSE;
784	}
785	/* Switch to graphics mode - required before mmap. */
786	if (ioctl(fPtr->fd, WSDISPLAYIO_SMODE, &wsmode) == -1) {
787		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
788			   "ioctl WSDISPLAYIO_SMODE: %s\n",
789			   strerror(errno));
790		return FALSE;
791	}
792	/* Get wsdisplay type to handle quirks */
793	if (ioctl(fPtr->fd, WSDISPLAYIO_GTYPE, &wstype) == -1) {
794		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
795			   "ioctl WSDISPLAY_GTYPE: %s\n",
796			   strerror(errno));
797		return FALSE;
798	}
799	fPtr->fbmem = wsfb_mmap(len, 0, fPtr->fd);
800
801	if (fPtr->fbmem == NULL) {
802		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
803			   "wsfb_mmap: %s\n", strerror(errno));
804		return FALSE;
805	}
806	fPtr->fbmem_len = len;
807
808	WsfbSave(pScrn);
809	pScrn->vtSema = TRUE;
810
811	/* MI layer */
812	miClearVisualTypes();
813	if (pScrn->bitsPerPixel > 8) {
814		if (!miSetVisualTypes(pScrn->depth, TrueColorMask,
815				      pScrn->rgbBits, TrueColor))
816			return FALSE;
817	} else {
818		if (!miSetVisualTypes(pScrn->depth,
819				      miGetDefaultVisualMask(pScrn->depth),
820				      pScrn->rgbBits, pScrn->defaultVisual))
821			return FALSE;
822	}
823	if (!miSetPixmapDepths())
824		return FALSE;
825
826	if (fPtr->rotate == WSFB_ROTATE_CW
827	    || fPtr->rotate == WSFB_ROTATE_CCW) {
828		int tmp = pScrn->virtualX;
829		pScrn->virtualX = pScrn->displayWidth = pScrn->virtualY;
830		pScrn->virtualY = tmp;
831	}
832	if (fPtr->rotate && !fPtr->PointerMoved) {
833		fPtr->PointerMoved = pScrn->PointerMoved;
834		pScrn->PointerMoved = WsfbPointerMoved;
835	}
836
837	fPtr->fbstart = fPtr->fbmem;
838#ifdef	WSDISPLAY_TYPE_LUNA
839	if (wstype == WSDISPLAY_TYPE_LUNA) {
840		/*
841		 * XXX
842		 * LUNA's FB seems to have 64 dot (8 byte) offset.
843		 * This might be able to be changed in kernel lunafb driver,
844		 * but current setting was pulled from 4.4BSD-Lite2/luna68k.
845		 */
846		fPtr->fbstart += 8;
847	}
848#endif
849
850	if (fPtr->shadowFB) {
851		fPtr->shadow = xcalloc(1, pScrn->virtualX * pScrn->virtualY *
852		    pScrn->bitsPerPixel);
853
854		if (!fPtr->shadow) {
855			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
856			    "Failed to allocate shadow framebuffer\n");
857			return FALSE;
858		}
859	}
860
861	switch (pScrn->bitsPerPixel) {
862	case 1:
863		ret = fbScreenInit(pScreen,
864		    fPtr->fbstart,
865		    pScrn->virtualX, pScrn->virtualY,
866		    pScrn->xDpi, pScrn->yDpi,
867		    fPtr->linebytes * 8, pScrn->bitsPerPixel);
868		break;
869	case 4:
870	case 8:
871	case 16:
872	case 24:
873	case 32:
874		ret = fbScreenInit(pScreen,
875		    fPtr->shadowFB ? fPtr->shadow : fPtr->fbstart,
876		    pScrn->virtualX, pScrn->virtualY,
877		    pScrn->xDpi, pScrn->yDpi,
878		    pScrn->displayWidth, pScrn->bitsPerPixel);
879		break;
880	default:
881		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
882			   "Unsupported bpp: %d", pScrn->bitsPerPixel);
883		return FALSE;
884	} /* case */
885
886	if (!ret)
887		return FALSE;
888
889	if (pScrn->bitsPerPixel > 8) {
890		/* Fixup RGB ordering. */
891		visual = pScreen->visuals + pScreen->numVisuals;
892		while (--visual >= pScreen->visuals) {
893			if ((visual->class | DynamicClass) == DirectColor) {
894				visual->offsetRed   = pScrn->offset.red;
895				visual->offsetGreen = pScrn->offset.green;
896				visual->offsetBlue  = pScrn->offset.blue;
897				visual->redMask     = pScrn->mask.red;
898				visual->greenMask   = pScrn->mask.green;
899				visual->blueMask    = pScrn->mask.blue;
900			}
901		}
902	}
903
904	if (pScrn->bitsPerPixel >= 8) {
905		if (!fbPictureInit(pScreen, NULL, 0))
906			xf86DrvMsg(pScrn->scrnIndex, X_WARNING,
907				   "RENDER extension initialisation failed.");
908	}
909	if (fPtr->shadowFB && !WsfbShadowInit(pScreen)) {
910		xf86DrvMsg(scrnIndex, X_ERROR,
911		    "shadow framebuffer initialization failed\n");
912		return FALSE;
913	}
914
915#ifdef XFreeXDGA
916	if (!fPtr->rotate)
917		WsfbDGAInit(pScrn, pScreen);
918	else
919		xf86DrvMsg(scrnIndex, X_INFO, "Rotated display, "
920		    "disabling DGA\n");
921#endif
922	if (fPtr->rotate) {
923		xf86DrvMsg(scrnIndex, X_INFO, "Enabling Driver Rotation, "
924		    "disabling RandR\n");
925		xf86DisableRandR();
926		if (pScrn->bitsPerPixel == 24)
927			xf86DrvMsg(scrnIndex, X_WARNING,
928			    "Rotation might be broken in 24 bpp\n");
929	}
930
931	xf86SetBlackWhitePixels(pScreen);
932	miInitializeBackingStore(pScreen);
933	xf86SetBackingStore(pScreen);
934
935	/* Software cursor. */
936	miDCInitialize(pScreen, xf86GetPointerScreenFuncs());
937
938	/* check for hardware cursor support */
939	if (fPtr->HWCursor)
940		WsfbSetupCursor(pScreen);
941
942	/*
943	 * Colormap
944	 *
945	 * Note that, even on less than 8 bit depth frame buffers, we
946	 * expect the colormap to be programmable with 8 bit values.
947	 * As of now, this is indeed the case on all OpenBSD supported
948	 * graphics hardware.
949	 */
950	if (!miCreateDefColormap(pScreen))
951		return FALSE;
952	flags = CMAP_RELOAD_ON_MODE_SWITCH;
953	ncolors = fPtr->info.cmsize;
954	/* On StaticGray visuals, fake a 256 entries colormap. */
955	if (ncolors == 0)
956		ncolors = 256;
957	if(!xf86HandleColormaps(pScreen, ncolors, 8, WsfbLoadPalette,
958				NULL, flags))
959		return FALSE;
960
961	pScreen->SaveScreen = WsfbSaveScreen;
962
963#ifdef XvExtension
964	{
965		XF86VideoAdaptorPtr *ptr;
966
967		int n = xf86XVListGenericAdaptors(pScrn,&ptr);
968		if (n) {
969			xf86XVScreenInit(pScreen,ptr,n);
970		}
971	}
972#endif
973
974	/* Wrap the current CloseScreen function. */
975	fPtr->CloseScreen = pScreen->CloseScreen;
976	pScreen->CloseScreen = WsfbCloseScreen;
977
978	TRACE_EXIT("WsfbScreenInit");
979	return TRUE;
980}
981
982static Bool
983WsfbCloseScreen(int scrnIndex, ScreenPtr pScreen)
984{
985	ScrnInfoPtr pScrn = xf86Screens[scrnIndex];
986	PixmapPtr pPixmap;
987	WsfbPtr fPtr = WSFBPTR(pScrn);
988
989
990	TRACE_ENTER("WsfbCloseScreen");
991
992	pPixmap = pScreen->GetScreenPixmap(pScreen);
993	shadowRemove(pScreen, pPixmap);
994
995	if (pScrn->vtSema) {
996		WsfbRestore(pScrn);
997		if (munmap(fPtr->fbmem, fPtr->fbmem_len) == -1) {
998			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
999				   "munmap: %s\n", strerror(errno));
1000		}
1001
1002		fPtr->fbmem = NULL;
1003	}
1004#ifdef XFreeXDGA
1005	if (fPtr->pDGAMode) {
1006		xfree(fPtr->pDGAMode);
1007		fPtr->pDGAMode = NULL;
1008		fPtr->nDGAMode = 0;
1009	}
1010#endif
1011	pScrn->vtSema = FALSE;
1012
1013	/* Unwrap CloseScreen. */
1014	pScreen->CloseScreen = fPtr->CloseScreen;
1015	TRACE_EXIT("WsfbCloseScreen");
1016	return (*pScreen->CloseScreen)(scrnIndex, pScreen);
1017}
1018
1019static void *
1020WsfbWindowLinear(ScreenPtr pScreen, CARD32 row, CARD32 offset, int mode,
1021		CARD32 *size, void *closure)
1022{
1023	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
1024	WsfbPtr fPtr = WSFBPTR(pScrn);
1025
1026	if (fPtr->linebytes)
1027		*size = fPtr->linebytes;
1028	else {
1029		if (ioctl(fPtr->fd, WSDISPLAYIO_LINEBYTES, size) == -1)
1030			return NULL;
1031		fPtr->linebytes = *size;
1032	}
1033	return ((CARD8 *)fPtr->fbmem + row *fPtr->linebytes + offset);
1034}
1035
1036static void
1037WsfbPointerMoved(int index, int x, int y)
1038{
1039    ScrnInfoPtr pScrn = xf86Screens[index];
1040    WsfbPtr fPtr = WSFBPTR(pScrn);
1041    int newX, newY;
1042
1043    switch (fPtr->rotate)
1044    {
1045    case WSFB_ROTATE_CW:
1046	/* 90 degrees CW rotation. */
1047	newX = pScrn->pScreen->height - y - 1;
1048	newY = x;
1049	break;
1050
1051    case WSFB_ROTATE_CCW:
1052	/* 90 degrees CCW rotation. */
1053	newX = y;
1054	newY = pScrn->pScreen->width - x - 1;
1055	break;
1056
1057    case WSFB_ROTATE_UD:
1058	/* 180 degrees UD rotation. */
1059	newX = pScrn->pScreen->width - x - 1;
1060	newY = pScrn->pScreen->height - y - 1;
1061	break;
1062
1063    default:
1064	/* No rotation. */
1065	newX = x;
1066	newY = y;
1067	break;
1068    }
1069
1070    /* Pass adjusted pointer coordinates to wrapped PointerMoved function. */
1071    (*fPtr->PointerMoved)(index, newX, newY);
1072}
1073
1074static Bool
1075WsfbEnterVT(int scrnIndex, int flags)
1076{
1077	ScrnInfoPtr pScrn = xf86Screens[scrnIndex];
1078
1079	TRACE_ENTER("EnterVT");
1080	pScrn->vtSema = TRUE;
1081	TRACE_EXIT("EnterVT");
1082	return TRUE;
1083}
1084
1085static void
1086WsfbLeaveVT(int scrnIndex, int flags)
1087{
1088#if DEBUG
1089	ScrnInfoPtr pScrn = xf86Screens[scrnIndex];
1090#endif
1091
1092	TRACE_ENTER("LeaveVT");
1093}
1094
1095static Bool
1096WsfbSwitchMode(int scrnIndex, DisplayModePtr mode, int flags)
1097{
1098#if DEBUG
1099	ScrnInfoPtr pScrn = xf86Screens[scrnIndex];
1100#endif
1101
1102	TRACE_ENTER("SwitchMode");
1103	/* Nothing else to do. */
1104	return TRUE;
1105}
1106
1107static int
1108WsfbValidMode(int scrnIndex, DisplayModePtr mode, Bool verbose, int flags)
1109{
1110#if DEBUG
1111	ScrnInfoPtr pScrn = xf86Screens[scrnIndex];
1112#endif
1113
1114	TRACE_ENTER("ValidMode");
1115	return MODE_OK;
1116}
1117
1118static void
1119WsfbLoadPalette(ScrnInfoPtr pScrn, int numColors, int *indices,
1120	       LOCO *colors, VisualPtr pVisual)
1121{
1122	WsfbPtr fPtr = WSFBPTR(pScrn);
1123	struct wsdisplay_cmap cmap;
1124	unsigned char red[256],green[256],blue[256];
1125	int i, indexMin=256, indexMax=0;
1126
1127	TRACE_ENTER("LoadPalette");
1128
1129	cmap.count   = 1;
1130	cmap.red   = red;
1131	cmap.green = green;
1132	cmap.blue  = blue;
1133
1134	if (numColors == 1) {
1135		/* Optimisation */
1136		cmap.index = indices[0];
1137		red[0]   = colors[indices[0]].red;
1138		green[0] = colors[indices[0]].green;
1139		blue[0]  = colors[indices[0]].blue;
1140		if (ioctl(fPtr->fd,WSDISPLAYIO_PUTCMAP, &cmap) == -1)
1141			ErrorF("ioctl FBIOPUTCMAP: %s\n", strerror(errno));
1142	} else {
1143		/*
1144		 * Change all colors in 2 ioctls
1145		 * and limit the data to be transfered.
1146		 */
1147		for (i = 0; i < numColors; i++) {
1148			if (indices[i] < indexMin)
1149				indexMin = indices[i];
1150			if (indices[i] > indexMax)
1151				indexMax = indices[i];
1152		}
1153		cmap.index = indexMin;
1154		cmap.count = indexMax - indexMin + 1;
1155		cmap.red = &red[indexMin];
1156		cmap.green = &green[indexMin];
1157		cmap.blue = &blue[indexMin];
1158		/* Get current map. */
1159		if (ioctl(fPtr->fd, WSDISPLAYIO_GETCMAP, &cmap) == -1)
1160			ErrorF("ioctl FBIOGETCMAP: %s\n", strerror(errno));
1161		/* Change the colors that require updating. */
1162		for (i = 0; i < numColors; i++) {
1163			red[indices[i]]   = colors[indices[i]].red;
1164			green[indices[i]] = colors[indices[i]].green;
1165			blue[indices[i]]  = colors[indices[i]].blue;
1166		}
1167		/* Write the colormap back. */
1168		if (ioctl(fPtr->fd,WSDISPLAYIO_PUTCMAP, &cmap) == -1)
1169			ErrorF("ioctl FBIOPUTCMAP: %s\n", strerror(errno));
1170	}
1171	TRACE_EXIT("LoadPalette");
1172}
1173
1174static Bool
1175WsfbSaveScreen(ScreenPtr pScreen, int mode)
1176{
1177	ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum];
1178	WsfbPtr fPtr = WSFBPTR(pScrn);
1179	int state;
1180
1181	TRACE_ENTER("SaveScreen");
1182
1183	if (!pScrn->vtSema)
1184		return TRUE;
1185
1186	if (mode != SCREEN_SAVER_FORCER) {
1187		state = xf86IsUnblank(mode)?WSDISPLAYIO_VIDEO_ON:
1188		                            WSDISPLAYIO_VIDEO_OFF;
1189		ioctl(fPtr->fd,
1190		      WSDISPLAYIO_SVIDEO, &state);
1191	}
1192	TRACE_EXIT("SaveScreen");
1193	return TRUE;
1194}
1195
1196
1197static void
1198WsfbSave(ScrnInfoPtr pScrn)
1199{
1200	WsfbPtr fPtr = WSFBPTR(pScrn);
1201
1202	TRACE_ENTER("WsfbSave");
1203
1204	if (fPtr->info.cmsize == 0)
1205		return;
1206
1207	fPtr->saved_cmap.index = 0;
1208	fPtr->saved_cmap.count = fPtr->info.cmsize;
1209	if (ioctl(fPtr->fd, WSDISPLAYIO_GETCMAP,
1210		  &(fPtr->saved_cmap)) == -1) {
1211		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
1212			   "error saving colormap %s\n", strerror(errno));
1213	}
1214	TRACE_EXIT("WsfbSave");
1215
1216}
1217
1218static void
1219WsfbRestore(ScrnInfoPtr pScrn)
1220{
1221	WsfbPtr fPtr = WSFBPTR(pScrn);
1222	int mode;
1223
1224	TRACE_ENTER("WsfbRestore");
1225
1226	if (fPtr->info.cmsize != 0) {
1227		/* reset colormap for text mode */
1228		if (ioctl(fPtr->fd, WSDISPLAYIO_PUTCMAP,
1229			  &(fPtr->saved_cmap)) == -1) {
1230			xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
1231				   "error restoring colormap %s\n",
1232				   strerror(errno));
1233		}
1234	}
1235
1236	/* Clear the screen. */
1237	memset(fPtr->fbmem, 0, fPtr->fbmem_len);
1238
1239	/* Restore the text mode. */
1240	mode = WSDISPLAYIO_MODE_EMUL;
1241	if (ioctl(fPtr->fd, WSDISPLAYIO_SMODE, &mode) == -1) {
1242		xf86DrvMsg(pScrn->scrnIndex, X_ERROR,
1243			   "error setting text mode %s\n", strerror(errno));
1244	}
1245	TRACE_EXIT("WsfbRestore");
1246}
1247
1248#ifdef XFreeXDGA
1249/***********************************************************************
1250 * DGA stuff
1251 ***********************************************************************/
1252
1253static Bool
1254WsfbDGAOpenFramebuffer(ScrnInfoPtr pScrn, char **DeviceName,
1255		       unsigned char **ApertureBase, int *ApertureSize,
1256		       int *ApertureOffset, int *flags)
1257{
1258	*DeviceName = NULL;		/* No special device */
1259	*ApertureBase = (unsigned char *)(pScrn->memPhysBase);
1260	*ApertureSize = pScrn->videoRam;
1261	*ApertureOffset = pScrn->fbOffset;
1262	*flags = 0;
1263
1264	return TRUE;
1265}
1266
1267static Bool
1268WsfbDGASetMode(ScrnInfoPtr pScrn, DGAModePtr pDGAMode)
1269{
1270	DisplayModePtr pMode;
1271	int scrnIdx = pScrn->pScreen->myNum;
1272	int frameX0, frameY0;
1273
1274	if (pDGAMode) {
1275		pMode = pDGAMode->mode;
1276		frameX0 = frameY0 = 0;
1277	} else {
1278		if (!(pMode = pScrn->currentMode))
1279			return TRUE;
1280
1281		frameX0 = pScrn->frameX0;
1282		frameY0 = pScrn->frameY0;
1283	}
1284
1285	if (!(*pScrn->SwitchMode)(scrnIdx, pMode, 0))
1286		return FALSE;
1287	(*pScrn->AdjustFrame)(scrnIdx, frameX0, frameY0, 0);
1288
1289	return TRUE;
1290}
1291
1292static void
1293WsfbDGASetViewport(ScrnInfoPtr pScrn, int x, int y, int flags)
1294{
1295	(*pScrn->AdjustFrame)(pScrn->pScreen->myNum, x, y, flags);
1296}
1297
1298static int
1299WsfbDGAGetViewport(ScrnInfoPtr pScrn)
1300{
1301	return (0);
1302}
1303
1304static DGAFunctionRec WsfbDGAFunctions =
1305{
1306	WsfbDGAOpenFramebuffer,
1307	NULL,       /* CloseFramebuffer */
1308	WsfbDGASetMode,
1309	WsfbDGASetViewport,
1310	WsfbDGAGetViewport,
1311	NULL,       /* Sync */
1312	NULL,       /* FillRect */
1313	NULL,       /* BlitRect */
1314	NULL,       /* BlitTransRect */
1315};
1316
1317static void
1318WsfbDGAAddModes(ScrnInfoPtr pScrn)
1319{
1320	WsfbPtr fPtr = WSFBPTR(pScrn);
1321	DisplayModePtr pMode = pScrn->modes;
1322	DGAModePtr pDGAMode;
1323
1324	do {
1325		pDGAMode = xrealloc(fPtr->pDGAMode,
1326				    (fPtr->nDGAMode + 1) * sizeof(DGAModeRec));
1327		if (!pDGAMode)
1328			break;
1329
1330		fPtr->pDGAMode = pDGAMode;
1331		pDGAMode += fPtr->nDGAMode;
1332		(void)memset(pDGAMode, 0, sizeof(DGAModeRec));
1333
1334		++fPtr->nDGAMode;
1335		pDGAMode->mode = pMode;
1336		pDGAMode->flags = DGA_CONCURRENT_ACCESS | DGA_PIXMAP_AVAILABLE;
1337		pDGAMode->byteOrder = pScrn->imageByteOrder;
1338		pDGAMode->depth = pScrn->depth;
1339		pDGAMode->bitsPerPixel = pScrn->bitsPerPixel;
1340		pDGAMode->red_mask = pScrn->mask.red;
1341		pDGAMode->green_mask = pScrn->mask.green;
1342		pDGAMode->blue_mask = pScrn->mask.blue;
1343		pDGAMode->visualClass = pScrn->bitsPerPixel > 8 ?
1344			TrueColor : PseudoColor;
1345		pDGAMode->xViewportStep = 1;
1346		pDGAMode->yViewportStep = 1;
1347		pDGAMode->viewportWidth = pMode->HDisplay;
1348		pDGAMode->viewportHeight = pMode->VDisplay;
1349
1350		if (fPtr->linebytes)
1351			pDGAMode->bytesPerScanline = fPtr->linebytes;
1352		else {
1353			ioctl(fPtr->fd, WSDISPLAYIO_LINEBYTES,
1354			      &fPtr->linebytes);
1355			pDGAMode->bytesPerScanline = fPtr->linebytes;
1356		}
1357
1358		pDGAMode->imageWidth = pMode->HDisplay;
1359		pDGAMode->imageHeight =  pMode->VDisplay;
1360		pDGAMode->pixmapWidth = pDGAMode->imageWidth;
1361		pDGAMode->pixmapHeight = pDGAMode->imageHeight;
1362		pDGAMode->maxViewportX = pScrn->virtualX -
1363			pDGAMode->viewportWidth;
1364		pDGAMode->maxViewportY = pScrn->virtualY -
1365			pDGAMode->viewportHeight;
1366
1367		pDGAMode->address = fPtr->fbstart;
1368
1369		pMode = pMode->next;
1370	} while (pMode != pScrn->modes);
1371}
1372
1373static Bool
1374WsfbDGAInit(ScrnInfoPtr pScrn, ScreenPtr pScreen)
1375{
1376	WsfbPtr fPtr = WSFBPTR(pScrn);
1377
1378	if (pScrn->depth < 8)
1379		return FALSE;
1380
1381	if (!fPtr->nDGAMode)
1382		WsfbDGAAddModes(pScrn);
1383
1384	return (DGAInit(pScreen, &WsfbDGAFunctions,
1385			fPtr->pDGAMode, fPtr->nDGAMode));
1386}
1387#endif
1388
1389static Bool
1390WsfbDriverFunc(ScrnInfoPtr pScrn, xorgDriverFuncOp op,
1391    pointer ptr)
1392{
1393	xorgHWFlags *flag;
1394
1395	switch (op) {
1396	case GET_REQUIRED_HW_INTERFACES:
1397		flag = (CARD32*)ptr;
1398		(*flag) = 0;
1399		return TRUE;
1400	default:
1401		return FALSE;
1402	}
1403}
1404
1405