715 lines
		
	
	
		
			18 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			715 lines
		
	
	
		
			18 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 <sys/param.h>
 | |
| #ifndef __NetBSD__
 | |
| #  include <sys/sysctl.h>
 | |
| #  if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
 | |
| #      include <machine/sysarch.h>
 | |
| #   endif
 | |
| # else
 | |
| #  include <machine/sysarch.h>
 | |
| #endif
 | |
| 
 | |
| #include "xf86Axp.h"
 | |
| 
 | |
| #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
 | |
| 
 | |
| axpDevice bsdGetAXP(void);
 | |
| 
 | |
| #ifndef __NetBSD__
 | |
| extern unsigned long dense_base(void);
 | |
| 
 | |
| static int axpSystem = -1;
 | |
| static unsigned long hae_thresh;
 | |
| static unsigned long hae_mask;
 | |
| static unsigned long bus_base;
 | |
| static unsigned long sparse_size;
 | |
| 
 | |
| static unsigned long
 | |
| memory_base(void)
 | |
| {
 | |
|     static unsigned long base = 0;
 | |
| 
 | |
|     if (base == 0) {
 | |
| 	size_t len = sizeof(base);
 | |
| 	int error;
 | |
| #ifdef __OpenBSD__
 | |
|        int mib[3];
 | |
| 
 | |
|        mib[0] = CTL_MACHDEP;
 | |
|        mib[1] = CPU_CHIPSET;
 | |
|        mib[2] = CPU_CHIPSET_MEM;
 | |
| 
 | |
|        if ((error = sysctl(mib, 3, &base, &len, NULL, 0)) < 0)
 | |
| #else
 | |
| 	if ((error = sysctlbyname("hw.chipset.memory", &base, &len,
 | |
| 				  0, 0)) < 0)
 | |
| #endif
 | |
| 	    FatalError("xf86MapVidMem: can't find memory\n");
 | |
|     }
 | |
| 
 | |
|     return base;
 | |
| }
 | |
| 
 | |
| static int
 | |
| has_bwx(void)
 | |
| {
 | |
|     static int bwx = 0;
 | |
|     size_t len = sizeof(bwx);
 | |
|     int error;
 | |
| #ifdef __OpenBSD__
 | |
|     int mib[3];
 | |
| 
 | |
|     mib[0] = CTL_MACHDEP;
 | |
|     mib[1] = CPU_CHIPSET;
 | |
|     mib[2] = CPU_CHIPSET_BWX;
 | |
| 
 | |
|     if ((error = sysctl(mib, 3, &bwx, &len, NULL, 0)) < 0)
 | |
| 	return FALSE;
 | |
|     else
 | |
| 	return bwx;
 | |
| #else
 | |
|     if ((error = sysctlbyname("hw.chipset.bwx", &bwx, &len, 0, 0)) < 0)
 | |
| 	return FALSE;
 | |
|     else
 | |
| 	return bwx;
 | |
| #endif
 | |
| }
 | |
| #else /* __NetBSD__ */
 | |
| static unsigned long hae_thresh = (1UL << 24);
 | |
| static unsigned long hae_mask = 0xf8000000UL; /* XXX - should use xf86AXP.c */
 | |
| static struct alpha_bus_window *abw;
 | |
| static int abw_count = -1;
 | |
| 
 | |
| static void
 | |
| init_abw(void)
 | |
