plan 9 kernel history: overview | file list | diff list

1992/0406/port/devip.c (diff list | history)

1992/0406/sys/src/9/port/devip.c:1,944 – 1992/0414/sys/src/9/port/devip.c:1,944 (short | long | prev | next)
1991/0424    
#include	"u.h"
1992/0321    
#include	"../port/lib.h"
1991/0424    
#include	"mem.h" 
#include	"dat.h" 
#include	"fns.h"
1992/0111    
#include	"../port/error.h"
1991/0424    
#include 	"arp.h" 
#include 	"ipdat.h" 
 
#include	"devtab.h"
1991/1012    
enum 
{
1992/0318    
	Nrprotocol	= 3,	/* Number of protocols supported by this driver */ 
	Nipsubdir	= 4,	/* Number of subdirectory entries per connection */
1991/0424    
};
1991/1030    
int 	udpsum = 1;
1991/12171    
Queue	*Ipoutput;			/* Control message stream for tcp/il */ 
Ipifc	*ipifc;				/* IP protocol interfaces for stip */ 
Ipconv	*ipconv[Nrprotocol];		/* Connections for each protocol */ 
Network	*ipnet[Nrprotocol];		/* User level interface for protocol */ 
QLock	ipalloc;			/* Protocol port allocation lock */
1991/0424    
 
/* ARPA User Datagram Protocol */ 
void	udpstiput(Queue *, Block *); 
void	udpstoput(Queue *, Block *); 
void	udpstopen(Queue *, Stream *); 
void	udpstclose(Queue *); 
/* ARPA Transmission Control Protocol */ 
void	tcpstiput(Queue *, Block *); 
void	tcpstoput(Queue *, Block *); 
void	tcpstopen(Queue *, Stream *); 
void	tcpstclose(Queue *);
1991/1012    
/* Plan9 Reliable Datagram Protocol */ 
void	iliput(Queue *, Block *); 
void	iloput(Queue *, Block *); 
void	ilopen(Queue *, Stream *); 
void	ilclose(Queue *);
1991/0424    
1992/0318    
Qinfo tcpinfo = { tcpstiput, tcpstoput, tcpstopen, tcpstclose, "tcp", 0, 1 };
1991/0424    
Qinfo udpinfo = { udpstiput, udpstoput, udpstopen, udpstclose, "udp" };
1991/1012    
Qinfo ilinfo  = { iliput,    iloput,    ilopen,    ilclose,    "il"  };
1991/0424    
1991/1012    
Qinfo *protocols[] = { &tcpinfo, &udpinfo, &ilinfo, 0 };
1991/0424    
1991/1114    
void
1991/1126    
ipinitnet(Network *np, Qinfo *stproto, Ipconv *cp)
1991/1012    
{
1991/1114    
	int j;
1991/0424    
1991/1115    
	for(j = 0; j < conf.ip; j++, cp++){ 
		cp->index = j;
1991/1114    
		cp->stproto = stproto;
1991/1126    
		cp->net = np;
1991/1115    
	}
1991/1126    
	np->name = stproto->name; 
	np->nconv = conf.ip; 
	np->devp = &ipinfo; 
	np->protop = stproto;
1991/1114    
	if(stproto != &udpinfo)
1991/1126    
		np->listen = iplisten; 
	np->clone = ipclonecon; 
	np->prot = (Netprot *)ialloc(sizeof(Netprot) * conf.ip, 0); 
	np->ninfo = 3; 
	np->info[0].name = "remote"; 
	np->info[0].fill = ipremotefill; 
	np->info[1].name = "local"; 
	np->info[1].fill = iplocalfill; 
	np->info[2].name = "status"; 
	np->info[2].fill = ipstatusfill;
1991/1114    
}
1991/0424    
 
