|
|
|
1992/0916/sys/src/9/gnot/devport.c:1,262 –
1993/0501/sys/src/9/gnot/devport.c:0
(short | long | prev)
|
Deleted.
rsc Mon Mar 7 10:21:42 2005
|
|
1991/0110
| |
#include "u.h"
|
|
1992/0321
| |
#include "../port/lib.h"
|
|
1991/0110
| |
#include "mem.h"
#include "dat.h"
#include "fns.h"
#include "io.h"
|
|
1992/0111
| |
#include "../port/error.h"
|
|
1991/0110
| |
#include "devtab.h"
|
|
1992/0225
| |
#define ROMADDR 0x40000000
#define ROMSIZE ((256*1024)/8)
|
|
1992/0916
| |
#define P_qlock(sel) if(sel >= 0){\
qlock(&portpage);\
PORTSELECT = portpage.select = sel;\
}else
#define P_qunlock(sel) if(sel >= 0){\
qunlock(&portpage);\
}else
#define P_oper(sel, inst) P_qlock(sel); inst; P_qunlock(sel)
|
|
1992/0621
| |
#define P_read(sel, addr, val, type) P_oper(sel, val = *(type *)(PORT+addr))
#define P_write(sel, addr, val, type) P_oper(sel, *(type *)(PORT+addr) = val)
enum
{
|
|
1991/0110
| |
Qdir,
Qdata,
|
|
1992/0225
| |
Qrom
|
|
1991/0110
| |
};
Dirtab portdir[]={
|
|
1991/1112
| |
"data", {Qdata}, 0, 0666,
|
|
1992/0225
| |
"rom", {Qrom}, ROMSIZE, 0444,
|
|
1991/0110
| |
};
#define NPORT (sizeof portdir/sizeof(Dirtab))
|
|
1992/0621
| |
#define Nportservice 8
static int (*portservice[Nportservice])(void);
|
|
1992/0808
| |
Portpage portpage;
|
|
1992/0621
| |
static Lock intrlock;
|
|
1991/0110
| |
int
portprobe(char *what, int select, int addr, int rw, long val)
{
int time;
if (!conf.portispaged)
return 0;
P_qlock(select);
switch (rw) {
case -1:
|
|
1992/0621
| |
val = *(uchar *)(PORT+addr);
break;
|
|
1991/0110
| |
case -2:
|
|
1992/0621
| |
val = *(ushort *)(PORT+addr);
break;
|
|
1991/0110
| |
case -4:
|
|
1992/0621
| |
val = *(long *)(PORT+addr);
break;
|
|
1991/0110
| |
case 1:
|
|
1992/0621
| |
*(uchar *)(PORT+addr) = val;
break;
|
|
1991/0110
| |
case 2:
|
|
1992/0621
| |
*(ushort *)(PORT+addr) = val;
break;
|
|
1991/0110
| |
case 4:
|
|
1992/0621
| |
*(long *)(PORT+addr) = val;
break;
|
|
1991/0110
| |
default:
panic("portprobe");
}
time = PORTSELECT & 0x1f;
P_qunlock(select);
if (what) {
print("%s at %d, %d", what, select, addr);
print("%s", time & 0x10 ? " -- NOT FOUND\n" : "\n");
}
if (time & 0x10)
return -1;
return val;
}
void
portreset(void)
{
portpage.select = -1;
lock(&portpage);
unlock(&portpage);
}
void
portinit(void)
|
|
1992/0621
| |
{
}
|
|
1991/0110
| |
Chan *
portattach(char *param)
{
return devattach('x', param);
}
Chan *
portclone(Chan *c, Chan *nc)
{
return devclone(c, nc);
}
int
portwalk(Chan *c, char *name)
{
return devwalk(c, name, portdir, NPORT, devgen);
}
void
portstat(Chan *c, char *db)
{
devstat(c, db, portdir, NPORT, devgen);
}
Chan *
portopen(Chan *c, int omode)
{
return devopen(c, omode, portdir, NPORT, devgen);
}
void
portcreate(Chan *c, char *name, int omode, ulong perm)
{
|
|
1992/0711
| |
USED(c, name, omode, perm);
|
|
1991/0110
| |
error(Eperm);
}
void
portclose(Chan *c)
|
|
1992/0621
| |
{
|
|
1992/0711
| |
USED(c);
|
|
1992/0621
| |
}
|
|
1991/0110
| |
long
|
|
1991/0411
| |
portread(Chan *c, char *a, long n, ulong offset)
|
|
1991/0110
| |
{
long s, k;
if (n == 0)
return 0;
switch ((int)(c->qid.path & ~CHDIR)) {
case Qdir:
return devdirread(c, a, n, portdir, NPORT, devgen);
case Qdata:
|
|
1991/0411
| |
if (!conf.portispaged || (s = offset >> PORTSHIFT) > 0xff)
|
|
1991/0110
| |
s = -1;
|
|
1991/0411
| |
k = offset % PORTSIZE;
|
|
1991/0110
| |
P_qlock(s);
switch ((int)n) {
case 1:
*a = PORT[k]; break;
case 2:
*(short *)a = *(short *)(PORT+k); break;
case 4:
*(long *)a = *(long *)(PORT+k); break;
default:
P_qunlock(s);
error(Ebadarg);
}
P_qunlock(s);
|
|
1992/0225
| |
break;
case Qrom:
if(offset >= ROMSIZE)
return 0;
if(offset+n > ROMSIZE)
n = ROMSIZE - offset;
memmove(a, ((char*)ROMADDR)+offset, n);
return n;
|
|
1991/0110
| |
break;
default:
panic("portread");
}
return n;
}
long
|
|
1991/0411
| |
portwrite(Chan *c, char *a, long n, ulong offset)
|
|
1991/0110
| |
{
long s, k;
if (n == 0)
return 0;
switch ((int)c->qid.path) {
case Qdata:
|
|
1991/0411
| |
if (!conf.portispaged || (s = offset >> PORTSHIFT) > 0xff)
|
|
1991/0110
| |
s = -1;
|
|
1991/0411
| |
k = offset % PORTSIZE;
|
|
1991/0110
| |
P_qlock(s);
switch ((int)n) {
case 1:
PORT[k] = *a; break;
case 2:
|
|
1992/0621
| |
*(short *)(PORT+k) = *(short *)a;
break;
|
|
1991/0110
| |
case 4:
|
|
1992/0621
| |
*(long *)(PORT+k) = *(long *)a;
break;
|
|
1991/0110
| |
default:
P_qunlock(s);
error(Ebadarg);
}
P_qunlock(s);
break;
default:
panic("portwrite");
}
return n;
}
void
portremove(Chan *c)
{
|
|
1992/0621
| |
USED(c);
|
|
1991/0110
| |
error(Eperm);
}
void
portwstat(Chan *c, char *dp)
{
|
|
1992/0621
| |
USED(c, dp);
|
|
1991/0110
| |
error(Eperm);
}
void
addportintr(int (*f)(void))
{
int s = splhi();
int (**p)(void);
|
|
1992/0621
| |
|
|
1991/0110
| |
lock(&intrlock);
for (p=portservice; *p; p++)
if (*p == f)
goto out;
if (p >= &portservice[Nportservice-1])
panic("addportintr");
*p = f;
out:
unlock(&intrlock);
splx(s);
}
void
devportintr(void)
{
|
|
1992/0621
| |
int (**p)(void);
int i = 0;
|
|
1991/0110
| |
for (p=portservice; *p; p++)
i |= (**p)();
|
|
1992/0621
| |
|
|
1991/0110
| |
if (!i)
/*putstring("spurious portintr\n");*/
panic("portintr");
if (portpage.select >= 0)
PORTSELECT = portpage.select;
}
|