| {
 | |
| 	if (abw_count < 0) {
 | |
| 		abw_count = alpha_bus_getwindows(ALPHA_BUS_TYPE_PCI_MEM, &abw);
 | |
| 		if (abw_count <= 0)
 | |
| 			FatalError("init_abw: alpha_bus_getwindows failed\n");
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int
 | |
| has_bwx(void)
 | |
| {
 | |
| 	if (abw_count < 0)
 | |
| 		init_abw();
 | |
| 
 | |
| 	xf86Msg(X_INFO, "has_bwx = %d\n", 
 | |
| 		abw[0].abw_abst.abst_flags & ABST_BWX ? 1 : 0);	/* XXXX */
 | |
| 	return abw[0].abw_abst.abst_flags & ABST_BWX;
 | |
| }
 | |
| 
 | |
| static unsigned long
 | |
| dense_base(void)
 | |
| {
 | |
| 	if (abw_count < 0)
 | |
| 		init_abw();
 | |
| 
 | |
| 	/* XXX check abst_flags for ABST_DENSE just to be safe? */
 | |
| 	xf86Msg(X_INFO, "dense base = %#lx\n", 
 | |
| 		abw[0].abw_abst.abst_sys_start); /* XXXX */
 | |
| 	return abw[0].abw_abst.abst_sys_start;
 | |
| }
 | |
| 
 | |
| static unsigned long
 | |
| memory_base(void)
 | |
| {
 | |
| 	if (abw_count < 0)
 | |
| 		init_abw();
 | |
| 	
 | |
| 	if (abw_count > 0) {
 | |
| 		xf86Msg(X_INFO, "memory base = %#lx\n", 
 | |
| 			abw[1].abw_abst.abst_sys_start); /* XXXX */
 | |
| 		return abw[1].abw_abst.abst_sys_start;
 | |
| 	} else {
 | |
| 		xf86Msg(X_INFO, "no memory base\n"); /* XXXX */
 | |
| 		return 0;
 | |
| 	}
 | |
| }
 | |
| #endif /* __NetBSD__ */
 | |
| 
 | |
| #define BUS_BASE	dense_base()
 | |
| #define BUS_BASE_BWX	memory_base()
 | |
| 
 | |
| /***************************************************************************/
 | |
| /* Video Memory Mapping section                                            */
 | |
| /***************************************************************************/
 | |
| 
 | |
| #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"
 | |
| #endif
 | |
| 
 | |
| 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);
 | |
| static pointer mapVidMemSparse(int, unsigned long, unsigned long, int);
 | |
| static void unmapVidMemSparse(int, pointer, unsigned long);
 | |
| 
 | |
| /*
 | |
|  * 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;
 | |
| 
 | |
| #ifdef HAS_APERTURE_DRV
 | |
|        /* Try the aperture driver first */
 | |
|        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 + BUS_BASE);
 | |
|        
 | |
|            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));
 | |
|                }
 | |
|            }
 | |
|        } 
 | |
| #endif
 | |
|        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 + BUS_BASE);
 | |
| 	
 | |
| 	    if (base != MAP_FAILED) {
 | |
| 		munmap((caddr_t)base, 4096);
 | |
| 		devMemFd = fd;
 | |
| 		useDevMem = TRUE;
 | |
| 		return;
 | |
| 	    } else {
 | |
| 		if (warn) {
 | |
| 		    xf86Msg(X_WARNING, "checkDevMem: failed to mmap %s (%s)\n",
 | |
| 			    DEV_MEM, strerror(errno));
 | |
| 		}
 | |
| 	    }
 | |
| 	}
 | |
| 	if (warn) { 
 | |
| #ifndef HAS_APERTURE_DRV
 | |
|            xf86Msg(X_WARNING, "checkDevMem: failed to open/mmap %s (%s)\n",
 | |
|                    DEV_MEM, strerror(errno));
 | |
| #else
 | |
| #ifndef __OpenBSD__
 | |
|            xf86Msg(X_WARNING, "checkDevMem: failed to open %s and %s\n"
 | |
|                "\t(%s)\n", DEV_APERTURE, DEV_MEM, strerror(errno));
 | |
| #else /* __OpenBSD__ */
 | |
|            xf86Msg(X_WARNING, "checkDevMem: failed to open %s and %s\n"
 | |
|                    "\t(%s)\n%s", DEV_APERTURE, DEV_MEM, strerror(errno),
 | |
|                    SYSCTL_MSG);
 | |
| #endif /* __OpenBSD__ */
 | |
| #endif
 | |
|            xf86ErrorF("\tlinear framebuffer access unavailable\n");
 | |
| 	}
 | |
| 	useDevMem = FALSE;
 | |
| 	return;
 | |
| }
 | |
| 
 | |
| void
 | |
| xf86OSInitVidMem(VidMemInfoPtr pVidMem)
 | |