void 
ipreset(void) 
{
1991/1114    
	int i, j;
1991/0424    
 
	ipifc = (Ipifc *)ialloc(sizeof(Ipifc) * conf.ip, 0);
1991/1012    
	for(i = 0; protocols[i]; i++) {
1991/0424    
		ipconv[i] = (Ipconv *)ialloc(sizeof(Ipconv) * conf.ip, 0);
1991/1126    
		ipnet[i] = (Network *)ialloc(sizeof(Network), 0); 
		ipinitnet(ipnet[i], protocols[i], ipconv[i]);
1991/0424    
		newqinfo(protocols[i]); 
	} 
 
	initfrag(conf.frag);
1991/0705    
	tcpinit();
1991/0424    
} 
 
void 
ipinit(void) 
{ 
} 
 
Chan * 
ipattach(char *spec) 
{ 
	Chan *c; 
	int i;
1992/0219    
	/* fail if ip is not yet configured */ 
	if(Ipoutput == 0) 
		error(Enoproto);
1991/0424    
	for(i = 0; protocols[i]; i++) { 
		if(strcmp(spec, protocols[i]->name) == 0) { 
			c = devattach('I', spec); 
			c->dev = i; 
 
			return (c); 
		} 
	} 
 
	error(Enoproto); 
} 
 
Chan * 
ipclone(Chan *c, Chan *nc) 
{ 
	return devclone(c, nc); 
} 
 
int 
ipwalk(Chan *c, char *name) 
{
1991/1126    
	return netwalk(c, name, ipnet[c->dev]);
1991/0424    
} 
 
void 
ipstat(Chan *c, char *db) 
{
1991/1126    
	netstat(c, db, ipnet[c->dev]);
1991/0424    
} 
 
Chan * 
ipopen(Chan *c, int omode) 
{
1991/1126    
	return netopen(c, omode, ipnet[c->dev]);
1991/0424    
}
1991/1114    
int
1991/0424    
ipclonecon(Chan *c) 
{
1991/1108    
	Ipconv *new, *base;
1991/0424    
 
	base = ipconv[c->dev];
1991/1115    
	new = ipincoming(base, 0);
1991/1108    
	if(new == 0) 
		error(Enodev);
1991/1114    
	return new - base;
1991/1023    
} 
 
Ipconv *
1991/1115    
ipincoming(Ipconv *base, Ipconv *from)
1991/1023    
{
1991/1024    
	Ipconv *new, *etab;
1991/1023    
 
	etab = &base[conf.ip]; 
	for(new = base; new < etab; new++) {
1991/0424    
		if(new->ref == 0 && canqlock(new)) {
1992/0313    
			if(new->ref || ipconbusy(new)) {
1991/0424    
				qunlock(new); 
				continue; 
			}
1992/0318    
			if(from)	/* copy ownership from listening channel */
1992/0313    
				netown(new->net, new->index, 
				       new->net->prot[from->index].owner, 0);
1992/0318    
			else		/* current user becomes owner */
1991/1126    
				netown(new->net, new->index, u->p->user, 0);
1992/0313    
1991/1114    
			new->ref = 1;
1992/0306    
			new->newcon = 0;
1991/0424    
			qunlock(new); 
			return new; 
		}	 
	}
1991/1023    
	return 0;
1991/0424    
} 
 
void 
ipcreate(Chan *c, char *name, int omode, ulong perm) 
{
1991/1115    
	USED(c, name, omode, perm);
1991/0424    
	error(Eperm); 
} 
 
void 
ipremove(Chan *c) 
{
1991/1115    
	USED(c);
1991/0424    
	error(Eperm); 
} 
 
void 
ipwstat(Chan *c, char *dp) 
{
1991/1126    
	netwstat(c, dp, ipnet[c->dev]);
1991/0424    
} 
 
void 
ipclose(Chan *c) 
{
1991/1114    
	if(c->stream)
1991/0424    
		streamclose(c); 
} 
 
long 
ipread(Chan *c, void *a, long n, ulong offset) 
{
1991/1126    
	return netread(c, a, n, offset, ipnet[c->dev]);
1991/0424    
} 
 
