493 lines
12 KiB
C
493 lines
12 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
|
|
|
|
#ifdef HAS_MTRR_SUPPORT
|
|
static Bool cleanMTRR(void);
|
|
#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;
|
|
void *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;
|
|
|
|
if (useDevMem)
|
|
pci_system_init_dev_mem(devMemFd);
|
|
|
|
#ifdef HAS_MTRR_SUPPORT
|
|
if (useDevMem) {
|
|
cleanMTRR();
|
|
}
|
|
#endif
|
|
pVidMem->initialised = TRUE;
|
|
}
|
|
|
|
/*
|
|
* 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;
|
|
}
|
|
|
|
#endif /* HAS_MTRR_SUPPORT */
|