887 lines
		
	
	
		
			23 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			887 lines
		
	
	
		
			23 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * 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>
 | |
| #include "xf86.h"
 | |
| #include "xf86Priv.h"
 | |
| 
 | |
| #include <errno.h>
 | |
| #include <sys/mman.h>
 | |
| 
 | |
| #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>
 | |
| #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
 | |
| #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
 | |
| 
 | |
| #ifdef __OpenBSD__
 | |
| #define SYSCTL_MSG "\tCheck that you have set 'machdep.allowaperture=1'\n"\
 | |
| 		   "\tin /etc/sysctl.conf and reboot your machine\n" \
 | |
| 		   "\trefer to xf86(4) for details"
 | |
| #define SYSCTL_MSG2 \
 | |
| 		"Check that you have set 'machdep.allowaperture=2'\n" \
 | |
| 		"\tin /etc/sysctl.conf and reboot your machine\n" \
 | |
| 		"\trefer to xf86(4) for details"
 | |
| #endif
 | |
| 
 | |
| /***************************************************************************/
 | |
| /* Video Memory Mapping section                                            */
 | |
| /***************************************************************************/
 | |
| 
 | |
| static Bool useDevMem = FALSE;
 | |
| static int devMemFd = -1;
 | |
| 
 | |
| #ifdef HAS_APERTURE_DRV
 | |
| #define DEV_APERTURE "/dev/xf86"
 | |
| #endif
 | |
| 
 | |
| 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,
 | |
|                     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,
 | |
|                     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 (useDevMem)
 | |
|         pci_system_init_dev_mem(devMemFd);
 | |
| 
 | |
| #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) {
 | |
|             FatalError("xf86MapVidMem: failed to open %s (%s)",
 | |
|                        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);
 | |
|         if (base == MAP_FAILED) {
 | |
|             FatalError("%s: could not mmap %s [s=%lx,a=%lx] (%s)",
 | |
|                        "xf86MapVidMem", DEV_MEM, Size, Base, strerror(errno));
 | |
|         }
 | |
|         return base;
 | |
|     }
 | |
| 
 | |
|     /* else, mmap /dev/vga */
 | |
|     if ((unsigned long) Base < 0xA0000 || (unsigned long) Base >= 0xC0000) {
 | |
|         FatalError("%s: Address 0x%lx outside allowable range",
 | |
|                    "xf86MapVidMem", Base);
 | |
|     }
 | |
|     base = mmap(0, Size,
 | |
|                 (flags & VIDMEM_READONLY) ?
 | |
|                 PROT_READ : (PROT_READ | PROT_WRITE),
 | |
|                 MAP_FLAGS, xf86Info.consoleFd, (unsigned long) Base - 0xA0000);
 | |
|     if (base == MAP_FAILED) {
 | |
|         FatalError("xf86MapVidMem: Could not mmap /dev/vga (%s)",
 | |
|                    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
 | |
| 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();
 | |
|     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,
 | |
|                 "xf86ReadBIOS: %s mmap[s=%x,a=%lx,o=%lx] failed (%s)\n",
 | |
|                 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
 | |
| xf86EnableIO()
 | |
| {
 | |
|     if (ExtendedEnabled)
 | |
|         return TRUE;
 | |
| 
 | |
|     if (i386_iopl(TRUE) < 0) {
 | |
| #ifndef __OpenBSD__
 | |
|         xf86Msg(X_WARNING, "%s: Failed to set IOPL for extended I/O",
 | |
|                 "xf86EnableIO");
 | |
| #else
 | |
|         xf86Msg(X_WARNING, "%s: Failed to set IOPL for extended I/O\n%s",
 | |
|                 "xf86EnableIO", SYSCTL_MSG);
 | |
| #endif
 | |
|         return FALSE;
 | |
|     }
 | |
|     ExtendedEnabled = TRUE;
 | |
| 
 | |
|     return TRUE;
 | |
| }
 | |
| 
 | |
| void
 | |
| xf86DisableIO()
 | |
| {
 | |
|     if (!ExtendedEnabled)
 | |
|         return;
 | |
| 
 | |
|     i386_iopl(FALSE);
 | |
|     ExtendedEnabled = FALSE;
 | |
| 
 | |
|     return;
 | |
| }
 | |
| 
 | |
| #endif                          /* USE_I386_IOPL */
 | |
| 
 | |
| #ifdef USE_AMD64_IOPL
 | |
| /***************************************************************************/
 | |
| /* I/O Permissions section                                                 */
 | |
| /***************************************************************************/
 | |
| 
 | |
| static Bool ExtendedEnabled = FALSE;
 | |
| 
 | |
| Bool
 | |
| xf86EnableIO()
 | |
| {
 | |
|     if (ExtendedEnabled)
 | |
|         return TRUE;
 | |
| 
 | |
|     if (amd64_iopl(TRUE) < 0) {
 | |
| #ifndef __OpenBSD__
 | |
|         xf86Msg(X_WARNING, "%s: Failed to set IOPL for extended I/O",
 | |
|                 "xf86EnableIO");
 | |
| #else
 | |
|         xf86Msg(X_WARNING, "%s: Failed to set IOPL for extended I/O\n%s",
 | |
|                 "xf86EnableIO", SYSCTL_MSG);
 | |
| #endif
 | |
|         return FALSE;
 | |
|     }
 | |
|     ExtendedEnabled = TRUE;
 | |
| 
 | |
|     return TRUE;
 | |
| }
 | |
| 
 | |
| 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 */
 | |
| 
 | |
| #ifdef USE_DEV_IO
 | |
| static int IoFd = -1;
 | |
| 
 | |
| Bool
 | |
| xf86EnableIO()
 | |
| {
 | |
|     if (IoFd >= 0)
 | |
|         return TRUE;
 | |
| 
 | |
|     if ((IoFd = open("/dev/io", O_RDWR)) == -1) {
 | |
|         xf86Msg(X_WARNING, "xf86EnableIO: "
 | |
|                 "Failed to open /dev/io for extended I/O");
 | |
|         return FALSE;
 | |
|     }
 | |
|     return TRUE;
 | |
| }
 | |
| 
 | |
| void
 | |
| xf86DisableIO()
 | |
| {
 | |
|     if (IoFd < 0)
 | |
|         return;
 | |
| 
 | |
|     close(IoFd);
 | |
|     IoFd = -1;
 | |
|     return;
 | |
| }
 | |
| 
 | |
| #endif
 | |
| 
 | |
| #ifdef __NetBSD__
 | |
| /***************************************************************************/
 | |
| /* Set TV output mode                                                      */
 | |
| /***************************************************************************/
 | |
| void
 | |
| 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:
 | |
|         FatalError("Xf86SetTVOut: Unsupported console");
 | |
|         break;
 | |
|     }
 | |
|     return;
 | |
| }
 | |
| 
 | |
| void
 | |
| 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:
 | |
|         FatalError("Xf86SetTVOut: Unsupported console");
 | |
|         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)) {
 | |
|         free(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);
 | |
| #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
 | |
|     free(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;
 | |
|         free(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;
 | |
|         }
 | |
|     }
 | |
|     free(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) {
 | |
|         free(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);
 | |
|     free(mtrrp);
 | |
| }
 | |
| #endif
 |