long 
ipwrite(Chan *c, char *a, long n, ulong offset) 
{
1992/0128    
	int 	m, backlog, type, priv;
1991/1024    
	char 	*field[5], *ctlarg[5], buf[256];
1992/0128    
	Port	port;
1991/1024    
	Ipconv  *cp;
1991/0424    
 
	type = STREAMTYPE(c->qid.path); 
	if (type == Sdataqid) 
		return streamwrite(c, a, n, 0);
1991/1024    
	if (type != Sctlqid) 
		error(Eperm);
1991/0424    
1991/1024    
	cp = &ipconv[c->dev][STREAMID(c->qid.path)];
1991/0424    
1991/1024    
	m = n; 
	if(m > sizeof(buf)-1) 
		m = sizeof(buf)-1; 
	strncpy(buf, a, m); 
	buf[m] = '\0';
1991/0516    
1991/1024    
	m = getfields(buf, field, 5, ' '); 
	if(m < 1)
1992/0111    
		error(Ebadarg);
1991/0424    
1991/1024    
	if(strcmp(field[0], "connect") == 0) {
1992/0313    
		if(ipconbusy(cp)) 
			error(Enetbusy);
1991/0424    
1991/1024    
		if(m != 2) 
			error(Ebadarg);
1991/0424    
1991/1025    
		switch(getfields(field[1], ctlarg, 5, '!')) {
1991/1024    
		default: 
			error(Ebadarg); 
		case 2:
1992/0128    
			priv = 0;
1991/1024    
			break; 
		case 3: 
			if(strcmp(ctlarg[2], "r") != 0) 
				error(Eperm);
1992/0128    
			priv = 1;
1991/1024    
			break;
1991/0424    
		}
1991/1024    
		cp->dst = ipparse(ctlarg[0]); 
		cp->pdst = atoi(ctlarg[1]);
1991/0516    
1991/1024    
		/* If we have no local port assign one */ 
		qlock(&ipalloc); 
		if(cp->psrc == 0)
1992/0128    
			cp->psrc = nextport(ipconv[c->dev], priv);
1991/1024    
		qunlock(&ipalloc);
1991/0424    
1991/1114    
		if(cp->stproto == &tcpinfo) 
			tcpstart(cp, TCP_ACTIVE, Streamhi, 0); 
		else if(cp->stproto == &ilinfo)
1991/1124    
			ilstart(cp, IL_ACTIVE, 20);
1991/1114    
1991/1024    
	}
1991/1125    
	else if(strcmp(field[0], "disconnect") == 0) { 
		if(cp->stproto != &udpinfo) 
			error(Eperm); 
 
		cp->dst = 0; 
		cp->pdst = 0; 
	}
1991/1104    
	else if(strcmp(field[0], "announce") == 0) {
1992/0313    
		if(ipconbusy(cp)) 
			error(Enetbusy);
1991/0424    
1991/1024    
		if(m != 2) 
			error(Ebadarg); 
 
		port = atoi(field[1]); 
 
		qlock(&ipalloc); 
		if(portused(ipconv[c->dev], port)) { 
			qunlock(&ipalloc);	 
			error(Einuse); 
		} 
		cp->psrc = port; 
		qunlock(&ipalloc);
1991/1114    
 
		if(cp->stproto == &tcpinfo) 
			tcpstart(cp, TCP_PASSIVE, Streamhi, 0); 
		else if(cp->stproto == &ilinfo) 
			ilstart(cp, IL_PASSIVE, 10); 
 
		if(cp->backlog == 0) 
			cp->backlog = 3;
1991/0424    
	}
1991/1024    
	else if(strcmp(field[0], "backlog") == 0) { 
		if(m != 2) 
			error(Ebadarg); 
		backlog = atoi(field[1]); 
		if(backlog == 0) 
			error(Ebadarg); 
		if(backlog > 5) 
			backlog = 5; 
		cp->backlog = backlog; 
	} 
	else 
		return streamwrite(c, a, n, 0);
1991/0424    
1991/1024    
	return n;
1991/0424    
}
1992/0313    
int 
ipconbusy(Ipconv  *cp) 
{ 
	if(cp->stproto == &tcpinfo) 
	if(cp->tcpctl.state != Closed) 
		return 1;
1991/0424    
1992/0313    
	if(cp->stproto == &ilinfo) 
	if(cp->ilctl.state != Ilclosed) 
		return 1; 
 
	return 0; 
}
1991/0424    
void 
udpstiput(Queue *q, Block *bp) 
{
1991/0516    
	PUTNEXT(q, bp);
1991/0424    
} 
 