| {
 | |
| 	checkDevMem(TRUE);
 | |
| 	pVidMem->linearSupported = useDevMem;
 | |
| 
 | |
| 	if (has_bwx()) {
 | |
| 	    xf86Msg(X_PROBED,"Machine type has 8/16 bit access\n");
 | |
| 	    pVidMem->mapMem = mapVidMem;
 | |
| 	    pVidMem->unmapMem = unmapVidMem;
 | |
| 	} else {
 | |
| 	    xf86Msg(X_PROBED,"Machine needs sparse mapping\n");
 | |
| 	    pVidMem->mapMem = mapVidMemSparse;
 | |
| 	    pVidMem->unmapMem = unmapVidMemSparse;
 | |
| #ifndef __NetBSD__
 | |
| 	    if (axpSystem == -1)
 | |
|                 axpSystem = bsdGetAXP(); 
 | |
| 	    hae_thresh = xf86AXPParams[axpSystem].hae_thresh;
 | |
|             hae_mask = xf86AXPParams[axpSystem].hae_mask;
 | |
|             sparse_size = xf86AXPParams[axpSystem].size;
 | |
| #endif /* __NetBSD__ */
 | |
| 	}
 | |
| 	pVidMem->initialised = TRUE;
 | |
| }
 | |
| 
 | |
| static pointer
 | |
| mapVidMem(int ScreenNum, unsigned long Base, unsigned long Size, int flags)
 | |
