#ifdef HAVE_XORG_CONFIG_H
#include <xorg-config.h>
#endif
#include <X11/X.h>
#include "xf86.h"
#include "xf86Priv.h"
#include "xf86_OSlib.h"
#include "xf86OSpriv.h"
#ifdef __arm32__
#include "machine/devmap.h"
struct memAccess
{
int ioctl;
struct map_info memInfo;
pointer regionVirtBase;
Bool Checked;
Bool OK;
};
static pointer xf86MapInfoMap();
static void xf86MapInfoUnmap();
static struct memAccess *checkMapInfo();
extern int vgaPhysLinearBase;
struct memAccess vgaMemInfo = { CONSOLE_GET_MEM_INFO, NULL, NULL,
FALSE, FALSE };
struct memAccess linearMemInfo = { CONSOLE_GET_LINEAR_INFO, NULL, NULL,
FALSE, FALSE };
struct memAccess ioMemInfo = { CONSOLE_GET_IO_INFO, NULL, NULL,
FALSE, FALSE };
#endif
#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
#define BUS_BASE 0L
#define BUS_BASE_BWX 0L
static Bool useDevMem = FALSE;
static int devMemFd = -1;
#define DEV_MEM "/dev/mem"
static pointer mapVidMem(int, unsigned long, unsigned long, int);
static void unmapVidMem(int, pointer, unsigned long);
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)
{
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));
}
useDevMem = FALSE;
return;
}
}
if (warn)
{
xf86Msg(X_WARNING, "checkDevMem: failed to open %s (%s)\n",
DEV_MEM, strerror(errno));
}
useDevMem = FALSE;
return;
}
void
xf86OSInitVidMem(VidMemInfoPtr pVidMem)
{
checkDevMem(TRUE);
pVidMem->linearSupported = useDevMem;
pVidMem->mapMem = armMapVidMem;
pVidMem->unmapVidMem = armUnmapVidMem;
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)\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=%x,a=%x] (%s)\n",
"xf86MapVidMem", DEV_MEM, Size, Base,
strerror(errno));
}
return(base);
}
if ((unsigned long)Base < 0xA0000 || (unsigned long)Base >= 0xC0000)
{
FatalError("%s: Address 0x%x 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 - 0xA0000);
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);
}
_X_EXPORT 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=%x,o=%x] failed (%s)\n",
DEV_MEM, Len, Base, Offset, strerror(errno));
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);
}
static struct memAccess *
checkMapInfo(Bool warn, int Region)
{
struct memAccess *memAccP;
switch (Region)
{
case VGA_REGION:
memAccP = &vgaMemInfo;
break;
case LINEAR_REGION:
memAccP = &linearMemInfo;
break;
case MMIO_REGION:
memAccP = &ioMemInfo;
break;
default:
return NULL;
break;
}
if(!memAccP->Checked)
{
if(ioctl(xf86Info.screenFd, memAccP->ioctl, &(memAccP->memInfo)) == -1)
{
if(warn)
{
xf86Msg(X_WARNING,
"checkMapInfo: failed to get map info for region %d\n\t(%s)\n",
Region, strerror(errno));
}
}
else
{
if(memAccP->memInfo.u.map_info_mmap.map_offset
!= MAP_INFO_UNKNOWN)
memAccP->OK = TRUE;
}
memAccP->Checked = TRUE;
}
if (memAccP->OK)
{
return memAccP;
}
else
{
return NULL;
}
}
static pointer
xf86MapInfoMap(struct memAccess *memInfoP, pointer Base, unsigned long Size)
{
struct map_info *mapInfoP = &(memInfoP->memInfo);
if (mapInfoP->u.map_info_mmap.map_size == MAP_INFO_UNKNOWN)
{
Size = (unsigned long)Base + Size;
}
else
{
Size = mapInfoP->u.map_info_mmap.map_size;
}
switch(mapInfoP->method)
{
case MAP_MMAP:
if(memInfoP->regionVirtBase == NULL ||
mapInfoP->u.map_info_mmap.map_size == MAP_INFO_UNKNOWN)
{
if((memInfoP->regionVirtBase =
mmap((caddr_t)0,
Size,
PROT_READ | PROT_WRITE,
MAP_SHARED,
xf86Info.screenFd,
(unsigned long)mapInfoP->u.map_info_mmap.map_offset))
== (pointer)-1)
{
FatalError("xf86MapInfoMap: Failed to map memory at 0x%x\n\t%s\n",
mapInfoP->u.map_info_mmap.map_offset, strerror(errno));
}
if(mapInfoP->u.map_info_mmap.internal_offset > 0)
memInfoP->regionVirtBase +=
mapInfoP->u.map_info_mmap.internal_offset;
}
break;
default:
FatalError("xf86MapInfoMap: Unsuported mapping method\n");
break;
}
return (pointer)((int)memInfoP->regionVirtBase + (int)Base);
}
static void
xf86MapInfoUnmap(struct memAccess *memInfoP, unsigned long Size)
{
struct map_info *mapInfoP = &(memInfoP->memInfo);
switch(mapInfoP->method)
{
case MAP_MMAP:
if(memInfoP->regionVirtBase != NULL)
{
if(mapInfoP->u.map_info_mmap.map_size != MAP_INFO_UNKNOWN)
Size = mapInfoP->u.map_info_mmap.map_size;
munmap((caddr_t)memInfoP->regionVirtBase, Size);
memInfoP->regionVirtBase = NULL;
}
break;
default:
FatalError("xf86MapInfoMap: Unsuported mapping method\n");
break;
}
}
static pointer
armMapVidMem(int ScreenNum, unsigned long Base, unsigned long Size, int flags)
{
struct memAccess *memInfoP;
if((memInfoP = checkMapInfo(FALSE, Region)) != NULL)
{
switch(Region)
{
case LINEAR_REGION:
if (vgaPhysLinearBase)
{
Base -= vgaPhysLinearBase;
}
break;
case VGA_REGION:
Base -= 0xA0000;
break;
}
base = xf86MapInfoMap(memInfoP, Base, Size);
return (base);
}
return mapVidMem(ScreenNum, Base, Size, flags);
}
static void
armUnmapVidMem(int ScreenNum, pointer Base, unsigned long Size)
{
struct memAccess *memInfoP;
if((memInfoP = checkMapInfo(FALSE, Region)) != NULL)
{
xf86MapInfoUnmap(memInfoP, Base, Size);
}
unmapVidMem(ScreenNum, Base, Size);
}
#ifdef USE_DEV_IO
static int IoFd = -1;
_X_EXPORT 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\n");
return FALSE;
}
return TRUE;
}
_X_EXPORT void
xf86DisableIO()
{
if (IoFd < 0)
return;
close(IoFd);
IoFd = -1;
return;
}
#endif
#if defined(USE_ARC_MMAP) || defined(__arm32__)
Bool
xf86EnableIO()
{
int fd;
pointer base;
if (ExtendedEnabled)
return TRUE;
if ((fd = open("/dev/ttyC0", O_RDWR)) >= 0) {
base = (pointer)mmap((caddr_t)0, 65536, PROT_READ | PROT_WRITE,
MAP_FLAGS, fd, (off_t)0x0000);
if (base != (pointer)-1) {
IOPortBase = base;
}
else {
xf86Msg(X_WARNING,"EnableIO: failed to mmap %s (%s)\n",
"/dev/ttyC0", strerror(errno));
return FALSE;
}
}
else {
xf86Msg("EnableIO: failed to open %s (%s)\n",
"/dev/ttyC0", strerror(errno));
return FALSE;
}
ExtendedEnabled = TRUE;
return TRUE;
}
void
xf86DisableIO()
{
return;
}
#endif
#if 0
#if defined(USE_ARC_MMAP) || defined(__arm32__)
#ifdef USE_ARM32_MMAP
#define DEV_MEM_IOBASE 0x43000000
#endif
static Bool ScreenEnabled[MAXSCREENS];
static Bool ExtendedEnabled = FALSE;
static Bool InitDone = FALSE;
Bool
xf86EnableIOPorts(ScreenNum)
int ScreenNum;
{
int i;
int fd;
pointer base;
#ifdef __arm32__
struct memAccess *memInfoP;
int *Size;
#endif
ScreenEnabled[ScreenNum] = TRUE;
if (ExtendedEnabled)
return TRUE;
#ifdef USE_ARC_MMAP
if ((fd = open("/dev/ttyC0", O_RDWR)) >= 0) {
base = (pointer)mmap((caddr_t)0, 65536, PROT_READ | PROT_WRITE,
MAP_FLAGS, fd, (off_t)0x0000);
if (base != (pointer)-1) {
IOPortBase = base;
}
else {
xf86Msg(X_ERROR,
"EnableIOPorts: failed to mmap %s (%s)\n",
"/dev/ttyC0", strerror(errno));
}
}
else {
xf86Msg(X_ERROR, "EnableIOPorts: failed to open %s (%s)\n",
"/dev/ttyC0", strerror(errno));
}
#endif
#ifdef __arm32__
IOPortBase = (unsigned int)-1;
if((memInfoP = checkMapInfo(TRUE, MMIO_REGION)) != NULL)
{
IOPortBase = (unsigned int)xf86MapInfoMap(memInfoP,
(caddr_t)0x0, 0L)
- memInfoP->memInfo.u.map_info_mmap.internal_offset;
ExtendedEnabled = TRUE;
return TRUE;
}
#ifdef USE_ARM32_MMAP
checkDevMem(TRUE);
if (devMemFd >= 0 && useDevMem)
{
base = (pointer)mmap((caddr_t)0, 0x400, PROT_READ | PROT_WRITE,
MAP_FLAGS, devMemFd, (off_t)DEV_MEM_IOBASE);
if (base != (pointer)-1)
IOPortBase = (unsigned int)base;
}
if (IOPortBase == (unsigned int)-1)
{
xf86Msg(X_WARNING,"xf86EnableIOPorts: failed to open mem device or map IO base. \n\
Make sure you have the Aperture Driver installed, or a kernel built with the INSECURE option\n");
return FALSE;
}
#else
xf86Msg(X_WARNING,"xf86EnableIOPorts: failed to open mem device or map IO base. \n\
Try building the server with USE_ARM32_MMAP defined\n");
return FALSE;
#endif
#endif
ExtendedEnabled = TRUE;
return TRUE;
}
void
xf86DisableIOPorts(ScreenNum)
int ScreenNum;
{
int i;
#ifdef __arm32__
struct memAccess *memInfoP;
#endif
ScreenEnabled[ScreenNum] = FALSE;
#ifdef __arm32__
if((memInfoP = checkMapInfo(FALSE, MMIO_REGION)) != NULL)
{
xf86MapInfoUnmap(memInfoP, 0);
}
#endif
#ifdef USE_ARM32_MMAP
if (!ExtendedEnabled)
return;
for (i = 0; i < MAXSCREENS; i++)
if (ScreenEnabled[i])
return;
munmap((caddr_t)IOPortBase, 0x400);
IOPortBase = (unsigned int)-1;
ExtendedEnabled = FALSE;
#endif
return;
}
#endif
#endif