/* 
 * udprcvmsg - called by stip to multiplex udp ports onto conversations 
 */ 
void 
udprcvmsg(Ipconv *muxed, Block *bp) 
{ 
	Ipconv *ifc, *etab; 
	Udphdr *uh;
1991/1125    
	Port   dport, sport;
1991/0424    
	ushort sum, len; 
	Ipaddr addr; 
 
	uh = (Udphdr *)(bp->rptr); 
 
	/* Put back pseudo header for checksum */ 
	uh->Unused = 0; 
	len = nhgets(uh->udplen); 
	hnputs(uh->udpplen, len); 
 
	addr = nhgetl(uh->udpsrc); 
 
	if(udpsum && nhgets(uh->udpcksum)) { 
		if(sum = ptcl_csum(bp, UDP_EHSIZE, len+UDP_PHDRSIZE)) { 
			print("udp: checksum error %x (%d.%d.%d.%d)\n", 
			      sum, fmtaddr(addr)); 
			 
			freeb(bp); 
			return; 
		} 
	} 
 
	dport = nhgets(uh->udpdport);
1991/1125    
	sport = nhgets(uh->udpsport);
1991/0424    
 
	/* Look for a conversation structure for this port */ 
	etab = &muxed[conf.ip]; 
	for(ifc = muxed; ifc < etab; ifc++) {
1992/0313    
		if(ifc->ref) 
		if(ifc->psrc == dport) 
		if(ifc->pdst == 0 || ifc->pdst == sport) {
1991/0424    
			/* Trim the packet down to data size */ 
			len = len - (UDP_HDRSIZE-UDP_PHDRSIZE); 
			bp = btrim(bp, UDP_EHSIZE+UDP_HDRSIZE, len); 
			if(bp == 0) 
				return; 
 
			/* Stuff the src address into the remote file */ 
		 	ifc->dst = addr;
1991/1125    
			ifc->pdst = sport;
1991/0424    
			PUTNEXT(ifc->readq, bp); 
			return; 
		} 
	} 
 
	freeb(bp); 
} 
 
void 
udpstoput(Queue *q, Block *bp) 
{ 
	Ipconv *ipc; 
	Udphdr *uh;
1991/1104    
	int dlen, ptcllen, newlen;
1991/0424    
1991/1104    
	if(bp->type == M_CTL) { 
		PUTNEXT(q, bp); 
		return; 
	}
1991/0424    
	/* Prepend udp header to packet and pass on to ip layer */ 
	ipc = (Ipconv *)(q->ptr); 
	if(ipc->psrc == 0) 
		error(Enoport); 
 
	if(bp->type != M_DATA) { 
		freeb(bp); 
		error(Ebadctl); 
	} 
 
	/* Only allow atomic udp writes to form datagrams */ 
	if(!(bp->flags & S_DELIM)) { 
		freeb(bp); 
		error(Emsgsize); 
	} 
 
	/* Round packet up to even number of bytes and check we can 
	 * send it 
	 */ 
	dlen = blen(bp); 
	if(dlen > UDP_DATMAX) { 
		freeb(bp); 
		error(Emsgsize); 
	} 
	newlen = bround(bp, 1); 
 
	/* Make space to fit udp & ip & ethernet header */ 
	bp = padb(bp, UDP_EHSIZE + UDP_HDRSIZE); 
 
	uh = (Udphdr *)(bp->rptr); 
 
	ptcllen = dlen + (UDP_HDRSIZE-UDP_PHDRSIZE); 
	uh->Unused = 0; 
	uh->udpproto = IP_UDPPROTO;
1992/0106    
	uh->frag[0] = 0; 
	uh->frag[1] = 0;
1991/0424    
	hnputs(uh->udpplen, ptcllen); 
	hnputl(uh->udpdst, ipc->dst);
1992/0213    
	hnputl(uh->udpsrc, Myip[Myself]);
1991/0424    
	hnputs(uh->udpsport, ipc->psrc); 
	hnputs(uh->udpdport, ipc->pdst); 
	hnputs(uh->udplen, ptcllen); 
	uh->udpcksum[0] = 0; 
	uh->udpcksum[1] = 0; 
 
	hnputs(uh->udpcksum, ptcl_csum(bp, UDP_EHSIZE, newlen+UDP_HDRSIZE)); 
	PUTNEXT(q, bp); 
} 
 
