149268Sbostic /*- 249268Sbostic * Copyright (c) 1991 The Regents of the University of California. 349268Sbostic * All rights reserved. 449268Sbostic * 549268Sbostic * %sccs.include.redist.c% 649268Sbostic * 7*50500Ssklower * @(#)tp_usrreq.c 7.19 (Berkeley) 07/23/91 849268Sbostic */ 949268Sbostic 1036420Ssklower /*********************************************************** 1139196Ssklower Copyright IBM Corporation 1987 1236420Ssklower 1336420Ssklower All Rights Reserved 1436420Ssklower 1536420Ssklower Permission to use, copy, modify, and distribute this software and its 1636420Ssklower documentation for any purpose and without fee is hereby granted, 1736420Ssklower provided that the above copyright notice appear in all copies and that 1836420Ssklower both that copyright notice and this permission notice appear in 1936420Ssklower supporting documentation, and that the name of IBM not be 2036420Ssklower used in advertising or publicity pertaining to distribution of the 2136420Ssklower software without specific, written prior permission. 2236420Ssklower 2336420Ssklower IBM DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE, INCLUDING 2436420Ssklower ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS, IN NO EVENT SHALL 2536420Ssklower IBM BE LIABLE FOR ANY SPECIAL, INDIRECT OR CONSEQUENTIAL DAMAGES OR 2636420Ssklower ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, 2736420Ssklower WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, 2836420Ssklower ARISING OUT OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS 2936420Ssklower SOFTWARE. 3036420Ssklower 3136420Ssklower ******************************************************************/ 3236420Ssklower 3336420Ssklower /* 3436420Ssklower * ARGO Project, Computer Sciences Dept., University of Wisconsin - Madison 3536420Ssklower */ 3636420Ssklower /* 3736420Ssklower * ARGO TP 3836420Ssklower * 3936420Ssklower * $Header: tp_usrreq.c,v 5.4 88/11/18 17:29:18 nhall Exp $ 4036420Ssklower * $Source: /usr/argo/sys/netiso/RCS/tp_usrreq.c,v $ 4136420Ssklower * 4236420Ssklower * tp_usrreq(), the fellow that gets called from most of the socket code. 4336420Ssklower * Pretty straighforward. 4436420Ssklower * THe only really awful stuff here is the OOB processing, which is done 4536420Ssklower * wholly here. 4636420Ssklower * tp_rcvoob() and tp_sendoob() are contained here and called by tp_usrreq(). 4736420Ssklower */ 4836420Ssklower 4936420Ssklower #include "param.h" 5036420Ssklower #include "systm.h" 5136420Ssklower #include "mbuf.h" 5236420Ssklower #include "socket.h" 5336420Ssklower #include "socketvar.h" 5436420Ssklower #include "domain.h" 5536420Ssklower #include "protosw.h" 5636420Ssklower #include "errno.h" 5750236Ssklower #include "time.h" 5836420Ssklower 5937469Ssklower #include "tp_param.h" 6037469Ssklower #include "tp_timer.h" 6137469Ssklower #include "tp_stat.h" 6237469Ssklower #include "tp_seq.h" 6337469Ssklower #include "tp_ip.h" 6437469Ssklower #include "tp_pcb.h" 6537469Ssklower #include "argo_debug.h" 6637469Ssklower #include "tp_trace.h" 6737469Ssklower #include "tp_meas.h" 6837469Ssklower #include "iso.h" 6937469Ssklower #include "iso_errno.h" 7036420Ssklower 71*50500Ssklower int tp_attach(), tp_driver(), tp_pcbbind(); 7239937Ssklower int TNew; 7339937Ssklower int TPNagle1, TPNagle2; 7444424Ssklower struct tp_pcb *tp_listeners, *tp_intercepts; 7536420Ssklower 7636420Ssklower #ifdef ARGO_DEBUG 7736420Ssklower /* 7836420Ssklower * CALLED FROM: 7936420Ssklower * anywhere you want to debug... 8036420Ssklower * FUNCTION and ARGUMENTS: 8136420Ssklower * print (str) followed by the control info in the mbufs of an mbuf chain (n) 8236420Ssklower */ 8336420Ssklower void 8436420Ssklower dump_mbuf(n, str) 8536420Ssklower struct mbuf *n; 8636420Ssklower char *str; 8736420Ssklower { 8836420Ssklower struct mbuf *nextrecord; 8936420Ssklower 9036420Ssklower printf("dump %s\n", str); 9136420Ssklower 9244310Ssklower if (n == MNULL) { 9336420Ssklower printf("EMPTY:\n"); 9436420Ssklower return; 9536420Ssklower } 9636420Ssklower 9744310Ssklower while (n) { 9836420Ssklower nextrecord = n->m_act; 9936420Ssklower printf("RECORD:\n"); 10036420Ssklower while (n) { 10137469Ssklower printf("%x : Len %x Data %x A %x Nx %x Tp %x\n", 10237469Ssklower n, n->m_len, n->m_data, n->m_act, n->m_next, n->m_type); 10336420Ssklower #ifdef notdef 10436420Ssklower { 10536420Ssklower register char *p = mtod(n, char *); 10636420Ssklower register int i; 10736420Ssklower 10836420Ssklower printf("data: "); 10944310Ssklower for (i = 0; i < n->m_len; i++) { 11044310Ssklower if (i%8 == 0) 11136420Ssklower printf("\n"); 11236420Ssklower printf("0x%x ", *(p+i)); 11336420Ssklower } 11436420Ssklower printf("\n"); 11536420Ssklower } 11636420Ssklower #endif notdef 11744310Ssklower if (n->m_next == n) { 11836420Ssklower printf("LOOP!\n"); 11936420Ssklower return; 12036420Ssklower } 12136420Ssklower n = n->m_next; 12236420Ssklower } 12336420Ssklower n = nextrecord; 12436420Ssklower } 12536420Ssklower printf("\n"); 12636420Ssklower } 12736420Ssklower 12836420Ssklower #endif ARGO_DEBUG 12936420Ssklower 13036420Ssklower /* 13136420Ssklower * CALLED FROM: 13236420Ssklower * tp_usrreq(), PRU_RCVOOB 13336420Ssklower * FUNCTION and ARGUMENTS: 13436420Ssklower * Copy data from the expedited data socket buffer into 13536420Ssklower * the pre-allocated mbuf m. 13636420Ssklower * There is an isomorphism between XPD TPDUs and expedited data TSDUs. 13736420Ssklower * XPD tpdus are limited to 16 bytes of data so they fit in one mbuf. 13836420Ssklower * RETURN VALUE: 13936420Ssklower * EINVAL if debugging is on and a disaster has occurred 14036420Ssklower * ENOTCONN if the socket isn't connected 14136420Ssklower * EWOULDBLOCK if the socket is in non-blocking mode and there's no 14236420Ssklower * xpd data in the buffer 14336420Ssklower * E* whatever is returned from the fsm. 14436420Ssklower */ 14536420Ssklower tp_rcvoob(tpcb, so, m, outflags, inflags) 14636420Ssklower struct tp_pcb *tpcb; 14736420Ssklower register struct socket *so; 14836420Ssklower register struct mbuf *m; 14936420Ssklower int *outflags; 15036420Ssklower int inflags; 15136420Ssklower { 15236420Ssklower register struct mbuf *n; 15337469Ssklower register struct sockbuf *sb = &so->so_rcv; 15436420Ssklower struct tp_event E; 15536420Ssklower int error = 0; 15637469Ssklower register struct mbuf **nn; 15736420Ssklower 15836420Ssklower IFDEBUG(D_XPD) 15936420Ssklower printf("PRU_RCVOOB, sostate 0x%x\n", so->so_state); 16036420Ssklower ENDDEBUG 16136420Ssklower 16236420Ssklower /* if you use soreceive */ 16344310Ssklower if (m == MNULL) 16436420Ssklower return ENOBUFS; 16536420Ssklower 16636420Ssklower restart: 16736420Ssklower if ((((so->so_state & SS_ISCONNECTED) == 0) 16836420Ssklower || (so->so_state & SS_ISDISCONNECTING) != 0) && 16936420Ssklower (so->so_proto->pr_flags & PR_CONNREQUIRED)) { 17036420Ssklower return ENOTCONN; 17136420Ssklower } 17236420Ssklower 17337469Ssklower /* Take the first mbuf off the chain. 17437469Ssklower * Each XPD TPDU gives you a complete TSDU so the chains don't get 17537469Ssklower * coalesced, but one TSDU may span several mbufs. 17637469Ssklower * Nevertheless, since n should have a most 16 bytes, it 17737469Ssklower * will fit into m. (size was checked in tp_input() ) 17837469Ssklower */ 17937469Ssklower 18037469Ssklower /* 18137469Ssklower * Code for excision of OOB data should be added to 18237469Ssklower * uipc_socket2.c (like sbappend). 18337469Ssklower */ 18437469Ssklower 18538841Ssklower sblock(sb); 18637469Ssklower for (nn = &sb->sb_mb; n = *nn; nn = &n->m_act) 18737469Ssklower if (n->m_type == MT_OOBDATA) 18837469Ssklower break; 18937469Ssklower 19037469Ssklower if (n == 0) { 19136420Ssklower IFDEBUG(D_XPD) 19236420Ssklower printf("RCVOOB: empty queue!\n"); 19336420Ssklower ENDDEBUG 19438841Ssklower sbunlock(sb); 19536420Ssklower if (so->so_state & SS_NBIO) { 19636420Ssklower return EWOULDBLOCK; 19736420Ssklower } 19836420Ssklower sbwait(sb); 19936420Ssklower goto restart; 20036420Ssklower } 20136420Ssklower m->m_len = 0; 20236420Ssklower 20336420Ssklower /* Assuming at most one xpd tpdu is in the buffer at once */ 20444310Ssklower while (n != MNULL) { 20536420Ssklower m->m_len += n->m_len; 20637469Ssklower bcopy(mtod(n, caddr_t), mtod(m, caddr_t), (unsigned)n->m_len); 20737469Ssklower m->m_data += n->m_len; /* so mtod() in bcopy() above gives right addr */ 20836420Ssklower n = n->m_next; 20936420Ssklower } 21037469Ssklower m->m_data = m->m_dat; 21137469Ssklower m->m_flags |= M_EOR; 21236420Ssklower 21336420Ssklower IFDEBUG(D_XPD) 21436420Ssklower printf("tp_rcvoob: xpdlen 0x%x\n", m->m_len); 21536420Ssklower dump_mbuf(so->so_rcv.sb_mb, "RCVOOB: Rcv socketbuf"); 21636420Ssklower dump_mbuf(sb->sb_mb, "RCVOOB: Xrcv socketbuf"); 21736420Ssklower ENDDEBUG 21836420Ssklower 21944310Ssklower if ((inflags & MSG_PEEK) == 0) { 22037469Ssklower n = *nn; 22137469Ssklower *nn = n->m_act; 22237469Ssklower sb->sb_cc -= m->m_len; 22337469Ssklower } 22436420Ssklower 22536420Ssklower release: 22636420Ssklower sbunlock(sb); 22736420Ssklower 22836420Ssklower IFTRACE(D_XPD) 22936420Ssklower tptraceTPCB(TPPTmisc, "PRU_RCVOOB @ release sb_cc m_len", 23044310Ssklower tpcb->tp_Xrcv.sb_cc, m->m_len, 0, 0); 23136420Ssklower ENDTRACE 23236420Ssklower if (error == 0) 23336420Ssklower error = DoEvent(T_USR_Xrcvd); 23436420Ssklower return error; 23536420Ssklower } 23636420Ssklower 23736420Ssklower /* 23836420Ssklower * CALLED FROM: 23936420Ssklower * tp_usrreq(), PRU_SENDOOB 24036420Ssklower * FUNCTION and ARGUMENTS: 24136420Ssklower * Send what's in the mbuf chain (m) as an XPD TPDU. 24236420Ssklower * The mbuf may not contain more then 16 bytes of data. 24336420Ssklower * XPD TSDUs aren't segmented, so they translate into 24436420Ssklower * exactly one XPD TPDU, with EOT bit set. 24536420Ssklower * RETURN VALUE: 24636420Ssklower * EWOULDBLOCK if socket is in non-blocking mode and the previous 24736420Ssklower * xpd data haven't been acked yet. 24836420Ssklower * EMSGSIZE if trying to send > max-xpd bytes (16) 24936420Ssklower * ENOBUFS if ran out of mbufs 25036420Ssklower */ 25136420Ssklower tp_sendoob(tpcb, so, xdata, outflags) 25236420Ssklower struct tp_pcb *tpcb; 25336420Ssklower register struct socket *so; 25436420Ssklower register struct mbuf *xdata; 25536420Ssklower int *outflags; /* not used */ 25636420Ssklower { 25736420Ssklower /* 25836420Ssklower * Each mbuf chain represents a sequence # in the XPD seq space. 25936420Ssklower * The first one in the queue has sequence # tp_Xuna. 26036420Ssklower * When we add to the XPD queue, we stuff a zero-length 26136420Ssklower * mbuf (mark) into the DATA queue, with its sequence number in m_next 26236420Ssklower * to be assigned to this XPD tpdu, so data xfer can stop 26336420Ssklower * when it reaches the zero-length mbuf if this XPD TPDU hasn't 26436420Ssklower * yet been acknowledged. 26536420Ssklower */ 26636420Ssklower register struct sockbuf *sb = &(tpcb->tp_Xsnd); 26736420Ssklower register struct mbuf *xmark; 26836420Ssklower register int len=0; 26936420Ssklower struct tp_event E; 27036420Ssklower 27136420Ssklower IFDEBUG(D_XPD) 27236420Ssklower printf("tp_sendoob:"); 27344310Ssklower if (xdata) 27436420Ssklower printf("xdata len 0x%x\n", xdata->m_len); 27536420Ssklower ENDDEBUG 27636420Ssklower /* DO NOT LOCK the Xsnd buffer!!!! You can have at MOST one 27736420Ssklower * socket buf locked at any time!!! (otherwise you might 27836420Ssklower * sleep() in sblock() w/ a signal pending and cause the 27936420Ssklower * system call to be aborted w/ a locked socketbuf, which 28036420Ssklower * is a problem. So the so_snd buffer lock 28136420Ssklower * (done in sosend()) serves as the lock for Xpd. 28236420Ssklower */ 28338841Ssklower if (sb->sb_mb) { /* Anything already in eXpedited data sockbuf? */ 28436420Ssklower if (so->so_state & SS_NBIO) { 28536420Ssklower return EWOULDBLOCK; 28636420Ssklower } 28738841Ssklower while (sb->sb_mb) { 28838841Ssklower sbunlock(&so->so_snd); /* already locked by sosend */ 28938841Ssklower sbwait(&so->so_snd); 29038841Ssklower sblock(&so->so_snd); /* sosend will unlock on return */ 29138841Ssklower } 29236420Ssklower } 29336420Ssklower 29436420Ssklower if (xdata == (struct mbuf *)0) { 29536420Ssklower /* empty xpd packet */ 29637469Ssklower MGETHDR(xdata, M_WAIT, MT_OOBDATA); 29736420Ssklower if (xdata == NULL) { 29836420Ssklower return ENOBUFS; 29936420Ssklower } 30036420Ssklower xdata->m_len = 0; 30137469Ssklower xdata->m_pkthdr.len = 0; 30236420Ssklower } 30336420Ssklower IFDEBUG(D_XPD) 30436420Ssklower printf("tp_sendoob 1:"); 30544310Ssklower if (xdata) 30636420Ssklower printf("xdata len 0x%x\n", xdata->m_len); 30736420Ssklower ENDDEBUG 30836420Ssklower xmark = xdata; /* temporary use of variable xmark */ 30936420Ssklower while (xmark) { 31036420Ssklower len += xmark->m_len; 31136420Ssklower xmark = xmark->m_next; 31236420Ssklower } 31336420Ssklower if (len > TP_MAX_XPD_DATA) { 31436420Ssklower return EMSGSIZE; 31536420Ssklower } 31636420Ssklower IFDEBUG(D_XPD) 31736420Ssklower printf("tp_sendoob 2:"); 31844310Ssklower if (xdata) 31936420Ssklower printf("xdata len 0x%x\n", len); 32036420Ssklower ENDDEBUG 32136420Ssklower 32236420Ssklower 32336420Ssklower IFTRACE(D_XPD) 32438841Ssklower tptraceTPCB(TPPTmisc, "XPD mark m_next ", xdata->m_next, 0, 0, 0); 32536420Ssklower ENDTRACE 32636420Ssklower 32736420Ssklower sbappendrecord(sb, xdata); 32836420Ssklower 32936420Ssklower IFDEBUG(D_XPD) 33036420Ssklower printf("tp_sendoob len 0x%x\n", len); 33136420Ssklower dump_mbuf(so->so_snd.sb_mb, "XPD request Regular sndbuf:"); 33236420Ssklower dump_mbuf(tpcb->tp_Xsnd.sb_mb, "XPD request Xsndbuf:"); 33336420Ssklower ENDDEBUG 33436420Ssklower return DoEvent(T_XPD_req); 33536420Ssklower } 33636420Ssklower 33736420Ssklower /* 33836420Ssklower * CALLED FROM: 33936420Ssklower * the socket routines 34036420Ssklower * FUNCTION and ARGUMENTS: 34136420Ssklower * Handles all "user requests" except the [gs]ockopts() requests. 34236420Ssklower * The argument (req) is the request type (PRU*), 34336420Ssklower * (m) is an mbuf chain, generally used for send and 34436420Ssklower * receive type requests only. 34536420Ssklower * (nam) is used for addresses usually, in particular for the bind request. 34636420Ssklower * 34736420Ssklower */ 34836420Ssklower /*ARGSUSED*/ 34936420Ssklower ProtoHook 35040773Ssklower tp_usrreq(so, req, m, nam, controlp) 35136420Ssklower struct socket *so; 35236420Ssklower u_int req; 35340773Ssklower struct mbuf *m, *nam, *controlp; 35436420Ssklower { 35536420Ssklower register struct tp_pcb *tpcb = sototpcb(so); 35636420Ssklower int s = splnet(); 35736420Ssklower int error = 0; 35837469Ssklower int flags, *outflags = &flags; 35936420Ssklower u_long eotsdu = 0; 36036420Ssklower struct tp_event E; 36136420Ssklower 36236420Ssklower IFDEBUG(D_REQUEST) 36336420Ssklower printf("usrreq(0x%x,%d,0x%x,0x%x,0x%x)\n",so,req,m,nam,outflags); 36444310Ssklower if (so->so_error) 36536420Ssklower printf("WARNING!!! so->so_error is 0x%x\n", so->so_error); 36636420Ssklower ENDDEBUG 36736420Ssklower IFTRACE(D_REQUEST) 36836420Ssklower tptraceTPCB(TPPTusrreq, "req so m state [", req, so, m, 36936420Ssklower tpcb?tpcb->tp_state:0); 37036420Ssklower ENDTRACE 37136420Ssklower 37236420Ssklower if ((u_int)tpcb == 0 && req != PRU_ATTACH) { 37336420Ssklower IFTRACE(D_REQUEST) 37436420Ssklower tptraceTPCB(TPPTusrreq, "req failed NO TPCB[", 0, 0, 0, 0); 37536420Ssklower ENDTRACE 37636420Ssklower splx(s); 37736420Ssklower return ENOTCONN; 37836420Ssklower } 37936420Ssklower 38036420Ssklower switch (req) { 38136420Ssklower 38236420Ssklower case PRU_ATTACH: 38336420Ssklower if (tpcb) { 38436420Ssklower error = EISCONN; 38536420Ssklower break; 38636420Ssklower } 38744310Ssklower if (error = tp_attach(so, so->so_proto->pr_domain->dom_family)) 38836420Ssklower break; 38936420Ssklower tpcb = sototpcb(so); 39036420Ssklower break; 39136420Ssklower 39236420Ssklower case PRU_ABORT: /* called from close() */ 39336420Ssklower /* called for each incoming connect queued on the 39436420Ssklower * parent (accepting) socket 39536420Ssklower */ 39644310Ssklower if (tpcb->tp_state == TP_OPEN) { 39736420Ssklower E.ATTR(T_DISC_req).e_reason = E_TP_NO_SESSION; 39836420Ssklower error = DoEvent(T_DISC_req); /* pretend it was a close() */ 39936420Ssklower break; 40036420Ssklower } /* else DROP THROUGH */ 40136420Ssklower 40236420Ssklower case PRU_DETACH: /* called from close() */ 40336420Ssklower /* called only after disconnect was called */ 40444424Ssklower if (tpcb->tp_state == TP_LISTENING) { 40544424Ssklower register struct tp_pcb **tt; 40644424Ssklower for (tt = &tp_listeners; *tt; tt = &((*tt)->tp_nextlisten)) 40744424Ssklower if (*tt == tpcb) 40844424Ssklower break; 40944424Ssklower if (*tt) 41044424Ssklower *tt = tpcb->tp_nextlisten; 41144424Ssklower else { 41244424Ssklower for (tt = &tp_intercepts; *tt; tt = &((*tt)->tp_nextlisten)) 41344424Ssklower if (*tt == tpcb) 41444424Ssklower break; 41544424Ssklower if (*tt) 41644424Ssklower *tt = tpcb->tp_nextlisten; 41744424Ssklower else 41844424Ssklower printf("tp_usrreq - detach: should panic\n"); 41944424Ssklower } 42044424Ssklower } 42144424Ssklower if (tpcb->tp_next) 42244424Ssklower remque(tpcb); 42336420Ssklower error = DoEvent(T_DETACH); 42437469Ssklower if (tpcb->tp_state == TP_CLOSED) { 42537469Ssklower free((caddr_t)tpcb, M_PCB); 42637469Ssklower tpcb = 0; 42737469Ssklower } 42836420Ssklower break; 42936420Ssklower 43036420Ssklower case PRU_SHUTDOWN: 43136420Ssklower /* recv end may have been released; local credit might be zero */ 43236420Ssklower case PRU_DISCONNECT: 43336420Ssklower E.ATTR(T_DISC_req).e_reason = E_TP_NORMAL_DISC; 43436420Ssklower error = DoEvent(T_DISC_req); 43536420Ssklower break; 43636420Ssklower 43736420Ssklower case PRU_BIND: 438*50500Ssklower error = tp_pcbbind(tpcb, nam); 43936420Ssklower break; 44036420Ssklower 44136420Ssklower case PRU_LISTEN: 442*50500Ssklower if (tpcb->tp_state != TP_CLOSED || tpcb->tp_lsuffixlen == 0 || 443*50500Ssklower tpcb->tp_next == 0) 444*50500Ssklower error = EINVAL; 445*50500Ssklower else { 446*50500Ssklower remque(tpcb); 44744424Ssklower tpcb->tp_nextlisten = tp_listeners; 448*50500Ssklower tpcb->tp_next = tpcb->tp_prev = tp_listeners = tpcb; 449*50500Ssklower error = DoEvent(T_LISTEN_req); 45044424Ssklower } 45136420Ssklower break; 45236420Ssklower 45336420Ssklower case PRU_CONNECT2: 45436420Ssklower error = EOPNOTSUPP; /* for unix domain sockets */ 45536420Ssklower break; 45636420Ssklower 45736420Ssklower case PRU_CONNECT: 45836420Ssklower IFTRACE(D_CONN) 45936420Ssklower tptraceTPCB(TPPTmisc, 46037469Ssklower "PRU_CONNECT: so 0x%x *SHORT_LSUFXP(tpcb) 0x%x lsuflen 0x%x, class 0x%x", 46136420Ssklower tpcb->tp_sock, *SHORT_LSUFXP(tpcb), tpcb->tp_lsuffixlen, 46236420Ssklower tpcb->tp_class); 46336420Ssklower ENDTRACE 46436420Ssklower IFDEBUG(D_CONN) 46536420Ssklower printf("PRU_CONNECT: so *SHORT_LSUFXP(tpcb) 0x%x lsuflen 0x%x, class 0x%x", 46636420Ssklower tpcb->tp_sock, *SHORT_LSUFXP(tpcb), tpcb->tp_lsuffixlen, 46736420Ssklower tpcb->tp_class); 46836420Ssklower ENDDEBUG 46944310Ssklower if (tpcb->tp_lsuffixlen == 0) { 47050435Ssklower if (error = (tpcb->tp_nlproto->nlp_pcbbind)(tpcb->tp_npcb, MNULL)) { 47136420Ssklower IFDEBUG(D_CONN) 47244310Ssklower printf("pcbbind returns error 0x%x\n", error); 47336420Ssklower ENDDEBUG 47436420Ssklower break; 47536420Ssklower } 47650435Ssklower (tpcb->tp_nlproto->nlp_getsufx)(tpcb->tp_npcb, &tpcb->tp_lsuffixlen, 47744310Ssklower tpcb->tp_lsuffix, TP_LOCAL); 47837469Ssklower } 47936420Ssklower 48036420Ssklower IFDEBUG(D_CONN) 48136420Ssklower printf("isop 0x%x isop->isop_socket offset 12 :\n", tpcb->tp_npcb); 48244310Ssklower dump_buf(tpcb->tp_npcb, 16); 48336420Ssklower ENDDEBUG 48444310Ssklower if (error = tp_route_to(nam, tpcb, /* channel */0)) 48536420Ssklower break; 48636420Ssklower IFDEBUG(D_CONN) 48736420Ssklower printf( 48836420Ssklower "PRU_CONNECT after tpcb 0x%x so 0x%x npcb 0x%x flags 0x%x\n", 48936420Ssklower tpcb, so, tpcb->tp_npcb, tpcb->tp_flags); 49036420Ssklower printf("isop 0x%x isop->isop_socket offset 12 :\n", tpcb->tp_npcb); 49144310Ssklower dump_buf(tpcb->tp_npcb, 16); 49236420Ssklower ENDDEBUG 49344310Ssklower if (tpcb->tp_fsuffixlen == 0) { 49436420Ssklower /* didn't set peer extended suffix */ 49550435Ssklower (tpcb->tp_nlproto->nlp_getsufx)(tpcb->tp_npcb, &tpcb->tp_fsuffixlen, 49644310Ssklower tpcb->tp_fsuffix, TP_FOREIGN); 49736420Ssklower } 49850435Ssklower (void) (tpcb->tp_nlproto->nlp_mtu)(so, tpcb->tp_npcb, 49936420Ssklower &tpcb->tp_l_tpdusize, &tpcb->tp_tpdusize, 0); 50044310Ssklower if (tpcb->tp_state == TP_CLOSED) { 50136420Ssklower soisconnecting(so); 50236420Ssklower error = DoEvent(T_CONN_req); 50336420Ssklower } else { 50450435Ssklower (tpcb->tp_nlproto->nlp_pcbdisc)(tpcb->tp_npcb); 50536420Ssklower error = EISCONN; 50636420Ssklower } 50736420Ssklower IFPERF(tpcb) 50836420Ssklower u_int lsufx, fsufx; 50939196Ssklower lsufx = *(u_short *)(tpcb->tp_lsuffix); 51039196Ssklower fsufx = *(u_short *)(tpcb->tp_fsuffix); 51136420Ssklower 51244310Ssklower tpmeas(tpcb->tp_lref, 51344310Ssklower TPtime_open | (tpcb->tp_xtd_format << 4), 51436420Ssklower &time, lsufx, fsufx, tpcb->tp_fref); 51536420Ssklower ENDPERF 51636420Ssklower break; 51736420Ssklower 51836420Ssklower case PRU_ACCEPT: 51950435Ssklower (tpcb->tp_nlproto->nlp_getnetaddr)(tpcb->tp_npcb, nam, TP_FOREIGN); 52036420Ssklower IFDEBUG(D_REQUEST) 52138841Ssklower printf("ACCEPT PEERADDDR:"); 52238841Ssklower dump_buf(mtod(nam, char *), nam->m_len); 52336420Ssklower ENDDEBUG 52436420Ssklower IFPERF(tpcb) 52536420Ssklower u_int lsufx, fsufx; 52639196Ssklower lsufx = *(u_short *)(tpcb->tp_lsuffix); 52739196Ssklower fsufx = *(u_short *)(tpcb->tp_fsuffix); 52836420Ssklower 52944310Ssklower tpmeas(tpcb->tp_lref, TPtime_open, 53036420Ssklower &time, lsufx, fsufx, tpcb->tp_fref); 53136420Ssklower ENDPERF 53236420Ssklower break; 53336420Ssklower 53436420Ssklower case PRU_RCVD: 53538841Ssklower if (so->so_state & SS_ISCONFIRMING) { 53638841Ssklower if (tpcb->tp_state == TP_CONFIRMING) 53738841Ssklower error = tp_confirm(tpcb); 53838841Ssklower break; 53938841Ssklower } 54036420Ssklower IFTRACE(D_DATA) 54136420Ssklower tptraceTPCB(TPPTmisc, 54236420Ssklower "RCVD BF: lcredit sent_lcdt cc hiwat \n", 54336420Ssklower tpcb->tp_lcredit, tpcb->tp_sent_lcdt, 54436420Ssklower so->so_rcv.sb_cc, so->so_rcv.sb_hiwat); 54536420Ssklower LOCAL_CREDIT(tpcb); 54636420Ssklower tptraceTPCB(TPPTmisc, 54736420Ssklower "PRU_RCVD AF sbspace lcredit hiwat cc", 54836420Ssklower sbspace(&so->so_rcv), tpcb->tp_lcredit, 54936420Ssklower so->so_rcv.sb_cc, so->so_rcv.sb_hiwat); 55036420Ssklower ENDTRACE 55137469Ssklower IFDEBUG(D_REQUEST) 55237469Ssklower printf("RCVD: cc %d space %d hiwat %d\n", 55337469Ssklower so->so_rcv.sb_cc, sbspace(&so->so_rcv), 55437469Ssklower so->so_rcv.sb_hiwat); 55537469Ssklower ENDDEBUG 55637469Ssklower if (((int)nam) & MSG_OOB) 55737469Ssklower error = DoEvent(T_USR_Xrcvd); 55837469Ssklower else 55937469Ssklower error = DoEvent(T_USR_rcvd); 56036420Ssklower break; 56136420Ssklower 56236420Ssklower case PRU_RCVOOB: 56336420Ssklower if ((so->so_state & SS_ISCONNECTED) == 0) { 56436420Ssklower error = ENOTCONN; 56536420Ssklower break; 56636420Ssklower } 56744310Ssklower if (! tpcb->tp_xpd_service) { 56836420Ssklower error = EOPNOTSUPP; 56936420Ssklower break; 57036420Ssklower } 57136420Ssklower /* kludge - nam is really flags here */ 57236420Ssklower error = tp_rcvoob(tpcb, so, m, outflags, (int)nam); 57336420Ssklower break; 57436420Ssklower 57538841Ssklower case PRU_SEND: 57636420Ssklower case PRU_SENDOOB: 57741924Ssklower if (controlp) { 57841924Ssklower error = tp_snd_control(controlp, so, &m); 57941924Ssklower controlp = NULL; 58041924Ssklower if (error) 58141924Ssklower break; 58241924Ssklower } 58348736Ssklower if ((so->so_state & SS_ISCONFIRMING) && 58448736Ssklower (tpcb->tp_state == TP_CONFIRMING) && 58548736Ssklower (error = tp_confirm(tpcb))) 58648736Ssklower break; 58748736Ssklower if (req == PRU_SENDOOB) { 58848736Ssklower error = (tpcb->tp_xpd_service == 0) ? 58948736Ssklower EOPNOTSUPP : tp_sendoob(tpcb, so, m, outflags); 59038841Ssklower break; 59138841Ssklower } 59237469Ssklower if (m == 0) 59337469Ssklower break; 59448736Ssklower if (m->m_flags & M_EOR) { 59548736Ssklower eotsdu = 1; 59648736Ssklower m->m_flags &= ~M_EOR; 59748736Ssklower } 59848736Ssklower if (eotsdu == 0 && m->m_pkthdr.len == 0) 59936420Ssklower break; 60048736Ssklower if (tpcb->tp_state != TP_AKWAIT && tpcb->tp_state != TP_OPEN) { 60148736Ssklower error = ENOTCONN; 60248736Ssklower break; 60336420Ssklower } 60436420Ssklower /* 60536420Ssklower * The protocol machine copies mbuf chains, 60636420Ssklower * prepends headers, assigns seq numbers, and 60736420Ssklower * puts the packets on the device. 60836420Ssklower * When they are acked they are removed from the socket buf. 60936420Ssklower * 61036420Ssklower * sosend calls this up until sbspace goes negative. 61136420Ssklower * Sbspace may be made negative by appending this mbuf chain, 61236420Ssklower * possibly by a whole cluster. 61336420Ssklower */ 61436420Ssklower { 61537469Ssklower register struct mbuf *n = m; 61636420Ssklower register struct sockbuf *sb = &so->so_snd; 61737469Ssklower int maxsize = tpcb->tp_l_tpdusize 61837469Ssklower - tp_headersize(DT_TPDU_type, tpcb) 61937469Ssklower - (tpcb->tp_use_checksum?4:0) ; 62037469Ssklower int totlen = n->m_pkthdr.len; 62139937Ssklower int mbufcnt = 0; 62239196Ssklower struct mbuf *nn; 62336420Ssklower 62437469Ssklower /* 62537469Ssklower * Could have eotsdu and no data.(presently MUST have 62637469Ssklower * an mbuf though, even if its length == 0) 62737469Ssklower */ 62836420Ssklower IFPERF(tpcb) 62937469Ssklower PStat(tpcb, Nb_from_sess) += totlen; 63036420Ssklower tpmeas(tpcb->tp_lref, TPtime_from_session, 0, 0, 63137469Ssklower PStat(tpcb, Nb_from_sess), totlen); 63236420Ssklower ENDPERF 63336420Ssklower IFDEBUG(D_SYSCALL) 63436420Ssklower printf( 63536420Ssklower "PRU_SEND: eot %d before sbappend 0x%x len 0x%x to sb @ 0x%x\n", 63639937Ssklower eotsdu, m, totlen, sb); 63736420Ssklower dump_mbuf(sb->sb_mb, "so_snd.sb_mb"); 63836420Ssklower dump_mbuf(m, "m : to be added"); 63936420Ssklower ENDDEBUG 64037469Ssklower /* 64137469Ssklower * Pre-packetize the data in the sockbuf 64237469Ssklower * according to negotiated mtu. Do it here 64337469Ssklower * where we can safely wait for mbufs. 64439196Ssklower * 64539196Ssklower * This presumes knowledge of sockbuf conventions. 64636420Ssklower */ 64739196Ssklower if (n = sb->sb_mb) 64839196Ssklower while (n->m_act) 64939196Ssklower n = n->m_act; 65039647Ssklower if ((nn = n) && n->m_pkthdr.len < maxsize) { 65139937Ssklower u_int space = maxsize - n->m_pkthdr.len; 65239647Ssklower 65339647Ssklower do { 65439647Ssklower if (n->m_flags & M_EOR) 65539647Ssklower goto on1; 65639647Ssklower } while (n->m_next && (n = n->m_next)); 65739937Ssklower if (totlen <= space) { 65839937Ssklower TPNagle1++; 65939196Ssklower n->m_next = m; 66039937Ssklower nn->m_pkthdr.len += totlen; 66139937Ssklower while (n = n->m_next) 66239937Ssklower sballoc(sb, n); 66339196Ssklower if (eotsdu) 66439196Ssklower nn->m_flags |= M_EOR; 66539196Ssklower goto on2; 66639937Ssklower } else { 66739937Ssklower /* 66839937Ssklower * Can't sleep here, because when you wake up 66939937Ssklower * packet you want to attach to may be gone! 67039937Ssklower */ 67139937Ssklower if (TNew && (n->m_next = m_copym(m, 0, space, M_NOWAIT))) { 67239937Ssklower nn->m_pkthdr.len += space; 67339937Ssklower TPNagle2++; 67439937Ssklower while (n = n->m_next) 67539937Ssklower sballoc(sb, n); 67639937Ssklower m_adj(m, space); 67739937Ssklower } 67839196Ssklower } 67939196Ssklower } 68039937Ssklower on1: mbufcnt++; 68139196Ssklower for (n = m; n->m_pkthdr.len > maxsize;) { 68239937Ssklower nn = m_copym(n, 0, maxsize, M_WAIT); 68337469Ssklower sbappendrecord(sb, nn); 68437469Ssklower m_adj(n, maxsize); 68539937Ssklower mbufcnt++; 68637469Ssklower } 68739196Ssklower if (eotsdu) 68839196Ssklower n->m_flags |= M_EOR; 68937469Ssklower sbappendrecord(sb, n); 69039196Ssklower on2: 69139196Ssklower IFTRACE(D_DATA) 69239196Ssklower tptraceTPCB(TPPTmisc, 69339937Ssklower "SEND BF: maxsize totlen mbufcnt eotsdu", 69439937Ssklower maxsize, totlen, mbufcnt, eotsdu); 69539196Ssklower ENDTRACE 69636420Ssklower IFDEBUG(D_SYSCALL) 69739937Ssklower printf("PRU_SEND: eot %d after sbappend 0x%x mbufcnt 0x%x\n", 69839937Ssklower eotsdu, n, mbufcnt); 69936420Ssklower dump_mbuf(sb->sb_mb, "so_snd.sb_mb"); 70036420Ssklower ENDDEBUG 70148736Ssklower if (tpcb->tp_state == TP_OPEN) 70248736Ssklower error = DoEvent(T_DATA_req); 70336420Ssklower IFDEBUG(D_SYSCALL) 70436420Ssklower printf("PRU_SEND: after driver error 0x%x \n",error); 70537469Ssklower printf("so_snd 0x%x cc 0t%d mbcnt 0t%d\n", 70637469Ssklower sb, sb->sb_cc, sb->sb_mbcnt); 70737469Ssklower dump_mbuf(sb->sb_mb, "so_snd.sb_mb after driver"); 70836420Ssklower ENDDEBUG 70936420Ssklower } 71036420Ssklower break; 71136420Ssklower 71237469Ssklower case PRU_SOCKADDR: 71350435Ssklower (tpcb->tp_nlproto->nlp_getnetaddr)(tpcb->tp_npcb, nam, TP_LOCAL); 71436420Ssklower break; 71536420Ssklower 71636420Ssklower case PRU_PEERADDR: 71750435Ssklower (tpcb->tp_nlproto->nlp_getnetaddr)(tpcb->tp_npcb, nam, TP_FOREIGN); 71836420Ssklower break; 71936420Ssklower 72036420Ssklower case PRU_CONTROL: 72136420Ssklower error = EOPNOTSUPP; 72236420Ssklower break; 72336420Ssklower 72436420Ssklower case PRU_PROTOSEND: 72536420Ssklower case PRU_PROTORCV: 72636420Ssklower case PRU_SENSE: 72736420Ssklower case PRU_SLOWTIMO: 72836420Ssklower case PRU_FASTTIMO: 72936420Ssklower error = EOPNOTSUPP; 73036420Ssklower break; 73136420Ssklower 73236420Ssklower default: 73336420Ssklower #ifdef ARGO_DEBUG 73436420Ssklower printf("tp_usrreq UNKNOWN PRU %d\n", req); 73536420Ssklower #endif ARGO_DEBUG 73636420Ssklower error = EOPNOTSUPP; 73736420Ssklower } 73836420Ssklower 73936420Ssklower IFDEBUG(D_REQUEST) 74038841Ssklower printf("%s, so 0x%x, tpcb 0x%x, error %d, state %d\n", 74138841Ssklower "returning from tp_usrreq", so, tpcb, error, 74238841Ssklower tpcb ? 0 : tpcb->tp_state); 74336420Ssklower ENDDEBUG 74436420Ssklower IFTRACE(D_REQUEST) 74536420Ssklower tptraceTPCB(TPPTusrreq, "END req so m state [", req, so, m, 74636420Ssklower tpcb?0:tpcb->tp_state); 74736420Ssklower ENDTRACE 74841924Ssklower if (controlp) { 74941924Ssklower m_freem(controlp); 75041924Ssklower printf("control data unexpectedly retained in tp_usrreq()"); 75141924Ssklower } 75236420Ssklower splx(s); 75336420Ssklower return error; 75436420Ssklower } 75539196Ssklower tp_ltrace(so, uio) 75639196Ssklower struct socket *so; 75739196Ssklower struct uio *uio; 75839196Ssklower { 75939196Ssklower IFTRACE(D_DATA) 76039196Ssklower register struct tp_pcb *tpcb = sototpcb(so); 76139196Ssklower if (tpcb) { 76239196Ssklower tptraceTPCB(TPPTmisc, "sosend so resid iovcnt", so, 76339196Ssklower uio->uio_resid, uio->uio_iovcnt, 0); 76439196Ssklower } 76539196Ssklower ENDTRACE 76639196Ssklower } 76737469Ssklower 76838841Ssklower tp_confirm(tpcb) 76938841Ssklower register struct tp_pcb *tpcb; 77037469Ssklower { 77138841Ssklower struct tp_event E; 77238841Ssklower if (tpcb->tp_state == TP_CONFIRMING) 77338841Ssklower return DoEvent(T_ACPT_req); 77438841Ssklower printf("Tp confirm called when not confirming; tpcb 0x%x, state 0x%x\n", 77538841Ssklower tpcb, tpcb->tp_state); 77638841Ssklower return 0; 77737469Ssklower } 77837469Ssklower 77937469Ssklower /* 78037469Ssklower * Process control data sent with sendmsg() 78137469Ssklower */ 78241924Ssklower tp_snd_control(m, so, data) 78341924Ssklower struct mbuf *m; 78437469Ssklower struct socket *so; 78537469Ssklower register struct mbuf **data; 78637469Ssklower { 78742468Ssklower register struct cmsghdr *ch; 78837469Ssklower int error = 0; 78937469Ssklower 79041924Ssklower if (m && m->m_len) { 79142468Ssklower ch = mtod(m, struct cmsghdr *); 79241924Ssklower m->m_len -= sizeof (*ch); 79341924Ssklower m->m_data += sizeof (*ch); 79437469Ssklower error = tp_ctloutput(PRCO_SETOPT, 79537469Ssklower so, ch->cmsg_level, ch->cmsg_type, &m); 79637469Ssklower if (ch->cmsg_type == TPOPT_DISC_DATA) { 79737469Ssklower if (data && *data) { 79837469Ssklower m_freem(*data); 79937469Ssklower *data = 0; 80037469Ssklower } 80141924Ssklower error = tp_usrreq(so, PRU_DISCONNECT, (struct mbuf *)0, 80241924Ssklower (caddr_t)0, (struct mbuf *)0); 80337469Ssklower } 80437469Ssklower } 80541924Ssklower if (m) 80641924Ssklower m_freem(m); 80737469Ssklower return error; 80837469Ssklower } 809