d/freebsd-skq
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
3c4dd3568f
freebsd-skq/sys/netiso/tp_input.c
David Greenman 3c4dd3568f Added $Id$
1994-08-02 07:55:43 +00:00

1626 lines
46 KiB
C
Raw Blame History

/*-
* Copyright (c) 1991, 1993
* The Regents of the University of California. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by the University of
* California, Berkeley and its contributors.
* 4. Neither the name of the University nor the names of its contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* @(#)tp_input.c 8.1 (Berkeley) 6/10/93
* $Id$
*/
/***********************************************************
Copyright IBM Corporation 1987
All Rights Reserved
Permission to use, copy, modify, and distribute this software and its
documentation for any purpose and without fee is hereby granted,
provided that the above copyright notice appear in all copies and that
both that copyright notice and this permission notice appear in
supporting documentation, and that the name of IBM not be
used in advertising or publicity pertaining to distribution of the
software without specific, written prior permission.
IBM DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, INCLUDING
ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO EVENT SHALL
IBM BE LIABLE FOR ANY SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR
ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS,
WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION,
ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS
SOFTWARE.
******************************************************************/
/*
* ARGO Project, Computer Sciences Dept., University of Wisconsin - Madison
*/
/*
* ARGO TP
*
* $Header: /home/ncvs/src/sys/netiso/tp_input.c,v 1.1.1.1 1994/05/24 10:06:54 rgrimes Exp $
* $Source: /home/ncvs/src/sys/netiso/tp_input.c,v $
*
* tp_input() gets an mbuf chain from ip. Actually, not directly
* from ip, because ip calls a net-level routine that strips off
* the net header and then calls tp_input(), passing the proper type
* of addresses for the address family in use (how it figures out
* which AF is not yet determined.)
*
* Decomposing the tpdu is some of the most laughable code. The variable-length
* parameters and the problem of non-aligned memory references
* necessitates such abominations as the macros WHILE_OPTIONS (q.v. below)
* to loop through the header and decompose it.
*
* The routine tp_newsocket() is called when a CR comes in for a listening
* socket. tp_input calls sonewconn() and tp_newsocket() to set up the
* "child" socket. Most tpcb values are copied from the parent tpcb into
* the child.
*
* Also in here is tp_headersize() (grot) which tells the expected size
* of a tp header, to be used by other layers. It's in here because it
* uses the static structure tpdu_info.
*/
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/mbuf.h>
#include <sys/socket.h>
#include <sys/socketvar.h>
#include <sys/domain.h>
#include <sys/protosw.h>
#include <sys/errno.h>
#include <sys/time.h>
#include <sys/kernel.h>
#include <netiso/iso.h>
#include <netiso/iso_errno.h>
#include <netiso/iso_pcb.h>
#include <netiso/tp_param.h>
#include <netiso/tp_timer.h>
#include <netiso/tp_stat.h>
#include <netiso/tp_pcb.h>
#include <netiso/argo_debug.h>
#include <netiso/tp_trace.h>
#include <netiso/tp_tpdu.h>
#include <net/if.h>
#ifdef TRUE
#undef FALSE
#undef TRUE
#endif
#include <netccitt/x25.h>
#include <netccitt/pk.h>
#include <netccitt/pk_var.h>
int iso_check_csum(), tp_driver(), tp_headersize(), tp_error_emit();
/*
#ifdef lint
#undef ATTR
#define ATTR(X)ev_number
#endif lint
*/
struct mbuf *
tp_inputprep(m)
register struct mbuf *m;
{
int hdrlen;
IFDEBUG(D_TPINPUT)
printf("tp_inputprep: m 0x%x\n", m) ;
ENDDEBUG
while( m->m_len < 1 ) {
/* The "m_free" logic
* if( (m = m_free(m)) == MNULL )
* return (struct mbuf *)0;
* would cause a system crash if ever executed.
* This logic will be executed if the first mbuf
* in the chain only contains a CLNP header. The m_free routine
* will release the mbuf containing the CLNP header from the
* chain and the new head of the chain will not have the
* M_PKTHDR bit set. This routine, tp_inputprep, will
* eventually call the "sbappendaddr" routine. "sbappendaddr"
* calls "panic" if M_PKTHDR is not set. m_pullup is a cheap
* way of keeping the head of the chain from being freed.
*/
if((m = m_pullup(m, 1)) == MNULL)
return (MNULL);
}
if(((int)m->m_data) & 0x3) {
/* If we are not 4-byte aligned, we have to be
* above the beginning of the mbuf, and it is ok just
* to slide it back.
*/
caddr_t ocp = m->m_data;
m->m_data = (caddr_t)(((int)m->m_data) & ~0x3);
bcopy(ocp, m->m_data, (unsigned)m->m_len);
}
CHANGE_MTYPE(m, TPMT_DATA);
/* we KNOW that there is at least 1 byte in this mbuf
and that it is hdr->tpdu_li XXXXXXX! */
hdrlen = 1 + *mtod( m, u_char *);
/*
* now pull up the whole tp header
*/
if ( m->m_len < hdrlen) {
if ((m = m_pullup(m, hdrlen)) == MNULL ) {
IncStat(ts_recv_drop);
return (struct mbuf *)0;
}
}
IFDEBUG(D_INPUT)
printf(
" at end: m 0x%x hdr->tpdu_li 0x%x m_len 0x%x\n",m,
hdrlen, m->m_len);
ENDDEBUG
return m;
}
/* begin groan
* -- this array and the following macros allow you to step through the
* parameters of the variable part of a header
* note that if for any reason the values of the **_TPDU macros (in tp_events.h)
* should change, this array has to be rearranged
*/
#define TP_LEN_CLASS_0_INDEX 2
#define TP_MAX_DATA_INDEX 3
static u_char tpdu_info[][4] =
{
/* length max data len */
/* reg fmt xtd fmt class 0 */
/* UNUSED 0x0 */ 0x0 , 0x0, 0x0, 0x0,
/* XPD_TPDU_type 0x1 */ 0x5, 0x8, 0x0, TP_MAX_XPD_DATA,
/* XAK_TPDU_type 0x2 */ 0x5 , 0x8, 0x0, 0x0,
/* GR_TPDU_type 0x3 */ 0x0 , 0x0, 0x0, 0x0,
/* UNUSED 0x4 */ 0x0 , 0x0, 0x0, 0x0,
/* UNUSED 0x5 */ 0x0 , 0x0, 0x0, 0x0,
/* AK_TPDU_type 0x6 */ 0x5, 0xa, 0x0, 0x0,
/* ER_TPDU_type 0x7 */ 0x5, 0x5, 0x0, 0x0,
/* DR_TPDU_type 0x8 */ 0x7, 0x7, 0x7, TP_MAX_DR_DATA,
/* UNUSED 0x9 */ 0x0 , 0x0, 0x0, 0x0,
/* UNUSED 0xa */ 0x0 , 0x0, 0x0, 0x0,
/* UNUSED 0xb */ 0x0 , 0x0, 0x0, 0x0,
/* DC_TPDU_type 0xc */ 0x6, 0x6, 0x0, 0x0,
/* CC_TPDU_type 0xd */ 0x7, 0x7, 0x7, TP_MAX_CC_DATA,
/* CR_TPDU_type 0xe */ 0x7, 0x7, 0x7, TP_MAX_CR_DATA,
/* DT_TPDU_type 0xf */ 0x5, 0x8, 0x3, 0x0,
};
#define CHECK(Phrase, Erval, Stat, Whattodo, Loc)\
if (Phrase) {error = (Erval); errlen = (int)(Loc); IncStat(Stat);\
goto Whattodo; }
/*
* WHENEVER YOU USE THE FOLLOWING MACRO,
* BE SURE THE TPDUTYPE IS A LEGIT VALUE FIRST!
*/
#define WHILE_OPTIONS(P, hdr, format)\
{ register caddr_t P = tpdu_info[(hdr)->tpdu_type][(format)] + (caddr_t)hdr;\
caddr_t PLIM = 1 + hdr->tpdu_li + (caddr_t)hdr;\
for (;; P += 2 + ((struct tp_vbp *)P)->tpv_len) {\
CHECK((P > PLIM), E_TP_LENGTH_INVAL, ts_inv_length,\
respond, P - (caddr_t)hdr);\
if (P == PLIM) break;
#define END_WHILE_OPTIONS(P) } }
/* end groan */
/*
* NAME: tp_newsocket()
*
* CALLED FROM:
* tp_input() on incoming CR, when a socket w/ the called suffix
* is awaiting a connection request
*
* FUNCTION and ARGUMENTS:
* Create a new socket structure, attach to it a new transport pcb,
* using a copy of the net level pcb for the parent socket.
* (so) is the parent socket.
* (fname) is the foreign address (all that's used is the nsap portion)
*
* RETURN VALUE:
* a new socket structure, being this end of the newly formed connection.
*
* SIDE EFFECTS:
* Sets a few things in the tpcb and net level pcb
*
* NOTES:
*/
static struct socket *
tp_newsocket(so, fname, cons_channel, class_to_use, netservice)
struct socket *so;
struct sockaddr *fname;
caddr_t cons_channel;
u_char class_to_use;
u_int netservice;
{
register struct tp_pcb *tpcb = sototpcb(so); /* old tpcb, needed below */
register struct tp_pcb *newtpcb;
/*
* sonewconn() gets a new socket structure,
* a new lower layer pcb and a new tpcb,
* but the pcbs are unnamed (not bound)
*/
IFTRACE(D_NEWSOCK)
tptraceTPCB(TPPTmisc, "newsock: listg_so, _tpcb, so_head",
so, tpcb, so->so_head, 0);
ENDTRACE
if ((so = sonewconn(so, SS_ISCONFIRMING)) == (struct socket *)0)
return so;
IFTRACE(D_NEWSOCK)
tptraceTPCB(TPPTmisc, "newsock: after newconn so, so_head",
so, so->so_head, 0, 0);
ENDTRACE
IFDEBUG(D_NEWSOCK)
printf("tp_newsocket(channel 0x%x) after sonewconn so 0x%x \n",
cons_channel, so);
dump_addr(fname);
{
struct socket *t, *head ;
head = so->so_head;
t = so;
printf("so 0x%x so_head 0x%x so_q0 0x%x, q0len %d\n",
t, t->so_head, t->so_q0, t->so_q0len);
while( (t=t->so_q0) && t!= so && t!= head)
printf("so 0x%x so_head 0x%x so_q0 0x%x, q0len %d\n",
t, t->so_head, t->so_q0, t->so_q0len);
}
ENDDEBUG
/*
* before we clobber the old tpcb ptr, get these items from the parent pcb
*/
newtpcb = sototpcb(so);
newtpcb->_tp_param = tpcb->_tp_param;
newtpcb->tp_flags = tpcb->tp_flags;
newtpcb->tp_lcredit = tpcb->tp_lcredit;
newtpcb->tp_l_tpdusize = tpcb->tp_l_tpdusize;
newtpcb->tp_lsuffixlen = tpcb->tp_lsuffixlen;
bcopy( tpcb->tp_lsuffix, newtpcb->tp_lsuffix, newtpcb->tp_lsuffixlen);
if( /* old */ tpcb->tp_ucddata) {
/*
* These data are the connect- , confirm- or disconnect- data.
*/
struct mbuf *conndata;
conndata = m_copy(tpcb->tp_ucddata, 0, (int)M_COPYALL);
IFDEBUG(D_CONN)
dump_mbuf(conndata, "conndata after mcopy");
ENDDEBUG
newtpcb->tp_ucddata = conndata;
}
tpcb = newtpcb;
tpcb->tp_state = TP_LISTENING;
tpcb->tp_class = class_to_use;
tpcb->tp_netservice = netservice;
ASSERT( fname != 0 ) ; /* just checking */
if ( fname ) {
/*
* tp_route_to takes its address argument in the form of an mbuf.
*/
struct mbuf *m;
int err;
MGET(m, M_DONTWAIT, MT_SONAME); /* mbuf type used is confusing */
if (m) {
/*
* this seems a bit grotesque, but tp_route_to expects
* an mbuf * instead of simply a sockaddr; it calls the ll
* pcb_connect, which expects the name/addr in an mbuf as well.
* sigh.
*/
bcopy((caddr_t)fname, mtod(m, caddr_t), fname->sa_len);
m->m_len = fname->sa_len;
/* grot : have to say the kernel can override params in
* the passive open case
*/
tpcb->tp_dont_change_params = 0;
err = tp_route_to( m, tpcb, cons_channel);
m_free(m);
if (!err)
goto ok;
}
IFDEBUG(D_CONN)
printf("tp_route_to FAILED! detaching tpcb 0x%x, so 0x%x\n",
tpcb, so);
ENDDEBUG
(void) tp_detach(tpcb);
return 0;
}
ok:
IFDEBUG(D_TPINPUT)
printf("tp_newsocket returning so 0x%x, sototpcb(so) 0x%x\n",
so, sototpcb(so));
ENDDEBUG
return so;
}
#ifndef TPCONS
tpcons_output()
{
return(0);
}
#endif /* !CONS */
/*
* NAME: tp_input()
*
* CALLED FROM:
* net layer input routine
*
* FUNCTION and ARGUMENTS:
* Process an incoming TPDU (m), finding the associated tpcb if there
* is one. Create the appropriate type of event and call the driver.
* (faddr) and (laddr) are the foreign and local addresses.
*
* When tp_input() is called we KNOW that the ENTIRE TP HEADER
* has been m_pullup-ed.
*
* RETURN VALUE: Nada
*
* SIDE EFFECTS:
* When using COSNS it may affect the state of the net-level pcb
*
* NOTE:
* The initial value of acktime is 2 so that we will never
* have a 0 value for tp_peer_acktime. It gets used in the
* computation of the retransmission timer value, and so it
* mustn't be zero.
* 2 seems like a reasonable minimum.
*/
ProtoHook
tp_input(m, faddr, laddr, cons_channel, dgout_routine, ce_bit)
register struct mbuf *m;
struct sockaddr *faddr, *laddr; /* NSAP addresses */
caddr_t cons_channel;
int (*dgout_routine)();
int ce_bit;
{
register struct tp_pcb *tpcb;
register struct tpdu *hdr;
struct socket *so;
struct tp_event e;
int error;
unsigned dutype;
u_short dref, sref, acktime, subseq;
u_char preferred_class, class_to_use, pdusize;
u_char opt, dusize, addlopt, version;
#ifdef TP_PERF_MEAS
u_char perf_meas;
#endif /* TP_PERF_MEAS */
u_char fsufxlen, lsufxlen;
caddr_t fsufxloc, lsufxloc;
int tpdu_len;
u_int takes_data;
u_int fcc_present;
int errlen;
struct tp_conn_param tpp;
int tpcons_output();
again:
hdr = mtod(m, struct tpdu *);
tpcb = 0;
error = errlen = tpdu_len = 0;
takes_data = fcc_present = FALSE;
acktime = 2; sref = subseq = 0;
fsufxloc = lsufxloc = NULL;
fsufxlen = lsufxlen =
preferred_class = class_to_use = pdusize = addlopt = 0;
dusize = TP_DFL_TPDUSIZE;
#ifdef TP_PERF_MEAS
GET_CUR_TIME( &e.e_time ); perf_meas = 0;
#endif /* TP_PERF_MEAS */
IFDEBUG(D_TPINPUT)
printf("tp_input(0x%x, ... 0x%x)\n", m, cons_channel);
ENDDEBUG
/*
* get the actual tpdu length - necessary for monitoring
* and for checksumming
*
* Also, maybe measure the mbuf chain lengths and sizes.
*/
{ register struct mbuf *n=m;
# ifdef ARGO_DEBUG
int chain_length = 0;
# endif ARGO_DEBUG
for(;;) {
tpdu_len += n->m_len;
IFDEBUG(D_MBUF_MEAS)
if( n->m_flags & M_EXT) {
IncStat(ts_mb_cluster);
} else {
IncStat(ts_mb_small);
}
chain_length ++;
ENDDEBUG
if (n->m_next == MNULL ) {
break;
}
n = n->m_next;
}
IFDEBUG(D_MBUF_MEAS)
if(chain_length > 16)
chain_length = 0; /* zero used for anything > 16 */
tp_stat.ts_mb_len_distr[chain_length] ++;
ENDDEBUG
}
IFTRACE(D_TPINPUT)
tptraceTPCB(TPPTtpduin, hdr->tpdu_type, hdr, hdr->tpdu_li+1, tpdu_len,
0);
ENDTRACE
dref = ntohs((short)hdr->tpdu_dref);
sref = ntohs((short)hdr->tpdu_sref);
dutype = (int)hdr->tpdu_type;
IFDEBUG(D_TPINPUT)
printf("input: dutype 0x%x cons_channel 0x%x dref 0x%x\n", dutype,
cons_channel, dref);
printf("input: dref 0x%x sref 0x%x\n", dref, sref);
ENDDEBUG
IFTRACE(D_TPINPUT)
tptrace(TPPTmisc, "channel dutype dref ",
cons_channel, dutype, dref, 0);
ENDTRACE
#ifdef ARGO_DEBUG
if( (dutype < TP_MIN_TPDUTYPE) || (dutype > TP_MAX_TPDUTYPE)) {
printf("BAD dutype! 0x%x, channel 0x%x dref 0x%x\n",
dutype, cons_channel, dref);
dump_buf (m, sizeof( struct mbuf ));
IncStat(ts_inv_dutype);
goto discard;
}
#endif /* ARGO_DEBUG */
CHECK( (dutype < TP_MIN_TPDUTYPE || dutype > TP_MAX_TPDUTYPE),
E_TP_INV_TPDU, ts_inv_dutype, respond,
2 );
/* unfortunately we can't take the address of the tpdu_type field,
* since it's a bit field - so we just use the constant offset 2
*/
/* Now this isn't very neat but since you locate a pcb one way
* at the beginning of connection establishment, and by
* the dref for each tpdu after that, we have to treat CRs differently
*/
if ( dutype == CR_TPDU_type ) {
u_char alt_classes = 0;
preferred_class = 1 << hdr->tpdu_CRclass;
opt = hdr->tpdu_CRoptions;
WHILE_OPTIONS(P, hdr, 1 ) /* { */
switch( vbptr(P)->tpv_code ) {
case TPP_tpdu_size:
vb_getval(P, u_char, dusize);
IFDEBUG(D_TPINPUT)
printf("CR dusize 0x%x\n", dusize);
ENDDEBUG
/* COS tests: NBS IA (Dec. 1987) Sec. 4.5.2.1 */
if (dusize < TP_MIN_TPDUSIZE || dusize > TP_MAX_TPDUSIZE)
dusize = TP_DFL_TPDUSIZE;
break;
case TPP_ptpdu_size:
switch (vbptr(P)->tpv_len) {
case 1: pdusize = vbval(P, u_char); break;
case 2: pdusize = ntohs(vbval(P, u_short)); break;
default: ;
IFDEBUG(D_TPINPUT)
printf("malformed prefered TPDU option\n");
ENDDEBUG
}
break;
case TPP_addl_opt:
vb_getval(P, u_char, addlopt);
break;
case TPP_calling_sufx:
/* could use vb_getval, but we want to save the loc & len
* for later use
*/
fsufxloc = (caddr_t) &vbptr(P)->tpv_val;
fsufxlen = vbptr(P)->tpv_len;
IFDEBUG(D_TPINPUT)
printf("CR fsufx:");
{ register int j;
for(j=0; j<fsufxlen; j++ ) {
printf(" 0x%x. ", *((caddr_t)(fsufxloc+j)) );
}
printf("\n");
}
ENDDEBUG
break;
case TPP_called_sufx:
/* could use vb_getval, but we want to save the loc & len
* for later use
*/
lsufxloc = (caddr_t) &vbptr(P)->tpv_val;
lsufxlen = vbptr(P)->tpv_len;
IFDEBUG(D_TPINPUT)
printf("CR lsufx:");
{ register int j;
for(j=0; j<lsufxlen; j++ ) {
printf(" 0x%x. ", *((u_char *)(lsufxloc+j)) );
}
printf("\n");
}
ENDDEBUG
break;
#ifdef TP_PERF_MEAS
case TPP_perf_meas:
vb_getval(P, u_char, perf_meas);
break;
#endif /* TP_PERF_MEAS */
case TPP_vers:
/* not in class 0; 1 octet; in CR_TPDU only */
/* COS tests says if version wrong, use default version!?XXX */
CHECK( (vbval(P, u_char) != TP_VERSION ),
E_TP_INV_PVAL, ts_inv_pval, setversion,
(1 + (caddr_t)&vbptr(P)->tpv_val - (caddr_t)hdr) );
setversion:
version = vbval(P, u_char);
break;
case TPP_acktime:
vb_getval(P, u_short, acktime);
acktime = ntohs(acktime);
acktime = acktime/500; /* convert to slowtimo ticks */
if((short)acktime <=0 )
acktime = 2; /* don't allow a bad peer to screw us up */
IFDEBUG(D_TPINPUT)
printf("CR acktime 0x%x\n", acktime);
ENDDEBUG
break;
case TPP_alt_class:
{
u_char *aclass = 0;
register int i;
static u_char bad_alt_classes[5] =
{ ~0, ~3, ~5, ~0xf, ~0x1f};
aclass =
(u_char *) &(((struct tp_vbp *)P)->tpv_val);
for (i = ((struct tp_vbp *)P)->tpv_len; i>0; i--) {
alt_classes |= (1<<((*aclass++)>>4));
}
CHECK( (bad_alt_classes[hdr->tpdu_CRclass] & alt_classes),
E_TP_INV_PVAL, ts_inv_aclass, respond,
((caddr_t)aclass) - (caddr_t)hdr);
IFDEBUG(D_TPINPUT)
printf("alt_classes 0x%x\n", alt_classes);
ENDDEBUG
}
break;
case TPP_security:
case TPP_residER:
case TPP_priority:
case TPP_transdelay:
case TPP_throughput:
case TPP_addl_info:
case TPP_subseq:
default:
IFDEBUG(D_TPINPUT)
printf("param ignored CR_TPDU code= 0x%x\n",
vbptr(P)->tpv_code);
ENDDEBUG
IncStat(ts_param_ignored);
break;
case TPP_checksum:
IFDEBUG(D_TPINPUT)
printf("CR before cksum\n");
ENDDEBUG
CHECK( iso_check_csum(m, tpdu_len),
E_TP_INV_PVAL, ts_bad_csum, discard, 0)
IFDEBUG(D_TPINPUT)
printf("CR before cksum\n");
ENDDEBUG
break;
}
/* } */ END_WHILE_OPTIONS(P)
if (lsufxlen == 0) {
/* can't look for a tpcb w/o any called sufx */
error = E_TP_LENGTH_INVAL;
IncStat(ts_inv_sufx);
goto respond;
} else {
register struct tp_pcb *t;
/*
* The intention here is to trap all CR requests
* to a given nsap, for constructing transport
* service bridges at user level; so these
* intercepts should precede the normal listens.
* Phrasing the logic in this way also allows for
* mop-up listeners, which we don't currently implement.
* We also wish to have a single socket be able to
* listen over any network service provider,
* (cons or clns or ip).
*/
for (t = tp_listeners; t ; t = t->tp_nextlisten)
if ((t->tp_lsuffixlen == 0 ||
(lsufxlen == t->tp_lsuffixlen &&
bcmp(lsufxloc, t->tp_lsuffix, lsufxlen) == 0)) &&
((t->tp_flags & TPF_GENERAL_ADDR) ||
(laddr->sa_family == t->tp_domain &&
(*t->tp_nlproto->nlp_cmpnetaddr)
(t->tp_npcb, laddr, TP_LOCAL))))
break;
CHECK(t == 0, E_TP_NO_SESSION, ts_inv_sufx, respond,
(1 + 2 + (caddr_t)&hdr->_tpduf - (caddr_t)hdr))
/* _tpduf is the fixed part; add 2 to get the dref bits of
* the fixed part (can't take the address of a bit field)
*/
IFDEBUG(D_TPINPUT)
printf("checking if dup CR\n");
ENDDEBUG
tpcb = t;
for (t = tpcb->tp_next; t != tpcb; t = t->tp_next) {
if (sref != t->tp_fref)
continue;
if ((*tpcb->tp_nlproto->nlp_cmpnetaddr)(
t->tp_npcb, faddr, TP_FOREIGN)) {
IFDEBUG(D_TPINPUT)
printf("duplicate CR discarded\n");
ENDDEBUG
goto discard;
}
}
IFTRACE(D_TPINPUT)
tptrace(TPPTmisc, "tp_input: tpcb *lsufxloc tpstate",
tpcb, *lsufxloc, tpcb->tp_state, 0);
ENDTRACE
}
/*
* WE HAVE A TPCB
* already know that the classes in the CR match at least
* one class implemented, but we don't know yet if they
* include any classes permitted by this server.
*/
IFDEBUG(D_TPINPUT)
printf("HAVE A TPCB 1: 0x%x\n", tpcb);
ENDDEBUG
IFDEBUG(D_CONN)
printf(
"CR: bef CHKS: flags 0x%x class_to_use 0x%x alt 0x%x opt 0x%x tp_class 0x%x\n",
tpcb->tp_flags, class_to_use, alt_classes, opt, tpcb->tp_class);
ENDDEBUG
/* tpcb->tp_class doesn't include any classes not implemented */
class_to_use = (preferred_class & tpcb->tp_class);
if( (class_to_use = preferred_class & tpcb->tp_class) == 0 )
class_to_use = alt_classes & tpcb->tp_class;
class_to_use = 1 << tp_mask_to_num(class_to_use);
{
tpp = tpcb->_tp_param;
tpp.p_class = class_to_use;
tpp.p_tpdusize = dusize;
tpp.p_ptpdusize = pdusize;
tpp.p_xtd_format = (opt & TPO_XTD_FMT) == TPO_XTD_FMT;
tpp.p_xpd_service = (addlopt & TPAO_USE_TXPD) == TPAO_USE_TXPD;
tpp.p_use_checksum = (tpp.p_class == TP_CLASS_0)?0:
(addlopt & TPAO_NO_CSUM) == 0;
tpp.p_version = version;
#ifdef notdef
tpp.p_use_efc = (opt & TPO_USE_EFC) == TPO_USE_EFC;
tpp.p_use_nxpd = (addlopt & TPAO_USE_NXPD) == TPAO_USE_NXPD;
tpp.p_use_rcc = (addlopt & TPAO_USE_RCC) == TPAO_USE_RCC;
#endif /* notdef */
CHECK(
tp_consistency(tpcb, 0 /* not force or strict */, &tpp) != 0,
E_TP_NEGOT_FAILED, ts_negotfailed, clear_parent_tcb,
(1 + 2 + (caddr_t)&hdr->_tpdufr.CRCC - (caddr_t)hdr)
/* ^ more or less the location of class */
)
}
IFTRACE(D_CONN)
tptrace(TPPTmisc,
"after 1 consist class_to_use class, out, tpconsout",
class_to_use,
tpcb->tp_class, dgout_routine, tpcons_output
);
ENDTRACE
CHECK(
((class_to_use == TP_CLASS_0)&&(dgout_routine != tpcons_output)),
E_TP_NEGOT_FAILED, ts_negotfailed, clear_parent_tcb,
(1 + 2 + (caddr_t)&hdr->_tpdufr.CRCC - (caddr_t)hdr)
/* ^ more or less the location of class */
)
IFDEBUG(D_CONN)
printf("CR: after CRCCCHECKS: tpcb 0x%x, flags 0x%x\n",
tpcb, tpcb->tp_flags);
ENDDEBUG
takes_data = TRUE;
e.ATTR(CR_TPDU).e_cdt = hdr->tpdu_CRcdt;
e.ev_number = CR_TPDU;
so = tpcb->tp_sock;
if (so->so_options & SO_ACCEPTCONN) {
struct tp_pcb *parent_tpcb = tpcb;
/*
* Create a socket, tpcb, ll pcb, etc.
* for this newborn connection, and fill in all the values.
*/
IFDEBUG(D_CONN)
printf("abt to call tp_newsocket(0x%x, 0x%x, 0x%x, 0x%x)\n",
so, laddr, faddr, cons_channel);
ENDDEBUG
if( (so =
tp_newsocket(so, faddr, cons_channel,
class_to_use,
((tpcb->tp_netservice == IN_CLNS) ? IN_CLNS :
(dgout_routine == tpcons_output)?ISO_CONS:ISO_CLNS))
) == (struct socket *)0 ) {
/* note - even if netservice is IN_CLNS, as far as
* the tp entity is concerned, the only differences
* are CO vs CL
*/
IFDEBUG(D_CONN)
printf("tp_newsocket returns 0\n");
ENDDEBUG
goto discard;
clear_parent_tcb:
tpcb = 0;
goto respond;
}
tpcb = sototpcb(so);
insque(tpcb, parent_tpcb);
/*
* Stash the addresses in the net level pcb
* kind of like a pcbconnect() but don't need
* or want all those checks.
*/
(tpcb->tp_nlproto->nlp_putnetaddr)(tpcb->tp_npcb, faddr, TP_FOREIGN);
(tpcb->tp_nlproto->nlp_putnetaddr)(tpcb->tp_npcb, laddr, TP_LOCAL);
/* stash the f suffix in the new tpcb */
if (tpcb->tp_fsuffixlen = fsufxlen) {
bcopy(fsufxloc, tpcb->tp_fsuffix, fsufxlen);
(tpcb->tp_nlproto->nlp_putsufx)
(tpcb->tp_npcb, fsufxloc, fsufxlen, TP_FOREIGN);
}
/* stash the l suffix in the new tpcb */
tpcb->tp_lsuffixlen = lsufxlen;
bcopy(lsufxloc, tpcb->tp_lsuffix, lsufxlen);
(tpcb->tp_nlproto->nlp_putsufx)
(tpcb->tp_npcb, lsufxloc, lsufxlen, TP_LOCAL);
#ifdef TP_PERF_MEAS
if( tpcb->tp_perf_on = perf_meas ) { /* assignment */
/* ok, let's create an mbuf for stashing the
* statistics if one doesn't already exist
*/
(void) tp_setup_perf(tpcb);
}
#endif /* TP_PERF_MEAS */
tpcb->tp_fref = sref;
/* We've already checked for consistency with the options
* set in tpp, but we couldn't set them earlier because
* we didn't want to change options in the LISTENING tpcb.
* Now we set the options in the new socket's tpcb.
*/
(void) tp_consistency( tpcb, TP_FORCE, &tpp);
if(!tpcb->tp_use_checksum)
IncStat(ts_csum_off);
if(tpcb->tp_xpd_service)
IncStat(ts_use_txpd);
if(tpcb->tp_xtd_format)
IncStat(ts_xtd_fmt);
tpcb->tp_peer_acktime = acktime;
/*
* The following kludge is used to test retransmissions and
* timeout during connection establishment.
*/
IFDEBUG(D_ZDREF)
IncStat(ts_zdebug);
/*tpcb->tp_fref = 0;*/
ENDDEBUG
}
LOCAL_CREDIT(tpcb);
IncStat(ts_CR_rcvd);
if (!tpcb->tp_cebit_off) {
tpcb->tp_win_recv = tp_start_win << 8;
tpcb->tp_cong_sample.cs_size = 0;
CONG_INIT_SAMPLE(tpcb);
CONG_UPDATE_SAMPLE(tpcb, ce_bit);
}
} else if ( dutype == ER_TPDU_type ) {
/*
* ER TPDUs have to be recognized separately
* because they don't necessarily have a tpcb
* with them and we don't want err out looking for such
* a beast.
* We could put a bunch of little kludges in the
* next section of code so it would avoid references to tpcb
* if dutype == ER_TPDU_type but we don't want code for ERs to
* mess up code for data transfer.
*/
IncStat(ts_ER_rcvd);
e.ev_number = ER_TPDU;
e.ATTR(ER_TPDU).e_reason = (u_char)hdr->tpdu_ERreason;
CHECK (((int)dref <= 0 || dref >= tp_refinfo.tpr_size ||
(tpcb = tp_ref[dref].tpr_pcb ) == (struct tp_pcb *) 0 ||
tpcb->tp_refstate == REF_FREE ||
tpcb->tp_refstate == REF_FROZEN),
E_TP_MISM_REFS, ts_inv_dref, discard, 0)
} else {
/* tpdu type is CC, XPD, XAK, GR, AK, DR, DC, or DT */
/* In the next 4 checks,
* _tpduf is the fixed part; add 2 to get the dref bits of
* the fixed part (can't take the address of a bit field)
*/
#ifdef TPCONS
if (cons_channel && dutype == DT_TPDU_type) {
struct isopcb *isop = ((struct isopcb *)
((struct pklcd *)cons_channel)->lcd_upnext);
if (isop && isop->isop_refcnt == 1 && isop->isop_socket &&
(tpcb = sototpcb(isop->isop_socket)) &&
(tpcb->tp_class == TP_CLASS_0/* || == CLASS_1 */)) {
IFDEBUG(D_TPINPUT)
printf("tpinput_dt: class 0 short circuit\n");
ENDDEBUG
dref = tpcb->tp_lref;
sref = tpcb->tp_fref;
CHECK( (tpcb->tp_refstate == REF_FREE),
E_TP_MISM_REFS,ts_inv_dref, nonx_dref,
(1 + 2 + (caddr_t)&hdr->_tpduf - (caddr_t)hdr))
goto tp0_data;
}
}
#endif
{
CHECK( ((int)dref <= 0 || dref >= tp_refinfo.tpr_size) ,
E_TP_MISM_REFS,ts_inv_dref, nonx_dref,
(1 + 2 + (caddr_t)&hdr->_tpduf - (caddr_t)hdr))
CHECK( ((tpcb = tp_ref[dref].tpr_pcb ) == (struct tp_pcb *) 0 ),
E_TP_MISM_REFS,ts_inv_dref, nonx_dref,
(1 + 2 + (caddr_t)&hdr->_tpduf - (caddr_t)hdr))
CHECK( (tpcb->tp_refstate == REF_FREE),
E_TP_MISM_REFS,ts_inv_dref, nonx_dref,
(1 + 2 + (caddr_t)&hdr->_tpduf - (caddr_t)hdr))
}
IFDEBUG(D_TPINPUT)
printf("HAVE A TPCB 2: 0x%x\n", tpcb);
ENDDEBUG
/* causes a DR to be sent for CC; ER for all else */
CHECK( (tpcb->tp_refstate == REF_FROZEN),
(dutype == CC_TPDU_type?E_TP_NO_SESSION:E_TP_MISM_REFS),
ts_inv_dref, respond,
(1 + 2 + (caddr_t)&hdr->_tpduf - (caddr_t)hdr))
IFDEBUG(D_TPINPUT)
printf("state of dref %d ok, tpcb 0x%x\n", dref,tpcb);
ENDDEBUG
/*
* At this point the state of the dref could be
* FROZEN: tpr_pcb == NULL, has ( reference only) timers
* for example, DC may arrive after the close() has detached
* the tpcb (e.g., if user turned off SO_LISTEN option)
* OPENING : a tpcb exists but no timers yet
* OPEN : tpcb exists & timers are outstanding
*/
if (!tpcb->tp_cebit_off)
CONG_UPDATE_SAMPLE(tpcb, ce_bit);
dusize = tpcb->tp_tpdusize;
pdusize = tpcb->tp_ptpdusize;
dutype = hdr->tpdu_type << 8; /* for the switch below */
WHILE_OPTIONS(P, hdr, tpcb->tp_xtd_format) /* { */
#define caseof(x,y) case (((x)<<8)+(y))
switch( dutype | vbptr(P)->tpv_code ) {
caseof( CC_TPDU_type, TPP_addl_opt ):
/* not in class 0; 1 octet */
vb_getval(P, u_char, addlopt);
break;
caseof( CC_TPDU_type, TPP_tpdu_size ):
{
u_char odusize = dusize;
vb_getval(P, u_char, dusize);
CHECK( (dusize < TP_MIN_TPDUSIZE ||
dusize > TP_MAX_TPDUSIZE || dusize > odusize),
E_TP_INV_PVAL, ts_inv_pval, respond,
(1 + (caddr_t)&vbptr(P)->tpv_val - (caddr_t)hdr) )
IFDEBUG(D_TPINPUT)
printf("CC dusize 0x%x\n", dusize);
ENDDEBUG
}
break;
caseof( CC_TPDU_type, TPP_ptpdu_size ):
{
u_short opdusize = pdusize;
switch (vbptr(P)->tpv_len) {
case 1: pdusize = vbval(P, u_char); break;
case 2: pdusize = ntohs(vbval(P, u_short)); break;
default: ;
IFDEBUG(D_TPINPUT)
printf("malformed prefered TPDU option\n");
ENDDEBUG
}
CHECK( (pdusize == 0 ||
(opdusize && (pdusize > opdusize))),
E_TP_INV_PVAL, ts_inv_pval, respond,
(1 + (caddr_t)&vbptr(P)->tpv_val - (caddr_t)hdr) )
}
break;
caseof( CC_TPDU_type, TPP_calling_sufx):
IFDEBUG(D_TPINPUT)
printf("CC calling (local) sufxlen 0x%x\n", lsufxlen);
ENDDEBUG
lsufxloc = (caddr_t) &vbptr(P)->tpv_val;
lsufxlen = vbptr(P)->tpv_len;
break;
caseof( CC_TPDU_type, TPP_acktime ):
/* class 4 only, 2 octets */
vb_getval(P, u_short, acktime);
acktime = ntohs(acktime);
acktime = acktime/500; /* convert to slowtimo ticks */
if( (short)acktime <=0 )
acktime = 2;
break;
caseof( CC_TPDU_type, TPP_called_sufx):
fsufxloc = (caddr_t) &vbptr(P)->tpv_val;
fsufxlen = vbptr(P)->tpv_len;
IFDEBUG(D_TPINPUT)
printf("CC called (foreign) sufx len %d\n", fsufxlen);
ENDDEBUG
break;
caseof( CC_TPDU_type, TPP_checksum):
caseof( DR_TPDU_type, TPP_checksum):
caseof( DT_TPDU_type, TPP_checksum):
caseof( XPD_TPDU_type, TPP_checksum):
if( tpcb->tp_use_checksum ) {
CHECK( iso_check_csum(m, tpdu_len),
E_TP_INV_PVAL, ts_bad_csum, discard, 0)
}
break;
/* this is different from the above because in the context
* of concat/ sep tpdu_len might not be the same as hdr len
*/
caseof( AK_TPDU_type, TPP_checksum):
caseof( XAK_TPDU_type, TPP_checksum):
caseof( DC_TPDU_type, TPP_checksum):
if( tpcb->tp_use_checksum ) {
CHECK( iso_check_csum(m, (int)hdr->tpdu_li + 1),
E_TP_INV_PVAL, ts_bad_csum, discard, 0)
}
break;
#ifdef notdef
caseof( DR_TPDU_type, TPP_addl_info ):
/* ignore - its length and meaning are
* user defined and there's no way
* to pass this info to the user anyway
*/
break;
#endif /* notdef */
caseof( AK_TPDU_type, TPP_subseq ):
/* used after reduction of window */
vb_getval(P, u_short, subseq);
subseq = ntohs(subseq);
IFDEBUG(D_ACKRECV)
printf("AK dref 0x%x Subseq 0x%x\n", dref, subseq);
ENDDEBUG
break;
caseof( AK_TPDU_type, TPP_flow_cntl_conf ):
{
u_int ylwe;
u_short ysubseq, ycredit;
fcc_present = TRUE;
vb_getval(P, u_int, ylwe);
vb_getval(P, u_short, ysubseq);
vb_getval(P, u_short, ycredit);
ylwe = ntohl(ylwe);
ysubseq = ntohs(ysubseq);
ycredit = ntohs(ycredit);
IFDEBUG(D_ACKRECV)
printf("%s%x, subseq 0x%x, cdt 0x%x dref 0x%x\n",
"AK FCC lwe 0x", ylwe, ysubseq, ycredit, dref);
ENDDEBUG
}
break;
default:
IFDEBUG(D_TPINPUT)
printf("param ignored dutype 0x%x, code 0x%x\n",
dutype, vbptr(P)->tpv_code);
ENDDEBUG
IFTRACE(D_TPINPUT)
tptrace(TPPTmisc, "param ignored dutype code ",
dutype, vbptr(P)->tpv_code ,0,0);
ENDTRACE
IncStat(ts_param_ignored);
break;
#undef caseof
}
/* } */ END_WHILE_OPTIONS(P)
/* NOTE: the variable dutype has been shifted left! */
switch( hdr->tpdu_type ) {
case CC_TPDU_type:
/* If CC comes back with an unacceptable class
* respond with a DR or ER
*/
opt = hdr->tpdu_CCoptions; /* 1 byte */
{
tpp = tpcb->_tp_param;
tpp.p_class = (1<<hdr->tpdu_CCclass);
tpp.p_tpdusize = dusize;
tpp.p_ptpdusize = pdusize;
tpp.p_dont_change_params = 0;
tpp.p_xtd_format = (opt & TPO_XTD_FMT) == TPO_XTD_FMT;
tpp.p_xpd_service = (addlopt & TPAO_USE_TXPD) == TPAO_USE_TXPD;
tpp.p_use_checksum = (addlopt & TPAO_NO_CSUM) == 0;
#ifdef notdef
tpp.p_use_efc = (opt & TPO_USE_EFC) == TPO_USE_EFC;
tpp.p_use_nxpd = (addlopt & TPAO_USE_NXPD) == TPAO_USE_NXPD;
tpp.p_use_rcc = (addlopt & TPAO_USE_RCC) == TPAO_USE_RCC;
#endif /* notdef */
CHECK(
tp_consistency(tpcb, TP_FORCE, &tpp) != 0,
E_TP_NEGOT_FAILED, ts_negotfailed, respond,
(1 + 2 + (caddr_t)&hdr->_tpdufr.CRCC - (caddr_t)hdr)
/* ^ more or less the location of class */
)
IFTRACE(D_CONN)
tptrace(TPPTmisc,
"after 1 consist class, out, tpconsout",
tpcb->tp_class, dgout_routine, tpcons_output, 0
);
ENDTRACE
CHECK(
((class_to_use == TP_CLASS_0)&&
(dgout_routine != tpcons_output)),
E_TP_NEGOT_FAILED, ts_negotfailed, respond,
(1 + 2 + (caddr_t)&hdr->_tpdufr.CRCC - (caddr_t)hdr)
/* ^ more or less the location of class */
)
#ifdef TPCONS
if (tpcb->tp_netservice == ISO_CONS &&
class_to_use == TP_CLASS_0) {
struct isopcb *isop = (struct isopcb *)tpcb->tp_npcb;
struct pklcd *lcp = (struct pklcd *)isop->isop_chan;
lcp->lcd_flags &= ~X25_DG_CIRCUIT;
}
#endif
}
if( ! tpcb->tp_use_checksum)
IncStat(ts_csum_off);
if(tpcb->tp_xpd_service)
IncStat(ts_use_txpd);
if(tpcb->tp_xtd_format)
IncStat(ts_xtd_fmt);
IFTRACE(D_CONN)
tptrace(TPPTmisc, "after CC class flags dusize CCclass",
tpcb->tp_class, tpcb->tp_flags, tpcb->tp_tpdusize,
hdr->tpdu_CCclass);
ENDTRACE
/* if called or calling suffices appeared on the CC,
* they'd better jive with what's in the pcb
*/
if( fsufxlen ) {
CHECK( ((tpcb->tp_fsuffixlen != fsufxlen) ||
bcmp(fsufxloc, tpcb->tp_fsuffix, fsufxlen)),
E_TP_INV_PVAL,ts_inv_sufx, respond,
(1+fsufxloc - (caddr_t)hdr))
}
if( lsufxlen ) {
CHECK( ((tpcb->tp_lsuffixlen != lsufxlen) ||
bcmp(lsufxloc, tpcb->tp_lsuffix, lsufxlen)),
E_TP_INV_PVAL,ts_inv_sufx, respond,
(1+lsufxloc - (caddr_t)hdr))
}
e.ATTR(CC_TPDU).e_sref = sref;
e.ATTR(CC_TPDU).e_cdt = hdr->tpdu_CCcdt;
takes_data = TRUE;
e.ev_number = CC_TPDU;
IncStat(ts_CC_rcvd);
break;
case DC_TPDU_type:
if (sref != tpcb->tp_fref)
printf("INPUT: inv sufx DCsref 0x%x, tp_fref 0x%x\n",
sref, tpcb->tp_fref);
CHECK( (sref != tpcb->tp_fref),
E_TP_MISM_REFS, ts_inv_sufx, discard,
(1 + (caddr_t)&hdr->tpdu_DCsref - (caddr_t)hdr))
e.ev_number = DC_TPDU;
IncStat(ts_DC_rcvd);
break;
case DR_TPDU_type:
IFTRACE(D_TPINPUT)
tptrace(TPPTmisc, "DR recvd", hdr->tpdu_DRreason, 0, 0, 0);
ENDTRACE
if (sref != tpcb->tp_fref) {
printf("INPUT: inv sufx DRsref 0x%x tp_fref 0x%x\n",
sref, tpcb->tp_fref);
}
CHECK( (sref != 0 && sref != tpcb->tp_fref &&
tpcb->tp_state != TP_CRSENT),
(TP_ERROR_SNDC | E_TP_MISM_REFS),ts_inv_sufx, respond,
(1 + (caddr_t)&hdr->tpdu_DRsref - (caddr_t)hdr))
e.ATTR(DR_TPDU).e_reason = hdr->tpdu_DRreason;
e.ATTR(DR_TPDU).e_sref = (u_short)sref;
takes_data = TRUE;
e.ev_number = DR_TPDU;
IncStat(ts_DR_rcvd);
break;
case ER_TPDU_type:
IFTRACE(D_TPINPUT)
tptrace(TPPTmisc, "ER recvd", hdr->tpdu_ERreason,0,0,0);
ENDTRACE
e.ev_number = ER_TPDU;
e.ATTR(ER_TPDU).e_reason = hdr->tpdu_ERreason;
IncStat(ts_ER_rcvd);
break;
case AK_TPDU_type:
e.ATTR(AK_TPDU).e_subseq = subseq;
e.ATTR(AK_TPDU).e_fcc_present = fcc_present;
if (tpcb->tp_xtd_format) {
#ifdef BYTE_ORDER
union seq_type seqeotX;
seqeotX.s_seqeot = ntohl(hdr->tpdu_seqeotX);
e.ATTR(AK_TPDU).e_seq = seqeotX.s_seq;
e.ATTR(AK_TPDU).e_cdt = ntohs(hdr->tpdu_AKcdtX);
#else
e.ATTR(AK_TPDU).e_cdt = hdr->tpdu_AKcdtX;
e.ATTR(AK_TPDU).e_seq = hdr->tpdu_AKseqX;
#endif /* BYTE_ORDER */
} else {
e.ATTR(AK_TPDU).e_cdt = hdr->tpdu_AKcdt;
e.ATTR(AK_TPDU).e_seq = hdr->tpdu_AKseq;
}
IFTRACE(D_TPINPUT)
tptrace(TPPTmisc, "AK recvd seq cdt subseq fcc_pres",
e.ATTR(AK_TPDU).e_seq, e.ATTR(AK_TPDU).e_cdt,
subseq, fcc_present);
ENDTRACE
e.ev_number = AK_TPDU;
IncStat(ts_AK_rcvd);
IncPStat(tpcb, tps_AK_rcvd);
break;
case XAK_TPDU_type:
if (tpcb->tp_xtd_format) {
#ifdef BYTE_ORDER
union seq_type seqeotX;
seqeotX.s_seqeot = ntohl(hdr->tpdu_seqeotX);
e.ATTR(XAK_TPDU).e_seq = seqeotX.s_seq;
#else
e.ATTR(XAK_TPDU).e_seq = hdr->tpdu_XAKseqX;
#endif /* BYTE_ORDER */
} else {
e.ATTR(XAK_TPDU).e_seq = hdr->tpdu_XAKseq;
}
e.ev_number = XAK_TPDU;
IncStat(ts_XAK_rcvd);
IncPStat(tpcb, tps_XAK_rcvd);
break;
case XPD_TPDU_type:
if (tpcb->tp_xtd_format) {
#ifdef BYTE_ORDER
union seq_type seqeotX;
seqeotX.s_seqeot = ntohl(hdr->tpdu_seqeotX);
e.ATTR(XPD_TPDU).e_seq = seqeotX.s_seq;
#else
e.ATTR(XPD_TPDU).e_seq = hdr->tpdu_XPDseqX;
#endif /* BYTE_ORDER */
} else {
e.ATTR(XPD_TPDU).e_seq = hdr->tpdu_XPDseq;
}
takes_data = TRUE;
e.ev_number = XPD_TPDU;
IncStat(ts_XPD_rcvd);
IncPStat(tpcb, tps_XPD_rcvd);
break;
case DT_TPDU_type:
{ /* the y option will cause occasional packets to be dropped.
* A little crude but it works.
*/
IFDEBUG(D_DROP)
if(time.tv_usec & 0x4 && hdr->tpdu_DTseq & 0x1) {
IncStat(ts_ydebug);
goto discard;
}
ENDDEBUG
}
if (tpcb->tp_class == TP_CLASS_0) {
tp0_data:
e.ATTR(DT_TPDU).e_seq = 0; /* actually don't care */
e.ATTR(DT_TPDU).e_eot = (((struct tp0du *)hdr)->tp0du_eot);
} else if (tpcb->tp_xtd_format) {
#ifdef BYTE_ORDER
union seq_type seqeotX;
seqeotX.s_seqeot = ntohl(hdr->tpdu_seqeotX);
e.ATTR(DT_TPDU).e_seq = seqeotX.s_seq;
e.ATTR(DT_TPDU).e_eot = seqeotX.s_eot;
#else
e.ATTR(DT_TPDU).e_seq = hdr->tpdu_DTseqX;
e.ATTR(DT_TPDU).e_eot = hdr->tpdu_DTeotX;
#endif /* BYTE_ORDER */
} else {
e.ATTR(DT_TPDU).e_seq = hdr->tpdu_DTseq;
e.ATTR(DT_TPDU).e_eot = hdr->tpdu_DTeot;
}
if(e.ATTR(DT_TPDU).e_eot)
IncStat(ts_eot_input);
takes_data = TRUE;
e.ev_number = DT_TPDU;
IncStat(ts_DT_rcvd);
IncPStat(tpcb, tps_DT_rcvd);
break;
case GR_TPDU_type:
tp_indicate(T_DISCONNECT, tpcb, ECONNABORTED);
/* drop through */
default:
/* this should NEVER happen because there is a
* check for dutype well above here
*/
error = E_TP_INV_TPDU; /* causes an ER */
IFDEBUG(D_TPINPUT)
printf("INVALID dutype 0x%x\n", hdr->tpdu_type);
ENDDEBUG
IncStat(ts_inv_dutype);
goto respond;
}
}
/* peel off the tp header;
* remember that the du_li doesn't count itself.
* This may leave us w/ an empty mbuf at the front of a chain.
* We can't just throw away the empty mbuf because hdr still points
* into the mbuf's data area and we're still using hdr (the tpdu header)
*/
m->m_len -= ((int)hdr->tpdu_li + 1);
m->m_data += ((int)hdr->tpdu_li + 1);
if (takes_data) {
int max = tpdu_info[ hdr->tpdu_type ] [TP_MAX_DATA_INDEX];
int datalen = tpdu_len - hdr->tpdu_li - 1, mbtype = MT_DATA;
struct {
struct tp_disc_reason dr;
struct cmsghdr x_hdr;
} x;
#define c_hdr x.x_hdr
register struct mbuf *n;
CHECK( (max && datalen > max), E_TP_LENGTH_INVAL,
ts_inv_length, respond, (max + hdr->tpdu_li + 1) );
switch( hdr->tpdu_type ) {
case CR_TPDU_type:
c_hdr.cmsg_type = TPOPT_CONN_DATA;
goto make_control_msg;
case CC_TPDU_type:
c_hdr.cmsg_type = TPOPT_CFRM_DATA;
goto make_control_msg;
case DR_TPDU_type:
x.dr.dr_hdr.cmsg_len = sizeof(x) - sizeof(c_hdr);
x.dr.dr_hdr.cmsg_type = TPOPT_DISC_REASON;
x.dr.dr_hdr.cmsg_level = SOL_TRANSPORT;
x.dr.dr_reason = hdr->tpdu_DRreason;
c_hdr.cmsg_type = TPOPT_DISC_DATA;
make_control_msg:
datalen += sizeof(c_hdr);
c_hdr.cmsg_len = datalen;
c_hdr.cmsg_level = SOL_TRANSPORT;
mbtype = MT_CONTROL;
MGET(n, M_DONTWAIT, MT_DATA);
if (n == 0)
{m_freem(m); m = 0; datalen = 0; goto invoke; }
if (hdr->tpdu_type == DR_TPDU_type) {
datalen += sizeof(x) - sizeof(c_hdr);
bcopy((caddr_t)&x, mtod(n, caddr_t), n->m_len = sizeof(x));
} else
bcopy((caddr_t)&c_hdr, mtod(n, caddr_t),
n->m_len = sizeof(c_hdr));
n->m_next = m;
m = n;
/* FALLTHROUGH */
case XPD_TPDU_type:
if (mbtype != MT_CONTROL)
mbtype = MT_OOBDATA;
m->m_flags |= M_EOR;
/* FALLTHROUGH */
case DT_TPDU_type:
for (n = m; n; n = n->m_next) {
MCHTYPE(n, mbtype);
}
invoke:
e.ATTR(DT_TPDU).e_datalen = datalen;
e.ATTR(DT_TPDU).e_data = m;
break;
default:
printf(
"ERROR in tp_input! hdr->tpdu_type 0x%x takes_data 0x%x m 0x%x\n",
hdr->tpdu_type, takes_data, m);
break;
}
/* prevent m_freem() after tp_driver() from throwing it all away */
m = MNULL;
}
IncStat(ts_tpdu_rcvd);
IFDEBUG(D_TPINPUT)
printf( "tp_input: before driver, state 0x%x event 0x%x m 0x%x",
tpcb->tp_state, e.ev_number, m );
printf(" e.e_data 0x%x\n", e.ATTR(DT_TPDU).e_data);
printf("takes_data 0x%x m_len 0x%x, tpdu_len 0x%x\n",
takes_data, (m==MNULL)?0:m->m_len, tpdu_len);
ENDDEBUG
error = tp_driver(tpcb, &e);
ASSERT(tpcb != (struct tp_pcb *)0);
ASSERT(tpcb->tp_sock != (struct socket *)0);
if( tpcb->tp_sock->so_error == 0 )
tpcb->tp_sock->so_error = error;
/* Kludge to keep the state tables under control (adding
* data on connect & disconnect & freeing the mbuf containing
* the data would have exploded the tables and made a big mess ).
*/
switch(e.ev_number) {
case CC_TPDU:
case DR_TPDU:
case CR_TPDU:
m = e.ATTR(CC_TPDU).e_data; /* same field for all three dutypes */
IFDEBUG(D_TPINPUT)
printf("after driver, restoring m to 0x%x, takes_data 0x%x\n",
m, takes_data);
ENDDEBUG
break;
default:
break;
}
/* Concatenated sequences are terminated by any tpdu that
* carries data: CR, CC, DT, XPD, DR.
* All other tpdu types may be concatenated: AK, XAK, DC, ER.
*/
separate:
if ( takes_data == 0 ) {
ASSERT( m != MNULL );
/*
* we already peeled off the prev. tp header so
* we can just pull up some more and repeat
*/
if( m = tp_inputprep(m) ) {
IFDEBUG(D_TPINPUT)
hdr = mtod(m, struct tpdu *);
printf("tp_input @ separate: hdr 0x%x size %d m 0x%x\n",
hdr, (int) hdr->tpdu_li + 1, m);
dump_mbuf(m, "tp_input after driver, at separate");
ENDDEBUG
IncStat(ts_concat_rcvd);
goto again;
}
}
if ( m != MNULL ) {
IFDEBUG(D_TPINPUT)
printf("tp_input : m_freem(0x%x)\n", m);
ENDDEBUG
m_freem(m);
IFDEBUG(D_TPINPUT)
printf("tp_input : after m_freem 0x%x\n", m);
ENDDEBUG
}
return (ProtoHook) tpcb;
discard:
/* class 4: drop the tpdu */
/* class 2,0: Should drop the net connection, if you can figure out
* to which connection it applies
*/
IFDEBUG(D_TPINPUT)
printf("tp_input DISCARD\n");
ENDDEBUG
IFTRACE(D_TPINPUT)
tptrace(TPPTmisc, "tp_input DISCARD m", m,0,0,0);
ENDTRACE
m_freem(m);
IncStat(ts_recv_drop);
return (ProtoHook)0;
nonx_dref:
switch (dutype) {
default:
goto discard;
case CC_TPDU_type:
/* error = E_TP_MISM_REFS; */
break;
case DR_TPDU_type:
error |= TP_ERROR_SNDC;
}
respond:
IFDEBUG(D_TPINPUT)
printf("RESPOND: error 0x%x, errlen 0x%x\n", error, errlen);
ENDDEBUG
IFTRACE(D_TPINPUT)
tptrace(TPPTmisc, "tp_input RESPOND m error sref", m, error, sref, 0);
ENDTRACE
if (sref == 0)
goto discard;
(void) tp_error_emit(error, (u_long)sref, (struct sockaddr_iso *)faddr,
(struct sockaddr_iso *)laddr, m, errlen, tpcb,
cons_channel, dgout_routine);
IFDEBUG(D_ERROR_EMIT)
printf("tp_input after error_emit\n");
ENDDEBUG
#ifdef lint
printf("",sref,opt);
#endif /* lint */
IncStat(ts_recv_drop);
return (ProtoHook)0;
}
/*
* NAME: tp_headersize()
*
* CALLED FROM:
* tp_emit() and tp_sbsend()
* TP needs to know the header size so it can figure out how
* much data to put in each tpdu.
*
* FUNCTION, ARGUMENTS, and RETURN VALUE:
* For a given connection, represented by (tpcb), and
* tpdu type (dutype), return the size of a tp header.
*
* RETURNS: the expected size of the heade in bytesr
*
* SIDE EFFECTS:
*
* NOTES: It would be nice if it got the network header size as well.
*/
int
tp_headersize(dutype, tpcb)
int dutype;
struct tp_pcb *tpcb;
{
register int size = 0;
IFTRACE(D_CONN)
tptrace(TPPTmisc, "tp_headersize dutype class xtd_format",
dutype, tpcb->tp_class, tpcb->tp_xtd_format, 0);
ENDTRACE
if( !( (tpcb->tp_class == TP_CLASS_0) ||
(tpcb->tp_class == TP_CLASS_4) ||
(dutype == DR_TPDU_type) ||
(dutype == CR_TPDU_type) )) {
printf("tp_headersize:dutype 0x%x, class 0x%x",
dutype, tpcb->tp_class);
/* TODO: identify this and GET RID OF IT */
}
ASSERT( (tpcb->tp_class == TP_CLASS_0) ||
(tpcb->tp_class == TP_CLASS_4) ||
(dutype == DR_TPDU_type) ||
(dutype == CR_TPDU_type) );
if( tpcb->tp_class == TP_CLASS_0 ) {
size = tpdu_info[ dutype ] [TP_LEN_CLASS_0_INDEX];
} else {
size = tpdu_info[ dutype ] [tpcb->tp_xtd_format];
}
return size;
/* caller must get network level header size separately */
}
Reference in New Issue View Git Blame Copy Permalink