void 
udpstclose(Queue *q) 
{ 
	Ipconv *ipc; 
 
	ipc = (Ipconv *)(q->ptr);
1991/1114    
	ipc->psrc = 0; 
	ipc->pdst = 0; 
	ipc->dst = 0;
1991/0424    
 
	closeipifc(ipc->ipinterface); 
} 
 
void 
udpstopen(Queue *q, Stream *s) 
{ 
	Ipconv *ipc; 
 
	ipc = &ipconv[s->dev][s->id]; 
	ipc->ipinterface = newipifc(IP_UDPPROTO, udprcvmsg, ipconv[s->dev], 
			            1500, 512, ETHER_HDR, "UDP"); 
 
	ipc->readq = RD(q);	 
	RD(q)->ptr = (void *)ipc; 
	WR(q)->next->ptr = (void *)ipc->ipinterface; 
	WR(q)->ptr = (void *)ipc; 
} 
 
void 
tcpstiput(Queue *q, Block *bp) 
{
1991/0516    
	PUTNEXT(q, bp);
1991/0424    
} 
 
void 
tcpstoput(Queue *q, Block *bp) 
{ 
	Ipconv *s; 
	Tcpctl *tcb;
1991/1104    
	int len, errnum;
1991/1126    
	Block *f;
1991/0424    
 
	s = (Ipconv *)(q->ptr); 
	tcb = &s->tcpctl;
1991/1104    
	if(bp->type == M_CTL) { 
		PUTNEXT(q, bp); 
		return; 
	}
1991/0424    
	if(s->psrc == 0) 
		error(Enoport); 
 
	/* Report asynchronous errors */ 
	if(s->err) 
		error(s->err); 
 
	switch(tcb->state) {
1991/12171    
	case Listen:
1991/0424    
		tcb->flags |= ACTIVE; 
		send_syn(tcb);
1991/12171    
		setstate(s, Syn_sent);
1992/0313    
1991/0424    
		/* No break */
1991/12171    
	case Syn_sent: 
	case Syn_received: 
	case Established: 
	case Close_wait:
1991/0424    
		qlock(tcb);
1992/0322    
		if(waserror()) { 
			qunlock(tcb); 
			nexterror(); 
		}
1991/1126    
		tcb->sndcnt += blen(bp); 
		if(tcb->sndq == 0) 
			tcb->sndq = bp; 
		else { 
			for(f = tcb->sndq; f->next; f = f->next) 
				; 
			f->next = bp; 
		}
1991/0424    
		tcprcvwin(s); 
		tcp_output(s);
1992/0322    
		poperror();
1991/0424    
		qunlock(tcb); 
		break;
1992/0313    
1991/0424    
	default: 
		freeb(bp); 
		error(Ehungup); 
	}	 
} 
 