| {
 | |
| 	pointer base;
 | |
| 
 | |
| 	checkDevMem(FALSE);
 | |
| 	Base = Base & ((1L<<32) - 1);
 | |
| 
 | |
| 	if (useDevMem)
 | |
| 	{
 | |
| 	    if (devMemFd < 0) 
 | |
| 	    {
 | |
| 		FatalError("xf86MapVidMem: failed to open %s (%s)\n",
 | |
| 			   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 + BUS_BASE_BWX);
 | |
| 	    if (base == MAP_FAILED)
 | |
| 	    {
 | |
| 		FatalError("%s: could not mmap %s [s=%lx,a=%lx] (%s)\n",
 | |
| 			   "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\n",
 | |
| 			   "xf86MapVidMem", Base);
 | |
| 	}
 | |
| 	base = mmap(0, Size,
 | |
| 		    (flags & VIDMEM_READONLY) ?
 | |
| 		     PROT_READ : (PROT_READ | PROT_WRITE),
 | |
| 		    MAP_FLAGS, xf86Info.screenFd,
 | |
| 		    (unsigned long)Base + BUS_BASE);
 | |
| 	if (base == MAP_FAILED)
 | |
| 	{
 | |
| 	    FatalError("xf86MapVidMem: Could not mmap /dev/vga (%s)\n",
 | |
| 		       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+BUS_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));
 | |
| 		return(-1);
 | |
| 	}
 | |
| #ifdef DEBUG
 | |
| 	xf86MsgVerb(X_INFO, 3, "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);
 | |
| }
 | |
| 
 | |
| 
 | |
| #if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__OpenBSD__)
 | |
| 
 | |
| extern int ioperm(unsigned long from, unsigned long num, int on);
 | |
| 
 | |
| Bool
 | |
| xf86EnableIO()
 | |
| {
 | |
|     if (!ioperm(0, 65536, TRUE))
 | |
| 	return TRUE;
 | |
|     return FALSE;
 | |
| }
 | |
| 
 | |
| void
 | |
| xf86DisableIO()
 | |
| {
 | |
| 	return;
 | |
| }
 | |
| 
 | |
| #endif /* __FreeBSD_kernel__ || __OpenBSD__ */
 | |
| 
 | |
| #ifdef USE_ALPHA_PIO
 | |
| 
 | |
| Bool
 | |
| xf86EnableIO()
 | |
| {
 | |
| 	alpha_pci_io_enable(1);
 | |
| 	return TRUE;
 | |
| }
 | |
| 
 | |
| void
 | |
| xf86DisableIO()
 | |
| {
 | |
| 	alpha_pci_io_enable(0);
 | |
| }
 | |
| 
 | |
| #endif /* USE_ALPHA_PIO */
 | |
| 
 | |
| #define vuip    volatile unsigned int *
 | |
| 
 | |
| static unsigned long msb_set = 0;
 | |
| static pointer memSBase = 0;
 | |
| static pointer memBase = 0;
 | |
| 
 | |
| extern int readDense8(pointer Base, register unsigned long Offset);
 | |
| extern int readDense16(pointer Base, register unsigned long Offset);
 | |
| extern int readDense32(pointer Base, register unsigned long Offset);
 | |
| extern void
 | |
| writeDenseNB8(int Value, pointer Base, register unsigned long Offset);
 | |
| extern void
 | |
| writeDenseNB16(int Value, pointer Base, register unsigned long Offset);
 | |
| extern void
 | |
| writeDenseNB32(int Value, pointer Base, register unsigned long Offset);
 | |
| extern void
 | |
| writeDense8(int Value, pointer Base, register unsigned long Offset);
 | |
| extern void
 | |
| writeDense16(int Value, pointer Base, register unsigned long Offset);
 | |
| extern void
 | |
| writeDense32(int Value, pointer Base, register unsigned long Offset);
 | |
| 
 | |
| static int readSparse8(pointer Base, register unsigned long Offset);
 | |
| static int readSparse16(pointer Base, register unsigned long Offset);
 | |
| static int readSparse32(pointer Base, register unsigned long Offset);
 | |
| static void
 | |
| writeSparseNB8(int Value, pointer Base, register unsigned long Offset);
 | |
| static void
 | |
| writeSparseNB16(int Value, pointer Base, register unsigned long Offset);
 | |
| static void
 | |
| writeSparseNB32(int Value, pointer Base, register unsigned long Offset);
 | |
| static void
 | |
| writeSparse8(int Value, pointer Base, register unsigned long Offset);
 | |
| static void
 | |
| writeSparse16(int Value, pointer Base, register unsigned long Offset);
 | |
| static void
 | |
| writeSparse32(int Value, pointer Base, register unsigned long Offset);
 | |
| 
 | |
| #if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
 | |
| extern int sysarch(int, void *);
 | |
| #endif
 | |
| 
 | |
| struct parms {
 | |
| 	u_int64_t hae;
 | |
| };
 | |
| 
 | |
| #ifndef __NetBSD__
 | |
| static int
 | |
| sethae(u_int64_t hae)
 | |
| {
 | |
| #if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
 | |
| #ifndef ALPHA_SETHAE
 | |
| #define ALPHA_SETHAE 0
 | |
| #endif
 | |
| 	struct parms p;
 | |
| 	p.hae = hae;
 | |
| 	return (sysarch(ALPHA_SETHAE, (char *)&p));
 | |
| #endif
 | |
| #ifdef __OpenBSD__
 | |
| 	return -1;
 | |
| #endif
 | |
| }
 | |
| #endif /* __NetBSD__ */
 | |
| 
 | |
| static pointer
 | |
| mapVidMemSparse(int ScreenNum, unsigned long Base, unsigned long Size, int flags)
 | |
| {
 | |
|     static Bool was_here = FALSE;
 | |
| 
 | |
|     if (!was_here) {
 | |
|       was_here = TRUE;
 | |
| 
 | |
|       checkDevMem(FALSE);
 | |
| 
 | |
|       xf86WriteMmio8 = writeSparse8;
 | |
|       xf86WriteMmio16 = writeSparse16;
 | |
|       xf86WriteMmio32 = writeSparse32;
 | |
|       xf86WriteMmioNB8 = writeSparseNB8;
 | |
|       xf86WriteMmioNB16 = writeSparseNB16;
 | |
|       xf86WriteMmioNB32 = writeSparseNB32;
 | |
|       xf86ReadMmio8 = readSparse8;
 | |
|       xf86ReadMmio16 = readSparse16;
 | |
|       xf86ReadMmio32 = readSparse32;
 | |
| 	
 | |
|       memBase = mmap((caddr_t)0, 0x100000000,
 | |
| 		     PROT_READ | PROT_WRITE,
 | |
| 		     MAP_SHARED, devMemFd,
 | |
| 		     (off_t) BUS_BASE);
 | |
|       memSBase = mmap((caddr_t)0, 0x100000000,
 | |
| 		      PROT_READ | PROT_WRITE,
 | |
| 		      MAP_SHARED, devMemFd,
 | |
| 		      (off_t) BUS_BASE_BWX);
 | |
|       
 | |
|       if (memSBase == MAP_FAILED || memBase == MAP_FAILED)	{
 | |
| 	FatalError("xf86MapVidMem: Could not mmap framebuffer (%s)\n",
 | |
| 		   strerror(errno));
 | |
|       }
 | |
|     }
 | |
|     return (pointer)((unsigned long)memBase + Base);
 | |
| }
 | |
| 
 | |
| static void
 | |
| unmapVidMemSparse(int ScreenNum, pointer Base, unsigned long Size)
 | |
| {
 | |
| }
 | |
| 
 | |
| static int
 | |
| readSparse8(pointer Base, register unsigned long Offset)
 | |
| {
 | |
|     register unsigned long result, shift;
 | |
|     register unsigned long msb;
 | |
|     mem_barrier();
 | |
|     Offset += (unsigned long)Base - (unsigned long)memBase;
 | |
|     shift = (Offset & 0x3) << 3;
 | |
|       if (Offset >= (hae_thresh)) {
 | |
|         msb = Offset & hae_mask;
 | |
|         Offset -= msb;
 | |
| 	if (msb_set != msb) {
 | |
| #ifndef __NetBSD__
 | |
| 	sethae(msb);
 | |
| #endif
 | |
| 	msb_set = msb;
 | |
| 	}
 | |
|       }
 | |
|     result = *(vuip) ((unsigned long)memSBase + (Offset << 5));
 | |
|     result >>= shift;
 | |
|     return 0xffUL & result;
 | |
| }
 | |
| 
 | |
| static int
 | |
| readSparse16(pointer Base, register unsigned long Offset)
 | |
| {
 | |
|     register unsigned long result, shift;
 | |
|     register unsigned long msb;
 | |
| 
 | |
|     mem_barrier();
 | |
|     Offset += (unsigned long)Base - (unsigned long)memBase;
 | |
|     shift = (Offset & 0x2) << 3;
 | |
|     if (Offset >= (hae_thresh)) {
 | |
|         msb = Offset & hae_mask;
 | |
|         Offset -= msb;
 | |
|       if (msb_set != msb) {
 | |
| #ifndef __NetBSD__
 | |
| 	sethae(msb);
 | |
| #endif
 | |
| 	msb_set = msb;
 | |
|       }
 | |
|     }
 | |
|     result = *(vuip)((unsigned long)memSBase+(Offset<<5)+(1<<(5-2)));
 | |
|     result >>= shift;
 | |
|     return 0xffffUL & result;
 | |
| }
 | |
| 
 | |
| static int
 | |
| readSparse32(pointer Base, register unsigned long Offset)
 | |
| {
 | |
|     mem_barrier();
 | |
|     return *(vuip)((unsigned long)Base+(Offset));
 | |
| }
 | |
| 
 | |
| static void
 | |
| writeSparse8(int Value, pointer Base, register unsigned long Offset)
 | |
| {
 | |
|     register unsigned long msb;
 | |
|     register unsigned int b = Value & 0xffU;
 | |
| 
 | |
|     write_mem_barrier();
 | |
|     Offset += (unsigned long)Base - (unsigned long)memBase;
 | |
|     if (Offset >= (hae_thresh)) {
 | |
|       msb = Offset & hae_mask;
 | |
|       Offset -= msb;
 | |
|       if (msb_set != msb) {
 | |
| #ifndef __NetBSD__
 | |
| 	sethae(msb);
 | |
| #endif
 | |
| 	msb_set = msb;
 | |
|       }
 | |
|     }
 | |
|     *(vuip) ((unsigned long)memSBase + (Offset << 5)) = b * 0x01010101;
 | |
| }
 | |
| 
 | |
| static void
 | |
| writeSparse16(int Value, pointer Base, register unsigned long Offset)
 | |
| {
 | |
|     register unsigned long msb;
 | |
|     register unsigned int w = Value & 0xffffU;
 | |
| 
 | |
|     write_mem_barrier();
 | |
|     Offset += (unsigned long)Base - (unsigned long)memBase;
 | |
|     if (Offset >= (hae_thresh)) {
 | |
|       msb = Offset & hae_mask;
 | |
|       Offset -= msb;
 | |
|       if (msb_set != msb) {
 | |
| #ifndef __NetBSD__
 | |
| 	sethae(msb);
 | |
| #endif
 | |
| 	msb_set = msb;
 | |
|       }
 | |
|     }
 | |
|     *(vuip)((unsigned long)memSBase+(Offset<<5)+(1<<(5-2))) =
 | |
|       w * 0x00010001;
 | |
| 
 | |
| }
 | |
| 
 | |
| static void
 | |
| writeSparse32(int Value, pointer Base, register unsigned long Offset)
 | |
| {
 | |
|     write_mem_barrier();
 | |
|     *(vuip)((unsigned long)Base + (Offset)) = Value;
 | |
|     return;
 | |
| }
 | |
| 
 | |
| static void
 | |
| writeSparseNB8(int Value, pointer Base, register unsigned long Offset)
 | |
| {
 | |
|     register unsigned long msb;
 | |
|     register unsigned int b = Value & 0xffU;
 | |
| 
 | |
|     Offset += (unsigned long)Base - (unsigned long)memBase;
 | |
|     if (Offset >= (hae_thresh)) {
 | |
|       msb = Offset & hae_mask;
 | |
|       Offset -= msb;
 | |
|       if (msb_set != msb) {
 | |
| #ifndef __NetBSD__
 | |
| 	sethae(msb);
 | |
| #endif
 | |
| 	msb_set = msb;
 | |
|       }
 | |
|     }
 | |
|     *(vuip) ((unsigned long)memSBase + (Offset << 5)) = b * 0x01010101;
 | |
| }
 | |
| 
 | |
| static void
 | |
| writeSparseNB16(int Value, pointer Base, register unsigned long Offset)
 | |
| {
 | |
|     register unsigned long msb;
 | |
|     register unsigned int w = Value & 0xffffU;
 | |
| 
 | |
|     Offset += (unsigned long)Base - (unsigned long)memBase;
 | |
|     if (Offset >= (hae_thresh)) {
 | |
|       msb = Offset & hae_mask ;
 | |
|       Offset -= msb;
 | |
|       if (msb_set != msb) {
 | |
| #ifndef __NetBSD__
 | |
| 	sethae(msb);
 | |
| #endif
 | |
| 	msb_set = msb;
 | |
|       }
 | |
|     }
 | |
|     *(vuip)((unsigned long)memSBase+(Offset<<5)+(1<<(5-2))) =
 | |
|       w * 0x00010001;
 | |
| }
 | |
| 
 | |
| static void
 | |
| writeSparseNB32(int Value, pointer Base, register unsigned long Offset)
 | |
| {
 | |
|     *(vuip)((unsigned long)Base + (Offset)) = Value;
 | |
|     return;
 | |
| }
 | |
| 
 | |
| void (*xf86WriteMmio8)(int Value, pointer Base, unsigned long Offset)
 | |
|      = writeDense8;
 | |
| void (*xf86WriteMmio16)(int Value, pointer Base, unsigned long Offset)
 | |
|      = writeDense16;
 | |
| void (*xf86WriteMmio32)(int Value, pointer Base, unsigned long Offset)
 | |
|      = writeDense32;
 | |
| void (*xf86WriteMmioNB8)(int Value, pointer Base, unsigned long Offset)
 | |
|      = writeDenseNB8;
 | |
| void (*xf86WriteMmioNB16)(int Value, pointer Base, unsigned long Offset)
 | |
|      = writeDenseNB16;
 | |
| void (*xf86WriteMmioNB32)(int Value, pointer Base, unsigned long Offset)
 | |
|      = writeDenseNB32;
 | |
| int  (*xf86ReadMmio8)(pointer Base, unsigned long Offset)
 | |
|      = readDense8;
 | |
| int  (*xf86ReadMmio16)(pointer Base, unsigned long Offset)
 | |
|      = readDense16;
 | |
| int  (*xf86ReadMmio32)(pointer Base, unsigned long Offset)
 | |
|      = readDense32;
 | |
| 
 |