xserver-multidpi/hw/xfree86/os-support/bsd/i386_video.c

909 lines
20 KiB
C
Raw Normal View History

2003-11-14 17:48:57 +01:00
/*
* Copyright 1992 by Rich Murphey <Rich@Rice.edu>
* Copyright 1993 by David Wexelblat <dwex@goblin.org>
*
* Permission to use, copy, modify, distribute, and sell this software and its
* documentation for any purpose is hereby granted without fee, provided that
* the above copyright notice appear in all copies and that both that
* copyright notice and this permission notice appear in supporting
* documentation, and that the names of Rich Murphey and David Wexelblat
* not be used in advertising or publicity pertaining to distribution of
* the software without specific, written prior permission. Rich Murphey and
* David Wexelblat make no representations about the suitability of this
* software for any purpose. It is provided "as is" without express or
* implied warranty.
*
* RICH MURPHEY AND DAVID WEXELBLAT DISCLAIM ALL WARRANTIES WITH REGARD TO
* THIS SOFTWARE, INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND
* FITNESS, IN NO EVENT SHALL RICH MURPHEY OR DAVID WEXELBLAT BE LIABLE FOR
* ANY SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER
* RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF
* CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
* CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*
*/
#ifdef HAVE_XORG_CONFIG_H
#include <xorg-config.h>
#endif
#include <X11/X.h>
2003-11-14 17:48:57 +01:00
#include "xf86.h"
#include "xf86Priv.h"
#include <errno.h>
#include <sys/mman.h>
2003-11-14 17:48:57 +01:00
#ifdef HAS_MTRR_SUPPORT
#ifndef __NetBSD__
#include <sys/types.h>
#include <sys/memrange.h>
#else
#include "memrange.h"
#endif
#define X_MTRR_ID "XFree86"
#endif
#if defined(HAS_MTRR_BUILTIN) && defined(__NetBSD__)
#include <machine/mtrr.h>
#include <machine/sysarch.h>
#include <sys/queue.h>
2007-04-11 01:15:40 +02:00
#ifdef __x86_64__
#define i386_set_mtrr x86_64_set_mtrr
#define i386_get_mtrr x86_64_get_mtrr
#define i386_iopl x86_64_iopl
#endif
2003-11-14 17:48:57 +01:00
#endif
#include "xf86_OSlib.h"
#include "xf86OSpriv.h"
#if defined(__NetBSD__) && !defined(MAP_FILE)
#define MAP_FLAGS MAP_SHARED
#else
#define MAP_FLAGS (MAP_FILE | MAP_SHARED)
#endif
#ifndef MAP_FAILED
#define MAP_FAILED ((caddr_t)-1)
#endif
#ifdef __OpenBSD__
#define SYSCTL_MSG "\tCheck that you have set 'machdep.allowaperture=1'\n"\
"\tin /etc/sysctl.conf and reboot your machine\n" \
2004-07-24 18:32:39 +02:00
"\trefer to xf86(4) for details"
2003-11-14 17:48:57 +01:00
#define SYSCTL_MSG2 \
"Check that you have set 'machdep.allowaperture=2'\n" \
"\tin /etc/sysctl.conf and reboot your machine\n" \
2004-07-24 18:32:39 +02:00
"\trefer to xf86(4) for details"
2003-11-14 17:48:57 +01:00
#endif
/***************************************************************************/
/* Video Memory Mapping section */
/***************************************************************************/
static Bool useDevMem = FALSE;
static int devMemFd = -1;
#ifdef HAS_APERTURE_DRV
#define DEV_APERTURE "/dev/xf86"
#endif
#define DEV_MEM "/dev/mem"
static pointer mapVidMem(int, unsigned long, unsigned long, int);
static void unmapVidMem(int, pointer, unsigned long);
#ifdef HAS_MTRR_SUPPORT
static pointer setWC(int, unsigned long, unsigned long, Bool, MessageType);
static void undoWC(int, pointer);
static Bool cleanMTRR(void);
#endif
#if defined(HAS_MTRR_BUILTIN) && defined(__NetBSD__)
static pointer NetBSDsetWC(int, unsigned long, unsigned long, Bool,
MessageType);
static void NetBSDundoWC(int, pointer);
#endif
/*
* Check if /dev/mem can be mmap'd. If it can't print a warning when
* "warn" is TRUE.
*/
static void
checkDevMem(Bool warn)
{
static Bool devMemChecked = FALSE;
int fd;
pointer base;
if (devMemChecked)
return;
devMemChecked = TRUE;
if ((fd = open(DEV_MEM, O_RDWR)) >= 0)
{
/* Try to map a page at the VGA address */
base = mmap((caddr_t)0, 4096, PROT_READ | PROT_WRITE,
2003-11-14 17:48:57 +01:00
MAP_FLAGS, fd, (off_t)0xA0000);
if (base != MAP_FAILED)
{
munmap((caddr_t)base, 4096);
devMemFd = fd;
useDevMem = TRUE;
return;
} else {
/* This should not happen */
if (warn)
{
xf86Msg(X_WARNING, "checkDevMem: failed to mmap %s (%s)\n",
DEV_MEM, strerror(errno));
}
useDevMem = FALSE;
return;
}
}
#ifndef HAS_APERTURE_DRV
if (warn)
{
xf86Msg(X_WARNING, "checkDevMem: failed to open %s (%s)\n",
DEV_MEM, strerror(errno));
}
useDevMem = FALSE;
return;
#else
/* Failed to open /dev/mem, try the aperture driver */
if ((fd = open(DEV_APERTURE, O_RDWR)) >= 0)
{
/* Try to map a page at the VGA address */
base = mmap((caddr_t)0, 4096, PROT_READ | PROT_WRITE,
2003-11-14 17:48:57 +01:00
MAP_FLAGS, fd, (off_t)0xA0000);
if (base != MAP_FAILED)
{
munmap((caddr_t)base, 4096);
devMemFd = fd;
useDevMem = TRUE;
xf86Msg(X_INFO, "checkDevMem: using aperture driver %s\n",
DEV_APERTURE);
return;
} else {
if (warn)
{
xf86Msg(X_WARNING, "checkDevMem: failed to mmap %s (%s)\n",
DEV_APERTURE, strerror(errno));
}
}
} else {
if (warn)
{
#ifndef __OpenBSD__
xf86Msg(X_WARNING, "checkDevMem: failed to open %s and %s\n"
"\t(%s)\n", DEV_MEM, DEV_APERTURE, strerror(errno));
#else /* __OpenBSD__ */
xf86Msg(X_WARNING, "checkDevMem: failed to open %s and %s\n"
"\t(%s)\n%s", DEV_MEM, DEV_APERTURE, strerror(errno),
SYSCTL_MSG);
#endif /* __OpenBSD__ */
}
}
useDevMem = FALSE;
return;
#endif
}
void
xf86OSInitVidMem(VidMemInfoPtr pVidMem)
{
checkDevMem(TRUE);
pVidMem->linearSupported = useDevMem;
pVidMem->mapMem = mapVidMem;
pVidMem->unmapMem = unmapVidMem;
#if HAVE_PCI_SYSTEM_INIT_DEV_MEM
if (useDevMem)
pci_system_init_dev_mem(devMemFd);
#endif
2003-11-14 17:48:57 +01:00
#ifdef HAS_MTRR_SUPPORT
if (useDevMem) {
if (cleanMTRR()) {
pVidMem->setWC = setWC;
pVidMem->undoWC = undoWC;
}
}
#endif
#if defined(HAS_MTRR_BUILTIN) && defined(__NetBSD__)
pVidMem->setWC = NetBSDsetWC;
pVidMem->undoWC = NetBSDundoWC;
#endif
pVidMem->initialised = TRUE;
}
static pointer
mapVidMem(int ScreenNum, unsigned long Base, unsigned long Size, int flags)
{
pointer base;
checkDevMem(FALSE);
if (useDevMem)
{
if (devMemFd < 0)
{
2004-07-24 18:32:39 +02:00
FatalError("xf86MapVidMem: failed to open %s (%s)",
2003-11-14 17:48:57 +01:00
DEV_MEM, strerror(errno));
}
base = mmap((caddr_t)0, Size,
(flags & VIDMEM_READONLY) ?
PROT_READ : (PROT_READ | PROT_WRITE),
MAP_FLAGS, devMemFd, (off_t)Base);
2003-11-14 17:48:57 +01:00
if (base == MAP_FAILED)
{
2004-07-24 18:32:39 +02:00
FatalError("%s: could not mmap %s [s=%lx,a=%lx] (%s)",
2003-11-14 17:48:57 +01:00
"xf86MapVidMem", DEV_MEM, Size, Base,
strerror(errno));
}
return(base);
}
/* else, mmap /dev/vga */
if ((unsigned long)Base < 0xA0000 || (unsigned long)Base >= 0xC0000)
{
2004-07-24 18:32:39 +02:00
FatalError("%s: Address 0x%lx outside allowable range",
2003-11-14 17:48:57 +01:00
"xf86MapVidMem", Base);
}
base = mmap(0, Size,
(flags & VIDMEM_READONLY) ?
PROT_READ : (PROT_READ | PROT_WRITE),
MAP_FLAGS, xf86Info.screenFd,
(unsigned long)Base - 0xA0000
2003-11-14 17:48:57 +01:00
);
if (base == MAP_FAILED)
{
2004-07-24 18:32:39 +02:00
FatalError("xf86MapVidMem: Could not mmap /dev/vga (%s)",
2003-11-14 17:48:57 +01:00
strerror(errno));
}
return(base);
}
static void
unmapVidMem(int ScreenNum, pointer Base, unsigned long Size)
{
munmap((caddr_t)Base, Size);
}
/*
* Read BIOS via mmap()ing DEV_MEM
*/
int
2003-11-14 17:48:57 +01:00
xf86ReadBIOS(unsigned long Base, unsigned long Offset, unsigned char *Buf,
int Len)
{
unsigned char *ptr;
int psize;
int mlen;
checkDevMem(TRUE);
if (devMemFd == -1) {
return(-1);
}
psize = getpagesize();
2003-11-14 17:48:57 +01:00
Offset += Base & (psize - 1);
Base &= ~(psize - 1);
mlen = (Offset + Len + psize - 1) & ~(psize - 1);
ptr = (unsigned char *)mmap((caddr_t)0, mlen, PROT_READ,
MAP_SHARED, devMemFd, (off_t)Base);
if ((long)ptr == -1)
{
xf86Msg(X_WARNING,
2004-07-24 18:32:39 +02:00
"xf86ReadBIOS: %s mmap[s=%x,a=%lx,o=%lx] failed (%s)\n",
2003-11-14 17:48:57 +01:00
DEV_MEM, Len, Base, Offset, strerror(errno));
#ifdef __OpenBSD__
if (Base < 0xa0000) {
xf86Msg(X_WARNING, SYSCTL_MSG2);
}
#endif
return(-1);
}
#ifdef DEBUG
ErrorF("xf86ReadBIOS: BIOS at 0x%08x has signature 0x%04x\n",
Base, ptr[0] | (ptr[1] << 8));
#endif
(void)memcpy(Buf, (void *)(ptr + Offset), Len);
(void)munmap((caddr_t)ptr, mlen);
#ifdef DEBUG
xf86MsgVerb(X_INFO, 3, "xf86ReadBIOS(%x, %x, Buf, %x)"
"-> %02x %02x %02x %02x...\n",
Base, Offset, Len, Buf[0], Buf[1], Buf[2], Buf[3]);
#endif
return(Len);
}
#ifdef USE_I386_IOPL
/***************************************************************************/
/* I/O Permissions section */
/***************************************************************************/
static Bool ExtendedEnabled = FALSE;
Bool
2003-11-14 17:48:57 +01:00
xf86EnableIO()
{
if (ExtendedEnabled)
return TRUE;
2003-11-14 17:48:57 +01:00
if (i386_iopl(TRUE) < 0)
{
#ifndef __OpenBSD__
xf86Msg(X_WARNING,"%s: Failed to set IOPL for extended I/O",
2003-11-14 17:48:57 +01:00
"xf86EnableIO");
#else
xf86Msg(X_WARNING,"%s: Failed to set IOPL for extended I/O\n%s",
2003-11-14 17:48:57 +01:00
"xf86EnableIO", SYSCTL_MSG);
#endif
return FALSE;
2003-11-14 17:48:57 +01:00
}
ExtendedEnabled = TRUE;
return TRUE;
2003-11-14 17:48:57 +01:00
}
void
2003-11-14 17:48:57 +01:00
xf86DisableIO()
{
if (!ExtendedEnabled)
return;
i386_iopl(FALSE);
ExtendedEnabled = FALSE;
return;
}
#endif /* USE_I386_IOPL */
2004-07-24 18:32:39 +02:00
#ifdef USE_AMD64_IOPL
/***************************************************************************/
/* I/O Permissions section */
/***************************************************************************/
static Bool ExtendedEnabled = FALSE;
Bool
2004-07-24 18:32:39 +02:00
xf86EnableIO()
{
if (ExtendedEnabled)
return TRUE;
2004-07-24 18:32:39 +02:00
if (amd64_iopl(TRUE) < 0)
{
#ifndef __OpenBSD__
xf86Msg(X_WARNING,"%s: Failed to set IOPL for extended I/O",
2004-07-24 18:32:39 +02:00
"xf86EnableIO");
#else
xf86Msg(X_WARNING,"%s: Failed to set IOPL for extended I/O\n%s",
2004-07-24 18:32:39 +02:00
"xf86EnableIO", SYSCTL_MSG);
#endif
return FALSE;
2004-07-24 18:32:39 +02:00
}
ExtendedEnabled = TRUE;
return TRUE;
2004-07-24 18:32:39 +02:00
}
void
xf86DisableIO()
{
if (!ExtendedEnabled)
return;
if (amd64_iopl(FALSE) == 0) {
ExtendedEnabled = FALSE;
}
/* Otherwise, the X server has revoqued its root uid,
and thus cannot give up IO privileges any more */
return;
}
#endif /* USE_AMD64_IOPL */
2003-11-14 17:48:57 +01:00
#ifdef USE_DEV_IO
static int IoFd = -1;
Bool
2003-11-14 17:48:57 +01:00
xf86EnableIO()
{
if (IoFd >= 0)
return TRUE;
2003-11-14 17:48:57 +01:00
if ((IoFd = open("/dev/io", O_RDWR)) == -1)
{
xf86Msg(X_WARNING,"xf86EnableIO: "
2004-07-24 18:32:39 +02:00
"Failed to open /dev/io for extended I/O");
return FALSE;
2003-11-14 17:48:57 +01:00
}
return TRUE;
2003-11-14 17:48:57 +01:00
}
void
xf86DisableIO()
{
if (IoFd < 0)
return;
close(IoFd);
IoFd = -1;
return;
}
#endif
#ifdef __NetBSD__
/***************************************************************************/
/* Set TV output mode */
/***************************************************************************/
void
2003-11-14 17:48:57 +01:00
xf86SetTVOut(int mode)
{
switch (xf86Info.consType)
{
#ifdef PCCONS_SUPPORT
case PCCONS:{
if (ioctl (xf86Info.consoleFd, CONSOLE_X_TV_ON, &mode) < 0)
{
xf86Msg(X_WARNING,
"xf86SetTVOut: Could not set console to TV output, %s\n",
strerror(errno));
}
}
break;
#endif /* PCCONS_SUPPORT */
default:
2004-07-24 18:32:39 +02:00
FatalError("Xf86SetTVOut: Unsupported console");
2003-11-14 17:48:57 +01:00
break;
}
return;
}
void
2003-11-14 17:48:57 +01:00
xf86SetRGBOut()
{
switch (xf86Info.consType)
{
#ifdef PCCONS_SUPPORT
case PCCONS:{
if (ioctl (xf86Info.consoleFd, CONSOLE_X_TV_OFF, 0) < 0)
{
xf86Msg(X_WARNING,
"xf86SetTVOut: Could not set console to RGB output, %s\n",
strerror(errno));
}
}
break;
#endif /* PCCONS_SUPPORT */
default:
2004-07-24 18:32:39 +02:00
FatalError("Xf86SetTVOut: Unsupported console");
2003-11-14 17:48:57 +01:00
break;
}
return;
}
#endif
#ifdef HAS_MTRR_SUPPORT
/* memory range (MTRR) support for FreeBSD */
/*
* This code is experimental. Some parts may be overkill, and other parts
* may be incomplete.
*/
/*
* getAllRanges returns the full list of memory ranges with attributes set.
*/
static struct mem_range_desc *
getAllRanges(int *nmr)
{
struct mem_range_desc *mrd;
struct mem_range_op mro;
/*
* Find how many ranges there are. If this fails, then the kernel
* probably doesn't have MTRR support.
*/
mro.mo_arg[0] = 0;
if (ioctl(devMemFd, MEMRANGE_GET, &mro))
return NULL;
*nmr = mro.mo_arg[0];
mrd = xnfalloc(*nmr * sizeof(struct mem_range_desc));
mro.mo_arg[0] = *nmr;
mro.mo_desc = mrd;
if (ioctl(devMemFd, MEMRANGE_GET, &mro)) {
xfree(mrd);
return NULL;
}
return mrd;
}
/*
* cleanMTRR removes any memory attribute that may be left by a previous
* X server. Normally there won't be any, but this takes care of the
* case where a server crashed without being able finish cleaning up.
*/
static Bool
cleanMTRR()
{
struct mem_range_desc *mrd;
struct mem_range_op mro;
int nmr, i;
/* This shouldn't happen */
if (devMemFd < 0)
return FALSE;
if (!(mrd = getAllRanges(&nmr)))
return FALSE;
for (i = 0; i < nmr; i++) {
if (strcmp(mrd[i].mr_owner, X_MTRR_ID) == 0 &&
(mrd[i].mr_flags & MDF_ACTIVE)) {
#ifdef DEBUG
ErrorF("Clean for (0x%lx,0x%lx)\n",
(unsigned long)mrd[i].mr_base,
(unsigned long)mrd[i].mr_len);
2003-11-14 17:48:57 +01:00
#endif
if (mrd[i].mr_flags & MDF_FIXACTIVE) {
mro.mo_arg[0] = MEMRANGE_SET_UPDATE;
mrd[i].mr_flags = MDF_UNCACHEABLE;
} else {
mro.mo_arg[0] = MEMRANGE_SET_REMOVE;
}
mro.mo_desc = mrd + i;
ioctl(devMemFd, MEMRANGE_SET, &mro);
}
}
#ifdef DEBUG
sleep(10);
#endif
xfree(mrd);
return TRUE;
}
typedef struct x_RangeRec {
struct mem_range_desc mrd;
Bool wasWC;
struct x_RangeRec * next;
} RangeRec, *RangePtr;
static void
freeRangeList(RangePtr range)
{
RangePtr rp;
while (range) {
rp = range;
range = rp->next;
xfree(rp);
}
}
static RangePtr
dupRangeList(RangePtr list)
{
RangePtr new = NULL, rp, p;
rp = list;
while (rp) {
p = xnfalloc(sizeof(RangeRec));
*p = *rp;
p->next = new;
new = p;
rp = rp->next;
}
return new;
}
static RangePtr
sortRangeList(RangePtr list)
{
RangePtr rp1, rp2, copy, sorted = NULL, minp, prev, minprev;
unsigned long minBase;
/* Sort by base address */
rp1 = copy = dupRangeList(list);
while (rp1) {
minBase = rp1->mrd.mr_base;
minp = rp1;
minprev = NULL;
prev = rp1;
rp2 = rp1->next;
while (rp2) {
if (rp2->mrd.mr_base < minBase) {
minBase = rp2->mrd.mr_base;
minp = rp2;
minprev = prev;
}
prev = rp2;
rp2 = rp2->next;
}
if (minprev) {
minprev->next = minp->next;
rp1 = copy;
} else {
rp1 = minp->next;
}
minp->next = sorted;
sorted = minp;
}
return sorted;
}
/*
* findRanges returns a list of ranges that overlap the specified range.
*/
static void
findRanges(unsigned long base, unsigned long size, RangePtr *ucp, RangePtr *wcp)
{
struct mem_range_desc *mrd;
int nmr, i;
RangePtr rp, *p;
if (!(mrd = getAllRanges(&nmr)))
return;
for (i = 0; i < nmr; i++) {
if ((mrd[i].mr_flags & MDF_ACTIVE) &&
mrd[i].mr_base < base + size &&
mrd[i].mr_base + mrd[i].mr_len > base) {
if (mrd[i].mr_flags & MDF_WRITECOMBINE)
p = wcp;
else if (mrd[i].mr_flags & MDF_UNCACHEABLE)
p = ucp;
else
continue;
rp = xnfalloc(sizeof(RangeRec));
rp->mrd = mrd[i];
rp->next = *p;
*p = rp;
}
}
xfree(mrd);
}
/*
* This checks if the existing overlapping ranges fully cover the requested
* range. Is this overkill?
*/
static Bool
fullCoverage(unsigned long base, unsigned long size, RangePtr overlap)
{
RangePtr rp1, sorted = NULL;
unsigned long end;
sorted = sortRangeList(overlap);
/* Look for gaps */
rp1 = sorted;
end = base + size;
while (rp1) {
if (rp1->mrd.mr_base > base) {
freeRangeList(sorted);
return FALSE;
} else {
base = rp1->mrd.mr_base + rp1->mrd.mr_len;
}
if (base >= end) {
freeRangeList(sorted);
return TRUE;
}
rp1 = rp1->next;
}
freeRangeList(sorted);
return FALSE;
}
static pointer
addWC(int screenNum, unsigned long base, unsigned long size, MessageType from)
{
RangePtr uc = NULL, wc = NULL, retlist = NULL;
struct mem_range_desc mrd;
struct mem_range_op mro;
findRanges(base, size, &uc, &wc);
/* See of the full range is already WC */
if (!uc && fullCoverage(base, size, wc)) {
xf86DrvMsg(screenNum, from,
"Write-combining range (0x%lx,0x%lx) was already set\n",
base, size);
return NULL;
}
/* Otherwise, try to add the new range */
mrd.mr_base = base;
mrd.mr_len = size;
strcpy(mrd.mr_owner, X_MTRR_ID);
mrd.mr_flags = MDF_WRITECOMBINE;
mro.mo_desc = &mrd;
mro.mo_arg[0] = MEMRANGE_SET_UPDATE;
if (ioctl(devMemFd, MEMRANGE_SET, &mro)) {
xf86DrvMsg(screenNum, X_WARNING,
"Failed to set write-combining range "
"(0x%lx,0x%lx)\n", base, size);
return NULL;
} else {
xf86DrvMsg(screenNum, from,
"Write-combining range (0x%lx,0x%lx)\n", base, size);
retlist = xnfalloc(sizeof(RangeRec));
retlist->mrd = mrd;
retlist->wasWC = FALSE;
retlist->next = NULL;
return retlist;
}
}
static pointer
delWC(int screenNum, unsigned long base, unsigned long size, MessageType from)
{
RangePtr uc = NULL, wc = NULL, retlist = NULL;
struct mem_range_desc mrd;
struct mem_range_op mro;
findRanges(base, size, &uc, &wc);
/*
* See of the full range is already not WC, or if there is full
* coverage from UC ranges.
*/
if (!wc || fullCoverage(base, size, uc)) {
xf86DrvMsg(screenNum, from,
"Write-combining range (0x%lx,0x%lx) was already clear\n",
base, size);
return NULL;
}
/* Otherwise, try to add the new range */
mrd.mr_base = base;
mrd.mr_len = size;
strcpy(mrd.mr_owner, X_MTRR_ID);
mrd.mr_flags = MDF_UNCACHEABLE;
mro.mo_desc = &mrd;
mro.mo_arg[0] = MEMRANGE_SET_UPDATE;
if (ioctl(devMemFd, MEMRANGE_SET, &mro)) {
xf86DrvMsg(screenNum, X_WARNING,
"Failed to remove write-combining range "
"(0x%lx,0x%lx)\n", base, size);
/* XXX Should then remove all of the overlapping WC ranges */
return NULL;
} else {
xf86DrvMsg(screenNum, from,
"Removed Write-combining range (0x%lx,0x%lx)\n",
base, size);
retlist = xnfalloc(sizeof(RangeRec));
retlist->mrd = mrd;
retlist->wasWC = TRUE;
retlist->next = NULL;
return retlist;
}
}
static pointer
setWC(int screenNum, unsigned long base, unsigned long size, Bool enable,
MessageType from)
{
if (enable)
return addWC(screenNum, base, size, from);
else
return delWC(screenNum, base, size, from);
}
static void
undoWC(int screenNum, pointer list)
{
RangePtr rp;
struct mem_range_op mro;
Bool failed;
rp = list;
while (rp) {
#ifdef DEBUG
ErrorF("Undo for (0x%lx,0x%lx), %d\n",
(unsigned long)rp->mrd.mr_base,
(unsigned long)rp->mrd.mr_len, rp->wasWC);
#endif
failed = FALSE;
if (rp->wasWC) {
mro.mo_arg[0] = MEMRANGE_SET_UPDATE;
rp->mrd.mr_flags = MDF_WRITECOMBINE;
strcpy(rp->mrd.mr_owner, "unknown");
} else {
mro.mo_arg[0] = MEMRANGE_SET_REMOVE;
}
mro.mo_desc = &rp->mrd;
if (ioctl(devMemFd, MEMRANGE_SET, &mro)) {
if (!rp->wasWC) {
mro.mo_arg[0] = MEMRANGE_SET_UPDATE;
rp->mrd.mr_flags = MDF_UNCACHEABLE;
strcpy(rp->mrd.mr_owner, "unknown");
if (ioctl(devMemFd, MEMRANGE_SET, &mro))
failed = TRUE;
} else
failed = TRUE;
}
if (failed) {
xf86DrvMsg(screenNum, X_WARNING,
"Failed to restore MTRR range (0x%lx,0x%lx)\n",
(unsigned long)rp->mrd.mr_base,
(unsigned long)rp->mrd.mr_len);
}
rp = rp->next;
}
}
#endif /* HAS_MTRR_SUPPORT */
#if defined(HAS_MTRR_BUILTIN) && defined(__NetBSD__)
static pointer
NetBSDsetWC(int screenNum, unsigned long base, unsigned long size, Bool enable,
MessageType from)
{
struct mtrr *mtrrp;
int n;
xf86DrvMsg(screenNum, X_WARNING,
"%s MTRR %lx - %lx\n", enable ? "set" : "remove",
base, (base + size));
mtrrp = xnfalloc(sizeof (struct mtrr));
mtrrp->base = base;
mtrrp->len = size;
mtrrp->type = MTRR_TYPE_WC;
/*
* MTRR_PRIVATE will make this MTRR get reset automatically
* if this process exits, so we have no need for an explicit
* cleanup operation when starting a new server.
*/
if (enable)
mtrrp->flags = MTRR_VALID | MTRR_PRIVATE;
else
mtrrp->flags = 0;
n = 1;
if (i386_set_mtrr(mtrrp, &n) < 0) {
xfree(mtrrp);
return NULL;
}
return mtrrp;
}
static void
NetBSDundoWC(int screenNum, pointer list)
{
struct mtrr *mtrrp = (struct mtrr *)list;
int n;
if (mtrrp == NULL)
return;
n = 1;
mtrrp->flags &= ~MTRR_VALID;
i386_set_mtrr(mtrrp, &n);
xfree(mtrrp);
}
#endif