void 
tcpstopen(Queue *q, Stream *s) 
{ 
	Ipconv *ipc;
1991/1019    
	static int tcpkprocs;
1991/0424    
1991/1019    
	if(!Ipoutput) { 
		Ipoutput = WR(q);
1991/0430    
		s->opens++;
1991/0504    
		s->inuse++;
1991/1019    
	} 
 
	/* Flow control and tcp timer processes */ 
	if(tcpkprocs == 0) { 
		tcpkprocs = 1;
1991/0424    
		kproc("tcpack", tcpackproc, 0); 
		kproc("tcpflow", tcpflow, &ipconv[s->dev]);
1991/0430    
1991/0424    
	} 
 
	ipc = &ipconv[s->dev][s->id]; 
	ipc->ipinterface = newipifc(IP_TCPPROTO, tcp_input, ipconv[s->dev],  
			            1500, 512, ETHER_HDR, "TCP"); 
 
	ipc->readq = RD(q); 
	ipc->readq->rp = &tcpflowr;
1992/0128    
	ipc->err = 0;
1991/0424    
 
	RD(q)->ptr = (void *)ipc; 
	WR(q)->next->ptr = (void *)ipc->ipinterface; 
	WR(q)->ptr = (void *)ipc; 
}
1991/1114    
void 
ipremotefill(Chan *c, char *buf, int len) 
{ 
	int connection; 
	Ipconv *cp; 
 
	connection = STREAMID(c->qid.path); 
	cp = &ipconv[c->dev][connection]; 
	sprint(buf, "%d.%d.%d.%d %d\n", fmtaddr(cp->dst), cp->pdst); 
}
1991/1124    
1991/1114    
void 
iplocalfill(Chan *c, char *buf, int len) 
{ 
	int connection; 
	Ipconv *cp; 
 
	connection = STREAMID(c->qid.path); 
	cp = &ipconv[c->dev][connection];
1992/0213    
	sprint(buf, "%d.%d.%d.%d %d\n", fmtaddr(Myip[Myself]), cp->psrc);
1991/1114    
}
1991/1124    
1991/1114    
void 
ipstatusfill(Chan *c, char *buf, int len) 
{ 
	int connection; 
	Ipconv *cp; 
 
	connection = STREAMID(c->qid.path); 
	cp = &ipconv[c->dev][connection]; 
	if(cp->stproto == &tcpinfo) 
		sprint(buf, "tcp/%d %d %s %s\n", connection, cp->ref, 
			tcpstate[cp->tcpctl.state], 
			cp->tcpctl.flags & CLONE ? "listen" : "connect"); 
	else if(cp->stproto == &ilinfo)
1992/0307    
		sprint(buf, "il/%d %d %s rtt %d ms %d csum\n", connection, cp->ref, 
			ilstate[cp->ilctl.state], cp->ilctl.rtt, 
			cp->ipinterface ? cp->ipinterface->chkerrs : 0);
1991/1114    
	else 
		sprint(buf, "%s/%d %d\n", cp->stproto->name, connection, cp->ref); 
}
1991/0424    
int
1991/1023    
iphavecon(Ipconv *s)
1991/0424    
{ 
	return s->curlog; 
}
1991/1114    
int 
iplisten(Chan *c)
1991/0424    
{ 
	Ipconv *etab, *new;
1991/1114    
	Ipconv *s, *base; 
	int connection; 
	Ipconv *cp;
1991/0424    
1991/1114    
	connection = STREAMID(c->qid.path); 
	s = &ipconv[c->dev][connection]; 
	base = ipconv[c->dev];
1992/0313    
	if(s->stproto == &tcpinfo) 
	if(s->tcpctl.state != Listen)
1992/0112    
		error(Enolisten);
1991/1114    
1992/0313    
	if(s->stproto == &ilinfo) 
	if(s->ilctl.state != Illistening) 
		error(Enolisten);
1991/0424    
	qlock(&s->listenq);
1991/1025    
	if(waserror()) { 
		qunlock(&s->listenq); 
		nexterror(); 
	}
1991/1030    
                 
1991/0424    
	for(;;) {
1992/0414    
		qlock(&s->listenq);	/* single thread for the sleep */ 
		if(waserror()) { 
			qunlock(&s->listenq); 
			nexterror(); 
		}
1991/1023    
		sleep(&s->listenr, iphavecon, s);
1991/1025    
		poperror();
1991/1023    
		new = base; 
 		for(etab = &base[conf.ip]; new < etab; new++) { 
			if(new->newcon) {
1992/0414    
			if(new->newcon == s) {
1992/0306    
				qlock(s);
1991/0424    
				s->curlog--;
1992/0306    
				qunlock(s);
1991/1023    
				new->newcon = 0;
1991/0424    
				qunlock(&s->listenq);
1991/1114    
				return new - base;
1991/0424    
			} 
		}
1992/0414    
		qunlock(&s->listenq);
1992/0307    
		print("iplisten: no newcon\n");
1991/0424    
	} 
} 
 
void 
tcpstclose(Queue *q) 
{ 
	Ipconv *s; 
	Tcpctl *tcb; 
 
	s = (Ipconv *)(q->ptr); 
	tcb = &s->tcpctl; 
 
	/* Not interested in data anymore */
1992/0223    
	qlock(s);
1991/0424    
	s->readq = 0;
1992/0223    
	qunlock(s);
1991/0424    
 
	switch(tcb->state){
1991/12171    
	case Closed: 
	case Listen: 
	case Syn_sent:
1991/0424    
		close_self(s, 0); 
		break;
1992/0313    
1991/12171    
	case Syn_received: 
	case Established:
1991/0424    
		tcb->sndcnt++; 
		tcb->snd.nxt++;
1991/12171    
		setstate(s, Finwait1);
1991/0424    
		goto output;
1992/0313    
1991/12171    
	case Close_wait:
1991/0424    
		tcb->sndcnt++; 
		tcb->snd.nxt++;
1991/12171    
		setstate(s, Last_ack);
1991/0424    
	output: 
		qlock(tcb);
1992/0322    
		if(waserror()) { 
			qunlock(tcb); 
			nexterror(); 
		}
1991/0424    
		tcp_output(s);
1992/0322    
		poperror();
1991/0424    
		qunlock(tcb); 
		break; 
	} 
}
1992/0101    
static	short	endian	= 1; 
static	char*	aendian	= (char*)&endian; 
#define	LITTLE	*aendian
1991/0424    
ushort
1992/0101    
ptcl_bsum(uchar *addr, int len) 
{ 
	ulong losum, hisum, mdsum, x; 
	ulong t1, t2; 
 
	losum = 0; 
	hisum = 0; 
	mdsum = 0; 
 
	x = 0; 
	if((ulong)addr & 1) { 
		if(len) { 
			hisum += addr[0]; 
			len--; 
			addr++; 
		} 
		x = 1; 
	} 
	while(len >= 16) { 
		t1 = *(ushort*)(addr+0); 
		t2 = *(ushort*)(addr+2);	mdsum += t1; 
		t1 = *(ushort*)(addr+4);	mdsum += t2; 
		t2 = *(ushort*)(addr+6);	mdsum += t1; 
		t1 = *(ushort*)(addr+8);	mdsum += t2; 
		t2 = *(ushort*)(addr+10);	mdsum += t1; 
		t1 = *(ushort*)(addr+12);	mdsum += t2; 
		t2 = *(ushort*)(addr+14);	mdsum += t1; 
		mdsum += t2; 
		len -= 16; 
		addr += 16; 
	} 
	while(len >= 2) { 
		mdsum += *(ushort*)addr; 
		len -= 2; 
		addr += 2; 
	} 
	if(x) { 
		if(len) 
			losum += addr[0]; 
		if(LITTLE) 
			losum += mdsum; 
		else 
			hisum += mdsum; 
	} else { 
		if(len) 
			hisum += addr[0]; 
		if(LITTLE) 
			hisum += mdsum; 
		else 
			losum += mdsum; 
	} 
 
	losum += hisum >> 8; 
	losum += (hisum & 0xff) << 8; 
	while(hisum = losum>>16) 
		losum = hisum + (losum & 0xffff); 
 
	return losum & 0xffff; 
} 
 
ushort
1991/0424    
ptcl_csum(Block *bp, int offset, int len) 
{ 
	uchar *addr;
1992/0101    
	ulong losum, hisum;
1991/0424    
	ushort csum; 
	int odd, blen, x; 
 
	/* Correct to front of data area */ 
	while(bp && offset && offset >= BLEN(bp)) { 
		offset -= BLEN(bp); 
		bp = bp->next; 
	} 
	if(bp == 0) 
		return 0; 
 
	addr = bp->rptr + offset; 
	blen = BLEN(bp) - offset;
1992/0101    
 
	if(bp->next == 0) 
		return ~ptcl_bsum(addr, MIN(len, blen)) & 0xffff; 
 
	losum = 0; 
	hisum = 0;
1991/0424    
	odd = 0; 
	while(len) {
1992/0101    
		x = MIN(len, blen); 
		csum = ptcl_bsum(addr, x); 
		if(odd) 
			hisum += csum; 
		else 
			losum += csum; 
		odd = (odd+x) & 1; 
		len -= x;
1991/0424    
		bp = bp->next; 
		if(bp == 0) 
			break; 
		blen = BLEN(bp); 
		addr = bp->rptr; 
	} 
 
	losum += hisum>>8; 
	losum += (hisum&0xff)<<8; 
	while((csum = losum>>16) != 0) 
		losum = csum + (losum & 0xffff); 
 
	return ~losum & 0xffff; 
} 
 
Block * 
btrim(Block *bp, int offset, int len) 
{ 
	Block *nb, *startb; 
	ulong l; 
 
	if(blen(bp) < offset+len) { 
		freeb(bp); 
		return 0; 
	} 
 
	while((l = BLEN(bp)) < offset) { 
		offset -= l; 
		nb = bp->next; 
		bp->next = 0; 
		freeb(bp); 
		bp = nb; 
	} 
 
	startb = bp; 
	bp->rptr += offset; 
 
	while((l = BLEN(bp)) < len) { 
		len -= l; 
		bp = bp->next; 
	} 
 
	bp->wptr -= (BLEN(bp) - len); 
	bp->flags |= S_DELIM; 
 
	if(bp->next) { 
		freeb(bp->next); 
		bp->next = 0; 
	} 
 
	return(startb); 
} 
 
Ipconv * 
portused(Ipconv *ic, Port port) 
{ 
	Ipconv *ifc, *etab;
1992/0406    
	if(port == 0) 
		return 0;
1991/0424    
	etab = &ic[conf.ip];
1991/12171    
	for(ifc = ic; ifc < etab; ifc++)
1991/0424    
		if(ifc->psrc == port)  
			return ifc; 
 
	return 0; 
}
1992/0128    
static Port lastport[2] = { PORTALLOC-1, PRIVPORTALLOC-1 };
1991/0424    
Port
1992/0128    
nextport(Ipconv *ic, int priv)
1991/0424    
{
1992/0128    
	Port base; 
	Port max; 
	Port *p;
1991/0424    
	Port i;
1992/0128    
	if(priv){ 
		base = PRIVPORTALLOC; 
		max = PORTALLOC; 
		p = &lastport[1]; 
	} else { 
		base = PORTALLOC; 
		max = PORTMAX; 
		p = &lastport[0]; 
	} 
	 
	for(i = *p + 1; i < max; i++)
1991/0424    
		if(!portused(ic, i))
1992/0128    
			return(*p = i); 
	for(i = base ; i <= *p; i++) 
		if(!portused(ic, i)) 
			return(*p = i);
1991/12171    
1991/0424    
	return(0); 
} 
 
/* NEEDS HASHING ! */ 
 
Ipconv * 
ip_conn(Ipconv *ic, Port dst, Port src, Ipaddr dest, char proto) 
{ 
	Ipconv *s, *etab; 
 
	/* Look for a conversation structure for this port */ 
	etab = &ic[conf.ip]; 
	for(s = ic; s < etab; s++) {
1991/12171    
		if(s->psrc == dst) 
		if(s->pdst == src) 
		if(s->dst == dest || dest == 0)
1991/0424    
			return s; 
	} 
 
	return 0; 
}


source code copyright © 1990-2005 Lucent Technologies; see license
Plan 9 distribution
comments to russ cox (rsc@swtch.com)