mirror of
git://sourceware.org/git/glibc.git
synced 2024-12-27 04:41:02 +08:00
442 lines
9.4 KiB
C
442 lines
9.4 KiB
C
/* Copyright (C) 1992 Free Software Foundation, Inc.
|
|
This file is part of the GNU C Library.
|
|
Contributed by David Mosberger.
|
|
|
|
The GNU C Library is free software; you can redistribute it and/or
|
|
modify it under the terms of the GNU Library General Public License as
|
|
published by the Free Software Foundation; either version 2 of the
|
|
License, or (at your option) any later version.
|
|
|
|
The GNU C Library is distributed in the hope that it will be useful,
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Library General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Library General Public
|
|
License along with the GNU C Library; see the file COPYING.LIB. If
|
|
not, write to the Free Software Foundation, Inc., 675 Mass Ave,
|
|
Cambridge, MA 02139, USA. */
|
|
|
|
/* I/O access is restricted to ISA port space (ports 0..65535).
|
|
Modern devices hopefully are sane enough not to put any performance
|
|
critical registers in i/o space.
|
|
|
|
On the first call to ioperm() or _sethae(), the entire (E)ISA port
|
|
space is mapped into the virtual address space at address io.base.
|
|
mprotect() calls are then used to enable/disable access to ports. Per
|
|
page, there are PAGE_SIZE>>IO_SHIFT I/O ports (e.g., 256 ports on a
|
|
Low Cost Alpha based system using 8KB pages).
|
|
|
|
Keep in mind that this code should be able to run in a 32bit address
|
|
space. It is therefore unreasonable to expect mmap'ing the entire
|
|
sparse address space would work (e.g., the Low Cost Alpha chip has an
|
|
I/O address space that's 512MB large!). */
|
|
|
|
#include <errno.h>
|
|
#include <fcntl.h>
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
|
|
#include <sys/types.h>
|
|
#include <sys/mman.h>
|
|
|
|
#include <asm/io.h>
|
|
#include <asm/page.h>
|
|
#include <asm/system.h>
|
|
|
|
#undef inb
|
|
#undef inw
|
|
#undef inl
|
|
#undef outb
|
|
#undef outw
|
|
#undef outl
|
|
|
|
#define PATH_CPUINFO "/proc/cpuinfo"
|
|
|
|
#define MAX_PORT 0x10000
|
|
#define vuip volatile unsigned int *
|
|
|
|
#define JENSEN_IO_BASE (IDENT_ADDR + 0x0300000000UL)
|
|
#define APECS_IO_BASE (IDENT_ADDR + 0x01c0000000UL)
|
|
#define ALCOR_IO_BASE (IDENT_ADDR + 0x8580000000UL)
|
|
|
|
enum {
|
|
IOSYS_JENSEN = 0, IOSYS_APECS = 1, IOSYS_ALCOR = 2
|
|
} iosys_t;
|
|
|
|
struct ioswtch {
|
|
void (*sethae)(unsigned long addr);
|
|
void (*outb)(unsigned char b, unsigned long port);
|
|
void (*outw)(unsigned short b, unsigned long port);
|
|
void (*outl)(unsigned int b, unsigned long port);
|
|
unsigned int (*inb)(unsigned long port);
|
|
unsigned int (*inw)(unsigned long port);
|
|
unsigned int (*inl)(unsigned long port);
|
|
};
|
|
|
|
static struct platform {
|
|
const char *name;
|
|
int io_sys;
|
|
} platform[] = {
|
|
{"Alcor", IOSYS_ALCOR},
|
|
{"Avanti", IOSYS_APECS},
|
|
{"Cabriolet", IOSYS_APECS},
|
|
{"EB64+", IOSYS_APECS},
|
|
{"EB66", IOSYS_APECS},
|
|
{"EB66P", IOSYS_APECS},
|
|
{"Jensen", IOSYS_JENSEN},
|
|
{"Mustang", IOSYS_APECS},
|
|
{"Noname", IOSYS_APECS},
|
|
};
|
|
|
|
|
|
static struct {
|
|
struct hae hae;
|
|
unsigned long base;
|
|
struct ioswtch * swp;
|
|
int sys;
|
|
} io;
|
|
|
|
|
|
static inline unsigned long
|
|
port_to_cpu_addr (unsigned long port, int iosys, int size)
|
|
{
|
|
if (iosys == IOSYS_JENSEN) {
|
|
return (port << 7) + ((size - 1) << 4) + io.base;
|
|
} else {
|
|
return (port << 5) + ((size - 1) << 3) + io.base;
|
|
}
|
|
}
|
|
|
|
|
|
static inline void
|
|
inline_sethae (unsigned long addr, int iosys)
|
|
{
|
|
if (iosys == IOSYS_JENSEN) {
|
|
/* hae on the Jensen is bits 31:25 shifted right */
|
|
addr >>= 25;
|
|
if (addr != io.hae.cache) {
|
|
__sethae (addr);
|
|
io.hae.cache = addr;
|
|
}
|
|
} else {
|
|
unsigned long msb;
|
|
|
|
/* no need to set hae if msb is 0: */
|
|
msb = addr & 0xf8000000;
|
|
if (msb && msb != io.hae.cache) {
|
|
__sethae (msb);
|
|
io.hae.cache = msb;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
static inline void
|
|
inline_outb (unsigned char b, unsigned long port, int iosys)
|
|
{
|
|
unsigned int w;
|
|
unsigned long addr = port_to_cpu_addr (port, iosys, 1);
|
|
|
|
inline_sethae (0, iosys);
|
|
asm ("insbl %2,%1,%0" : "r=" (w) : "ri" (port & 0x3), "r" (b));
|
|
*(vuip)addr = w;
|
|
mb ();
|
|
}
|
|
|
|
|
|
static inline void
|
|
inline_outw (unsigned short b, unsigned long port, int iosys)
|
|
{
|
|
unsigned int w;
|
|
unsigned long addr = port_to_cpu_addr (port, iosys, 2);
|
|
|
|
inline_sethae (0, iosys);
|
|
asm ("inswl %2,%1,%0" : "r=" (w) : "ri" (port & 0x3), "r" (b));
|
|
*(vuip)addr = w;
|
|
mb ();
|
|
}
|
|
|
|
|
|
static inline void
|
|
inline_outl (unsigned int b, unsigned long port, int iosys)
|
|
{
|
|
unsigned long addr = port_to_cpu_addr (port, iosys, 4);
|
|
|
|
if (port >= MAX_PORT)
|
|
return;
|
|
|
|
inline_sethae (0, iosys);
|
|
*(vuip)addr = b;
|
|
mb ();
|
|
}
|
|
|
|
|
|
static inline unsigned int
|
|
inline_inb (unsigned long port, int iosys)
|
|
{
|
|
unsigned long result, addr = port_to_cpu_addr (port, iosys, 1);
|
|
|
|
inline_sethae (0, iosys);
|
|
result = *(vuip) addr;
|
|
result >>= (port & 3) * 8;
|
|
return 0xffUL & result;
|
|
}
|
|
|
|
|
|
static inline unsigned int
|
|
inline_inw (unsigned long port, int iosys)
|
|
{
|
|
unsigned long result, addr = port_to_cpu_addr (port, iosys, 2);
|
|
|
|
inline_sethae (0, iosys);
|
|
result = *(vuip) addr;
|
|
result >>= (port & 3) * 8;
|
|
return 0xffffUL & result;
|
|
}
|
|
|
|
|
|
static inline unsigned int
|
|
inline_inl (unsigned long port, int iosys)
|
|
{
|
|
unsigned long addr = port_to_cpu_addr (port, iosys, 4);
|
|
|
|
inline_sethae (0, iosys);
|
|
return *(vuip) addr;
|
|
}
|
|
|
|
|
|
#define DCL_SETHAE(name, iosys) \
|
|
static void \
|
|
name##_sethae (unsigned long addr) \
|
|
{ \
|
|
inline_sethae (addr, IOSYS_##iosys); \
|
|
}
|
|
|
|
#define DCL_OUT(name, func, type, iosys) \
|
|
static void \
|
|
name##_##func (unsigned type b, unsigned long addr) \
|
|
{ \
|
|
inline_##func (b, addr, IOSYS_##iosys); \
|
|
}
|
|
|
|
|
|
#define DCL_IN(name, func, iosys) \
|
|
static unsigned int \
|
|
name##_##func (unsigned long addr) \
|
|
{ \
|
|
return inline_##func (addr, IOSYS_##iosys); \
|
|
}
|
|
|
|
|
|
DCL_SETHAE(jensen, JENSEN)
|
|
DCL_OUT(jensen, outb, char, JENSEN)
|
|
DCL_OUT(jensen, outw, short, JENSEN)
|
|
DCL_OUT(jensen, outl, int, JENSEN)
|
|
DCL_IN(jensen, inb, JENSEN)
|
|
DCL_IN(jensen, inw, JENSEN)
|
|
DCL_IN(jensen, inl, JENSEN)
|
|
|
|
/* The APECS functions are also used for ALCOR since they are
|
|
identical. */
|
|
|
|
DCL_SETHAE(apecs, APECS)
|
|
DCL_OUT(apecs, outb, char, APECS)
|
|
DCL_OUT(apecs, outw, short, APECS)
|
|
DCL_OUT(apecs, outl, int, APECS)
|
|
DCL_IN(apecs, inb, APECS)
|
|
DCL_IN(apecs, inw, APECS)
|
|
DCL_IN(apecs, inl, APECS)
|
|
|
|
struct ioswtch ioswtch[] = {
|
|
{
|
|
jensen_sethae,
|
|
jensen_outb, jensen_outw, jensen_outl,
|
|
jensen_inb, jensen_inw, jensen_inl
|
|
},
|
|
{
|
|
apecs_sethae,
|
|
apecs_outb, apecs_outw, apecs_outl,
|
|
apecs_inb, apecs_inw, apecs_inl
|
|
}
|
|
};
|
|
|
|
|
|
static int
|
|
init_iosys (void)
|
|
{
|
|
char name[256], value[256];
|
|
FILE * fp;
|
|
int i;
|
|
|
|
fp = fopen (PATH_CPUINFO, "r");
|
|
if (!fp)
|
|
return -1;
|
|
|
|
while (fscanf (fp, "%256[^:]: %256[^\n]\n", name, value) == 2) {
|
|
if (strncmp (name, "system type", 11) == 0) {
|
|
for (i = 0; i < sizeof (platform) / sizeof (platform[0]); ++i) {
|
|
if (strcmp (platform[i].name, value) == 0) {
|
|
fclose (fp);
|
|
io.sys = platform[i].io_sys;
|
|
if (io.sys == IOSYS_JENSEN)
|
|
io.swp = &ioswtch[0];
|
|
else
|
|
io.swp = &ioswtch[1];
|
|
return 0;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
fclose (fp);
|
|
errno = ENODEV;
|
|
return -1;
|
|
}
|
|
|
|
|
|
int
|
|
_ioperm (unsigned long from, unsigned long num, int turn_on)
|
|
{
|
|
unsigned long addr, len;
|
|
int prot;
|
|
|
|
if (!io.swp && init_iosys () < 0)
|
|
return -1;
|
|
|
|
/* this test isn't as silly as it may look like; consider overflows! */
|
|
if (from >= MAX_PORT || from + num > MAX_PORT) {
|
|
errno = EINVAL;
|
|
return -1;
|
|
}
|
|
|
|
if (turn_on) {
|
|
if (!io.base) {
|
|
unsigned long base;
|
|
int fd;
|
|
|
|
io.hae.reg = 0; /* not used in user-level */
|
|
io.hae.cache = 0;
|
|
__sethae (io.hae.cache); /* synchronize with hw */
|
|
|
|
fd = open ("/dev/mem", O_RDWR);
|
|
if (fd < 0)
|
|
return fd;
|
|
|
|
switch (io.sys) {
|
|
case IOSYS_JENSEN: base = JENSEN_IO_BASE; break;
|
|
case IOSYS_APECS: base = APECS_IO_BASE; break;
|
|
case IOSYS_ALCOR: base = ALCOR_IO_BASE; break;
|
|
default:
|
|
errno = ENODEV;
|
|
return -1;
|
|
}
|
|
addr = port_to_cpu_addr (from, io.sys, 1);
|
|
addr &= PAGE_MASK;
|
|
len = port_to_cpu_addr (MAX_PORT, io.sys, 1) - addr;
|
|
io.base =
|
|
(unsigned long) __mmap (0, len, PROT_NONE, MAP_SHARED, fd, base);
|
|
close (fd);
|
|
if ((long) io.base == -1)
|
|
return -1;
|
|
}
|
|
prot = PROT_READ | PROT_WRITE;
|
|
} else {
|
|
if (!io.base)
|
|
return 0; /* never was turned on... */
|
|
|
|
/* turnoff access to relevant pages: */
|
|
prot = PROT_NONE;
|
|
}
|
|
addr = port_to_cpu_addr (from, io.sys, 1);
|
|
addr &= PAGE_MASK;
|
|
len = port_to_cpu_addr (from + num, io.sys, 1) - addr;
|
|
return mprotect ((void *) addr, len, prot);
|
|
}
|
|
|
|
|
|
int
|
|
_iopl (unsigned int level)
|
|
{
|
|
if (level > 3) {
|
|
errno = EINVAL;
|
|
return -1;
|
|
}
|
|
if (level) {
|
|
return _ioperm (0, MAX_PORT, 1);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
void
|
|
_sethae (unsigned long addr)
|
|
{
|
|
if (!io.swp && init_iosys () < 0)
|
|
return;
|
|
|
|
io.swp->sethae (addr);
|
|
}
|
|
|
|
|
|
void
|
|
_outb (unsigned char b, unsigned long port)
|
|
{
|
|
if (port >= MAX_PORT)
|
|
return;
|
|
|
|
io.swp->outb (b, port);
|
|
}
|
|
|
|
|
|
void
|
|
_outw (unsigned short b, unsigned long port)
|
|
{
|
|
if (port >= MAX_PORT)
|
|
return;
|
|
|
|
io.swp->outw (b, port);
|
|
}
|
|
|
|
|
|
void
|
|
_outl (unsigned int b, unsigned long port)
|
|
{
|
|
if (port >= MAX_PORT)
|
|
return;
|
|
|
|
io.swp->outl (b, port);
|
|
}
|
|
|
|
|
|
unsigned int
|
|
_inb (unsigned long port)
|
|
{
|
|
return io.swp->inb (port);
|
|
}
|
|
|
|
|
|
unsigned int
|
|
_inw (unsigned long port)
|
|
{
|
|
return io.swp->inw (port);
|
|
}
|
|
|
|
|
|
unsigned int
|
|
_inl (unsigned long port)
|
|
{
|
|
return io.swp->inl (port);
|
|
}
|
|
|
|
|
|
weak_alias (_sethae, sethae);
|
|
weak_alias (_ioperm, ioperm);
|
|
weak_alias (_iopl, iopl);
|
|
weak_alias (_inb, inb);
|
|
weak_alias (_inw, inw);
|
|
weak_alias (_inl, inl);
|
|
weak_alias (_outb, outb);
|
|
weak_alias (_outw, outw);
|
|
weak_alias (_outl, outl);
|