wsfb_driver.c revision bff82b7e
1357bfbb2Smrg/* 2cba5e21cSmrg * Copyright © 2001-2012 Matthieu Herrb 3357bfbb2Smrg * All rights reserved. 4357bfbb2Smrg * 5357bfbb2Smrg * Redistribution and use in source and binary forms, with or without 6357bfbb2Smrg * modification, are permitted provided that the following conditions 7357bfbb2Smrg * are met: 8357bfbb2Smrg * 9357bfbb2Smrg * - Redistributions of source code must retain the above copyright 10357bfbb2Smrg * notice, this list of conditions and the following disclaimer. 11357bfbb2Smrg * - Redistributions in binary form must reproduce the above 12357bfbb2Smrg * copyright notice, this list of conditions and the following 13357bfbb2Smrg * disclaimer in the documentation and/or other materials provided 14357bfbb2Smrg * with the distribution. 15357bfbb2Smrg * 16357bfbb2Smrg * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 17357bfbb2Smrg * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 18357bfbb2Smrg * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 19357bfbb2Smrg * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE 20357bfbb2Smrg * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 21357bfbb2Smrg * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 22357bfbb2Smrg * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 23357bfbb2Smrg * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER 24357bfbb2Smrg * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 25357bfbb2Smrg * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 26357bfbb2Smrg * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 27357bfbb2Smrg * POSSIBILITY OF SUCH DAMAGE. 28357bfbb2Smrg * 29357bfbb2Smrg */ 30357bfbb2Smrg 31357bfbb2Smrg/* 32357bfbb2Smrg * Based on fbdev.c written by: 33357bfbb2Smrg * 34357bfbb2Smrg * Authors: Alan Hourihane, <alanh@fairlite.demon.co.uk> 35357bfbb2Smrg * Michel Dänzer, <michdaen@iiic.ethz.ch> 36357bfbb2Smrg */ 37357bfbb2Smrg 38357bfbb2Smrg#ifdef HAVE_CONFIG_H 39357bfbb2Smrg#include "config.h" 40357bfbb2Smrg#endif 41357bfbb2Smrg 4264f08a18Smrg#include <errno.h> 43357bfbb2Smrg#include <fcntl.h> 44cba5e21cSmrg#include <unistd.h> 45cba5e21cSmrg#include <sys/ioctl.h> 46357bfbb2Smrg#include <sys/types.h> 4764f08a18Smrg#include <sys/mman.h> 48357bfbb2Smrg#include <sys/time.h> 492b2b17b3Smrg#include <errno.h> 50357bfbb2Smrg#include <dev/wscons/wsconsio.h> 51357bfbb2Smrg 5264f08a18Smrg/* All drivers need this. */ 53357bfbb2Smrg#include "xf86.h" 54357bfbb2Smrg#include "xf86_OSproc.h" 55357bfbb2Smrg 56357bfbb2Smrg#include "mipointer.h" 57357bfbb2Smrg#include "micmap.h" 58357bfbb2Smrg#include "colormapst.h" 59357bfbb2Smrg#include "xf86cmap.h" 60357bfbb2Smrg#include "shadow.h" 61357bfbb2Smrg#include "dgaproc.h" 62357bfbb2Smrg 6364f08a18Smrg/* For visuals */ 64357bfbb2Smrg#include "fb.h" 65357bfbb2Smrg 6664f08a18Smrg#if GET_ABI_MAJOR(ABI_VIDEODRV_VERSION) < 6 67357bfbb2Smrg#include "xf86Resources.h" 68357bfbb2Smrg#include "xf86RAC.h" 6964f08a18Smrg#endif 70357bfbb2Smrg 71357bfbb2Smrg#ifdef XvExtension 72357bfbb2Smrg#include "xf86xv.h" 73357bfbb2Smrg#endif 74357bfbb2Smrg 755d492fd2Smacallan#include "wsfb.h" 765d492fd2Smacallan 7764f08a18Smrg#ifdef X_PRIVSEP 78357bfbb2Smrgextern int priv_open_device(const char *); 79357bfbb2Smrg#else 80357bfbb2Smrg#define priv_open_device(n) open(n,O_RDWR|O_NONBLOCK|O_EXCL) 81357bfbb2Smrg#endif 82357bfbb2Smrg 83357bfbb2Smrg#if defined(__NetBSD__) 84357bfbb2Smrg#define WSFB_DEFAULT_DEV "/dev/ttyE0" 85357bfbb2Smrg#else 86357bfbb2Smrg#define WSFB_DEFAULT_DEV "/dev/ttyC0" 87357bfbb2Smrg#endif 88357bfbb2Smrg 89357bfbb2Smrg#define DEBUG 0 90357bfbb2Smrg 91357bfbb2Smrg#if DEBUG 92357bfbb2Smrg# define TRACE_ENTER(str) ErrorF("wsfb: " str " %d\n",pScrn->scrnIndex) 93357bfbb2Smrg# define TRACE_EXIT(str) ErrorF("wsfb: " str " done\n") 94357bfbb2Smrg# define TRACE(str) ErrorF("wsfb trace: " str "\n") 95357bfbb2Smrg#else 96357bfbb2Smrg# define TRACE_ENTER(str) 97357bfbb2Smrg# define TRACE_EXIT(str) 98357bfbb2Smrg# define TRACE(str) 99357bfbb2Smrg#endif 100357bfbb2Smrg 101357bfbb2Smrg/* Prototypes */ 102357bfbb2Smrgstatic pointer WsfbSetup(pointer, pointer, int *, int *); 103357bfbb2Smrgstatic Bool WsfbGetRec(ScrnInfoPtr); 104357bfbb2Smrgstatic void WsfbFreeRec(ScrnInfoPtr); 105357bfbb2Smrgstatic const OptionInfoRec * WsfbAvailableOptions(int, int); 106357bfbb2Smrgstatic void WsfbIdentify(int); 107357bfbb2Smrgstatic Bool WsfbProbe(DriverPtr, int); 108357bfbb2Smrgstatic Bool WsfbPreInit(ScrnInfoPtr, int); 1099974adabSmrgstatic Bool WsfbScreenInit(SCREEN_INIT_ARGS_DECL); 1109974adabSmrgstatic Bool WsfbCloseScreen(CLOSE_SCREEN_ARGS_DECL); 111357bfbb2Smrgstatic void *WsfbWindowLinear(ScreenPtr, CARD32, CARD32, int, CARD32 *, 112357bfbb2Smrg void *); 113dc9c99a5Stsutsui#ifdef HAVE_SHADOW_AFB 1143306a6a4Sjandbergstatic void *WsfbWindowAfb(ScreenPtr, CARD32, CARD32, int, CARD32 *, 1153306a6a4Sjandberg void *); 116dc9c99a5Stsutsui#endif 1179974adabSmrgstatic void WsfbPointerMoved(SCRN_ARG_TYPE, int, int); 1189974adabSmrgstatic Bool WsfbEnterVT(VT_FUNC_ARGS_DECL); 1199974adabSmrgstatic void WsfbLeaveVT(VT_FUNC_ARGS_DECL); 1209974adabSmrgstatic Bool WsfbSwitchMode(SWITCH_MODE_ARGS_DECL); 1219974adabSmrgstatic int WsfbValidMode(SCRN_ARG_TYPE, DisplayModePtr, Bool, int); 122357bfbb2Smrgstatic void WsfbLoadPalette(ScrnInfoPtr, int, int *, LOCO *, VisualPtr); 123357bfbb2Smrgstatic Bool WsfbSaveScreen(ScreenPtr, int); 124357bfbb2Smrgstatic void WsfbSave(ScrnInfoPtr); 125357bfbb2Smrgstatic void WsfbRestore(ScrnInfoPtr); 126357bfbb2Smrg 12764f08a18Smrg/* DGA stuff */ 128357bfbb2Smrg#ifdef XFreeXDGA 129357bfbb2Smrgstatic Bool WsfbDGAOpenFramebuffer(ScrnInfoPtr, char **, unsigned char **, 130357bfbb2Smrg int *, int *, int *); 131357bfbb2Smrgstatic Bool WsfbDGASetMode(ScrnInfoPtr, DGAModePtr); 132357bfbb2Smrgstatic void WsfbDGASetViewport(ScrnInfoPtr, int, int, int); 133357bfbb2Smrgstatic Bool WsfbDGAInit(ScrnInfoPtr, ScreenPtr); 134357bfbb2Smrg#endif 1350ef55ed1Smacallan 136bff82b7eSjmcneillstatic void WsfbShadowUpdateRGB16ToYUY2(ScreenPtr, shadowBufPtr); 1370ef55ed1Smacallanstatic void WsfbShadowUpdateSwap32(ScreenPtr, shadowBufPtr); 138cbc9a668Smacallanstatic void WsfbShadowUpdateSplit(ScreenPtr, shadowBufPtr); 1390ef55ed1Smacallan 1400ef55ed1Smacallanstatic Bool WsfbDriverFunc(ScrnInfoPtr, xorgDriverFuncOp, pointer); 141357bfbb2Smrg 14264f08a18Smrg/* Helper functions */ 143cba5e21cSmrgstatic int wsfb_open(const char *); 144357bfbb2Smrgstatic pointer wsfb_mmap(size_t, off_t, int); 145357bfbb2Smrg 146357bfbb2Smrgenum { WSFB_ROTATE_NONE = 0, 147357bfbb2Smrg WSFB_ROTATE_CCW = 90, 148357bfbb2Smrg WSFB_ROTATE_UD = 180, 149357bfbb2Smrg WSFB_ROTATE_CW = 270 150357bfbb2Smrg}; 151357bfbb2Smrg 152357bfbb2Smrg/* 153cba5e21cSmrg * This is intentionally screen-independent. 15464f08a18Smrg * It indicates the binding choice made in the first PreInit. 155357bfbb2Smrg */ 156357bfbb2Smrgstatic int pix24bpp = 0; 157357bfbb2Smrg 158bff82b7eSjmcneill/* 159bff82b7eSjmcneill * Screen-independent lookup table for RGB16 to YUV conversions. 160bff82b7eSjmcneill */ 161bff82b7eSjmcneillstatic unsigned char *mapRGB16ToY = NULL; 162bff82b7eSjmcneillstatic unsigned char *mapRGB16ToU = NULL; 163bff82b7eSjmcneillstatic unsigned char *mapRGB16ToV = NULL; 164bff82b7eSjmcneill 1658a4fa5cdStsutsui#define WSFB_VERSION 4000 166357bfbb2Smrg#define WSFB_NAME "wsfb" 167357bfbb2Smrg#define WSFB_DRIVER_NAME "wsfb" 168357bfbb2Smrg 169357bfbb2Smrg_X_EXPORT DriverRec WSFB = { 170357bfbb2Smrg WSFB_VERSION, 1718a4fa5cdStsutsui (char *)WSFB_DRIVER_NAME, 172357bfbb2Smrg WsfbIdentify, 173357bfbb2Smrg WsfbProbe, 174357bfbb2Smrg WsfbAvailableOptions, 175357bfbb2Smrg NULL, 176357bfbb2Smrg 0, 177357bfbb2Smrg WsfbDriverFunc 178357bfbb2Smrg}; 179357bfbb2Smrg 180357bfbb2Smrg/* Supported "chipsets" */ 181357bfbb2Smrgstatic SymTabRec WsfbChipsets[] = { 182357bfbb2Smrg { 0, "wsfb" }, 183357bfbb2Smrg { -1, NULL } 184357bfbb2Smrg}; 185357bfbb2Smrg 186357bfbb2Smrg/* Supported options */ 187357bfbb2Smrgtypedef enum { 188357bfbb2Smrg OPTION_SHADOW_FB, 1895d492fd2Smacallan OPTION_ROTATE, 1905d492fd2Smacallan OPTION_HW_CURSOR, 1915d492fd2Smacallan OPTION_SW_CURSOR 192357bfbb2Smrg} WsfbOpts; 193357bfbb2Smrg 194357bfbb2Smrgstatic const OptionInfoRec WsfbOptions[] = { 195357bfbb2Smrg { OPTION_SHADOW_FB, "ShadowFB", OPTV_BOOLEAN, {0}, FALSE}, 196357bfbb2Smrg { OPTION_ROTATE, "Rotate", OPTV_STRING, {0}, FALSE}, 197b6e55117Smacallan { OPTION_HW_CURSOR, "HWCursor", OPTV_BOOLEAN, {1}, FALSE}, 198357bfbb2Smrg { -1, NULL, OPTV_NONE, {0}, FALSE} 199357bfbb2Smrg}; 200357bfbb2Smrg 201357bfbb2Smrgstatic XF86ModuleVersionInfo WsfbVersRec = { 202357bfbb2Smrg "wsfb", 203357bfbb2Smrg MODULEVENDORSTRING, 204357bfbb2Smrg MODINFOSTRING1, 205357bfbb2Smrg MODINFOSTRING2, 206357bfbb2Smrg XORG_VERSION_CURRENT, 207cba5e21cSmrg PACKAGE_VERSION_MAJOR, 208cba5e21cSmrg PACKAGE_VERSION_MINOR, 209357bfbb2Smrg PACKAGE_VERSION_PATCHLEVEL, 210357bfbb2Smrg ABI_CLASS_VIDEODRV, 211357bfbb2Smrg ABI_VIDEODRV_VERSION, 212357bfbb2Smrg NULL, 213357bfbb2Smrg {0, 0, 0, 0} 214357bfbb2Smrg}; 215357bfbb2Smrg 216357bfbb2Smrg_X_EXPORT XF86ModuleData wsfbModuleData = { &WsfbVersRec, WsfbSetup, NULL }; 217357bfbb2Smrg 218357bfbb2Smrgstatic pointer 219357bfbb2SmrgWsfbSetup(pointer module, pointer opts, int *errmaj, int *errmin) 220357bfbb2Smrg{ 221357bfbb2Smrg static Bool setupDone = FALSE; 222357bfbb2Smrg 2238a4fa5cdStsutsui#if !defined(__OpenBSD__) && !defined(__NetBSD__) 22472ee27a2Smrg return NULL; 22572ee27a2Smrg#endif 2268a4fa5cdStsutsui 227357bfbb2Smrg if (!setupDone) { 228357bfbb2Smrg setupDone = TRUE; 229357bfbb2Smrg xf86AddDriver(&WSFB, module, HaveDriverFuncs); 230357bfbb2Smrg return (pointer)1; 231357bfbb2Smrg } else { 232357bfbb2Smrg if (errmaj != NULL) 233357bfbb2Smrg *errmaj = LDR_ONCEONLY; 234357bfbb2Smrg return NULL; 235357bfbb2Smrg } 236357bfbb2Smrg} 237357bfbb2Smrg 238357bfbb2Smrgstatic Bool 239357bfbb2SmrgWsfbGetRec(ScrnInfoPtr pScrn) 240357bfbb2Smrg{ 241357bfbb2Smrg 242357bfbb2Smrg if (pScrn->driverPrivate != NULL) 243357bfbb2Smrg return TRUE; 244357bfbb2Smrg 245357bfbb2Smrg pScrn->driverPrivate = xnfcalloc(sizeof(WsfbRec), 1); 246357bfbb2Smrg return TRUE; 247357bfbb2Smrg} 248357bfbb2Smrg 249357bfbb2Smrgstatic void 250357bfbb2SmrgWsfbFreeRec(ScrnInfoPtr pScrn) 251357bfbb2Smrg{ 252357bfbb2Smrg 253357bfbb2Smrg if (pScrn->driverPrivate == NULL) 254357bfbb2Smrg return; 255cba5e21cSmrg free(pScrn->driverPrivate); 256357bfbb2Smrg pScrn->driverPrivate = NULL; 257357bfbb2Smrg} 258357bfbb2Smrg 259357bfbb2Smrgstatic const OptionInfoRec * 260357bfbb2SmrgWsfbAvailableOptions(int chipid, int busid) 261357bfbb2Smrg{ 262357bfbb2Smrg return WsfbOptions; 263357bfbb2Smrg} 264357bfbb2Smrg 265357bfbb2Smrgstatic void 266357bfbb2SmrgWsfbIdentify(int flags) 267357bfbb2Smrg{ 268357bfbb2Smrg xf86PrintChipsets(WSFB_NAME, "driver for wsdisplay framebuffer", 269357bfbb2Smrg WsfbChipsets); 270357bfbb2Smrg} 271357bfbb2Smrg 27264f08a18Smrg/* Open the framebuffer device. */ 273357bfbb2Smrgstatic int 274cba5e21cSmrgwsfb_open(const char *dev) 275357bfbb2Smrg{ 276357bfbb2Smrg int fd = -1; 277357bfbb2Smrg 278cba5e21cSmrg /* Try argument from xorg.conf first. */ 279357bfbb2Smrg if (dev == NULL || ((fd = priv_open_device(dev)) == -1)) { 28064f08a18Smrg /* Second: environment variable. */ 281357bfbb2Smrg dev = getenv("XDEVICE"); 282357bfbb2Smrg if (dev == NULL || ((fd = priv_open_device(dev)) == -1)) { 28364f08a18Smrg /* Last try: default device. */ 284357bfbb2Smrg dev = WSFB_DEFAULT_DEV; 285357bfbb2Smrg if ((fd = priv_open_device(dev)) == -1) { 286357bfbb2Smrg return -1; 287357bfbb2Smrg } 288357bfbb2Smrg } 289357bfbb2Smrg } 290357bfbb2Smrg return fd; 291357bfbb2Smrg} 292357bfbb2Smrg 29364f08a18Smrg/* Map the framebuffer's memory. */ 294357bfbb2Smrgstatic pointer 295357bfbb2Smrgwsfb_mmap(size_t len, off_t off, int fd) 296357bfbb2Smrg{ 297357bfbb2Smrg int pagemask, mapsize; 298357bfbb2Smrg caddr_t addr; 299357bfbb2Smrg pointer mapaddr; 300357bfbb2Smrg 301357bfbb2Smrg pagemask = getpagesize() - 1; 302357bfbb2Smrg mapsize = ((int) len + pagemask) & ~pagemask; 303357bfbb2Smrg addr = 0; 304357bfbb2Smrg 305357bfbb2Smrg /* 30664f08a18Smrg * Try and make it private first, that way once we get it, an 307357bfbb2Smrg * interloper, e.g. another server, can't get this frame buffer, 308357bfbb2Smrg * and if another server already has it, this one won't. 309357bfbb2Smrg */ 310357bfbb2Smrg mapaddr = (pointer) mmap(addr, mapsize, 311357bfbb2Smrg PROT_READ | PROT_WRITE, MAP_SHARED, 312357bfbb2Smrg fd, off); 3135d492fd2Smacallan if (mapaddr == MAP_FAILED) { 314357bfbb2Smrg mapaddr = NULL; 315357bfbb2Smrg } 316357bfbb2Smrg#if DEBUG 317357bfbb2Smrg ErrorF("mmap returns: addr %p len 0x%x\n", mapaddr, mapsize); 318357bfbb2Smrg#endif 319357bfbb2Smrg return mapaddr; 320357bfbb2Smrg} 321357bfbb2Smrg 322357bfbb2Smrgstatic Bool 323357bfbb2SmrgWsfbProbe(DriverPtr drv, int flags) 324357bfbb2Smrg{ 325357bfbb2Smrg int i, fd, entity; 3268a4fa5cdStsutsui GDevPtr *devSections; 327357bfbb2Smrg int numDevSections; 328cba5e21cSmrg const char *dev; 329357bfbb2Smrg Bool foundScreen = FALSE; 330357bfbb2Smrg 331357bfbb2Smrg TRACE("probe start"); 332357bfbb2Smrg 333357bfbb2Smrg /* For now, just bail out for PROBE_DETECT. */ 334357bfbb2Smrg if (flags & PROBE_DETECT) 335357bfbb2Smrg return FALSE; 336357bfbb2Smrg 337357bfbb2Smrg if ((numDevSections = xf86MatchDevice(WSFB_DRIVER_NAME, 338357bfbb2Smrg &devSections)) <= 0) 339357bfbb2Smrg return FALSE; 340357bfbb2Smrg 341357bfbb2Smrg for (i = 0; i < numDevSections; i++) { 342357bfbb2Smrg ScrnInfoPtr pScrn = NULL; 343357bfbb2Smrg 344357bfbb2Smrg dev = xf86FindOptionValue(devSections[i]->options, "device"); 345357bfbb2Smrg if ((fd = wsfb_open(dev)) >= 0) { 346357bfbb2Smrg entity = xf86ClaimFbSlot(drv, 0, devSections[i], TRUE); 347357bfbb2Smrg pScrn = xf86ConfigFbEntity(NULL,0,entity, 348357bfbb2Smrg NULL,NULL,NULL,NULL); 349357bfbb2Smrg if (pScrn != NULL) { 350357bfbb2Smrg foundScreen = TRUE; 351357bfbb2Smrg pScrn->driverVersion = WSFB_VERSION; 3528a4fa5cdStsutsui pScrn->driverName = (char *)WSFB_DRIVER_NAME; 3538a4fa5cdStsutsui pScrn->name = (char *)WSFB_NAME; 354357bfbb2Smrg pScrn->Probe = WsfbProbe; 355357bfbb2Smrg pScrn->PreInit = WsfbPreInit; 356357bfbb2Smrg pScrn->ScreenInit = WsfbScreenInit; 357357bfbb2Smrg pScrn->SwitchMode = WsfbSwitchMode; 358357bfbb2Smrg pScrn->AdjustFrame = NULL; 359357bfbb2Smrg pScrn->EnterVT = WsfbEnterVT; 360357bfbb2Smrg pScrn->LeaveVT = WsfbLeaveVT; 361357bfbb2Smrg pScrn->ValidMode = WsfbValidMode; 362357bfbb2Smrg 363357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_INFO, 364357bfbb2Smrg "using %s\n", dev != NULL ? dev : 365357bfbb2Smrg "default device"); 366357bfbb2Smrg } 367357bfbb2Smrg } 368357bfbb2Smrg } 369cba5e21cSmrg free(devSections); 370357bfbb2Smrg TRACE("probe done"); 371357bfbb2Smrg return foundScreen; 372357bfbb2Smrg} 373357bfbb2Smrg 374357bfbb2Smrgstatic Bool 375357bfbb2SmrgWsfbPreInit(ScrnInfoPtr pScrn, int flags) 376357bfbb2Smrg{ 377357bfbb2Smrg WsfbPtr fPtr; 3787b613f18Stsutsui int default_depth, bitsperpixel, wstype; 3798a4fa5cdStsutsui const char *dev; 3808a4fa5cdStsutsui const char *s; 381357bfbb2Smrg Gamma zeros = {0.0, 0.0, 0.0}; 382357bfbb2Smrg DisplayModePtr mode; 3835d492fd2Smacallan MessageType from; 384357bfbb2Smrg 385357bfbb2Smrg if (flags & PROBE_DETECT) return FALSE; 386357bfbb2Smrg 387357bfbb2Smrg TRACE_ENTER("PreInit"); 388357bfbb2Smrg 389357bfbb2Smrg if (pScrn->numEntities != 1) return FALSE; 390357bfbb2Smrg 391357bfbb2Smrg pScrn->monitor = pScrn->confScreen->monitor; 392357bfbb2Smrg 393357bfbb2Smrg WsfbGetRec(pScrn); 394357bfbb2Smrg fPtr = WSFBPTR(pScrn); 395357bfbb2Smrg 396357bfbb2Smrg fPtr->pEnt = xf86GetEntityInfo(pScrn->entityList[0]); 397357bfbb2Smrg 39864f08a18Smrg#if GET_ABI_MAJOR(ABI_VIDEODRV_VERSION) < 6 399357bfbb2Smrg pScrn->racMemFlags = RAC_FB | RAC_COLORMAP | RAC_CURSOR | RAC_VIEWPORT; 400357bfbb2Smrg pScrn->racIoFlags = pScrn->racMemFlags; 40164f08a18Smrg#endif 402357bfbb2Smrg 403357bfbb2Smrg dev = xf86FindOptionValue(fPtr->pEnt->device->options, "device"); 404357bfbb2Smrg fPtr->fd = wsfb_open(dev); 405357bfbb2Smrg if (fPtr->fd == -1) { 406357bfbb2Smrg return FALSE; 407357bfbb2Smrg } 408357bfbb2Smrg 4093306a6a4Sjandberg if (ioctl(fPtr->fd, WSDISPLAYIO_GTYPE, &wstype) == -1) { 4103306a6a4Sjandberg xf86DrvMsg(pScrn->scrnIndex, X_WARNING, 4113306a6a4Sjandberg "ioctl WSDISPLAY_GTYPE: %s\n", 4123306a6a4Sjandberg strerror(errno)); 4133306a6a4Sjandberg wstype = WSDISPLAY_TYPE_UNKNOWN; 4143306a6a4Sjandberg } 4153306a6a4Sjandberg 4163788fa92Smacallan if (ioctl(fPtr->fd, WSDISPLAYIO_GET_FBINFO, &fPtr->fbi) != 0) { 4173788fa92Smacallan struct wsdisplay_fbinfo info; 4183788fa92Smacallan struct wsdisplayio_fbinfo *fbi = &fPtr->fbi; 4193788fa92Smacallan int lb; 4203788fa92Smacallan 4213788fa92Smacallan xf86Msg(X_WARNING, "ioctl(WSDISPLAYIO_GET_FBINFO) failed, " \ 4223788fa92Smacallan "falling back to old method\n"); 4233788fa92Smacallan if (ioctl(fPtr->fd, WSDISPLAYIO_GINFO, &info) == -1) { 4243788fa92Smacallan xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 4253788fa92Smacallan "ioctl WSDISPLAY_GINFO: %s\n", 4263788fa92Smacallan strerror(errno)); 4273788fa92Smacallan return FALSE; 4283788fa92Smacallan } 4293788fa92Smacallan if (ioctl(fPtr->fd, WSDISPLAYIO_LINEBYTES, &lb) == -1) { 4303788fa92Smacallan xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 4313788fa92Smacallan "ioctl WSDISPLAYIO_LINEBYTES: %s\n", 4323788fa92Smacallan strerror(errno)); 4333788fa92Smacallan return FALSE; 4343788fa92Smacallan } 4353788fa92Smacallan /* ok, fake up a new style fbinfo */ 4363788fa92Smacallan fbi->fbi_width = info.width; 4373788fa92Smacallan fbi->fbi_height = info.height; 4383788fa92Smacallan fbi->fbi_stride = lb; 4393788fa92Smacallan fbi->fbi_bitsperpixel = info.depth; 4403788fa92Smacallan if (info.depth > 16) { 4413788fa92Smacallan fbi->fbi_pixeltype = WSFB_RGB; 4423788fa92Smacallan if (wstype == WSDISPLAY_TYPE_SUN24 || 4433788fa92Smacallan wstype == WSDISPLAY_TYPE_SUNCG12 || 4443788fa92Smacallan wstype == WSDISPLAY_TYPE_SUNCG14 || 4453788fa92Smacallan wstype == WSDISPLAY_TYPE_SUNTCX || 4463788fa92Smacallan wstype == WSDISPLAY_TYPE_SUNFFB || 4473788fa92Smacallan wstype == WSDISPLAY_TYPE_XVR1000 || 4483788fa92Smacallan wstype == WSDISPLAY_TYPE_VC4) { 4493788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.red_offset = 0; 4503788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.red_size = 8; 4513788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.green_offset = 8; 4523788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.green_size = 8; 4533788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.blue_offset = 16; 4543788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.blue_size = 8; 4553788fa92Smacallan } else { 4563788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.red_offset = 16; 4573788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.red_size = 8; 4583788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.green_offset = 8; 4593788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.green_size = 8; 4603788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.blue_offset = 0; 4613788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.blue_size = 8; 4623788fa92Smacallan } 4633788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.alpha_offset = 0; 4643788fa92Smacallan fbi->fbi_subtype.fbi_rgbmasks.alpha_size = 0; 4653788fa92Smacallan } else if (info.depth <= 8) { 4663788fa92Smacallan fbi->fbi_pixeltype = WSFB_CI; 4673788fa92Smacallan fbi->fbi_subtype.fbi_cmapinfo.cmap_entries = info.cmsize; 4683788fa92Smacallan } 4693788fa92Smacallan fbi->fbi_flags = 0; 4700d003323Stsutsui fbi->fbi_fbsize = lb * info.height; 4718fbcba3dSrin#ifdef WSDISPLAY_TYPE_LUNA 4728fbcba3dSrin if (wstype == WSDISPLAY_TYPE_LUNA) { 4738fbcba3dSrin /* 4748fbcba3dSrin * XXX 4758fbcba3dSrin * LUNA's FB seems to have 64 dot (8 byte) offset. 4768fbcba3dSrin * This might be able to be changed in kernel 4778fbcba3dSrin * lunafb driver, but current setting was pulled 4788fbcba3dSrin * from 4.4BSD-Lite2/luna68k. 4798fbcba3dSrin */ 4808fbcba3dSrin fbi->fbi_fboffset = 8; 4818fbcba3dSrin } else 4828fbcba3dSrin#endif 4838fbcba3dSrin fbi->fbi_fboffset = 0; 484357bfbb2Smrg } 4858fbcba3dSrin xf86Msg(X_INFO, "fboffset %x\n", (int)fPtr->fbi.fbi_fboffset); 486357bfbb2Smrg /* 48764f08a18Smrg * Allocate room for saving the colormap. 488357bfbb2Smrg */ 489b8199fcbStsutsui if (fPtr->fbi.fbi_pixeltype == WSFB_CI && 490b8199fcbStsutsui fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries > 0) { 491357bfbb2Smrg fPtr->saved_cmap.red = 492cba5e21cSmrg (unsigned char *)malloc(fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries); 493357bfbb2Smrg if (fPtr->saved_cmap.red == NULL) { 494357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 4953788fa92Smacallan "Cannot malloc %d bytes\n", 4963788fa92Smacallan fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries); 497357bfbb2Smrg return FALSE; 498357bfbb2Smrg } 499357bfbb2Smrg fPtr->saved_cmap.green = 500cba5e21cSmrg (unsigned char *)malloc(fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries); 501357bfbb2Smrg if (fPtr->saved_cmap.green == NULL) { 502357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 5033788fa92Smacallan "Cannot malloc %d bytes\n", 5043788fa92Smacallan fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries); 505cba5e21cSmrg free(fPtr->saved_cmap.red); 506357bfbb2Smrg return FALSE; 507357bfbb2Smrg } 508357bfbb2Smrg fPtr->saved_cmap.blue = 509cba5e21cSmrg (unsigned char *)malloc(fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries); 510357bfbb2Smrg if (fPtr->saved_cmap.blue == NULL) { 511357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 5123788fa92Smacallan "Cannot malloc %d bytes\n", 5133788fa92Smacallan fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries); 514cba5e21cSmrg free(fPtr->saved_cmap.red); 515cba5e21cSmrg free(fPtr->saved_cmap.green); 516357bfbb2Smrg return FALSE; 517357bfbb2Smrg } 518357bfbb2Smrg } 519357bfbb2Smrg 520357bfbb2Smrg /* Handle depth */ 5213788fa92Smacallan default_depth = fPtr->fbi.fbi_bitsperpixel <= 24 ? fPtr->fbi.fbi_bitsperpixel : 24; 522e686e132Srin bitsperpixel = fPtr->fbi.fbi_bitsperpixel == 15 ? 16 : fPtr->fbi.fbi_bitsperpixel; 5237b613f18Stsutsui#if defined(__NetBSD__) && defined(WSDISPLAY_TYPE_LUNA) 5247b613f18Stsutsui if (wstype == WSDISPLAY_TYPE_LUNA) { 5257b613f18Stsutsui /* 5267b613f18Stsutsui * LUNA's color framebuffers support 4bpp or 8bpp 5277b613f18Stsutsui * but they have multiple 1bpp VRAM planes like ancient VGA. 5287b613f18Stsutsui */ 529c2056409Stsutsui#ifdef HAVE_SHADOW_AFB 530c2056409Stsutsui if (bitsperpixel == 8) { 531c2056409Stsutsui /* 532c2056409Stsutsui * For 8bpp one, we can use the bitplane ops with 533c2056409Stsutsui * shadow update proc as amiga. 534c2056409Stsutsui */ 535c2056409Stsutsui fPtr->planarAfb = TRUE; 536c2056409Stsutsui } else 537c2056409Stsutsui#endif 538c2056409Stsutsui { 539c2056409Stsutsui /* 540c2056409Stsutsui * For 4bpp one (or there is no planar support), 541c2056409Stsutsui * just use only the first one plane 542c2056409Stsutsui * as 1bpp monochrome server. 543c2056409Stsutsui * 544c2056409Stsutsui * Note OpenBSD/luna88k workarounds this by 545c2056409Stsutsui * switching depth and palette settings by 546c2056409Stsutsui * WSDISPLAYIO_SETGFXMODE ioctl. 547c2056409Stsutsui */ 548c2056409Stsutsui default_depth = 1; 549c2056409Stsutsui bitsperpixel = 1; 550c2056409Stsutsui } 5517b613f18Stsutsui } 5527b613f18Stsutsui#endif 553b4fe077eSrin#ifdef WSDISPLAY_TYPE_AMIGACC 554bb2f4479Srin if (wstype == WSDISPLAY_TYPE_AMIGACC) { 5553306a6a4Sjandberg /* 5563306a6a4Sjandberg * Video memory is organized in bitplanes. 5573306a6a4Sjandberg * 8bpp or 1bpp supported in this driver. 5583306a6a4Sjandberg * With 8bpp conversion to bitplane format 5593306a6a4Sjandberg * is done in shadow update proc. 5603306a6a4Sjandberg * With 1bpp no conversion needed. 5613306a6a4Sjandberg */ 562dc9c99a5Stsutsui#ifdef HAVE_SHADOW_AFB 5633306a6a4Sjandberg if (bitsperpixel == 8) { 5643306a6a4Sjandberg fPtr->planarAfb = TRUE; 5650bb1e2adSrin } else 566dc9c99a5Stsutsui#endif 5670bb1e2adSrin { 5683306a6a4Sjandberg default_depth = 1; 5693306a6a4Sjandberg bitsperpixel = 1; 5703306a6a4Sjandberg } 5713306a6a4Sjandberg } 5723306a6a4Sjandberg#endif 5733306a6a4Sjandberg 574357bfbb2Smrg if (!xf86SetDepthBpp(pScrn, default_depth, default_depth, 5757b613f18Stsutsui bitsperpixel, 5767b613f18Stsutsui bitsperpixel >= 24 ? Support24bppFb|Support32bppFb : 0)) 577357bfbb2Smrg return FALSE; 578357bfbb2Smrg 57964f08a18Smrg /* Check consistency. */ 5807b613f18Stsutsui if (pScrn->bitsPerPixel != bitsperpixel) { 581357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 582357bfbb2Smrg "specified depth (%d) or bpp (%d) doesn't match " 583cba5e21cSmrg "framebuffer depth (%d)\n", pScrn->depth, 5847b613f18Stsutsui pScrn->bitsPerPixel, bitsperpixel); 585357bfbb2Smrg return FALSE; 586357bfbb2Smrg } 587357bfbb2Smrg xf86PrintDepthBpp(pScrn); 588357bfbb2Smrg 58964f08a18Smrg /* Get the depth24 pixmap format. */ 590357bfbb2Smrg if (pScrn->depth == 24 && pix24bpp == 0) 591357bfbb2Smrg pix24bpp = xf86GetBppFromDepth(pScrn, 24); 592357bfbb2Smrg 5930ef55ed1Smacallan /* Handle options. */ 5940ef55ed1Smacallan xf86CollectOptions(pScrn, NULL); 5950ef55ed1Smacallan fPtr->Options = (OptionInfoRec *)malloc(sizeof(WsfbOptions)); 5960ef55ed1Smacallan if (fPtr->Options == NULL) 5970ef55ed1Smacallan return FALSE; 5980ef55ed1Smacallan memcpy(fPtr->Options, WsfbOptions, sizeof(WsfbOptions)); 5990ef55ed1Smacallan xf86ProcessOptions(pScrn->scrnIndex, fPtr->pEnt->device->options, 6000ef55ed1Smacallan fPtr->Options); 6010ef55ed1Smacallan 6020ef55ed1Smacallan /* Use shadow framebuffer by default, on depth >= 8 */ 6030ef55ed1Smacallan xf86Msg(X_INFO, "fbi_flags: %x\n", fPtr->fbi.fbi_flags); 6040ef55ed1Smacallan if ((pScrn->depth >= 8) && 6050ef55ed1Smacallan ((fPtr->fbi.fbi_flags & WSFB_VRAM_IS_RAM) == 0)) { 6060ef55ed1Smacallan fPtr->shadowFB = xf86ReturnOptValBool(fPtr->Options, 6070ef55ed1Smacallan OPTION_SHADOW_FB, TRUE); 6080ef55ed1Smacallan } else 6090ef55ed1Smacallan if (xf86ReturnOptValBool(fPtr->Options, 6100ef55ed1Smacallan OPTION_SHADOW_FB, FALSE)) { 6110ef55ed1Smacallan xf86DrvMsg(pScrn->scrnIndex, X_WARNING, 612b3c77fccStsutsui "Shadow FB option ignored on depth < 8\n"); 6130ef55ed1Smacallan } 614cbc9a668Smacallan if (fPtr->fbi.fbi_flags & WSFB_VRAM_IS_SPLIT) { 615cbc9a668Smacallan if (!fPtr->shadowFB) { 616cbc9a668Smacallan xf86DrvMsg(pScrn->scrnIndex, X_WARNING, 617b3c77fccStsutsui "Shadow FB forced on for split framebuffer\n"); 618cbc9a668Smacallan fPtr->shadowFB = TRUE; 619cbc9a668Smacallan } 620cbc9a668Smacallan } 621bff82b7eSjmcneill 622bff82b7eSjmcneill fPtr->useRGB16ToYUY2 = FALSE; 623bff82b7eSjmcneill#ifdef WSDISPLAY_TYPE_HOLLYWOOD 624bff82b7eSjmcneill if (wstype == WSDISPLAY_TYPE_HOLLYWOOD) { 625bff82b7eSjmcneill xf86DrvMsg(pScrn->scrnIndex, X_INFO, 626bff82b7eSjmcneill "Enabling RGB16->YUY2 conversion for Hollywood\n"); 627bff82b7eSjmcneill fPtr->useRGB16ToYUY2 = TRUE; 628bff82b7eSjmcneill if (!fPtr->shadowFB) { 629bff82b7eSjmcneill xf86DrvMsg(pScrn->scrnIndex, X_WARNING, 630bff82b7eSjmcneill "Shadow FB forced on for RGB16->YUY2 conversion\n"); 631bff82b7eSjmcneill fPtr->shadowFB = TRUE; 632bff82b7eSjmcneill } 633bff82b7eSjmcneill /* 634bff82b7eSjmcneill * Hollywood has a YUY2 framebuffer, but we treat it as 635bff82b7eSjmcneill * RGB565 and convert with a custom shadowproc. 636bff82b7eSjmcneill */ 637bff82b7eSjmcneill fPtr->fbi.fbi_pixeltype = WSFB_RGB; 638bff82b7eSjmcneill } 639bff82b7eSjmcneill#endif 6400ef55ed1Smacallan /* Rotation */ 6410ef55ed1Smacallan fPtr->rotate = WSFB_ROTATE_NONE; 6420ef55ed1Smacallan if ((s = xf86GetOptValString(fPtr->Options, OPTION_ROTATE))) { 6430ef55ed1Smacallan if (pScrn->depth >= 8) { 6440ef55ed1Smacallan if (!xf86NameCmp(s, "CW")) { 6450ef55ed1Smacallan fPtr->shadowFB = TRUE; 6460ef55ed1Smacallan fPtr->rotate = WSFB_ROTATE_CW; 6470ef55ed1Smacallan xf86DrvMsg(pScrn->scrnIndex, X_CONFIG, 6480ef55ed1Smacallan "Rotating screen clockwise\n"); 6490ef55ed1Smacallan } else if (!xf86NameCmp(s, "CCW")) { 6500ef55ed1Smacallan fPtr->shadowFB = TRUE; 6510ef55ed1Smacallan fPtr->rotate = WSFB_ROTATE_CCW; 6520ef55ed1Smacallan xf86DrvMsg(pScrn->scrnIndex, X_CONFIG, 6530ef55ed1Smacallan "Rotating screen counter clockwise\n"); 6540ef55ed1Smacallan } else if (!xf86NameCmp(s, "UD")) { 6550ef55ed1Smacallan fPtr->shadowFB = TRUE; 6560ef55ed1Smacallan fPtr->rotate = WSFB_ROTATE_UD; 6570ef55ed1Smacallan xf86DrvMsg(pScrn->scrnIndex, X_CONFIG, 6580ef55ed1Smacallan "Rotating screen upside down\n"); 6590ef55ed1Smacallan } else { 6600ef55ed1Smacallan xf86DrvMsg(pScrn->scrnIndex, X_CONFIG, 6610ef55ed1Smacallan "\"%s\" is not a valid value for Option " 6620ef55ed1Smacallan "\"Rotate\"\n", s); 6630ef55ed1Smacallan xf86DrvMsg(pScrn->scrnIndex, X_INFO, 6640ef55ed1Smacallan "Valid options are \"CW\", \"CCW\"," 6650ef55ed1Smacallan " or \"UD\"\n"); 6660ef55ed1Smacallan } 6670ef55ed1Smacallan } else { 6680ef55ed1Smacallan xf86DrvMsg(pScrn->scrnIndex, X_WARNING, 669b3c77fccStsutsui "Option \"Rotate\" ignored on depth < 8\n"); 6700ef55ed1Smacallan } 6710ef55ed1Smacallan } 6720ef55ed1Smacallan 6730ef55ed1Smacallan 6740ef55ed1Smacallan fPtr->useSwap32 = FALSE; 67564f08a18Smrg /* Color weight */ 6763788fa92Smacallan if (fPtr->fbi.fbi_pixeltype == WSFB_RGB) { 677357bfbb2Smrg rgb zeros = { 0, 0, 0 }, masks; 678357bfbb2Smrg 6793788fa92Smacallan if (fPtr->fbi.fbi_subtype.fbi_rgbmasks.red_size > 0) { 6803788fa92Smacallan uint32_t msk; 6813788fa92Smacallan 6820ef55ed1Smacallan /* 6830ef55ed1Smacallan * see if we need to byte-swap pixels 6840ef55ed1Smacallan * XXX this requires a shadow FB and is incompatible 6850ef55ed1Smacallan * (for now ) with rotation 6860ef55ed1Smacallan */ 6870ef55ed1Smacallan if ((fPtr->fbi.fbi_bitsperpixel == 32) && 6880ef55ed1Smacallan (fPtr->fbi.fbi_subtype.fbi_rgbmasks.blue_offset == 24) && 6890ef55ed1Smacallan (fPtr->rotate == WSFB_ROTATE_NONE) && 6900ef55ed1Smacallan (fPtr->shadowFB == TRUE)) { 6910ef55ed1Smacallan /* 6920ef55ed1Smacallan * looks like BGRA - set the swap flag and flip 6930ef55ed1Smacallan * the offsets 6940ef55ed1Smacallan */ 6950ef55ed1Smacallan xf86Msg(X_INFO, "endian-flipped RGB framebuffer " 6960ef55ed1Smacallan "detected, using WsfbShadowUpdateSwap32()\n"); 6970ef55ed1Smacallan fPtr->fbi.fbi_subtype.fbi_rgbmasks.blue_offset = 0; 6980ef55ed1Smacallan fPtr->fbi.fbi_subtype.fbi_rgbmasks.green_offset = 8; 6990ef55ed1Smacallan fPtr->fbi.fbi_subtype.fbi_rgbmasks.red_offset = 16; 7000ef55ed1Smacallan fPtr->fbi.fbi_subtype.fbi_rgbmasks.alpha_offset = 24; 7010ef55ed1Smacallan fPtr->useSwap32 = TRUE; 7020ef55ed1Smacallan } 7030ef55ed1Smacallan 7043788fa92Smacallan msk = 0xffffffff; 7053788fa92Smacallan msk = msk << fPtr->fbi.fbi_subtype.fbi_rgbmasks.red_size; 7063788fa92Smacallan msk = ~msk; 7073788fa92Smacallan masks.red = msk << fPtr->fbi.fbi_subtype.fbi_rgbmasks.red_offset; 7083788fa92Smacallan 7093788fa92Smacallan msk = 0xffffffff; 7103788fa92Smacallan msk = msk << fPtr->fbi.fbi_subtype.fbi_rgbmasks.green_size; 7113788fa92Smacallan msk = ~msk; 7123788fa92Smacallan masks.green = msk << fPtr->fbi.fbi_subtype.fbi_rgbmasks.green_offset; 7133788fa92Smacallan 7143788fa92Smacallan msk = 0xffffffff; 7153788fa92Smacallan msk = msk << fPtr->fbi.fbi_subtype.fbi_rgbmasks.blue_size; 7163788fa92Smacallan msk = ~msk; 7173788fa92Smacallan masks.blue = msk << fPtr->fbi.fbi_subtype.fbi_rgbmasks.blue_offset; 71853d96324Sapb xf86Msg(X_INFO, "masks generated: %08lx %08lx %08lx\n", 71953d96324Sapb (unsigned long)masks.red, 72053d96324Sapb (unsigned long)masks.green, 72153d96324Sapb (unsigned long)masks.blue); 722357bfbb2Smrg } else { 723357bfbb2Smrg masks.red = 0; 724357bfbb2Smrg masks.green = 0; 725357bfbb2Smrg masks.blue = 0; 726357bfbb2Smrg } 727357bfbb2Smrg 728357bfbb2Smrg if (!xf86SetWeight(pScrn, zeros, masks)) 729357bfbb2Smrg return FALSE; 730357bfbb2Smrg } 731357bfbb2Smrg 73264f08a18Smrg /* Visual init */ 733357bfbb2Smrg if (!xf86SetDefaultVisual(pScrn, -1)) 734357bfbb2Smrg return FALSE; 735357bfbb2Smrg 73664f08a18Smrg /* We don't currently support DirectColor at > 8bpp . */ 737357bfbb2Smrg if (pScrn->depth > 8 && pScrn->defaultVisual != TrueColor) { 738357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, "Given default visual" 739357bfbb2Smrg " (%s) is not supported at depth %d\n", 740357bfbb2Smrg xf86GetVisualName(pScrn->defaultVisual), 741357bfbb2Smrg pScrn->depth); 742357bfbb2Smrg return FALSE; 743357bfbb2Smrg } 744357bfbb2Smrg 745357bfbb2Smrg xf86SetGamma(pScrn,zeros); 746357bfbb2Smrg 747357bfbb2Smrg pScrn->progClock = TRUE; 7488fc0431cStsutsui pScrn->rgbBits = (pScrn->depth >= 8) ? 8 : pScrn->depth; 7498a4fa5cdStsutsui pScrn->chipset = (char *)"wsfb"; 7503788fa92Smacallan pScrn->videoRam = fPtr->fbi.fbi_fbsize; 751357bfbb2Smrg 752357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_INFO, "Vidmem: %dk\n", 753357bfbb2Smrg pScrn->videoRam/1024); 754357bfbb2Smrg 75564f08a18Smrg /* Fake video mode struct. */ 756cba5e21cSmrg mode = (DisplayModePtr)malloc(sizeof(DisplayModeRec)); 757357bfbb2Smrg mode->prev = mode; 758357bfbb2Smrg mode->next = mode; 7598a4fa5cdStsutsui mode->name = (char *)"wsfb current mode"; 760357bfbb2Smrg mode->status = MODE_OK; 761357bfbb2Smrg mode->type = M_T_BUILTIN; 762357bfbb2Smrg mode->Clock = 0; 7633788fa92Smacallan mode->HDisplay = fPtr->fbi.fbi_width; 764357bfbb2Smrg mode->HSyncStart = 0; 765357bfbb2Smrg mode->HSyncEnd = 0; 766357bfbb2Smrg mode->HTotal = 0; 767357bfbb2Smrg mode->HSkew = 0; 7683788fa92Smacallan mode->VDisplay = fPtr->fbi.fbi_height; 769357bfbb2Smrg mode->VSyncStart = 0; 770357bfbb2Smrg mode->VSyncEnd = 0; 771357bfbb2Smrg mode->VTotal = 0; 772357bfbb2Smrg mode->VScan = 0; 773357bfbb2Smrg mode->Flags = 0; 774357bfbb2Smrg if (pScrn->modes != NULL) { 775357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_INFO, 776357bfbb2Smrg "Ignoring mode specification from screen section\n"); 777357bfbb2Smrg } 778357bfbb2Smrg pScrn->currentMode = pScrn->modes = mode; 7793788fa92Smacallan pScrn->virtualX = fPtr->fbi.fbi_width; 7803788fa92Smacallan pScrn->virtualY = fPtr->fbi.fbi_height; 781357bfbb2Smrg pScrn->displayWidth = pScrn->virtualX; 782357bfbb2Smrg 78364f08a18Smrg /* Set the display resolution. */ 784357bfbb2Smrg xf86SetDpi(pScrn, 0, 0); 785357bfbb2Smrg 7865d492fd2Smacallan from = X_DEFAULT; 7875d492fd2Smacallan fPtr->HWCursor = TRUE; 7885d492fd2Smacallan if (xf86GetOptValBool(fPtr->Options, OPTION_HW_CURSOR, &fPtr->HWCursor)) 7895d492fd2Smacallan from = X_CONFIG; 7905d492fd2Smacallan if (xf86ReturnOptValBool(fPtr->Options, OPTION_SW_CURSOR, FALSE)) { 7915d492fd2Smacallan from = X_CONFIG; 7925d492fd2Smacallan fPtr->HWCursor = FALSE; 7935d492fd2Smacallan } 7945d492fd2Smacallan xf86DrvMsg(pScrn->scrnIndex, from, "Using %s cursor\n", 7955d492fd2Smacallan fPtr->HWCursor ? "HW" : "SW"); 7965d492fd2Smacallan 797357bfbb2Smrg 79864f08a18Smrg /* Load shadow if needed. */ 799357bfbb2Smrg if (fPtr->shadowFB) { 800357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_CONFIG, 801357bfbb2Smrg "Using \"Shadow Framebuffer\"\n"); 802357bfbb2Smrg if (xf86LoadSubModule(pScrn, "shadow") == NULL) { 803357bfbb2Smrg WsfbFreeRec(pScrn); 804357bfbb2Smrg return FALSE; 805357bfbb2Smrg } 806357bfbb2Smrg } 8078a4fa5cdStsutsui if (xf86LoadSubModule(pScrn, "fb") == NULL) { 808357bfbb2Smrg WsfbFreeRec(pScrn); 809357bfbb2Smrg return FALSE; 810357bfbb2Smrg } 8115d492fd2Smacallan 8125d492fd2Smacallan if (xf86LoadSubModule(pScrn, "ramdac") == NULL) { 8135d492fd2Smacallan WsfbFreeRec(pScrn); 8145d492fd2Smacallan return FALSE; 8155d492fd2Smacallan } 8165d492fd2Smacallan 817357bfbb2Smrg TRACE_EXIT("PreInit"); 818357bfbb2Smrg return TRUE; 819357bfbb2Smrg} 820357bfbb2Smrg 8218a4fa5cdStsutsuistatic void 8228a4fa5cdStsutsuiwsfbUpdateRotatePacked(ScreenPtr pScreen, shadowBufPtr pBuf) 8238a4fa5cdStsutsui{ 8248a4fa5cdStsutsui shadowUpdateRotatePacked(pScreen, pBuf); 8258a4fa5cdStsutsui} 8268a4fa5cdStsutsui 8278a4fa5cdStsutsuistatic void 8288a4fa5cdStsutsuiwsfbUpdatePacked(ScreenPtr pScreen, shadowBufPtr pBuf) 8298a4fa5cdStsutsui{ 8308a4fa5cdStsutsui shadowUpdatePacked(pScreen, pBuf); 8318a4fa5cdStsutsui} 8328a4fa5cdStsutsui 833357bfbb2Smrgstatic Bool 834357bfbb2SmrgWsfbCreateScreenResources(ScreenPtr pScreen) 835357bfbb2Smrg{ 8368a4fa5cdStsutsui ScrnInfoPtr pScrn = xf86ScreenToScrn(pScreen); 837357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 838357bfbb2Smrg PixmapPtr pPixmap; 839357bfbb2Smrg Bool ret; 840cbc9a668Smacallan void (*shadowproc)(ScreenPtr, shadowBufPtr); 8413306a6a4Sjandberg ShadowWindowProc windowproc = WsfbWindowLinear; 842357bfbb2Smrg 843357bfbb2Smrg pScreen->CreateScreenResources = fPtr->CreateScreenResources; 844357bfbb2Smrg ret = pScreen->CreateScreenResources(pScreen); 845357bfbb2Smrg pScreen->CreateScreenResources = WsfbCreateScreenResources; 846357bfbb2Smrg 847357bfbb2Smrg if (!ret) 848357bfbb2Smrg return FALSE; 849357bfbb2Smrg 850357bfbb2Smrg pPixmap = pScreen->GetScreenPixmap(pScreen); 851cbc9a668Smacallan if (fPtr->fbi.fbi_flags & WSFB_VRAM_IS_SPLIT) { 852cbc9a668Smacallan shadowproc = WsfbShadowUpdateSplit; 853bff82b7eSjmcneill } else if (fPtr->useRGB16ToYUY2) { 854bff82b7eSjmcneill /* Build RGB16 to Y, U, and V lookup tables */ 855bff82b7eSjmcneill if (mapRGB16ToY == NULL) { 856bff82b7eSjmcneill mapRGB16ToY = malloc(0x30000); 857bff82b7eSjmcneill if (mapRGB16ToY == NULL) { 858bff82b7eSjmcneill xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 859bff82b7eSjmcneill "Cannot malloc %d bytes for RGB16->YUY2\n", 860bff82b7eSjmcneill 0x30000); 861bff82b7eSjmcneill return FALSE; 862bff82b7eSjmcneill } 863bff82b7eSjmcneill mapRGB16ToU = mapRGB16ToY + 0x10000; 864bff82b7eSjmcneill mapRGB16ToV = mapRGB16ToY + 0x20000; 865bff82b7eSjmcneill for (unsigned int n = 0; n < 0x10000; n++) { 866bff82b7eSjmcneill /* RGB565 values, scaled to 8 bits */ 867bff82b7eSjmcneill const double R = (((n >> 11) & 0x1f) * 255) / 31; 868bff82b7eSjmcneill const double G = (((n >> 5) & 0x3f) * 255) / 63; 869bff82b7eSjmcneill const double B = (((n >> 0) & 0x1f) * 255) / 31; 870bff82b7eSjmcneill 871bff82b7eSjmcneill /* Convert to YUV */ 872bff82b7eSjmcneill mapRGB16ToY[n] = 873bff82b7eSjmcneill 0.257 * R + 0.504 * G + 0.098 * B + 16; 874bff82b7eSjmcneill mapRGB16ToU[n] = 875bff82b7eSjmcneill -0.148 * R - 0.291 * G + 0.439 * B + 128; 876bff82b7eSjmcneill mapRGB16ToV[n] = 877bff82b7eSjmcneill 0.439 * R - 0.368 * G - 0.071 * B + 128; 878bff82b7eSjmcneill } 879bff82b7eSjmcneill } 880bff82b7eSjmcneill 881bff82b7eSjmcneill shadowproc = WsfbShadowUpdateRGB16ToYUY2; 882cbc9a668Smacallan } else if (fPtr->useSwap32) { 883cbc9a668Smacallan shadowproc = WsfbShadowUpdateSwap32; 884cbc9a668Smacallan } else if (fPtr->rotate) { 8858a4fa5cdStsutsui shadowproc = wsfbUpdateRotatePacked; 886dc9c99a5Stsutsui } else 887dc9c99a5Stsutsui#ifdef HAVE_SHADOW_AFB 888dc9c99a5Stsutsui if (fPtr->planarAfb) { 8893306a6a4Sjandberg shadowproc = shadowUpdateAfb8; 8903306a6a4Sjandberg windowproc = WsfbWindowAfb; 891cbc9a668Smacallan } else 892dc9c99a5Stsutsui#endif 893dc9c99a5Stsutsui { 8948a4fa5cdStsutsui shadowproc = wsfbUpdatePacked; 895dc9c99a5Stsutsui } 896cbc9a668Smacallan 897cbc9a668Smacallan if (!shadowAdd(pScreen, pPixmap, shadowproc, 8983306a6a4Sjandberg windowproc, fPtr->rotate, NULL)) { 899357bfbb2Smrg return FALSE; 900357bfbb2Smrg } 901357bfbb2Smrg return TRUE; 902357bfbb2Smrg} 903357bfbb2Smrg 904357bfbb2Smrg 905357bfbb2Smrgstatic Bool 906357bfbb2SmrgWsfbShadowInit(ScreenPtr pScreen) 907357bfbb2Smrg{ 9088a4fa5cdStsutsui ScrnInfoPtr pScrn = xf86ScreenToScrn(pScreen); 909357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 910357bfbb2Smrg 911357bfbb2Smrg if (!shadowSetup(pScreen)) 912357bfbb2Smrg return FALSE; 913357bfbb2Smrg fPtr->CreateScreenResources = pScreen->CreateScreenResources; 914357bfbb2Smrg pScreen->CreateScreenResources = WsfbCreateScreenResources; 915357bfbb2Smrg 916357bfbb2Smrg return TRUE; 917357bfbb2Smrg} 918357bfbb2Smrg 919357bfbb2Smrgstatic Bool 9209974adabSmrgWsfbScreenInit(SCREEN_INIT_ARGS_DECL) 921357bfbb2Smrg{ 9228a4fa5cdStsutsui ScrnInfoPtr pScrn = xf86ScreenToScrn(pScreen); 923357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 924357bfbb2Smrg VisualPtr visual; 925357bfbb2Smrg int ret, flags, ncolors; 926357bfbb2Smrg int wsmode = WSDISPLAYIO_MODE_DUMBFB; 9278fc0431cStsutsui int wstype; 928fe5fcf53Stsutsui int width; 929357bfbb2Smrg size_t len; 930357bfbb2Smrg 931357bfbb2Smrg TRACE_ENTER("WsfbScreenInit"); 932357bfbb2Smrg#if DEBUG 933357bfbb2Smrg ErrorF("\tbitsPerPixel=%d, depth=%d, defaultVisual=%s\n" 934357bfbb2Smrg "\tmask: %x,%x,%x, offset: %u,%u,%u\n", 935357bfbb2Smrg pScrn->bitsPerPixel, 936357bfbb2Smrg pScrn->depth, 937357bfbb2Smrg xf86GetVisualName(pScrn->defaultVisual), 938357bfbb2Smrg pScrn->mask.red,pScrn->mask.green,pScrn->mask.blue, 939357bfbb2Smrg pScrn->offset.red,pScrn->offset.green,pScrn->offset.blue); 940357bfbb2Smrg#endif 9413788fa92Smacallan switch (fPtr->fbi.fbi_bitsperpixel) { 942357bfbb2Smrg case 1: 943357bfbb2Smrg case 4: 944357bfbb2Smrg case 8: 9453788fa92Smacallan len = fPtr->fbi.fbi_stride * fPtr->fbi.fbi_height; 9463e8a0de0Stsutsui#ifdef HAVE_SHADOW_AFB 9473e8a0de0Stsutsui if (fPtr->planarAfb) { 9483e8a0de0Stsutsui /* 9493e8a0de0Stsutsui * stride is "bytes per line" for each plane so 9503e8a0de0Stsutsui * we need a number of planes to mmap in planar case. 9513e8a0de0Stsutsui */ 9523e8a0de0Stsutsui len *= fPtr->fbi.fbi_bitsperpixel; 9533e8a0de0Stsutsui } 9543e8a0de0Stsutsui#endif 9553e8a0de0Stsutsui 956357bfbb2Smrg break; 957e686e132Srin case 15: 958357bfbb2Smrg case 16: 9593788fa92Smacallan if (fPtr->fbi.fbi_stride == fPtr->fbi.fbi_width) { 9603788fa92Smacallan len = fPtr->fbi.fbi_width * fPtr->fbi.fbi_height * sizeof(short); 961357bfbb2Smrg } else { 9623788fa92Smacallan len = fPtr->fbi.fbi_stride * fPtr->fbi.fbi_height; 963357bfbb2Smrg } 964357bfbb2Smrg break; 965357bfbb2Smrg case 24: 9663788fa92Smacallan if (fPtr->fbi.fbi_stride == fPtr->fbi.fbi_width) { 9673788fa92Smacallan len = fPtr->fbi.fbi_width * fPtr->fbi.fbi_height * 3; 968357bfbb2Smrg } else { 9693788fa92Smacallan len = fPtr->fbi.fbi_stride * fPtr->fbi.fbi_height; 970357bfbb2Smrg } 971357bfbb2Smrg break; 972357bfbb2Smrg case 32: 9733788fa92Smacallan if (fPtr->fbi.fbi_stride == fPtr->fbi.fbi_width) { 9743788fa92Smacallan len = fPtr->fbi.fbi_width * fPtr->fbi.fbi_height * sizeof(int); 975357bfbb2Smrg } else { 9763788fa92Smacallan len = fPtr->fbi.fbi_stride * fPtr->fbi.fbi_height; 977357bfbb2Smrg } 978357bfbb2Smrg break; 979357bfbb2Smrg default: 980357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 9813788fa92Smacallan "unsupported depth %d\n", fPtr->fbi.fbi_bitsperpixel); 982357bfbb2Smrg return FALSE; 983357bfbb2Smrg } 98464f08a18Smrg /* Switch to graphics mode - required before mmap. */ 985357bfbb2Smrg if (ioctl(fPtr->fd, WSDISPLAYIO_SMODE, &wsmode) == -1) { 986357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 987357bfbb2Smrg "ioctl WSDISPLAYIO_SMODE: %s\n", 988357bfbb2Smrg strerror(errno)); 989357bfbb2Smrg return FALSE; 990357bfbb2Smrg } 9918fc0431cStsutsui /* Get wsdisplay type to handle quirks */ 9928fc0431cStsutsui if (ioctl(fPtr->fd, WSDISPLAYIO_GTYPE, &wstype) == -1) { 9938fc0431cStsutsui xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 9948fc0431cStsutsui "ioctl WSDISPLAY_GTYPE: %s\n", 9958fc0431cStsutsui strerror(errno)); 9968fc0431cStsutsui return FALSE; 9978fc0431cStsutsui } 998cbc9a668Smacallan len = max(len, fPtr->fbi.fbi_fbsize); 9998fbcba3dSrin fPtr->fbmem = wsfb_mmap(len + fPtr->fbi.fbi_fboffset, 0, fPtr->fd); 1000357bfbb2Smrg 1001357bfbb2Smrg if (fPtr->fbmem == NULL) { 1002357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 1003357bfbb2Smrg "wsfb_mmap: %s\n", strerror(errno)); 1004357bfbb2Smrg return FALSE; 1005357bfbb2Smrg } 1006357bfbb2Smrg fPtr->fbmem_len = len; 1007357bfbb2Smrg 1008357bfbb2Smrg WsfbSave(pScrn); 1009357bfbb2Smrg pScrn->vtSema = TRUE; 1010357bfbb2Smrg 101164f08a18Smrg /* MI layer */ 1012357bfbb2Smrg miClearVisualTypes(); 1013357bfbb2Smrg if (pScrn->bitsPerPixel > 8) { 1014357bfbb2Smrg if (!miSetVisualTypes(pScrn->depth, TrueColorMask, 1015357bfbb2Smrg pScrn->rgbBits, TrueColor)) 1016357bfbb2Smrg return FALSE; 1017357bfbb2Smrg } else { 1018357bfbb2Smrg if (!miSetVisualTypes(pScrn->depth, 1019357bfbb2Smrg miGetDefaultVisualMask(pScrn->depth), 1020357bfbb2Smrg pScrn->rgbBits, pScrn->defaultVisual)) 1021357bfbb2Smrg return FALSE; 1022357bfbb2Smrg } 1023357bfbb2Smrg if (!miSetPixmapDepths()) 1024357bfbb2Smrg return FALSE; 1025357bfbb2Smrg 1026cba5e21cSmrg if (fPtr->rotate == WSFB_ROTATE_CW 1027357bfbb2Smrg || fPtr->rotate == WSFB_ROTATE_CCW) { 1028357bfbb2Smrg int tmp = pScrn->virtualX; 1029357bfbb2Smrg pScrn->virtualX = pScrn->displayWidth = pScrn->virtualY; 1030357bfbb2Smrg pScrn->virtualY = tmp; 1031357bfbb2Smrg } 1032357bfbb2Smrg if (fPtr->rotate && !fPtr->PointerMoved) { 1033357bfbb2Smrg fPtr->PointerMoved = pScrn->PointerMoved; 1034357bfbb2Smrg pScrn->PointerMoved = WsfbPointerMoved; 1035357bfbb2Smrg } 1036357bfbb2Smrg 103714f0c695Smacallan fPtr->fbstart = fPtr->fbmem + fPtr->fbi.fbi_fboffset; 1038357bfbb2Smrg 103964f08a18Smrg if (fPtr->shadowFB) { 1040fe5fcf53Stsutsui if (fPtr->rotate) { 1041fe5fcf53Stsutsui /* 1042fe5fcf53Stsutsui * Note Rotate and Shadow FB options are valid 1043fe5fcf53Stsutsui * only on depth >= 8. 1044fe5fcf53Stsutsui */ 1045fe5fcf53Stsutsui len = pScrn->virtualX * pScrn->virtualY * 1046fe5fcf53Stsutsui (pScrn->bitsPerPixel >> 3); 1047dc9c99a5Stsutsui } else 1048dc9c99a5Stsutsui#ifdef HAVE_SHADOW_AFB 1049dc9c99a5Stsutsui if (fPtr->planarAfb) { 10503306a6a4Sjandberg /* always 8bpp */ 10513306a6a4Sjandberg len = pScrn->virtualX * pScrn->virtualY; 1052dc9c99a5Stsutsui } else 1053dc9c99a5Stsutsui#endif 1054dc9c99a5Stsutsui { 1055fe5fcf53Stsutsui len = fPtr->fbi.fbi_stride * pScrn->virtualY; 1056fe5fcf53Stsutsui } 1057fe5fcf53Stsutsui fPtr->shadow = calloc(1, len); 1058cba5e21cSmrg 105964f08a18Smrg if (!fPtr->shadow) { 106064f08a18Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 106164f08a18Smrg "Failed to allocate shadow framebuffer\n"); 106264f08a18Smrg return FALSE; 106364f08a18Smrg } 106464f08a18Smrg } 106564f08a18Smrg 1066fe5fcf53Stsutsui /* 1067fe5fcf53Stsutsui * fbScreenInit() seems to require "pixel width of frame buffer" 1068fe5fcf53Stsutsui * but it is actually "stride in pixel" of frame buffer, 1069fe5fcf53Stsutsui * per xorg/xserver/tree/fb/fbscreen.c. 1070fe5fcf53Stsutsui */ 1071fe5fcf53Stsutsui if (fPtr->rotate) { 1072fe5fcf53Stsutsui width = pScrn->displayWidth; 1073dc9c99a5Stsutsui } else 1074dc9c99a5Stsutsui#ifdef HAVE_SHADOW_AFB 1075dc9c99a5Stsutsui if (fPtr->planarAfb) { 10763306a6a4Sjandberg width = pScrn->displayWidth; 1077dc9c99a5Stsutsui } else 1078dc9c99a5Stsutsui#endif 1079dc9c99a5Stsutsui { 1080fe5fcf53Stsutsui if (pScrn->bitsPerPixel > 8) { 1081fe5fcf53Stsutsui width = 1082fe5fcf53Stsutsui fPtr->fbi.fbi_stride / (pScrn->bitsPerPixel >> 3); 1083fe5fcf53Stsutsui } else { 1084fe5fcf53Stsutsui width = 1085fe5fcf53Stsutsui fPtr->fbi.fbi_stride * (8 / pScrn->bitsPerPixel); 1086fe5fcf53Stsutsui } 1087fe5fcf53Stsutsui } 1088357bfbb2Smrg switch (pScrn->bitsPerPixel) { 108964f08a18Smrg case 1: 10908fc0431cStsutsui ret = fbScreenInit(pScreen, 10918fc0431cStsutsui fPtr->fbstart, 10928fc0431cStsutsui pScrn->virtualX, pScrn->virtualY, 10938fc0431cStsutsui pScrn->xDpi, pScrn->yDpi, 1094fe5fcf53Stsutsui width, pScrn->bitsPerPixel); 10958fc0431cStsutsui break; 109664f08a18Smrg case 4: 1097357bfbb2Smrg case 8: 1098357bfbb2Smrg case 16: 1099357bfbb2Smrg case 24: 1100357bfbb2Smrg case 32: 1101357bfbb2Smrg ret = fbScreenInit(pScreen, 1102b603b469Snonaka fPtr->shadowFB ? fPtr->shadow : fPtr->fbstart, 1103357bfbb2Smrg pScrn->virtualX, pScrn->virtualY, 1104357bfbb2Smrg pScrn->xDpi, pScrn->yDpi, 1105fe5fcf53Stsutsui width, 1106cbc9a668Smacallan pScrn->bitsPerPixel); 1107357bfbb2Smrg break; 1108357bfbb2Smrg default: 1109357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 1110b3c77fccStsutsui "Unsupported bpp: %d\n", pScrn->bitsPerPixel); 1111357bfbb2Smrg return FALSE; 1112357bfbb2Smrg } /* case */ 1113357bfbb2Smrg 1114357bfbb2Smrg if (!ret) 1115357bfbb2Smrg return FALSE; 1116357bfbb2Smrg 1117357bfbb2Smrg if (pScrn->bitsPerPixel > 8) { 111864f08a18Smrg /* Fixup RGB ordering. */ 1119357bfbb2Smrg visual = pScreen->visuals + pScreen->numVisuals; 1120357bfbb2Smrg while (--visual >= pScreen->visuals) { 1121357bfbb2Smrg if ((visual->class | DynamicClass) == DirectColor) { 1122357bfbb2Smrg visual->offsetRed = pScrn->offset.red; 1123357bfbb2Smrg visual->offsetGreen = pScrn->offset.green; 1124357bfbb2Smrg visual->offsetBlue = pScrn->offset.blue; 1125357bfbb2Smrg visual->redMask = pScrn->mask.red; 1126357bfbb2Smrg visual->greenMask = pScrn->mask.green; 1127357bfbb2Smrg visual->blueMask = pScrn->mask.blue; 1128357bfbb2Smrg } 1129357bfbb2Smrg } 1130357bfbb2Smrg } 1131357bfbb2Smrg 1132357bfbb2Smrg if (pScrn->bitsPerPixel >= 8) { 1133357bfbb2Smrg if (!fbPictureInit(pScreen, NULL, 0)) 1134357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_WARNING, 1135b3c77fccStsutsui "RENDER extension initialisation failed.\n"); 1136357bfbb2Smrg } 1137357bfbb2Smrg if (fPtr->shadowFB && !WsfbShadowInit(pScreen)) { 11389974adabSmrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 1139357bfbb2Smrg "shadow framebuffer initialization failed\n"); 1140357bfbb2Smrg return FALSE; 1141357bfbb2Smrg } 1142357bfbb2Smrg 1143357bfbb2Smrg#ifdef XFreeXDGA 1144cba5e21cSmrg if (!fPtr->rotate) 1145357bfbb2Smrg WsfbDGAInit(pScrn, pScreen); 1146cba5e21cSmrg else 11479974adabSmrg xf86DrvMsg(pScrn->scrnIndex, X_INFO, "Rotated display, " 1148357bfbb2Smrg "disabling DGA\n"); 1149357bfbb2Smrg#endif 1150357bfbb2Smrg if (fPtr->rotate) { 11518a4fa5cdStsutsui xf86DrvMsg(pScrn->scrnIndex, X_INFO, 11528a4fa5cdStsutsui "Enabling Driver Rotation, " "disabling RandR\n"); 11535a609870Stsutsui#if GET_ABI_MAJOR(ABI_VIDEODRV_VERSION) < 24 1154357bfbb2Smrg xf86DisableRandR(); 115572ee27a2Smrg#endif 1156cba5e21cSmrg if (pScrn->bitsPerPixel == 24) 11579974adabSmrg xf86DrvMsg(pScrn->scrnIndex, X_WARNING, 1158357bfbb2Smrg "Rotation might be broken in 24 bpp\n"); 1159357bfbb2Smrg } 1160357bfbb2Smrg 1161357bfbb2Smrg xf86SetBlackWhitePixels(pScreen); 1162357bfbb2Smrg xf86SetBackingStore(pScreen); 1163357bfbb2Smrg 116464f08a18Smrg /* Software cursor. */ 1165357bfbb2Smrg miDCInitialize(pScreen, xf86GetPointerScreenFuncs()); 1166357bfbb2Smrg 11675d492fd2Smacallan /* check for hardware cursor support */ 11685d492fd2Smacallan if (fPtr->HWCursor) 11695d492fd2Smacallan WsfbSetupCursor(pScreen); 11705d492fd2Smacallan 117164f08a18Smrg /* 117264f08a18Smrg * Colormap 117364f08a18Smrg * 117464f08a18Smrg * Note that, even on less than 8 bit depth frame buffers, we 117564f08a18Smrg * expect the colormap to be programmable with 8 bit values. 117664f08a18Smrg * As of now, this is indeed the case on all OpenBSD supported 117764f08a18Smrg * graphics hardware. 117864f08a18Smrg */ 1179357bfbb2Smrg if (!miCreateDefColormap(pScreen)) 1180357bfbb2Smrg return FALSE; 1181357bfbb2Smrg flags = CMAP_RELOAD_ON_MODE_SWITCH; 11823788fa92Smacallan 11833788fa92Smacallan ncolors = 0; 11843788fa92Smacallan if (fPtr->fbi.fbi_pixeltype == WSFB_CI) { 11853788fa92Smacallan ncolors = fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries; 11863788fa92Smacallan } 11873788fa92Smacallan 118864f08a18Smrg /* On StaticGray visuals, fake a 256 entries colormap. */ 1189357bfbb2Smrg if (ncolors == 0) 1190357bfbb2Smrg ncolors = 256; 1191357bfbb2Smrg if(!xf86HandleColormaps(pScreen, ncolors, 8, WsfbLoadPalette, 1192357bfbb2Smrg NULL, flags)) 1193357bfbb2Smrg return FALSE; 1194357bfbb2Smrg 11957b613f18Stsutsui#if defined(__NetBSD__) && defined(WSDISPLAY_TYPE_LUNA) 11967b613f18Stsutsui if (wstype == WSDISPLAY_TYPE_LUNA) { 11977b613f18Stsutsui ncolors = fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries; 1198c2056409Stsutsui if (ncolors > 0 1199c2056409Stsutsui#ifdef HAVE_SHADOW_AFB 1200c2056409Stsutsui && !fPtr->planarAfb 1201c2056409Stsutsui#endif 1202c2056409Stsutsui ) { 12037b613f18Stsutsui /* 12047b613f18Stsutsui * Override palette to use 4bpp/8bpp framebuffers as 12057b613f18Stsutsui * monochrome server by using only the first plane. 12067b613f18Stsutsui * See also comment in WsfbPreInit(). 12077b613f18Stsutsui */ 12087b613f18Stsutsui struct wsdisplay_cmap cmap; 12097b613f18Stsutsui uint8_t r[256], g[256], b[256]; 12107b613f18Stsutsui int p; 12117b613f18Stsutsui 12127b613f18Stsutsui for (p = 0; p < ncolors; p++) 12137b613f18Stsutsui r[p] = g[p] = b[p] = (p & 1) ? 0xff : 0; 12147b613f18Stsutsui cmap.index = 0; 12157b613f18Stsutsui cmap.count = ncolors; 12167b613f18Stsutsui cmap.red = r; 12177b613f18Stsutsui cmap.green = g; 12187b613f18Stsutsui cmap.blue = b; 12197b613f18Stsutsui if (ioctl(fPtr->fd, WSDISPLAYIO_PUTCMAP, &cmap) == -1) { 12207b613f18Stsutsui xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 12217b613f18Stsutsui "ioctl WSDISPLAYIO_PUTCMAP: %s\n", 12227b613f18Stsutsui strerror(errno)); 12237b613f18Stsutsui } 12247b613f18Stsutsui } 12257b613f18Stsutsui } 12267b613f18Stsutsui#endif 12277b613f18Stsutsui 1228357bfbb2Smrg pScreen->SaveScreen = WsfbSaveScreen; 1229357bfbb2Smrg 1230357bfbb2Smrg#ifdef XvExtension 1231357bfbb2Smrg { 1232357bfbb2Smrg XF86VideoAdaptorPtr *ptr; 1233357bfbb2Smrg 1234357bfbb2Smrg int n = xf86XVListGenericAdaptors(pScrn,&ptr); 1235357bfbb2Smrg if (n) { 1236357bfbb2Smrg xf86XVScreenInit(pScreen,ptr,n); 1237357bfbb2Smrg } 1238357bfbb2Smrg } 1239357bfbb2Smrg#endif 1240357bfbb2Smrg 124164f08a18Smrg /* Wrap the current CloseScreen function. */ 1242357bfbb2Smrg fPtr->CloseScreen = pScreen->CloseScreen; 1243357bfbb2Smrg pScreen->CloseScreen = WsfbCloseScreen; 1244357bfbb2Smrg 1245357bfbb2Smrg TRACE_EXIT("WsfbScreenInit"); 1246357bfbb2Smrg return TRUE; 1247357bfbb2Smrg} 1248357bfbb2Smrg 1249357bfbb2Smrgstatic Bool 12509974adabSmrgWsfbCloseScreen(CLOSE_SCREEN_ARGS_DECL) 1251357bfbb2Smrg{ 12529974adabSmrg ScrnInfoPtr pScrn = xf86ScreenToScrn(pScreen); 125364f08a18Smrg PixmapPtr pPixmap; 1254357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 1255357bfbb2Smrg 125664f08a18Smrg 1257357bfbb2Smrg TRACE_ENTER("WsfbCloseScreen"); 1258357bfbb2Smrg 125964f08a18Smrg pPixmap = pScreen->GetScreenPixmap(pScreen); 1260141baaa7Smlelstv if (fPtr->shadowFB) 1261141baaa7Smlelstv shadowRemove(pScreen, pPixmap); 126264f08a18Smrg 1263357bfbb2Smrg if (pScrn->vtSema) { 1264357bfbb2Smrg WsfbRestore(pScrn); 12658fbcba3dSrin if (munmap(fPtr->fbmem, fPtr->fbmem_len + fPtr->fbi.fbi_fboffset) == -1) { 1266357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 1267357bfbb2Smrg "munmap: %s\n", strerror(errno)); 1268357bfbb2Smrg } 1269357bfbb2Smrg 1270357bfbb2Smrg fPtr->fbmem = NULL; 1271357bfbb2Smrg } 1272357bfbb2Smrg#ifdef XFreeXDGA 1273357bfbb2Smrg if (fPtr->pDGAMode) { 1274cba5e21cSmrg free(fPtr->pDGAMode); 1275357bfbb2Smrg fPtr->pDGAMode = NULL; 1276357bfbb2Smrg fPtr->nDGAMode = 0; 1277357bfbb2Smrg } 1278357bfbb2Smrg#endif 1279357bfbb2Smrg pScrn->vtSema = FALSE; 1280357bfbb2Smrg 128164f08a18Smrg /* Unwrap CloseScreen. */ 1282357bfbb2Smrg pScreen->CloseScreen = fPtr->CloseScreen; 128364f08a18Smrg TRACE_EXIT("WsfbCloseScreen"); 12849974adabSmrg return (*pScreen->CloseScreen)(CLOSE_SCREEN_ARGS); 1285357bfbb2Smrg} 1286357bfbb2Smrg 1287357bfbb2Smrgstatic void * 1288357bfbb2SmrgWsfbWindowLinear(ScreenPtr pScreen, CARD32 row, CARD32 offset, int mode, 1289357bfbb2Smrg CARD32 *size, void *closure) 1290357bfbb2Smrg{ 12918a4fa5cdStsutsui ScrnInfoPtr pScrn = xf86ScreenToScrn(pScreen); 1292357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 1293357bfbb2Smrg 12943788fa92Smacallan if (fPtr->fbi.fbi_stride) 12953788fa92Smacallan *size = fPtr->fbi.fbi_stride; 1296357bfbb2Smrg else { 1297357bfbb2Smrg if (ioctl(fPtr->fd, WSDISPLAYIO_LINEBYTES, size) == -1) 1298357bfbb2Smrg return NULL; 12993788fa92Smacallan fPtr->fbi.fbi_stride = *size; 1300357bfbb2Smrg } 13018fbcba3dSrin return ((CARD8 *)fPtr->fbstart + row * fPtr->fbi.fbi_stride + offset); 1302357bfbb2Smrg} 1303357bfbb2Smrg 1304dc9c99a5Stsutsui#ifdef HAVE_SHADOW_AFB 1305bb2f4479Srin/* 13063306a6a4Sjandberg * For use with shadowUpdateAfb8 13073306a6a4Sjandberg * 13083306a6a4Sjandberg * For video memory layout with non-interleaved bitplanes. 13093306a6a4Sjandberg */ 13103306a6a4Sjandbergstatic void * 13113306a6a4SjandbergWsfbWindowAfb(ScreenPtr pScreen, CARD32 row, CARD32 offset, int mode, 13123306a6a4Sjandberg CARD32 *size, void *closure) 13133306a6a4Sjandberg{ 13148a4fa5cdStsutsui ScrnInfoPtr pScrn = xf86ScreenToScrn(pScreen); 13153306a6a4Sjandberg WsfbPtr fPtr = WSFBPTR(pScrn); 13163306a6a4Sjandberg 13173306a6a4Sjandberg /* size is offset from start of bitplane to next bitplane */ 13183306a6a4Sjandberg *size = fPtr->fbi.fbi_stride * fPtr->fbi.fbi_height; 13193306a6a4Sjandberg return ((CARD8 *)fPtr->fbstart + row * fPtr->fbi.fbi_stride + offset); 13203306a6a4Sjandberg} 1321dc9c99a5Stsutsui#endif 13223306a6a4Sjandberg 1323357bfbb2Smrgstatic void 13249974adabSmrgWsfbPointerMoved(SCRN_ARG_TYPE arg, int x, int y) 1325357bfbb2Smrg{ 13269974adabSmrg SCRN_INFO_PTR(arg); 1327357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 1328357bfbb2Smrg int newX, newY; 1329357bfbb2Smrg 1330357bfbb2Smrg switch (fPtr->rotate) 1331357bfbb2Smrg { 1332357bfbb2Smrg case WSFB_ROTATE_CW: 1333357bfbb2Smrg /* 90 degrees CW rotation. */ 1334357bfbb2Smrg newX = pScrn->pScreen->height - y - 1; 1335357bfbb2Smrg newY = x; 1336357bfbb2Smrg break; 1337357bfbb2Smrg 1338357bfbb2Smrg case WSFB_ROTATE_CCW: 1339357bfbb2Smrg /* 90 degrees CCW rotation. */ 1340357bfbb2Smrg newX = y; 1341357bfbb2Smrg newY = pScrn->pScreen->width - x - 1; 1342357bfbb2Smrg break; 1343357bfbb2Smrg 1344357bfbb2Smrg case WSFB_ROTATE_UD: 1345357bfbb2Smrg /* 180 degrees UD rotation. */ 1346357bfbb2Smrg newX = pScrn->pScreen->width - x - 1; 1347357bfbb2Smrg newY = pScrn->pScreen->height - y - 1; 1348357bfbb2Smrg break; 1349357bfbb2Smrg 1350357bfbb2Smrg default: 1351357bfbb2Smrg /* No rotation. */ 1352357bfbb2Smrg newX = x; 1353357bfbb2Smrg newY = y; 1354357bfbb2Smrg break; 1355357bfbb2Smrg } 1356357bfbb2Smrg 1357357bfbb2Smrg /* Pass adjusted pointer coordinates to wrapped PointerMoved function. */ 13589974adabSmrg (*fPtr->PointerMoved)(arg, newX, newY); 1359357bfbb2Smrg} 1360357bfbb2Smrg 1361357bfbb2Smrgstatic Bool 13629974adabSmrgWsfbEnterVT(VT_FUNC_ARGS_DECL) 1363357bfbb2Smrg{ 13649974adabSmrg SCRN_INFO_PTR(arg); 1365b83350a8Smacallan WsfbPtr fPtr = WSFBPTR(pScrn); 1366b83350a8Smacallan int mode; 1367357bfbb2Smrg 1368357bfbb2Smrg TRACE_ENTER("EnterVT"); 1369357bfbb2Smrg pScrn->vtSema = TRUE; 1370b83350a8Smacallan 1371b83350a8Smacallan /* Restore the graphics mode. */ 1372b83350a8Smacallan mode = WSDISPLAYIO_MODE_DUMBFB; 1373b83350a8Smacallan if (ioctl(fPtr->fd, WSDISPLAYIO_SMODE, &mode) == -1) { 1374b83350a8Smacallan xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 1375b83350a8Smacallan "error setting graphics mode %s\n", strerror(errno)); 1376b83350a8Smacallan } 1377b83350a8Smacallan 137864f08a18Smrg TRACE_EXIT("EnterVT"); 1379357bfbb2Smrg return TRUE; 1380357bfbb2Smrg} 1381357bfbb2Smrg 1382357bfbb2Smrgstatic void 13839974adabSmrgWsfbLeaveVT(VT_FUNC_ARGS_DECL) 1384357bfbb2Smrg{ 13859974adabSmrg SCRN_INFO_PTR(arg); 1386b83350a8Smacallan WsfbPtr fPtr = WSFBPTR(pScrn); 1387b83350a8Smacallan int mode; 1388357bfbb2Smrg 1389357bfbb2Smrg TRACE_ENTER("LeaveVT"); 1390b83350a8Smacallan 1391b83350a8Smacallan /* 1392b83350a8Smacallan * stuff to do: 1393b83350a8Smacallan * - turn off hw cursor 1394b83350a8Smacallan * - restore colour map if WSFB_CI 1395b83350a8Smacallan * - ioctl(WSDISPLAYIO_MODE_EMUL) to notify the kernel driver that 1396b83350a8Smacallan * we're backing off 1397b83350a8Smacallan */ 1398b83350a8Smacallan 1399371b4ab3Stsutsui if (fPtr->fbi.fbi_pixeltype == WSFB_CI && 1400371b4ab3Stsutsui fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries > 0) { 1401b83350a8Smacallan /* reset colormap for text mode */ 1402b83350a8Smacallan if (ioctl(fPtr->fd, WSDISPLAYIO_PUTCMAP, 1403b83350a8Smacallan &(fPtr->saved_cmap)) == -1) { 1404b83350a8Smacallan xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 1405b83350a8Smacallan "error restoring colormap %s\n", 1406b83350a8Smacallan strerror(errno)); 1407b83350a8Smacallan } 1408b83350a8Smacallan } 1409b83350a8Smacallan 1410b83350a8Smacallan /* Restore the text mode. */ 1411b83350a8Smacallan mode = WSDISPLAYIO_MODE_EMUL; 1412b83350a8Smacallan if (ioctl(fPtr->fd, WSDISPLAYIO_SMODE, &mode) == -1) { 1413b83350a8Smacallan xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 1414b83350a8Smacallan "error setting text mode %s\n", strerror(errno)); 1415b83350a8Smacallan } 1416b83350a8Smacallan 1417b83350a8Smacallan pScrn->vtSema = FALSE; 1418b83350a8Smacallan TRACE_EXIT("LeaveVT"); 1419357bfbb2Smrg} 1420357bfbb2Smrg 1421357bfbb2Smrgstatic Bool 14229974adabSmrgWsfbSwitchMode(SWITCH_MODE_ARGS_DECL) 1423357bfbb2Smrg{ 14248a4fa5cdStsutsui#if DEBUG 14258a4fa5cdStsutsui SCRN_INFO_PTR(arg); 14268a4fa5cdStsutsui#endif 14278a4fa5cdStsutsui 1428357bfbb2Smrg TRACE_ENTER("SwitchMode"); 142964f08a18Smrg /* Nothing else to do. */ 1430357bfbb2Smrg return TRUE; 1431357bfbb2Smrg} 1432357bfbb2Smrg 1433357bfbb2Smrgstatic int 14349974adabSmrgWsfbValidMode(SCRN_ARG_TYPE arg, DisplayModePtr mode, Bool verbose, int flags) 1435357bfbb2Smrg{ 14368a4fa5cdStsutsui#if DEBUG 14378a4fa5cdStsutsui SCRN_INFO_PTR(arg); 14388a4fa5cdStsutsui#endif 14398a4fa5cdStsutsui 1440357bfbb2Smrg TRACE_ENTER("ValidMode"); 1441357bfbb2Smrg return MODE_OK; 1442357bfbb2Smrg} 1443357bfbb2Smrg 1444357bfbb2Smrgstatic void 1445357bfbb2SmrgWsfbLoadPalette(ScrnInfoPtr pScrn, int numColors, int *indices, 1446357bfbb2Smrg LOCO *colors, VisualPtr pVisual) 1447357bfbb2Smrg{ 1448357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 1449357bfbb2Smrg struct wsdisplay_cmap cmap; 1450357bfbb2Smrg unsigned char red[256],green[256],blue[256]; 1451357bfbb2Smrg int i, indexMin=256, indexMax=0; 1452357bfbb2Smrg 1453357bfbb2Smrg TRACE_ENTER("LoadPalette"); 1454357bfbb2Smrg 1455b8199fcbStsutsui /* nothing to do if there is no color palette support */ 1456b8199fcbStsutsui if (fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries == 0) 1457b8199fcbStsutsui return; 1458b8199fcbStsutsui 1459357bfbb2Smrg cmap.count = 1; 1460357bfbb2Smrg cmap.red = red; 1461357bfbb2Smrg cmap.green = green; 1462357bfbb2Smrg cmap.blue = blue; 1463357bfbb2Smrg 1464357bfbb2Smrg if (numColors == 1) { 1465357bfbb2Smrg /* Optimisation */ 1466357bfbb2Smrg cmap.index = indices[0]; 1467357bfbb2Smrg red[0] = colors[indices[0]].red; 1468357bfbb2Smrg green[0] = colors[indices[0]].green; 1469357bfbb2Smrg blue[0] = colors[indices[0]].blue; 1470357bfbb2Smrg if (ioctl(fPtr->fd,WSDISPLAYIO_PUTCMAP, &cmap) == -1) 1471357bfbb2Smrg ErrorF("ioctl FBIOPUTCMAP: %s\n", strerror(errno)); 1472357bfbb2Smrg } else { 147364f08a18Smrg /* 147464f08a18Smrg * Change all colors in 2 ioctls 14758a4fa5cdStsutsui * and limit the data to be transferred. 147664f08a18Smrg */ 1477357bfbb2Smrg for (i = 0; i < numColors; i++) { 1478357bfbb2Smrg if (indices[i] < indexMin) 1479357bfbb2Smrg indexMin = indices[i]; 1480357bfbb2Smrg if (indices[i] > indexMax) 1481357bfbb2Smrg indexMax = indices[i]; 1482357bfbb2Smrg } 1483357bfbb2Smrg cmap.index = indexMin; 1484357bfbb2Smrg cmap.count = indexMax - indexMin + 1; 1485357bfbb2Smrg cmap.red = &red[indexMin]; 1486357bfbb2Smrg cmap.green = &green[indexMin]; 1487357bfbb2Smrg cmap.blue = &blue[indexMin]; 148864f08a18Smrg /* Get current map. */ 1489357bfbb2Smrg if (ioctl(fPtr->fd, WSDISPLAYIO_GETCMAP, &cmap) == -1) 1490357bfbb2Smrg ErrorF("ioctl FBIOGETCMAP: %s\n", strerror(errno)); 149164f08a18Smrg /* Change the colors that require updating. */ 1492357bfbb2Smrg for (i = 0; i < numColors; i++) { 1493357bfbb2Smrg red[indices[i]] = colors[indices[i]].red; 1494357bfbb2Smrg green[indices[i]] = colors[indices[i]].green; 1495357bfbb2Smrg blue[indices[i]] = colors[indices[i]].blue; 1496357bfbb2Smrg } 149764f08a18Smrg /* Write the colormap back. */ 1498357bfbb2Smrg if (ioctl(fPtr->fd,WSDISPLAYIO_PUTCMAP, &cmap) == -1) 1499357bfbb2Smrg ErrorF("ioctl FBIOPUTCMAP: %s\n", strerror(errno)); 1500357bfbb2Smrg } 1501357bfbb2Smrg TRACE_EXIT("LoadPalette"); 1502357bfbb2Smrg} 1503357bfbb2Smrg 1504357bfbb2Smrgstatic Bool 1505357bfbb2SmrgWsfbSaveScreen(ScreenPtr pScreen, int mode) 1506357bfbb2Smrg{ 15078a4fa5cdStsutsui ScrnInfoPtr pScrn = xf86ScreenToScrn(pScreen); 1508357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 1509357bfbb2Smrg int state; 1510357bfbb2Smrg 1511357bfbb2Smrg TRACE_ENTER("SaveScreen"); 1512357bfbb2Smrg 1513357bfbb2Smrg if (!pScrn->vtSema) 1514357bfbb2Smrg return TRUE; 1515357bfbb2Smrg 1516357bfbb2Smrg if (mode != SCREEN_SAVER_FORCER) { 1517357bfbb2Smrg state = xf86IsUnblank(mode)?WSDISPLAYIO_VIDEO_ON: 15188a4fa5cdStsutsui WSDISPLAYIO_VIDEO_OFF; 1519357bfbb2Smrg ioctl(fPtr->fd, 1520357bfbb2Smrg WSDISPLAYIO_SVIDEO, &state); 1521357bfbb2Smrg } 152264f08a18Smrg TRACE_EXIT("SaveScreen"); 1523357bfbb2Smrg return TRUE; 1524357bfbb2Smrg} 1525357bfbb2Smrg 1526357bfbb2Smrg 1527357bfbb2Smrgstatic void 1528357bfbb2SmrgWsfbSave(ScrnInfoPtr pScrn) 1529357bfbb2Smrg{ 1530357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 1531357bfbb2Smrg 1532357bfbb2Smrg TRACE_ENTER("WsfbSave"); 1533357bfbb2Smrg 15343788fa92Smacallan /* nothing to save if we don't run in colour-indexed mode */ 15353788fa92Smacallan if (fPtr->fbi.fbi_pixeltype != WSFB_CI) 1536357bfbb2Smrg return; 1537357bfbb2Smrg 1538b8199fcbStsutsui /* nothing to do if no color palette support */ 1539b8199fcbStsutsui if (fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries == 0) 1540b8199fcbStsutsui return; 1541b8199fcbStsutsui 1542357bfbb2Smrg fPtr->saved_cmap.index = 0; 15433788fa92Smacallan fPtr->saved_cmap.count = fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries; 1544357bfbb2Smrg if (ioctl(fPtr->fd, WSDISPLAYIO_GETCMAP, 1545357bfbb2Smrg &(fPtr->saved_cmap)) == -1) { 1546357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 1547357bfbb2Smrg "error saving colormap %s\n", strerror(errno)); 1548357bfbb2Smrg } 154964f08a18Smrg TRACE_EXIT("WsfbSave"); 1550357bfbb2Smrg 1551357bfbb2Smrg} 1552357bfbb2Smrg 1553357bfbb2Smrgstatic void 1554357bfbb2SmrgWsfbRestore(ScrnInfoPtr pScrn) 1555357bfbb2Smrg{ 1556357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 1557357bfbb2Smrg int mode; 1558357bfbb2Smrg 1559357bfbb2Smrg TRACE_ENTER("WsfbRestore"); 1560357bfbb2Smrg 1561b8199fcbStsutsui if (fPtr->fbi.fbi_pixeltype == WSFB_CI && 1562b8199fcbStsutsui fPtr->fbi.fbi_subtype.fbi_cmapinfo.cmap_entries > 0) { 1563357bfbb2Smrg /* reset colormap for text mode */ 1564357bfbb2Smrg if (ioctl(fPtr->fd, WSDISPLAYIO_PUTCMAP, 1565357bfbb2Smrg &(fPtr->saved_cmap)) == -1) { 1566357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 1567357bfbb2Smrg "error restoring colormap %s\n", 1568357bfbb2Smrg strerror(errno)); 1569357bfbb2Smrg } 1570357bfbb2Smrg } 1571357bfbb2Smrg 157264f08a18Smrg /* Clear the screen. */ 15738fbcba3dSrin memset(fPtr->fbstart, 0, fPtr->fbmem_len); 1574357bfbb2Smrg 157564f08a18Smrg /* Restore the text mode. */ 1576357bfbb2Smrg mode = WSDISPLAYIO_MODE_EMUL; 1577357bfbb2Smrg if (ioctl(fPtr->fd, WSDISPLAYIO_SMODE, &mode) == -1) { 1578357bfbb2Smrg xf86DrvMsg(pScrn->scrnIndex, X_ERROR, 1579357bfbb2Smrg "error setting text mode %s\n", strerror(errno)); 1580357bfbb2Smrg } 1581357bfbb2Smrg TRACE_EXIT("WsfbRestore"); 1582357bfbb2Smrg} 1583357bfbb2Smrg 1584357bfbb2Smrg#ifdef XFreeXDGA 1585357bfbb2Smrg/*********************************************************************** 1586357bfbb2Smrg * DGA stuff 1587357bfbb2Smrg ***********************************************************************/ 1588357bfbb2Smrg 1589357bfbb2Smrgstatic Bool 1590357bfbb2SmrgWsfbDGAOpenFramebuffer(ScrnInfoPtr pScrn, char **DeviceName, 1591357bfbb2Smrg unsigned char **ApertureBase, int *ApertureSize, 1592357bfbb2Smrg int *ApertureOffset, int *flags) 1593357bfbb2Smrg{ 1594357bfbb2Smrg *DeviceName = NULL; /* No special device */ 1595357bfbb2Smrg *ApertureBase = (unsigned char *)(pScrn->memPhysBase); 1596357bfbb2Smrg *ApertureSize = pScrn->videoRam; 1597357bfbb2Smrg *ApertureOffset = pScrn->fbOffset; 1598357bfbb2Smrg *flags = 0; 1599357bfbb2Smrg 1600357bfbb2Smrg return TRUE; 1601357bfbb2Smrg} 1602357bfbb2Smrg 1603357bfbb2Smrgstatic Bool 1604357bfbb2SmrgWsfbDGASetMode(ScrnInfoPtr pScrn, DGAModePtr pDGAMode) 1605357bfbb2Smrg{ 1606357bfbb2Smrg DisplayModePtr pMode; 1607357bfbb2Smrg int frameX0, frameY0; 1608357bfbb2Smrg 1609357bfbb2Smrg if (pDGAMode) { 1610357bfbb2Smrg pMode = pDGAMode->mode; 1611357bfbb2Smrg frameX0 = frameY0 = 0; 1612357bfbb2Smrg } else { 1613357bfbb2Smrg if (!(pMode = pScrn->currentMode)) 1614357bfbb2Smrg return TRUE; 1615357bfbb2Smrg 1616357bfbb2Smrg frameX0 = pScrn->frameX0; 1617357bfbb2Smrg frameY0 = pScrn->frameY0; 1618357bfbb2Smrg } 1619357bfbb2Smrg 16209974adabSmrg if (!(*pScrn->SwitchMode)(SWITCH_MODE_ARGS(pScrn, pMode))) 1621357bfbb2Smrg return FALSE; 16229974adabSmrg (*pScrn->AdjustFrame)(ADJUST_FRAME_ARGS(pScrn, frameX0, frameY0)); 1623357bfbb2Smrg 1624357bfbb2Smrg return TRUE; 1625357bfbb2Smrg} 1626357bfbb2Smrg 1627357bfbb2Smrgstatic void 1628357bfbb2SmrgWsfbDGASetViewport(ScrnInfoPtr pScrn, int x, int y, int flags) 1629357bfbb2Smrg{ 16309974adabSmrg (*pScrn->AdjustFrame)(ADJUST_FRAME_ARGS(pScrn, x, y)); 1631357bfbb2Smrg} 1632357bfbb2Smrg 1633357bfbb2Smrgstatic int 1634357bfbb2SmrgWsfbDGAGetViewport(ScrnInfoPtr pScrn) 1635357bfbb2Smrg{ 1636357bfbb2Smrg return (0); 1637357bfbb2Smrg} 1638357bfbb2Smrg 1639357bfbb2Smrgstatic DGAFunctionRec WsfbDGAFunctions = 1640357bfbb2Smrg{ 1641357bfbb2Smrg WsfbDGAOpenFramebuffer, 1642357bfbb2Smrg NULL, /* CloseFramebuffer */ 1643357bfbb2Smrg WsfbDGASetMode, 1644357bfbb2Smrg WsfbDGASetViewport, 1645357bfbb2Smrg WsfbDGAGetViewport, 1646357bfbb2Smrg NULL, /* Sync */ 1647357bfbb2Smrg NULL, /* FillRect */ 1648357bfbb2Smrg NULL, /* BlitRect */ 1649357bfbb2Smrg NULL, /* BlitTransRect */ 1650357bfbb2Smrg}; 1651357bfbb2Smrg 1652357bfbb2Smrgstatic void 1653357bfbb2SmrgWsfbDGAAddModes(ScrnInfoPtr pScrn) 1654357bfbb2Smrg{ 1655357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 1656357bfbb2Smrg DisplayModePtr pMode = pScrn->modes; 1657357bfbb2Smrg DGAModePtr pDGAMode; 1658357bfbb2Smrg 1659357bfbb2Smrg do { 1660cba5e21cSmrg pDGAMode = realloc(fPtr->pDGAMode, 1661357bfbb2Smrg (fPtr->nDGAMode + 1) * sizeof(DGAModeRec)); 1662357bfbb2Smrg if (!pDGAMode) 1663357bfbb2Smrg break; 1664357bfbb2Smrg 1665357bfbb2Smrg fPtr->pDGAMode = pDGAMode; 1666357bfbb2Smrg pDGAMode += fPtr->nDGAMode; 1667357bfbb2Smrg (void)memset(pDGAMode, 0, sizeof(DGAModeRec)); 1668357bfbb2Smrg 1669357bfbb2Smrg ++fPtr->nDGAMode; 1670357bfbb2Smrg pDGAMode->mode = pMode; 1671357bfbb2Smrg pDGAMode->flags = DGA_CONCURRENT_ACCESS | DGA_PIXMAP_AVAILABLE; 1672357bfbb2Smrg pDGAMode->byteOrder = pScrn->imageByteOrder; 1673357bfbb2Smrg pDGAMode->depth = pScrn->depth; 1674357bfbb2Smrg pDGAMode->bitsPerPixel = pScrn->bitsPerPixel; 1675357bfbb2Smrg pDGAMode->red_mask = pScrn->mask.red; 1676357bfbb2Smrg pDGAMode->green_mask = pScrn->mask.green; 1677357bfbb2Smrg pDGAMode->blue_mask = pScrn->mask.blue; 1678357bfbb2Smrg pDGAMode->visualClass = pScrn->bitsPerPixel > 8 ? 1679357bfbb2Smrg TrueColor : PseudoColor; 1680357bfbb2Smrg pDGAMode->xViewportStep = 1; 1681357bfbb2Smrg pDGAMode->yViewportStep = 1; 1682357bfbb2Smrg pDGAMode->viewportWidth = pMode->HDisplay; 1683357bfbb2Smrg pDGAMode->viewportHeight = pMode->VDisplay; 1684357bfbb2Smrg 16853788fa92Smacallan if (fPtr->fbi.fbi_stride) 16863788fa92Smacallan pDGAMode->bytesPerScanline = fPtr->fbi.fbi_stride; 1687357bfbb2Smrg else { 1688357bfbb2Smrg ioctl(fPtr->fd, WSDISPLAYIO_LINEBYTES, 16893788fa92Smacallan &fPtr->fbi.fbi_stride); 16903788fa92Smacallan pDGAMode->bytesPerScanline = fPtr->fbi.fbi_stride; 1691357bfbb2Smrg } 1692357bfbb2Smrg 1693357bfbb2Smrg pDGAMode->imageWidth = pMode->HDisplay; 1694357bfbb2Smrg pDGAMode->imageHeight = pMode->VDisplay; 1695357bfbb2Smrg pDGAMode->pixmapWidth = pDGAMode->imageWidth; 1696357bfbb2Smrg pDGAMode->pixmapHeight = pDGAMode->imageHeight; 1697357bfbb2Smrg pDGAMode->maxViewportX = pScrn->virtualX - 1698357bfbb2Smrg pDGAMode->viewportWidth; 1699357bfbb2Smrg pDGAMode->maxViewportY = pScrn->virtualY - 1700357bfbb2Smrg pDGAMode->viewportHeight; 1701357bfbb2Smrg 1702357bfbb2Smrg pDGAMode->address = fPtr->fbstart; 1703357bfbb2Smrg 1704357bfbb2Smrg pMode = pMode->next; 1705357bfbb2Smrg } while (pMode != pScrn->modes); 1706357bfbb2Smrg} 1707357bfbb2Smrg 1708357bfbb2Smrgstatic Bool 1709357bfbb2SmrgWsfbDGAInit(ScrnInfoPtr pScrn, ScreenPtr pScreen) 1710357bfbb2Smrg{ 1711357bfbb2Smrg WsfbPtr fPtr = WSFBPTR(pScrn); 1712357bfbb2Smrg 1713357bfbb2Smrg if (pScrn->depth < 8) 1714357bfbb2Smrg return FALSE; 1715357bfbb2Smrg 1716357bfbb2Smrg if (!fPtr->nDGAMode) 1717357bfbb2Smrg WsfbDGAAddModes(pScrn); 1718357bfbb2Smrg 1719357bfbb2Smrg return (DGAInit(pScreen, &WsfbDGAFunctions, 1720357bfbb2Smrg fPtr->pDGAMode, fPtr->nDGAMode)); 1721357bfbb2Smrg} 1722357bfbb2Smrg#endif 1723357bfbb2Smrg 1724357bfbb2Smrgstatic Bool 1725357bfbb2SmrgWsfbDriverFunc(ScrnInfoPtr pScrn, xorgDriverFuncOp op, 1726357bfbb2Smrg pointer ptr) 1727357bfbb2Smrg{ 1728357bfbb2Smrg xorgHWFlags *flag; 1729cba5e21cSmrg 1730357bfbb2Smrg switch (op) { 1731357bfbb2Smrg case GET_REQUIRED_HW_INTERFACES: 1732357bfbb2Smrg flag = (CARD32*)ptr; 1733357bfbb2Smrg (*flag) = 0; 1734357bfbb2Smrg return TRUE; 1735357bfbb2Smrg default: 1736357bfbb2Smrg return FALSE; 1737357bfbb2Smrg } 1738357bfbb2Smrg} 1739357bfbb2Smrg 1740bff82b7eSjmcneillstatic inline void 1741bff82b7eSjmcneillWsfbCopyRGB16ToYUY2(void *dest, void *src, int len) 1742bff82b7eSjmcneill{ 1743bff82b7eSjmcneill uint16_t *src16 = src; 1744bff82b7eSjmcneill uint32_t *dest32 = dest; 1745bff82b7eSjmcneill 1746bff82b7eSjmcneill while (len > 0) { 1747bff82b7eSjmcneill const uint16_t rgb0 = src16[0]; 1748bff82b7eSjmcneill const uint16_t rgb1 = src16[1]; 1749bff82b7eSjmcneill const uint16_t rgb = ((rgb0 >> 1) & ~0x8410) + 1750bff82b7eSjmcneill ((rgb1 >> 1) & ~0x8410) + 1751bff82b7eSjmcneill ((rgb0 & rgb1) & 0x0841); 1752bff82b7eSjmcneill const uint32_t y0 = mapRGB16ToY[rgb0]; 1753bff82b7eSjmcneill const uint32_t y1 = mapRGB16ToY[rgb1]; 1754bff82b7eSjmcneill const uint32_t u = mapRGB16ToU[rgb]; 1755bff82b7eSjmcneill const uint32_t v = mapRGB16ToV[rgb]; 1756bff82b7eSjmcneill 1757bff82b7eSjmcneill *dest32 = (y0 << 24) | (u << 16) | (y1 << 8) | v; 1758bff82b7eSjmcneill 1759bff82b7eSjmcneill dest32++; 1760bff82b7eSjmcneill src16 += 2; 1761bff82b7eSjmcneill len -= 4; 1762bff82b7eSjmcneill } 1763bff82b7eSjmcneill} 1764bff82b7eSjmcneill 1765bff82b7eSjmcneillvoid 1766bff82b7eSjmcneillWsfbShadowUpdateRGB16ToYUY2(ScreenPtr pScreen, shadowBufPtr pBuf) 1767bff82b7eSjmcneill{ 1768bff82b7eSjmcneill RegionPtr damage = DamageRegion (pBuf->pDamage); 1769bff82b7eSjmcneill PixmapPtr pShadow = pBuf->pPixmap; 1770bff82b7eSjmcneill int nbox = RegionNumRects (damage); 1771bff82b7eSjmcneill BoxPtr pbox = RegionRects (damage); 1772bff82b7eSjmcneill FbBits *shaBase, *shaLine, *sha; 1773bff82b7eSjmcneill FbStride shaStride; 1774bff82b7eSjmcneill int scrBase, scrLine, scr; 1775bff82b7eSjmcneill int shaBpp; 1776bff82b7eSjmcneill int shaXoff, shaYoff; /* XXX assumed to be zero */ 1777bff82b7eSjmcneill int x, y, w, h, width; 1778bff82b7eSjmcneill int i; 1779bff82b7eSjmcneill FbBits *winBase = NULL, *win; 1780bff82b7eSjmcneill CARD32 winSize; 1781bff82b7eSjmcneill 1782bff82b7eSjmcneill fbGetDrawable (&pShadow->drawable, shaBase, shaStride, shaBpp, shaXoff, shaYoff); 1783bff82b7eSjmcneill while (nbox--) 1784bff82b7eSjmcneill { 1785bff82b7eSjmcneill x = pbox->x1 * shaBpp; 1786bff82b7eSjmcneill y = pbox->y1; 1787bff82b7eSjmcneill w = (pbox->x2 - pbox->x1) * shaBpp; 1788bff82b7eSjmcneill h = pbox->y2 - pbox->y1; 1789bff82b7eSjmcneill 1790bff82b7eSjmcneill scrLine = (x >> FB_SHIFT); 1791bff82b7eSjmcneill shaLine = shaBase + y * shaStride + (x >> FB_SHIFT); 1792bff82b7eSjmcneill 1793bff82b7eSjmcneill x &= FB_MASK; 1794bff82b7eSjmcneill w = (w + x + FB_MASK) >> FB_SHIFT; 1795bff82b7eSjmcneill 1796bff82b7eSjmcneill while (h--) 1797bff82b7eSjmcneill { 1798bff82b7eSjmcneill winSize = 0; 1799bff82b7eSjmcneill scrBase = 0; 1800bff82b7eSjmcneill width = w; 1801bff82b7eSjmcneill scr = scrLine; 1802bff82b7eSjmcneill sha = shaLine; 1803bff82b7eSjmcneill while (width) { 1804bff82b7eSjmcneill /* how much remains in this window */ 1805bff82b7eSjmcneill i = scrBase + winSize - scr; 1806bff82b7eSjmcneill if (i <= 0 || scr < scrBase) 1807bff82b7eSjmcneill { 1808bff82b7eSjmcneill winBase = (FbBits *) (*pBuf->window) (pScreen, 1809bff82b7eSjmcneill y, 1810bff82b7eSjmcneill scr * sizeof (FbBits), 1811bff82b7eSjmcneill SHADOW_WINDOW_WRITE, 1812bff82b7eSjmcneill &winSize, 1813bff82b7eSjmcneill pBuf->closure); 1814bff82b7eSjmcneill if(!winBase) 1815bff82b7eSjmcneill return; 1816bff82b7eSjmcneill scrBase = scr; 1817bff82b7eSjmcneill winSize /= sizeof (FbBits); 1818bff82b7eSjmcneill i = winSize; 1819bff82b7eSjmcneill } 1820bff82b7eSjmcneill win = winBase + (scr - scrBase); 1821bff82b7eSjmcneill if (i > width) 1822bff82b7eSjmcneill i = width; 1823bff82b7eSjmcneill width -= i; 1824bff82b7eSjmcneill scr += i; 1825bff82b7eSjmcneill WsfbCopyRGB16ToYUY2(win, sha, i * sizeof(FbBits)); 1826bff82b7eSjmcneill sha += i; 1827bff82b7eSjmcneill } 1828bff82b7eSjmcneill shaLine += shaStride; 1829bff82b7eSjmcneill y++; 1830bff82b7eSjmcneill } 1831bff82b7eSjmcneill pbox++; 1832bff82b7eSjmcneill } 1833bff82b7eSjmcneill} 1834bff82b7eSjmcneill 18350ef55ed1Smacallanstatic inline void 18360ef55ed1Smacallanmemcpy32sw(void *dest, void *src, int len) 18370ef55ed1Smacallan{ 18380ef55ed1Smacallan uint32_t *d = dest, *s = src; 18390ef55ed1Smacallan 18400ef55ed1Smacallan#if DEBUG 18410ef55ed1Smacallan if ((((long)dest & 3) + ((long)src & 3) + (len & 3)) != 0) { 18420ef55ed1Smacallan xf86Msg(X_ERROR, "unaligned %s\n", __func__); 18430ef55ed1Smacallan return; 18440ef55ed1Smacallan } 18450ef55ed1Smacallan#endif 18460ef55ed1Smacallan while (len > 0) { 18470ef55ed1Smacallan *d = bswap32(*s); 18480ef55ed1Smacallan d++; 18490ef55ed1Smacallan s++; 18500ef55ed1Smacallan len -= 4; 18510ef55ed1Smacallan } 18520ef55ed1Smacallan} 18530ef55ed1Smacallan 18540ef55ed1Smacallan/* adapted from miext/shadow/shpacked.c::shadowUpdatePacked() */ 18550ef55ed1Smacallanvoid 18560ef55ed1SmacallanWsfbShadowUpdateSwap32(ScreenPtr pScreen, shadowBufPtr pBuf) 18570ef55ed1Smacallan{ 185872ee27a2Smrg RegionPtr damage = DamageRegion (pBuf->pDamage); 18590ef55ed1Smacallan PixmapPtr pShadow = pBuf->pPixmap; 18600ef55ed1Smacallan int nbox = RegionNumRects (damage); 18610ef55ed1Smacallan BoxPtr pbox = RegionRects (damage); 18620ef55ed1Smacallan FbBits *shaBase, *shaLine, *sha; 18630ef55ed1Smacallan FbStride shaStride; 18640ef55ed1Smacallan int scrBase, scrLine, scr; 18650ef55ed1Smacallan int shaBpp; 18660ef55ed1Smacallan int shaXoff, shaYoff; /* XXX assumed to be zero */ 18670ef55ed1Smacallan int x, y, w, h, width; 18680ef55ed1Smacallan int i; 18690ef55ed1Smacallan FbBits *winBase = NULL, *win; 18700ef55ed1Smacallan CARD32 winSize; 18710ef55ed1Smacallan 18720ef55ed1Smacallan fbGetDrawable (&pShadow->drawable, shaBase, shaStride, shaBpp, shaXoff, shaYoff); 18730ef55ed1Smacallan while (nbox--) 18740ef55ed1Smacallan { 18750ef55ed1Smacallan x = pbox->x1 * shaBpp; 18760ef55ed1Smacallan y = pbox->y1; 18770ef55ed1Smacallan w = (pbox->x2 - pbox->x1) * shaBpp; 18780ef55ed1Smacallan h = pbox->y2 - pbox->y1; 18790ef55ed1Smacallan 18800ef55ed1Smacallan scrLine = (x >> FB_SHIFT); 18810ef55ed1Smacallan shaLine = shaBase + y * shaStride + (x >> FB_SHIFT); 18820ef55ed1Smacallan 18830ef55ed1Smacallan x &= FB_MASK; 18840ef55ed1Smacallan w = (w + x + FB_MASK) >> FB_SHIFT; 18850ef55ed1Smacallan 18860ef55ed1Smacallan while (h--) 18870ef55ed1Smacallan { 18880ef55ed1Smacallan winSize = 0; 18890ef55ed1Smacallan scrBase = 0; 18900ef55ed1Smacallan width = w; 18910ef55ed1Smacallan scr = scrLine; 18920ef55ed1Smacallan sha = shaLine; 18930ef55ed1Smacallan while (width) { 18940ef55ed1Smacallan /* how much remains in this window */ 18950ef55ed1Smacallan i = scrBase + winSize - scr; 18960ef55ed1Smacallan if (i <= 0 || scr < scrBase) 18970ef55ed1Smacallan { 18980ef55ed1Smacallan winBase = (FbBits *) (*pBuf->window) (pScreen, 18990ef55ed1Smacallan y, 19000ef55ed1Smacallan scr * sizeof (FbBits), 19010ef55ed1Smacallan SHADOW_WINDOW_WRITE, 19020ef55ed1Smacallan &winSize, 19030ef55ed1Smacallan pBuf->closure); 19040ef55ed1Smacallan if(!winBase) 19050ef55ed1Smacallan return; 19060ef55ed1Smacallan scrBase = scr; 19070ef55ed1Smacallan winSize /= sizeof (FbBits); 19080ef55ed1Smacallan i = winSize; 19090ef55ed1Smacallan } 19100ef55ed1Smacallan win = winBase + (scr - scrBase); 19110ef55ed1Smacallan if (i > width) 19120ef55ed1Smacallan i = width; 19130ef55ed1Smacallan width -= i; 19140ef55ed1Smacallan scr += i; 19150ef55ed1Smacallan memcpy32sw(win, sha, i * sizeof(FbBits)); 19160ef55ed1Smacallan sha += i; 19170ef55ed1Smacallan } 19180ef55ed1Smacallan shaLine += shaStride; 19190ef55ed1Smacallan y++; 19200ef55ed1Smacallan } 19210ef55ed1Smacallan pbox++; 19220ef55ed1Smacallan } 19230ef55ed1Smacallan} 19240ef55ed1Smacallan 1925cbc9a668Smacallanvoid 1926cbc9a668SmacallanWsfbShadowUpdateSplit(ScreenPtr pScreen, shadowBufPtr pBuf) 1927cbc9a668Smacallan{ 1928cbc9a668Smacallan ScrnInfoPtr pScrn = xf86Screens[pScreen->myNum]; 1929cbc9a668Smacallan WsfbPtr fPtr = WSFBPTR(pScrn); 193072ee27a2Smrg RegionPtr damage = DamageRegion (pBuf->pDamage); 1931cbc9a668Smacallan PixmapPtr pShadow = pBuf->pPixmap; 1932cbc9a668Smacallan int nbox = RegionNumRects (damage); 1933cbc9a668Smacallan BoxPtr pbox = RegionRects (damage); 1934cbc9a668Smacallan FbBits *shaBase, *shaLine, *sha; 1935cbc9a668Smacallan FbStride shaStride; 1936cbc9a668Smacallan int scrBase, scrLine, scr; 1937cbc9a668Smacallan int shaBpp; 1938cbc9a668Smacallan int shaXoff, shaYoff; /* XXX assumed to be zero */ 1939cbc9a668Smacallan int x, y, w, h, width; 1940cbc9a668Smacallan int i; 1941cbc9a668Smacallan FbBits *winBase = NULL, *win, *win2; 1942cbc9a668Smacallan unsigned long split = fPtr->fbi.fbi_fbsize / 2; 1943cbc9a668Smacallan CARD32 winSize; 1944cbc9a668Smacallan 1945cbc9a668Smacallan fbGetDrawable (&pShadow->drawable, shaBase, shaStride, shaBpp, shaXoff, shaYoff); 1946cbc9a668Smacallan while (nbox--) 1947cbc9a668Smacallan { 1948cbc9a668Smacallan x = pbox->x1 * shaBpp; 1949cbc9a668Smacallan y = pbox->y1; 1950cbc9a668Smacallan w = (pbox->x2 - pbox->x1) * shaBpp; 1951cbc9a668Smacallan h = pbox->y2 - pbox->y1; 1952cbc9a668Smacallan 1953cbc9a668Smacallan scrLine = (x >> FB_SHIFT); 1954cbc9a668Smacallan shaLine = shaBase + y * shaStride + (x >> FB_SHIFT); 1955cbc9a668Smacallan 1956cbc9a668Smacallan x &= FB_MASK; 1957cbc9a668Smacallan w = (w + x + FB_MASK) >> FB_SHIFT; 1958cbc9a668Smacallan 1959cbc9a668Smacallan while (h--) 1960cbc9a668Smacallan { 1961cbc9a668Smacallan winSize = 0; 1962cbc9a668Smacallan scrBase = 0; 1963cbc9a668Smacallan width = w; 1964cbc9a668Smacallan scr = scrLine; 1965cbc9a668Smacallan sha = shaLine; 1966cbc9a668Smacallan while (width) { 1967cbc9a668Smacallan /* how much remains in this window */ 1968cbc9a668Smacallan i = scrBase + winSize - scr; 1969cbc9a668Smacallan if (i <= 0 || scr < scrBase) 1970cbc9a668Smacallan { 1971cbc9a668Smacallan winBase = (FbBits *) (*pBuf->window) (pScreen, 1972cbc9a668Smacallan y, 1973cbc9a668Smacallan scr * sizeof (FbBits), 1974cbc9a668Smacallan SHADOW_WINDOW_WRITE, 1975cbc9a668Smacallan &winSize, 1976cbc9a668Smacallan pBuf->closure); 1977cbc9a668Smacallan if(!winBase) 1978cbc9a668Smacallan return; 1979cbc9a668Smacallan scrBase = scr; 1980cbc9a668Smacallan winSize /= sizeof (FbBits); 1981cbc9a668Smacallan i = winSize; 1982cbc9a668Smacallan } 1983cbc9a668Smacallan win = winBase + (scr - scrBase); 1984cbc9a668Smacallan win2 = (FbBits *)(split + (unsigned long)win); 1985cbc9a668Smacallan if (i > width) 1986cbc9a668Smacallan i = width; 1987cbc9a668Smacallan width -= i; 1988cbc9a668Smacallan scr += i; 1989cbc9a668Smacallan memcpy(win, sha, i * sizeof(FbBits)); 1990cbc9a668Smacallan memcpy(win2, sha, i * sizeof(FbBits)); 1991cbc9a668Smacallan sha += i; 1992cbc9a668Smacallan } 1993cbc9a668Smacallan shaLine += shaStride; 1994cbc9a668Smacallan y++; 1995cbc9a668Smacallan } 1996cbc9a668Smacallan pbox++; 1997cbc9a668Smacallan } 1998cbc9a668Smacallan} 1999