149268Sbostic /*- 249268Sbostic * Copyright (c) 1991 The Regents of the University of California. 349268Sbostic * All rights reserved. 449268Sbostic * 549268Sbostic * %sccs.include.redist.c% 649268Sbostic * 7*50648Ssklower * @(#)tp_usrreq.c 7.20 (Berkeley) 07/29/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 7150500Ssklower 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; 385*50648Ssklower } else if ((error = tp_attach(so, (int)nam)) == 0) 386*50648Ssklower tpcb = sototpcb(so); 38736420Ssklower break; 38836420Ssklower 38936420Ssklower case PRU_ABORT: /* called from close() */ 39036420Ssklower /* called for each incoming connect queued on the 39136420Ssklower * parent (accepting) socket 39236420Ssklower */ 393*50648Ssklower if (tpcb->tp_state == TP_OPEN || tpcb->tp_state == TP_CONFIRMING) { 39436420Ssklower E.ATTR(T_DISC_req).e_reason = E_TP_NO_SESSION; 39536420Ssklower error = DoEvent(T_DISC_req); /* pretend it was a close() */ 39636420Ssklower break; 39736420Ssklower } /* else DROP THROUGH */ 39836420Ssklower 39936420Ssklower case PRU_DETACH: /* called from close() */ 40036420Ssklower /* called only after disconnect was called */ 40144424Ssklower if (tpcb->tp_state == TP_LISTENING) { 40244424Ssklower register struct tp_pcb **tt; 40344424Ssklower for (tt = &tp_listeners; *tt; tt = &((*tt)->tp_nextlisten)) 40444424Ssklower if (*tt == tpcb) 40544424Ssklower break; 40644424Ssklower if (*tt) 40744424Ssklower *tt = tpcb->tp_nextlisten; 40844424Ssklower else { 40944424Ssklower for (tt = &tp_intercepts; *tt; tt = &((*tt)->tp_nextlisten)) 41044424Ssklower if (*tt == tpcb) 41144424Ssklower break; 41244424Ssklower if (*tt) 41344424Ssklower *tt = tpcb->tp_nextlisten; 41444424Ssklower else 41544424Ssklower printf("tp_usrreq - detach: should panic\n"); 41644424Ssklower } 41744424Ssklower } 41844424Ssklower if (tpcb->tp_next) 41944424Ssklower remque(tpcb); 42036420Ssklower error = DoEvent(T_DETACH); 42137469Ssklower if (tpcb->tp_state == TP_CLOSED) { 42237469Ssklower free((caddr_t)tpcb, M_PCB); 42337469Ssklower tpcb = 0; 42437469Ssklower } 42536420Ssklower break; 42636420Ssklower 42736420Ssklower case PRU_SHUTDOWN: 42836420Ssklower /* recv end may have been released; local credit might be zero */ 42936420Ssklower case PRU_DISCONNECT: 43036420Ssklower E.ATTR(T_DISC_req).e_reason = E_TP_NORMAL_DISC; 43136420Ssklower error = DoEvent(T_DISC_req); 43236420Ssklower break; 43336420Ssklower 43436420Ssklower case PRU_BIND: 43550500Ssklower error = tp_pcbbind(tpcb, nam); 43636420Ssklower break; 43736420Ssklower 43836420Ssklower case PRU_LISTEN: 43950500Ssklower if (tpcb->tp_state != TP_CLOSED || tpcb->tp_lsuffixlen == 0 || 44050500Ssklower tpcb->tp_next == 0) 44150500Ssklower error = EINVAL; 44250500Ssklower else { 44350500Ssklower remque(tpcb); 44444424Ssklower tpcb->tp_nextlisten = tp_listeners; 44550500Ssklower tpcb->tp_next = tpcb->tp_prev = tp_listeners = tpcb; 44650500Ssklower error = DoEvent(T_LISTEN_req); 44744424Ssklower } 44836420Ssklower break; 44936420Ssklower 45036420Ssklower case PRU_CONNECT2: 45136420Ssklower error = EOPNOTSUPP; /* for unix domain sockets */ 45236420Ssklower break; 45336420Ssklower 45436420Ssklower case PRU_CONNECT: 45536420Ssklower IFTRACE(D_CONN) 45636420Ssklower tptraceTPCB(TPPTmisc, 45737469Ssklower "PRU_CONNECT: so 0x%x *SHORT_LSUFXP(tpcb) 0x%x lsuflen 0x%x, class 0x%x", 45836420Ssklower tpcb->tp_sock, *SHORT_LSUFXP(tpcb), tpcb->tp_lsuffixlen, 45936420Ssklower tpcb->tp_class); 46036420Ssklower ENDTRACE 46136420Ssklower IFDEBUG(D_CONN) 46236420Ssklower printf("PRU_CONNECT: so *SHORT_LSUFXP(tpcb) 0x%x lsuflen 0x%x, class 0x%x", 46336420Ssklower tpcb->tp_sock, *SHORT_LSUFXP(tpcb), tpcb->tp_lsuffixlen, 46436420Ssklower tpcb->tp_class); 46536420Ssklower ENDDEBUG 46644310Ssklower if (tpcb->tp_lsuffixlen == 0) { 467*50648Ssklower if (error = tp_pcbbind(tpcb, MNULL)) { 46836420Ssklower IFDEBUG(D_CONN) 46944310Ssklower printf("pcbbind returns error 0x%x\n", error); 47036420Ssklower ENDDEBUG 47136420Ssklower break; 47236420Ssklower } 47337469Ssklower } 47436420Ssklower IFDEBUG(D_CONN) 47536420Ssklower printf("isop 0x%x isop->isop_socket offset 12 :\n", tpcb->tp_npcb); 47644310Ssklower dump_buf(tpcb->tp_npcb, 16); 47736420Ssklower ENDDEBUG 47844310Ssklower if (error = tp_route_to(nam, tpcb, /* channel */0)) 47936420Ssklower break; 48036420Ssklower IFDEBUG(D_CONN) 48136420Ssklower printf( 48236420Ssklower "PRU_CONNECT after tpcb 0x%x so 0x%x npcb 0x%x flags 0x%x\n", 48336420Ssklower tpcb, so, tpcb->tp_npcb, tpcb->tp_flags); 48436420Ssklower printf("isop 0x%x isop->isop_socket offset 12 :\n", tpcb->tp_npcb); 48544310Ssklower dump_buf(tpcb->tp_npcb, 16); 48636420Ssklower ENDDEBUG 48744310Ssklower if (tpcb->tp_fsuffixlen == 0) { 48836420Ssklower /* didn't set peer extended suffix */ 48950435Ssklower (tpcb->tp_nlproto->nlp_getsufx)(tpcb->tp_npcb, &tpcb->tp_fsuffixlen, 49044310Ssklower tpcb->tp_fsuffix, TP_FOREIGN); 49136420Ssklower } 49250435Ssklower (void) (tpcb->tp_nlproto->nlp_mtu)(so, tpcb->tp_npcb, 49336420Ssklower &tpcb->tp_l_tpdusize, &tpcb->tp_tpdusize, 0); 49444310Ssklower if (tpcb->tp_state == TP_CLOSED) { 49536420Ssklower soisconnecting(so); 49636420Ssklower error = DoEvent(T_CONN_req); 49736420Ssklower } else { 49850435Ssklower (tpcb->tp_nlproto->nlp_pcbdisc)(tpcb->tp_npcb); 49936420Ssklower error = EISCONN; 50036420Ssklower } 50136420Ssklower IFPERF(tpcb) 50236420Ssklower u_int lsufx, fsufx; 50339196Ssklower lsufx = *(u_short *)(tpcb->tp_lsuffix); 50439196Ssklower fsufx = *(u_short *)(tpcb->tp_fsuffix); 50536420Ssklower 50644310Ssklower tpmeas(tpcb->tp_lref, 50744310Ssklower TPtime_open | (tpcb->tp_xtd_format << 4), 50836420Ssklower &time, lsufx, fsufx, tpcb->tp_fref); 50936420Ssklower ENDPERF 51036420Ssklower break; 51136420Ssklower 51236420Ssklower case PRU_ACCEPT: 51350435Ssklower (tpcb->tp_nlproto->nlp_getnetaddr)(tpcb->tp_npcb, nam, TP_FOREIGN); 51436420Ssklower IFDEBUG(D_REQUEST) 51538841Ssklower printf("ACCEPT PEERADDDR:"); 51638841Ssklower dump_buf(mtod(nam, char *), nam->m_len); 51736420Ssklower ENDDEBUG 51836420Ssklower IFPERF(tpcb) 51936420Ssklower u_int lsufx, fsufx; 52039196Ssklower lsufx = *(u_short *)(tpcb->tp_lsuffix); 52139196Ssklower fsufx = *(u_short *)(tpcb->tp_fsuffix); 52236420Ssklower 52344310Ssklower tpmeas(tpcb->tp_lref, TPtime_open, 52436420Ssklower &time, lsufx, fsufx, tpcb->tp_fref); 52536420Ssklower ENDPERF 52636420Ssklower break; 52736420Ssklower 52836420Ssklower case PRU_RCVD: 52938841Ssklower if (so->so_state & SS_ISCONFIRMING) { 53038841Ssklower if (tpcb->tp_state == TP_CONFIRMING) 53138841Ssklower error = tp_confirm(tpcb); 53238841Ssklower break; 53338841Ssklower } 53436420Ssklower IFTRACE(D_DATA) 53536420Ssklower tptraceTPCB(TPPTmisc, 53636420Ssklower "RCVD BF: lcredit sent_lcdt cc hiwat \n", 53736420Ssklower tpcb->tp_lcredit, tpcb->tp_sent_lcdt, 53836420Ssklower so->so_rcv.sb_cc, so->so_rcv.sb_hiwat); 53936420Ssklower LOCAL_CREDIT(tpcb); 54036420Ssklower tptraceTPCB(TPPTmisc, 54136420Ssklower "PRU_RCVD AF sbspace lcredit hiwat cc", 54236420Ssklower sbspace(&so->so_rcv), tpcb->tp_lcredit, 54336420Ssklower so->so_rcv.sb_cc, so->so_rcv.sb_hiwat); 54436420Ssklower ENDTRACE 54537469Ssklower IFDEBUG(D_REQUEST) 54637469Ssklower printf("RCVD: cc %d space %d hiwat %d\n", 54737469Ssklower so->so_rcv.sb_cc, sbspace(&so->so_rcv), 54837469Ssklower so->so_rcv.sb_hiwat); 54937469Ssklower ENDDEBUG 55037469Ssklower if (((int)nam) & MSG_OOB) 55137469Ssklower error = DoEvent(T_USR_Xrcvd); 55237469Ssklower else 55337469Ssklower error = DoEvent(T_USR_rcvd); 55436420Ssklower break; 55536420Ssklower 55636420Ssklower case PRU_RCVOOB: 55736420Ssklower if ((so->so_state & SS_ISCONNECTED) == 0) { 55836420Ssklower error = ENOTCONN; 55936420Ssklower break; 56036420Ssklower } 56144310Ssklower if (! tpcb->tp_xpd_service) { 56236420Ssklower error = EOPNOTSUPP; 56336420Ssklower break; 56436420Ssklower } 56536420Ssklower /* kludge - nam is really flags here */ 56636420Ssklower error = tp_rcvoob(tpcb, so, m, outflags, (int)nam); 56736420Ssklower break; 56836420Ssklower 56938841Ssklower case PRU_SEND: 57036420Ssklower case PRU_SENDOOB: 57141924Ssklower if (controlp) { 57241924Ssklower error = tp_snd_control(controlp, so, &m); 57341924Ssklower controlp = NULL; 57441924Ssklower if (error) 57541924Ssklower break; 57641924Ssklower } 57748736Ssklower if ((so->so_state & SS_ISCONFIRMING) && 57848736Ssklower (tpcb->tp_state == TP_CONFIRMING) && 57948736Ssklower (error = tp_confirm(tpcb))) 58048736Ssklower break; 58148736Ssklower if (req == PRU_SENDOOB) { 58248736Ssklower error = (tpcb->tp_xpd_service == 0) ? 58348736Ssklower EOPNOTSUPP : tp_sendoob(tpcb, so, m, outflags); 58438841Ssklower break; 58538841Ssklower } 58637469Ssklower if (m == 0) 58737469Ssklower break; 58848736Ssklower if (m->m_flags & M_EOR) { 58948736Ssklower eotsdu = 1; 59048736Ssklower m->m_flags &= ~M_EOR; 59148736Ssklower } 59248736Ssklower if (eotsdu == 0 && m->m_pkthdr.len == 0) 59336420Ssklower break; 59448736Ssklower if (tpcb->tp_state != TP_AKWAIT && tpcb->tp_state != TP_OPEN) { 59548736Ssklower error = ENOTCONN; 59648736Ssklower break; 59736420Ssklower } 59836420Ssklower /* 59936420Ssklower * The protocol machine copies mbuf chains, 60036420Ssklower * prepends headers, assigns seq numbers, and 60136420Ssklower * puts the packets on the device. 60236420Ssklower * When they are acked they are removed from the socket buf. 60336420Ssklower * 60436420Ssklower * sosend calls this up until sbspace goes negative. 60536420Ssklower * Sbspace may be made negative by appending this mbuf chain, 60636420Ssklower * possibly by a whole cluster. 60736420Ssklower */ 60836420Ssklower { 60937469Ssklower register struct mbuf *n = m; 61036420Ssklower register struct sockbuf *sb = &so->so_snd; 61137469Ssklower int maxsize = tpcb->tp_l_tpdusize 61237469Ssklower - tp_headersize(DT_TPDU_type, tpcb) 61337469Ssklower - (tpcb->tp_use_checksum?4:0) ; 61437469Ssklower int totlen = n->m_pkthdr.len; 61539937Ssklower int mbufcnt = 0; 61639196Ssklower struct mbuf *nn; 61736420Ssklower 61837469Ssklower /* 61937469Ssklower * Could have eotsdu and no data.(presently MUST have 62037469Ssklower * an mbuf though, even if its length == 0) 62137469Ssklower */ 62236420Ssklower IFPERF(tpcb) 62337469Ssklower PStat(tpcb, Nb_from_sess) += totlen; 62436420Ssklower tpmeas(tpcb->tp_lref, TPtime_from_session, 0, 0, 62537469Ssklower PStat(tpcb, Nb_from_sess), totlen); 62636420Ssklower ENDPERF 62736420Ssklower IFDEBUG(D_SYSCALL) 62836420Ssklower printf( 62936420Ssklower "PRU_SEND: eot %d before sbappend 0x%x len 0x%x to sb @ 0x%x\n", 63039937Ssklower eotsdu, m, totlen, sb); 63136420Ssklower dump_mbuf(sb->sb_mb, "so_snd.sb_mb"); 63236420Ssklower dump_mbuf(m, "m : to be added"); 63336420Ssklower ENDDEBUG 63437469Ssklower /* 63537469Ssklower * Pre-packetize the data in the sockbuf 63637469Ssklower * according to negotiated mtu. Do it here 63737469Ssklower * where we can safely wait for mbufs. 63839196Ssklower * 63939196Ssklower * This presumes knowledge of sockbuf conventions. 64036420Ssklower */ 64139196Ssklower if (n = sb->sb_mb) 64239196Ssklower while (n->m_act) 64339196Ssklower n = n->m_act; 64439647Ssklower if ((nn = n) && n->m_pkthdr.len < maxsize) { 64539937Ssklower u_int space = maxsize - n->m_pkthdr.len; 64639647Ssklower 64739647Ssklower do { 64839647Ssklower if (n->m_flags & M_EOR) 64939647Ssklower goto on1; 65039647Ssklower } while (n->m_next && (n = n->m_next)); 65139937Ssklower if (totlen <= space) { 65239937Ssklower TPNagle1++; 65339196Ssklower n->m_next = m; 65439937Ssklower nn->m_pkthdr.len += totlen; 65539937Ssklower while (n = n->m_next) 65639937Ssklower sballoc(sb, n); 65739196Ssklower if (eotsdu) 65839196Ssklower nn->m_flags |= M_EOR; 65939196Ssklower goto on2; 66039937Ssklower } else { 66139937Ssklower /* 66239937Ssklower * Can't sleep here, because when you wake up 66339937Ssklower * packet you want to attach to may be gone! 66439937Ssklower */ 66539937Ssklower if (TNew && (n->m_next = m_copym(m, 0, space, M_NOWAIT))) { 66639937Ssklower nn->m_pkthdr.len += space; 66739937Ssklower TPNagle2++; 66839937Ssklower while (n = n->m_next) 66939937Ssklower sballoc(sb, n); 67039937Ssklower m_adj(m, space); 67139937Ssklower } 67239196Ssklower } 67339196Ssklower } 67439937Ssklower on1: mbufcnt++; 67539196Ssklower for (n = m; n->m_pkthdr.len > maxsize;) { 67639937Ssklower nn = m_copym(n, 0, maxsize, M_WAIT); 67737469Ssklower sbappendrecord(sb, nn); 67837469Ssklower m_adj(n, maxsize); 67939937Ssklower mbufcnt++; 68037469Ssklower } 68139196Ssklower if (eotsdu) 68239196Ssklower n->m_flags |= M_EOR; 68337469Ssklower sbappendrecord(sb, n); 68439196Ssklower on2: 68539196Ssklower IFTRACE(D_DATA) 68639196Ssklower tptraceTPCB(TPPTmisc, 68739937Ssklower "SEND BF: maxsize totlen mbufcnt eotsdu", 68839937Ssklower maxsize, totlen, mbufcnt, eotsdu); 68939196Ssklower ENDTRACE 69036420Ssklower IFDEBUG(D_SYSCALL) 69139937Ssklower printf("PRU_SEND: eot %d after sbappend 0x%x mbufcnt 0x%x\n", 69239937Ssklower eotsdu, n, mbufcnt); 69336420Ssklower dump_mbuf(sb->sb_mb, "so_snd.sb_mb"); 69436420Ssklower ENDDEBUG 69548736Ssklower if (tpcb->tp_state == TP_OPEN) 69648736Ssklower error = DoEvent(T_DATA_req); 69736420Ssklower IFDEBUG(D_SYSCALL) 69836420Ssklower printf("PRU_SEND: after driver error 0x%x \n",error); 69937469Ssklower printf("so_snd 0x%x cc 0t%d mbcnt 0t%d\n", 70037469Ssklower sb, sb->sb_cc, sb->sb_mbcnt); 70137469Ssklower dump_mbuf(sb->sb_mb, "so_snd.sb_mb after driver"); 70236420Ssklower ENDDEBUG 70336420Ssklower } 70436420Ssklower break; 70536420Ssklower 70637469Ssklower case PRU_SOCKADDR: 70750435Ssklower (tpcb->tp_nlproto->nlp_getnetaddr)(tpcb->tp_npcb, nam, TP_LOCAL); 70836420Ssklower break; 70936420Ssklower 71036420Ssklower case PRU_PEERADDR: 71150435Ssklower (tpcb->tp_nlproto->nlp_getnetaddr)(tpcb->tp_npcb, nam, TP_FOREIGN); 71236420Ssklower break; 71336420Ssklower 71436420Ssklower case PRU_CONTROL: 71536420Ssklower error = EOPNOTSUPP; 71636420Ssklower break; 71736420Ssklower 71836420Ssklower case PRU_PROTOSEND: 71936420Ssklower case PRU_PROTORCV: 72036420Ssklower case PRU_SENSE: 72136420Ssklower case PRU_SLOWTIMO: 72236420Ssklower case PRU_FASTTIMO: 72336420Ssklower error = EOPNOTSUPP; 72436420Ssklower break; 72536420Ssklower 72636420Ssklower default: 72736420Ssklower #ifdef ARGO_DEBUG 72836420Ssklower printf("tp_usrreq UNKNOWN PRU %d\n", req); 72936420Ssklower #endif ARGO_DEBUG 73036420Ssklower error = EOPNOTSUPP; 73136420Ssklower } 73236420Ssklower 73336420Ssklower IFDEBUG(D_REQUEST) 73438841Ssklower printf("%s, so 0x%x, tpcb 0x%x, error %d, state %d\n", 73538841Ssklower "returning from tp_usrreq", so, tpcb, error, 73638841Ssklower tpcb ? 0 : tpcb->tp_state); 73736420Ssklower ENDDEBUG 73836420Ssklower IFTRACE(D_REQUEST) 73936420Ssklower tptraceTPCB(TPPTusrreq, "END req so m state [", req, so, m, 74036420Ssklower tpcb?0:tpcb->tp_state); 74136420Ssklower ENDTRACE 74241924Ssklower if (controlp) { 74341924Ssklower m_freem(controlp); 74441924Ssklower printf("control data unexpectedly retained in tp_usrreq()"); 74541924Ssklower } 74636420Ssklower splx(s); 74736420Ssklower return error; 74836420Ssklower } 74939196Ssklower tp_ltrace(so, uio) 75039196Ssklower struct socket *so; 75139196Ssklower struct uio *uio; 75239196Ssklower { 75339196Ssklower IFTRACE(D_DATA) 75439196Ssklower register struct tp_pcb *tpcb = sototpcb(so); 75539196Ssklower if (tpcb) { 75639196Ssklower tptraceTPCB(TPPTmisc, "sosend so resid iovcnt", so, 75739196Ssklower uio->uio_resid, uio->uio_iovcnt, 0); 75839196Ssklower } 75939196Ssklower ENDTRACE 76039196Ssklower } 76137469Ssklower 76238841Ssklower tp_confirm(tpcb) 76338841Ssklower register struct tp_pcb *tpcb; 76437469Ssklower { 76538841Ssklower struct tp_event E; 76638841Ssklower if (tpcb->tp_state == TP_CONFIRMING) 76738841Ssklower return DoEvent(T_ACPT_req); 76838841Ssklower printf("Tp confirm called when not confirming; tpcb 0x%x, state 0x%x\n", 76938841Ssklower tpcb, tpcb->tp_state); 77038841Ssklower return 0; 77137469Ssklower } 77237469Ssklower 77337469Ssklower /* 77437469Ssklower * Process control data sent with sendmsg() 77537469Ssklower */ 77641924Ssklower tp_snd_control(m, so, data) 77741924Ssklower struct mbuf *m; 77837469Ssklower struct socket *so; 77937469Ssklower register struct mbuf **data; 78037469Ssklower { 78142468Ssklower register struct cmsghdr *ch; 78237469Ssklower int error = 0; 78337469Ssklower 78441924Ssklower if (m && m->m_len) { 78542468Ssklower ch = mtod(m, struct cmsghdr *); 78641924Ssklower m->m_len -= sizeof (*ch); 78741924Ssklower m->m_data += sizeof (*ch); 78837469Ssklower error = tp_ctloutput(PRCO_SETOPT, 78937469Ssklower so, ch->cmsg_level, ch->cmsg_type, &m); 79037469Ssklower if (ch->cmsg_type == TPOPT_DISC_DATA) { 79137469Ssklower if (data && *data) { 79237469Ssklower m_freem(*data); 79337469Ssklower *data = 0; 79437469Ssklower } 79541924Ssklower error = tp_usrreq(so, PRU_DISCONNECT, (struct mbuf *)0, 79641924Ssklower (caddr_t)0, (struct mbuf *)0); 79737469Ssklower } 79837469Ssklower } 79941924Ssklower if (m) 80041924Ssklower m_freem(m); 80137469Ssklower return error; 80237469Ssklower } 803