|
|
|
2000/0713/sys/src/9/carrera/devether.c:1,431 –
2001/0527/sys/src/9/carrera/devether.c:0
(short | long | prev)
|
Deleted.
rsc Mon Mar 7 10:21:06 2005
|
|
1997/1210
| |
#include "u.h"
#include "../port/lib.h"
#include "mem.h"
#include "dat.h"
#include "fns.h"
#include "io.h"
#include "ureg.h"
#include "../port/error.h"
#include "../port/netif.h"
|
|
1993/0903
| |
|
|
1997/1210
| |
#include "etherif.h"
|
|
1993/0903
| |
|
|
1997/1210
| |
static Ether *etherxx[MaxEther];
|
|
1993/0903
| |
|
|
1997/1210
| |
Chan*
etherattach(char* spec)
|
|
1993/0906
| |
{
|
|
1997/1210
| |
ulong ctlrno;
char *p;
Chan *chan;
|
|
1993/0906
| |
|
|
1997/1210
| |
ctlrno = 0;
if(spec && *spec){
ctlrno = strtoul(spec, &p, 0);
if((ctlrno == 0 && p == spec) || *p || (ctlrno >= MaxEther))
error(Ebadarg);
}
if(etherxx[ctlrno] == 0)
error(Enodev);
|
|
1993/0903
| |
|
|
1997/1210
| |
chan = devattach('l', spec);
chan->dev = ctlrno;
if(etherxx[ctlrno]->dev && etherxx[ctlrno]->dev->attach)
etherxx[ctlrno]->dev->attach(etherxx[ctlrno]);
return chan;
}
|
|
1993/0903
| |
|
|
1997/1210
| |
static int
etherwalk(Chan* chan, char* name)
|
|
1993/0904
| |
{
|
|
1997/1210
| |
return netifwalk(etherxx[chan->dev], chan, name);
}
|
|
1993/0903
| |
|
|
1997/1210
| |
static void
etherstat(Chan* chan, char* dp)
|
|
1993/0904
| |
{
|
|
1997/1210
| |
netifstat(etherxx[chan->dev], chan, dp);
}
|
|
1993/0903
| |
|
|
1997/1210
| |
static Chan*
etheropen(Chan* chan, int omode)
|
|
1993/0903
| |
{
|
|
1997/1210
| |
return netifopen(etherxx[chan->dev], chan, omode);
}
|
|
1993/0903
| |
|
|
1997/1210
| |
static void
ethercreate(Chan*, char*, int, ulong)
|
|
1993/0904
| |
{
|
|
1997/1210
| |
}
|
|
1993/0904
| |
|
|
1997/1210
| |
static void
etherclose(Chan* chan)
|
|
1993/0905
| |
{
|
|
1997/1210
| |
netifclose(etherxx[chan->dev], chan);
}
|
|
1993/0904
| |
|
|
1997/1210
| |
static long
|
|
1998/0319
| |
etherread(Chan* chan, void* buf, long n, vlong off)
|
|
1993/0903
| |
{
|
|
1997/1210
| |
Ether *ether;
|
|
1998/0319
| |
ulong offset = off;
|
|
1993/0903
| |
|
|
1997/1210
| |
ether = etherxx[chan->dev];
if((chan->qid.path & CHDIR) == 0 && ether->dev && ether->dev->ifstat){
/*
* With some controllers it is necessary to reach
* into the chip to extract statistics.
*/
if(NETTYPE(chan->qid.path) == Nifstatqid)
return ether->dev->ifstat(ether, buf, n, offset);
else if(NETTYPE(chan->qid.path) == Nstatqid)
ether->dev->ifstat(ether, buf, 0, offset);
}
|
|
1993/0903
| |
|
|
1997/1210
| |
return netifread(ether, chan, buf, n, offset);
}
|
|
1993/0904
| |
|
|
1997/1210
| |
static Block*
etherbread(Chan* chan, long n, ulong offset)
|
|
1993/0906
| |
{
|
|
1997/1210
| |
return netifbread(etherxx[chan->dev], chan, n, offset);
|
|
1993/0906
| |
}
static void
|
|
1997/1210
| |
etherremove(Chan*)
|
|
1993/0903
| |
{
}
|
|
1997/0327
| |
static void
|
|
1997/1210
| |
etherwstat(Chan* chan, char* dp)
|
|
1993/0905
| |
{
|
|
1997/1210
| |
netifwstat(etherxx[chan->dev], chan, dp);
|
|
1993/0905
| |
}
|
|
1997/1210
| |
static void
etherrtrace(Netfile* f, Etherpkt* pkt, int len)
|
|
1993/1212
| |
{
|
|
1997/1210
| |
int i, n;
Block *bp;
|
|
1993/1212
| |
|
|
1997/1210
| |
if(qwindow(f->in) <= 0)
return;
|
|
2000/0713
| |
if(len > 58)
n = 58;
|
|
1997/1210
| |
else
n = len;
|
|
2000/0713
| |
bp = iallocb(64);
if(bp == nil)
|
|
1997/1210
| |
return;
memmove(bp->wp, pkt->d, n);
i = TK2MS(MACHP(0)->ticks);
bp->wp[58] = len>>8;
bp->wp[59] = len;
bp->wp[60] = i>>24;
bp->wp[61] = i>>16;
bp->wp[62] = i>>8;
bp->wp[63] = i;
bp->wp += 64;
qpass(f->in, bp);
|
|
1993/1212
| |
}
|
|
1997/1210
| |
Block*
etheriq(Ether* ether, Block* bp, int freebp)
|
|
1993/0903
| |
{
|
|
1997/1210
| |
Etherpkt *pkt;
ushort type;
int len;
Netfile **ep, *f, **fp, *fx;
Block *xbp;
|
|
1993/0903
| |
|
|
1997/1210
| |
ether->inpackets++;
|
|
1993/0903
| |
|
|
1997/1210
| |
pkt = (Etherpkt*)bp->rp;
len = BLEN(bp);
type = (pkt->type[0]<<8)|pkt->type[1];
fx = 0;
ep = ðer->f[Ntypes];
|
|
1993/0904
| |
|
|
1997/1210
| |
/* check for valid multcast addresses */
if((pkt->d[0] & 1) && memcmp(pkt->d, ether->bcast, sizeof(pkt->d)) && ether->prom == 0){
if(!activemulti(ether, pkt->d, sizeof(pkt->d))){
if(freebp){
freeb(bp);
bp = 0;
|
|
1993/0904
| |
}
|
|
1997/1210
| |
return bp;
|
|
1993/0903
| |
}
|
|
1997/1210
| |
}
|
|
1993/0904
| |
|
|
1997/1210
| |
/*
* Multiplex the packet to all the connections which want it.
* If the packet is not to be used subsequently (freebp != 0),
* attempt to simply pass it into one of the connections, thereby
* saving a copy of the data (usual case hopefully).
*/
for(fp = ether->f; fp < ep; fp++){
if((f = *fp) && (f->type == type || f->type < 0)){
if(f->type > -2){
if(freebp && fx == 0)
fx = f;
else if(xbp = iallocb(len)){
memmove(xbp->wp, pkt, len);
xbp->wp += len;
qpass(f->in, xbp);
}
else
ether->soverflows++;
}
|
|
1993/0904
| |
else
|
|
1997/1210
| |
etherrtrace(f, pkt, len);
|
|
1993/0903
| |
}
|
|
1997/1210
| |
}
|
|
1993/0903
| |
|
|
1997/1210
| |
if(fx){
qpass(fx->in, bp);
return 0;
|
|
1993/0903
| |
}
|
|
1997/1210
| |
if(freebp){
freeb(bp);
return 0;
}
|
|
1993/0903
| |
|
|
1997/1210
| |
return bp;
|
|
1993/0903
| |
}
|
|
1997/1210
| |
static int
etheroq(Ether* ether, Block* bp)
|
|
1993/0906
| |
{
|
|
1997/1210
| |
int len, loopback, s;
Etherpkt *pkt;
|
|
1993/0906
| |
|
|
1997/1210
| |
ether->outpackets++;
|
|
1993/0906
| |
/*
|
|
1997/1210
| |
* Check if the packet has to be placed back onto the input queue,
* i.e. if it's a loopback or broadcast packet or the interface is
* in promiscuous mode.
* If it's a loopback packet indicate to etheriq that the data isn't
* needed and return, etheriq will pass-on or free the block.
|
|
1993/0906
| |
*/
|
|
1997/1210
| |
pkt = (Etherpkt*)bp->rp;
len = BLEN(bp);
loopback = (memcmp(pkt->d, ether->addr, sizeof(pkt->d)) == 0);
if(loopback || memcmp(pkt->d, ether->bcast, sizeof(pkt->d)) == 0 || ether->prom){
s = splhi();
etheriq(ether, bp, loopback);
splx(s);
|
|
1993/0906
| |
}
|
|
1997/1210
| |
if(!loopback){
if(ether->dev && ether->dev->transmit){
qbwrite(ether->oq, bp);
ether->dev->transmit(ether);
}
else{
freeb(bp);
return 0;
}
|
|
1993/0903
| |
}
|
|
1997/1210
| |
return len;
|
|
1993/0903
| |
}
|
|
1997/1210
| |
static long
|
|
1998/0319
| |
etherwrite(Chan* chan, void* buf, long n, vlong)
|
|
1993/0903
| |
{
|
|
1997/1210
| |
Ether *ether;
Block *bp;
|
|
1993/0905
| |
|
|
1997/1210
| |
ether = etherxx[chan->dev];
if(NETTYPE(chan->qid.path) != Ndataqid)
return netifwrite(ether, chan, buf, n);
|
|
1993/0903
| |
|
|
1997/1210
| |
if(n > ETHERMAXTU)
error(Etoobig);
if(n < ETHERMINTU)
error(Etoosmall);
|
|
1993/0903
| |
|
|
1997/1210
| |
bp = allocb(n);
if(waserror()){
freeb(bp);
nexterror();
}
memmove(bp->rp, buf, n);
memmove(bp->rp+Eaddrlen, ether->addr, Eaddrlen);
poperror();
bp->wp += n;
|
|
1993/0903
| |
|
|
1997/1210
| |
return etheroq(ether, bp);
|
|
1993/0903
| |
}
|
|
1997/0327
| |
static long
|
|
1997/1210
| |
etherbwrite(Chan* chan, Block* bp, ulong)
|
|
1993/0903
| |
{
|
|
1997/1210
| |
Ether *ether;
long n;
|
|
1993/0903
| |
|
|
1997/1210
| |
n = BLEN(bp);
ether = etherxx[chan->dev];
if(NETTYPE(chan->qid.path) != Ndataqid){
n = netifwrite(ether, chan, bp->rp, n);
freeb(bp);
|
|
1993/1202
| |
return n;
|
|
1993/0918
| |
}
|
|
1997/1210
| |
if(n > ETHERMAXTU){
freeb(bp);
error(Ebadarg);
|
|
1993/0903
| |
}
|
|
1997/1210
| |
if(n < ETHERMINTU){
freeb(bp);
error(Etoosmall);
}
|
|
1993/0905
| |
|
|
1997/1210
| |
return etheroq(ether, bp);
|
|
1995/0108
| |
}
|
|
1997/1210
| |
void
etherreset(void)
|
|
1993/0903
| |
{
|
|
1997/1210
| |
Ether *ether;
int i, n, ctlrno;
char name[NAMELEN], buf[128];
|
|
1993/0903
| |
|
|
1997/1210
| |
for(ether = 0, ctlrno = 0; ctlrno < MaxEther; ctlrno++){
if(ether == 0)
ether = malloc(sizeof(Ether));
memset(ether, 0, sizeof(Ether));
ether->ctlrno = ctlrno;
ether->tbdf = BUSUNKNOWN;
ether->mbps = 10;
if(isaconfig("ether", ctlrno, ether) == 0)
continue;
for(n = 0; endev[n]; n++){
if(cistrcmp(endev[n]->name, ether->type))
continue;
ether->dev = endev[n];
for(i = 0; i < ether->nopt; i++){
if(strncmp(ether->opt[i], "ea=", 3))
continue;
if(parseether(ether->addr, ðer->opt[i][3]) == -1)
memset(ether->addr, 0, Eaddrlen);
}
if(endev[n]->reset(ether))
break;
|
|
1993/0903
| |
|
|
1997/1210
| |
/*
* IRQ2 doesn't really exist, it's used to gang the interrupt
* controllers together. A device set to IRQ2 will appear on
* the second interrupt controller as IRQ9.
*/
if(ether->irq == 2)
ether->irq = 9;
intrenable(VectorPIC+ether->irq, ether->interrupt, ether, ether->tbdf);
|
|
1993/0906
| |
|
|
1997/1210
| |
i = sprint(buf, "#l%d: %s: %dMbps port 0x%luX",
ctlrno, ether->type, ether->mbps, ether->port);
if(ether->irq)
|
|
1999/0629
| |
i += sprint(buf+i, " irq %ld", ether->irq);
|
|
1997/1210
| |
if(ether->mem)
i += sprint(buf+i, " addr 0x%luX", PADDR(ether->mem));
if(ether->size)
i += sprint(buf+i, " size 0x%luX", ether->size);
i += sprint(buf+i, ": %2.2uX%2.2uX%2.2uX%2.2uX%2.2uX%2.2uX",
ether->addr[0], ether->addr[1], ether->addr[2],
ether->addr[3], ether->addr[4], ether->addr[5]);
sprint(buf+i, "\n");
print(buf);
|
|
1993/0906
| |
|
|
1997/1210
| |
snprint(name, sizeof(name), "ether%d", ctlrno);
if(ether->mbps == 100){
netifinit(ether, name, Ntypes, 256*1024);
if(ether->oq == 0)
ether->oq = qopen(256*1024, 1, 0, 0);
}
else{
netifinit(ether, name, Ntypes, 32*1024);
if(ether->oq == 0)
ether->oq = qopen(64*1024, 1, 0, 0);
}
if(ether->oq == 0)
panic("etherreset %s", name);
|
|
1993/0906
| |
|
|
1997/1210
| |
ether->alen = Eaddrlen;
memset(ether->bcast, 0xFF, Eaddrlen);
ether->arg = ether;
ether->promiscuous = ether->dev->promiscuous;
ether->multicast = ether->dev->multicast;
etherxx[ctlrno] = ether;
ether = 0;
break;
}
|
|
1993/0906
| |
}
|
|
1997/1210
| |
if(ether)
free(ether);
|
|
1993/0903
| |
}
|
|
1997/0327
| |
int
|
|
1997/1210
| |
parseether(uchar* to, char* from)
|
|
1997/0327
| |
{
char nip[4];
char *p;
int i;
p = from;
for(i = 0; i < 6; i++){
if(*p == 0)
return -1;
nip[0] = *p++;
if(*p == 0)
return -1;
nip[1] = *p++;
nip[2] = 0;
to[i] = strtoul(nip, 0, 16);
if(*p == ':')
p++;
}
return 0;
}
|
|
1997/1210
| |
#define POLY 0xedb88320
/* really slow 32 bit crc for ethers */
ulong
ethercrc(uchar* p, int len)
{
int i, j;
ulong crc, b;
crc = 0xffffffff;
for(i = 0; i < len; i++){
b = *p++;
for(j = 0; j < 8; j++){
crc = (crc>>1) ^ (((crc^b) & 1) ? POLY : 0);
b >>= 1;
}
}
return crc;
}
|
|
1997/0327
| |
Dev etherdevtab = {
|
|
1997/0408
| |
'l',
"ether",
|
|
1997/0327
| |
etherreset,
devinit,
etherattach,
devclone,
etherwalk,
etherstat,
etheropen,
ethercreate,
etherclose,
etherread,
|
|
1997/1210
| |
etherbread,
|
|
1997/0327
| |
etherwrite,
|
|
1997/1210
| |
etherbwrite,
|
|
1997/0327
| |
etherremove,
etherwstat,
};
|