Use MPIPE instead of misusing m_getclr() (i.e. m_get) for NETNS's
[dragonfly.git] / sys / netproto / ns / spp_usrreq.c
1 /*
2  * Copyright (c) 1984, 1985, 1986, 1987, 1993
3  *      The Regents of the University of California.  All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  * 3. All advertising materials mentioning features or use of this software
14  *    must display the following acknowledgement:
15  *      This product includes software developed by the University of
16  *      California, Berkeley and its contributors.
17  * 4. Neither the name of the University nor the names of its contributors
18  *    may be used to endorse or promote products derived from this software
19  *    without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
22  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
24  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
25  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
26  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
27  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
28  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31  * SUCH DAMAGE.
32  *
33  *      @(#)spp_usrreq.c        8.1 (Berkeley) 6/10/93
34  * $FreeBSD: src/sys/netns/spp_usrreq.c,v 1.11 1999/08/28 00:49:53 peter Exp $
35  * $DragonFly: src/sys/netproto/ns/spp_usrreq.c,v 1.10 2004/06/04 01:46:49 dillon Exp $
36  */
37
38 #include <sys/param.h>
39 #include <sys/systm.h>
40 #include <sys/malloc.h>
41 #include <sys/mbuf.h>
42 #include <sys/protosw.h>
43 #include <sys/socket.h>
44 #include <sys/socketvar.h>
45 #include <sys/errno.h>
46
47 #include <net/if.h>
48 #include <net/route.h>
49 #include <netinet/tcp_fsm.h>
50
51 #include "ns.h"
52 #include "ns_pcb.h"
53 #include "idp.h"
54 #include "idp_var.h"
55 #include "ns_error.h"
56 #include "sp.h"
57 #include "spidp.h"
58 #include "spp_timer.h"
59 #include "spp_var.h"
60 #include "spp_debug.h"
61
62 extern u_char nsctlerrmap[];            /* from ns_input.c */
63 extern int idpcksum;                    /* from ns_input.c */
64
65 struct spp_istat spp_istat;
66 u_short spp_iss;
67 int     spp_backoff[SPP_MAXRXTSHIFT+1] =
68     { 1, 2, 4, 8, 16, 32, 64, 64, 64, 64, 64, 64, 64 };
69
70 /*
71  * SP protocol implementation.
72  */
73 void
74 spp_init(void)
75 {
76
77         spp_iss = 1; /* WRONG !! should fish it out of TODR */
78 }
79 struct spidp spp_savesi;
80 int traceallspps = 0;
81 extern int sppconsdebug;
82 int spp_hardnosed;
83 int spp_use_delack = 0;
84 u_short spp_newchecks[50];
85
86 /*ARGSUSED*/
87 void
88 spp_input(struct mbuf *m, struct nspcb *nsp)
89 {
90         struct sppcb *cb;
91         struct spidp *si = mtod(m, struct spidp *);
92         struct socket *so;
93         short ostate = 0;
94         int dropsocket = 0;
95
96
97         sppstat.spps_rcvtotal++;
98         if (nsp == 0) {
99                 panic("No nspcb in spp_input");
100                 return;
101         }
102
103         cb = nstosppcb(nsp);
104         if (cb == 0) goto bad;
105
106         if (m->m_len < sizeof(*si)) {
107                 if ((m = m_pullup(m, sizeof(*si))) == 0) {
108                         sppstat.spps_rcvshort++;
109                         return;
110                 }
111                 si = mtod(m, struct spidp *);
112         }
113         si->si_seq = ntohs(si->si_seq);
114         si->si_ack = ntohs(si->si_ack);
115         si->si_alo = ntohs(si->si_alo);
116
117         so = nsp->nsp_socket;
118         if (so->so_options & SO_DEBUG || traceallspps) {
119                 ostate = cb->s_state;
120                 spp_savesi = *si;
121         }
122         if (so->so_options & SO_ACCEPTCONN) {
123                 struct sppcb *ocb = cb;
124
125                 so = sonewconn(so, 0);
126                 if (so == 0) {
127                         goto drop;
128                 }
129                 /*
130                  * This is ugly, but ....
131                  *
132                  * Mark socket as temporary until we're
133                  * committed to keeping it.  The code at
134                  * ``drop'' and ``dropwithreset'' check the
135                  * flag dropsocket to see if the temporary
136                  * socket created here should be discarded.
137                  * We mark the socket as discardable until
138                  * we're committed to it below in TCPS_LISTEN.
139                  */
140                 dropsocket++;
141                 nsp = (struct nspcb *)so->so_pcb;
142                 nsp->nsp_laddr = si->si_dna;
143                 cb = nstosppcb(nsp);
144                 cb->s_mtu = ocb->s_mtu;         /* preserve sockopts */
145                 cb->s_flags = ocb->s_flags;     /* preserve sockopts */
146                 cb->s_flags2 = ocb->s_flags2;   /* preserve sockopts */
147                 cb->s_state = TCPS_LISTEN;
148         }
149
150         /*
151          * Packet received on connection.
152          * reset idle time and keep-alive timer;
153          */
154         cb->s_idle = 0;
155         cb->s_timer[SPPT_KEEP] = SPPTV_KEEP;
156
157         switch (cb->s_state) {
158
159         case TCPS_LISTEN:{
160                 struct mbuf *am;
161                 struct sockaddr_ns *sns;
162                 struct ns_addr laddr;
163
164                 /*
165                  * If somebody here was carying on a conversation
166                  * and went away, and his pen pal thinks he can
167                  * still talk, we get the misdirected packet.
168                  */
169                 if (spp_hardnosed && (si->si_did != 0 || si->si_seq != 0)) {
170                         spp_istat.gonawy++;
171                         goto dropwithreset;
172                 }
173                 am = m_get(MB_DONTWAIT, MT_SONAME);
174                 if (am == NULL)
175                         goto drop;
176                 am->m_len = sizeof (struct sockaddr_ns);
177                 sns = mtod(am, struct sockaddr_ns *);
178                 sns->sns_len = sizeof(*sns);
179                 sns->sns_family = AF_NS;
180                 sns->sns_addr = si->si_sna;
181                 laddr = nsp->nsp_laddr;
182                 if (ns_nullhost(laddr))
183                         nsp->nsp_laddr = si->si_dna;
184                 if (ns_pcbconnect(nsp, am)) {
185                         nsp->nsp_laddr = laddr;
186                         (void) m_free(am);
187                         spp_istat.noconn++;
188                         goto drop;
189                 }
190                 (void) m_free(am);
191                 spp_template(cb);
192                 dropsocket = 0;         /* committed to socket */
193                 cb->s_did = si->si_sid;
194                 cb->s_rack = si->si_ack;
195                 cb->s_ralo = si->si_alo;
196 #define THREEWAYSHAKE
197 #ifdef THREEWAYSHAKE
198                 cb->s_state = TCPS_SYN_RECEIVED;
199                 cb->s_force = 1 + SPPT_KEEP;
200                 sppstat.spps_accepts++;
201                 cb->s_timer[SPPT_KEEP] = SPPTV_KEEP;
202                 }
203                 break;
204         /*
205          * This state means that we have heard a response
206          * to our acceptance of their connection
207          * It is probably logically unnecessary in this
208          * implementation.
209          */
210          case TCPS_SYN_RECEIVED: {
211                 if (si->si_did!=cb->s_sid) {
212                         spp_istat.wrncon++;
213                         goto drop;
214                 }
215 #endif
216                 nsp->nsp_fport =  si->si_sport;
217                 cb->s_timer[SPPT_REXMT] = 0;
218                 cb->s_timer[SPPT_KEEP] = SPPTV_KEEP;
219                 soisconnected(so);
220                 cb->s_state = TCPS_ESTABLISHED;
221                 sppstat.spps_accepts++;
222                 }
223                 break;
224
225         /*
226          * This state means that we have gotten a response
227          * to our attempt to establish a connection.
228          * We fill in the data from the other side,
229          * telling us which port to respond to, instead of the well-
230          * known one we might have sent to in the first place.
231          * We also require that this is a response to our
232          * connection id.
233          */
234         case TCPS_SYN_SENT:
235                 if (si->si_did!=cb->s_sid) {
236                         spp_istat.notme++;
237                         goto drop;
238                 }
239                 sppstat.spps_connects++;
240                 cb->s_did = si->si_sid;
241                 cb->s_rack = si->si_ack;
242                 cb->s_ralo = si->si_alo;
243                 cb->s_dport = nsp->nsp_fport =  si->si_sport;
244                 cb->s_timer[SPPT_REXMT] = 0;
245                 cb->s_flags |= SF_ACKNOW;
246                 soisconnected(so);
247                 cb->s_state = TCPS_ESTABLISHED;
248                 /* Use roundtrip time of connection request for initial rtt */
249                 if (cb->s_rtt) {
250                         cb->s_srtt = cb->s_rtt << 3;
251                         cb->s_rttvar = cb->s_rtt << 1;
252                         SPPT_RANGESET(cb->s_rxtcur,
253                             ((cb->s_srtt >> 2) + cb->s_rttvar) >> 1,
254                             SPPTV_MIN, SPPTV_REXMTMAX);
255                             cb->s_rtt = 0;
256                 }
257         }
258         if (so->so_options & SO_DEBUG || traceallspps)
259                 spp_trace(SA_INPUT, (u_char)ostate, cb, &spp_savesi, 0);
260
261         m->m_len -= sizeof (struct idp);
262         m->m_pkthdr.len -= sizeof (struct idp);
263         m->m_data += sizeof (struct idp);
264
265         if (spp_reass(cb, si)) {
266                 (void) m_freem(m);
267         }
268         if (cb->s_force || (cb->s_flags & (SF_ACKNOW|SF_WIN|SF_RXT)))
269                 (void) spp_output(cb, (struct mbuf *)0);
270         cb->s_flags &= ~(SF_WIN|SF_RXT);
271         return;
272
273 dropwithreset:
274         if (dropsocket)
275                 (void) soabort(so);
276         si->si_seq = ntohs(si->si_seq);
277         si->si_ack = ntohs(si->si_ack);
278         si->si_alo = ntohs(si->si_alo);
279         ns_error(dtom(si), NS_ERR_NOSOCK, 0);
280         if (cb->s_nspcb->nsp_socket->so_options & SO_DEBUG || traceallspps)
281                 spp_trace(SA_DROP, (u_char)ostate, cb, &spp_savesi, 0);
282         return;
283
284 drop:
285 bad:
286         if (cb == 0 || cb->s_nspcb->nsp_socket->so_options & SO_DEBUG ||
287             traceallspps)
288                 spp_trace(SA_DROP, (u_char)ostate, cb, &spp_savesi, 0);
289         m_freem(m);
290 }
291
292 int spprexmtthresh = 3;
293
294 /*
295  * This is structurally similar to the tcp reassembly routine
296  * but its function is somewhat different:  It merely queues
297  * packets up, and suppresses duplicates.
298  */
299 int
300 spp_reass(struct sppcb *cb, struct spidp *si)
301 {
302         struct spidp_q *q;
303         struct mbuf *m;
304         struct socket *so = cb->s_nspcb->nsp_socket;
305         char packetp = cb->s_flags & SF_HI;
306         int incr;
307         char wakeup = 0;
308
309         if (si == SI(0))
310                 goto present;
311         /*
312          * Update our news from them.
313          */
314         if (si->si_cc & SP_SA)
315                 cb->s_flags |= (spp_use_delack ? SF_DELACK : SF_ACKNOW);
316         if (SSEQ_GT(si->si_alo, cb->s_ralo))
317                 cb->s_flags |= SF_WIN;
318         if (SSEQ_LEQ(si->si_ack, cb->s_rack)) {
319                 if ((si->si_cc & SP_SP) && cb->s_rack != (cb->s_smax + 1)) {
320                         sppstat.spps_rcvdupack++;
321                         /*
322                          * If this is a completely duplicate ack
323                          * and other conditions hold, we assume
324                          * a packet has been dropped and retransmit
325                          * it exactly as in tcp_input().
326                          */
327                         if (si->si_ack != cb->s_rack ||
328                             si->si_alo != cb->s_ralo)
329                                 cb->s_dupacks = 0;
330                         else if (++cb->s_dupacks == spprexmtthresh) {
331                                 u_short onxt = cb->s_snxt;
332                                 int cwnd = cb->s_cwnd;
333
334                                 cb->s_snxt = si->si_ack;
335                                 cb->s_cwnd = CUNIT;
336                                 cb->s_force = 1 + SPPT_REXMT;
337                                 (void) spp_output(cb, (struct mbuf *)0);
338                                 cb->s_timer[SPPT_REXMT] = cb->s_rxtcur;
339                                 cb->s_rtt = 0;
340                                 if (cwnd >= 4 * CUNIT)
341                                         cb->s_cwnd = cwnd / 2;
342                                 if (SSEQ_GT(onxt, cb->s_snxt))
343                                         cb->s_snxt = onxt;
344                                 return (1);
345                         }
346                 } else
347                         cb->s_dupacks = 0;
348                 goto update_window;
349         }
350         cb->s_dupacks = 0;
351         /*
352          * If our correspondent acknowledges data we haven't sent
353          * TCP would drop the packet after acking.  We'll be a little
354          * more permissive
355          */
356         if (SSEQ_GT(si->si_ack, (cb->s_smax + 1))) {
357                 sppstat.spps_rcvacktoomuch++;
358                 si->si_ack = cb->s_smax + 1;
359         }
360         sppstat.spps_rcvackpack++;
361         /*
362          * If transmit timer is running and timed sequence
363          * number was acked, update smoothed round trip time.
364          * See discussion of algorithm in tcp_input.c
365          */
366         if (cb->s_rtt && SSEQ_GT(si->si_ack, cb->s_rtseq)) {
367                 sppstat.spps_rttupdated++;
368                 if (cb->s_srtt != 0) {
369                         short delta;
370                         delta = cb->s_rtt - (cb->s_srtt >> 3);
371                         if ((cb->s_srtt += delta) <= 0)
372                                 cb->s_srtt = 1;
373                         if (delta < 0)
374                                 delta = -delta;
375                         delta -= (cb->s_rttvar >> 2);
376                         if ((cb->s_rttvar += delta) <= 0)
377                                 cb->s_rttvar = 1;
378                 } else {
379                         /*
380                          * No rtt measurement yet
381                          */
382                         cb->s_srtt = cb->s_rtt << 3;
383                         cb->s_rttvar = cb->s_rtt << 1;
384                 }
385                 cb->s_rtt = 0;
386                 cb->s_rxtshift = 0;
387                 SPPT_RANGESET(cb->s_rxtcur,
388                         ((cb->s_srtt >> 2) + cb->s_rttvar) >> 1,
389                         SPPTV_MIN, SPPTV_REXMTMAX);
390         }
391         /*
392          * If all outstanding data is acked, stop retransmit
393          * timer and remember to restart (more output or persist).
394          * If there is more data to be acked, restart retransmit
395          * timer, using current (possibly backed-off) value;
396          */
397         if (si->si_ack == cb->s_smax + 1) {
398                 cb->s_timer[SPPT_REXMT] = 0;
399                 cb->s_flags |= SF_RXT;
400         } else if (cb->s_timer[SPPT_PERSIST] == 0)
401                 cb->s_timer[SPPT_REXMT] = cb->s_rxtcur;
402         /*
403          * When new data is acked, open the congestion window.
404          * If the window gives us less than ssthresh packets
405          * in flight, open exponentially (maxseg at a time).
406          * Otherwise open linearly (maxseg^2 / cwnd at a time).
407          */
408         incr = CUNIT;
409         if (cb->s_cwnd > cb->s_ssthresh)
410                 incr = max(incr * incr / cb->s_cwnd, 1);
411         cb->s_cwnd = min(cb->s_cwnd + incr, cb->s_cwmx);
412         /*
413          * Trim Acked data from output queue.
414          */
415         while ((m = so->so_snd.sb_mb) != NULL) {
416                 if (SSEQ_LT((mtod(m, struct spidp *))->si_seq, si->si_ack))
417                         sbdroprecord(&so->so_snd);
418                 else
419                         break;
420         }
421         sowwakeup(so);
422         cb->s_rack = si->si_ack;
423 update_window:
424         if (SSEQ_LT(cb->s_snxt, cb->s_rack))
425                 cb->s_snxt = cb->s_rack;
426         if (SSEQ_LT(cb->s_swl1, si->si_seq) || (cb->s_swl1 == si->si_seq &&
427             (SSEQ_LT(cb->s_swl2, si->si_ack) ||
428                 (cb->s_swl2 == si->si_ack && SSEQ_LT(cb->s_ralo, si->si_alo))))) {
429                 /* keep track of pure window updates */
430                 if ((si->si_cc & SP_SP) && cb->s_swl2 == si->si_ack
431                     && SSEQ_LT(cb->s_ralo, si->si_alo)) {
432                         sppstat.spps_rcvwinupd++;
433                         sppstat.spps_rcvdupack--;
434                 }
435                 cb->s_ralo = si->si_alo;
436                 cb->s_swl1 = si->si_seq;
437                 cb->s_swl2 = si->si_ack;
438                 cb->s_swnd = (1 + si->si_alo - si->si_ack);
439                 if (cb->s_swnd > cb->s_smxw)
440                         cb->s_smxw = cb->s_swnd;
441                 cb->s_flags |= SF_WIN;
442         }
443         /*
444          * If this packet number is higher than that which
445          * we have allocated refuse it, unless urgent
446          */
447         if (SSEQ_GT(si->si_seq, cb->s_alo)) {
448                 if (si->si_cc & SP_SP) {
449                         sppstat.spps_rcvwinprobe++;
450                         return (1);
451                 } else
452                         sppstat.spps_rcvpackafterwin++;
453                 if (si->si_cc & SP_OB) {
454                         if (SSEQ_GT(si->si_seq, cb->s_alo + 60)) {
455                                 ns_error(dtom(si), NS_ERR_FULLUP, 0);
456                                 return (0);
457                         } /* else queue this packet; */
458                 } else {
459                         /*register struct socket *so = cb->s_nspcb->nsp_socket;
460                         if (so->so_state && SS_NOFDREF) {
461                                 ns_error(dtom(si), NS_ERR_NOSOCK, 0);
462                                 (void)spp_close(cb);
463                         } else
464                                        would crash system*/
465                         spp_istat.notyet++;
466                         ns_error(dtom(si), NS_ERR_FULLUP, 0);
467                         return (0);
468                 }
469         }
470         /*
471          * If this is a system packet, we don't need to
472          * queue it up, and won't update acknowledge #
473          */
474         if (si->si_cc & SP_SP) {
475                 return (1);
476         }
477         /*
478          * We have already seen this packet, so drop.
479          */
480         if (SSEQ_LT(si->si_seq, cb->s_ack)) {
481                 spp_istat.bdreas++;
482                 sppstat.spps_rcvduppack++;
483                 if (si->si_seq == cb->s_ack - 1)
484                         spp_istat.lstdup++;
485                 return (1);
486         }
487         /*
488          * Loop through all packets queued up to insert in
489          * appropriate sequence.
490          */
491         for (q = cb->s_q.si_next; q!=&cb->s_q; q = q->si_next) {
492                 if (si->si_seq == SI(q)->si_seq) {
493                         sppstat.spps_rcvduppack++;
494                         return (1);
495                 }
496                 if (SSEQ_LT(si->si_seq, SI(q)->si_seq)) {
497                         sppstat.spps_rcvoopack++;
498                         break;
499                 }
500         }
501         insque(si, q->si_prev);
502         /*
503          * If this packet is urgent, inform process
504          */
505         if (si->si_cc & SP_OB) {
506                 cb->s_iobc = ((char *)si)[1 + sizeof(*si)];
507                 sohasoutofband(so);
508                 cb->s_oobflags |= SF_IOOB;
509         }
510 present:
511 #define SPINC sizeof(struct sphdr)
512         /*
513          * Loop through all packets queued up to update acknowledge
514          * number, and present all acknowledged data to user;
515          * If in packet interface mode, show packet headers.
516          */
517         for (q = cb->s_q.si_next; q!=&cb->s_q; q = q->si_next) {
518                   if (SI(q)->si_seq == cb->s_ack) {
519                         cb->s_ack++;
520                         m = dtom(q);
521                         if (SI(q)->si_cc & SP_OB) {
522                                 cb->s_oobflags &= ~SF_IOOB;
523                                 if (so->so_rcv.sb_cc)
524                                         so->so_oobmark = so->so_rcv.sb_cc;
525                                 else
526                                         so->so_state |= SS_RCVATMARK;
527                         }
528                         q = q->si_prev;
529                         remque(q->si_next);
530                         wakeup = 1;
531                         sppstat.spps_rcvpack++;
532 #ifdef SF_NEWCALL
533                         if (cb->s_flags2 & SF_NEWCALL) {
534                                 struct sphdr *sp = mtod(m, struct sphdr *);
535                                 u_char dt = sp->sp_dt;
536                                 spp_newchecks[4]++;
537                                 if (dt != cb->s_rhdr.sp_dt) {
538                                         struct mbuf *mm =
539                                            m_getclr(MB_DONTWAIT, MT_CONTROL);
540                                         spp_newchecks[0]++;
541                                         if (mm != NULL) {
542                                                 u_short *s =
543                                                         mtod(mm, u_short *);
544                                                 cb->s_rhdr.sp_dt = dt;
545                                                 mm->m_len = 5; /*XXX*/
546                                                 s[0] = 5;
547                                                 s[1] = 1;
548                                                 *(u_char *)(&s[2]) = dt;
549                                                 sbappend(&so->so_rcv, mm);
550                                         }
551                                 }
552                                 if (sp->sp_cc & SP_OB) {
553                                         MCHTYPE(m, MT_OOBDATA);
554                                         spp_newchecks[1]++;
555                                         so->so_oobmark = 0;
556                                         so->so_state &= ~SS_RCVATMARK;
557                                 }
558                                 if (packetp == 0) {
559                                         m->m_data += SPINC;
560                                         m->m_len -= SPINC;
561                                         m->m_pkthdr.len -= SPINC;
562                                 }
563                                 if ((sp->sp_cc & SP_EM) || packetp) {
564                                         sbappendrecord(&so->so_rcv, m);
565                                         spp_newchecks[9]++;
566                                 } else
567                                         sbappend(&so->so_rcv, m);
568                         } else
569 #endif
570                         if (packetp) {
571                                 sbappendrecord(&so->so_rcv, m);
572                         } else {
573                                 cb->s_rhdr = *mtod(m, struct sphdr *);
574                                 m->m_data += SPINC;
575                                 m->m_len -= SPINC;
576                                 m->m_pkthdr.len -= SPINC;
577                                 sbappend(&so->so_rcv, m);
578                         }
579                   } else
580                         break;
581         }
582         if (wakeup) sorwakeup(so);
583         return (0);
584 }
585
586 void
587 spp_ctlinput(int cmd, caddr_t arg)
588 {
589         struct ns_addr *na;
590         struct ns_errp *errp = 0;
591         struct nspcb *nsp;
592         struct sockaddr_ns *sns;
593         int type;
594
595         if (cmd < 0 || cmd > PRC_NCMDS)
596                 return;
597         type = NS_ERR_UNREACH_HOST;
598
599         switch (cmd) {
600
601         case PRC_ROUTEDEAD:
602                 return;
603
604         case PRC_IFDOWN:
605         case PRC_HOSTDEAD:
606         case PRC_HOSTUNREACH:
607                 sns = (struct sockaddr_ns *)arg;
608                 if (sns->sns_family != AF_NS)
609                         return;
610                 na = &sns->sns_addr;
611                 break;
612
613         default:
614                 errp = (struct ns_errp *)arg;
615                 na = &errp->ns_err_idp.idp_dna;
616                 type = errp->ns_err_num;
617                 type = ntohs((u_short)type);
618         }
619         switch (type) {
620
621         case NS_ERR_UNREACH_HOST:
622                 ns_pcbnotify(na, (int)nsctlerrmap[cmd], spp_abort, (long) 0);
623                 break;
624
625         case NS_ERR_TOO_BIG:
626         case NS_ERR_NOSOCK:
627                 nsp = ns_pcblookup(na, errp->ns_err_idp.idp_sna.x_port,
628                         NS_WILDCARD);
629                 if (nsp) {
630                         if(nsp->nsp_pcb)
631                                 (void) spp_drop((struct sppcb *)nsp->nsp_pcb,
632                                                 (int)nsctlerrmap[cmd]);
633                         else
634                                 (void) idp_drop(nsp, (int)nsctlerrmap[cmd]);
635                 }
636                 break;
637
638         case NS_ERR_FULLUP:
639                 ns_pcbnotify(na, 0, spp_quench, (long) 0);
640         }
641 }
642 /*
643  * When a source quench is received, close congestion window
644  * to one packet.  We will gradually open it again as we proceed.
645  */
646 void
647 spp_quench(struct nspcb *nsp)
648 {
649         struct sppcb *cb = nstosppcb(nsp);
650
651         if (cb)
652                 cb->s_cwnd = CUNIT;
653 }
654
655 #ifdef notdef
656 int
657 spp_fixmtu(struct nspcb *nsp)
658 {
659         struct sppcb *cb = (struct sppcb *)(nsp->nsp_pcb);
660         struct mbuf *m;
661         struct spidp *si;
662         struct ns_errp *ep;
663         struct sockbuf *sb;
664         int badseq, len;
665         struct mbuf *firstbad, *m0;
666
667         if (cb) {
668                 /*
669                  * The notification that we have sent
670                  * too much is bad news -- we will
671                  * have to go through queued up so far
672                  * splitting ones which are too big and
673                  * reassigning sequence numbers and checksums.
674                  * we should then retransmit all packets from
675                  * one above the offending packet to the last one
676                  * we had sent (or our allocation)
677                  * then the offending one so that the any queued
678                  * data at our destination will be discarded.
679                  */
680                  ep = (struct ns_errp *)nsp->nsp_notify_param;
681                  sb = &nsp->nsp_socket->so_snd;
682                  cb->s_mtu = ep->ns_err_param;
683                  badseq = SI(&ep->ns_err_idp)->si_seq;
684                  for (m = sb->sb_mb; m; m = m->m_act) {
685                         si = mtod(m, struct spidp *);
686                         if (si->si_seq == badseq)
687                                 break;
688                  }
689                  if (m == 0) return;
690                  firstbad = m;
691                  /*for (;;) {*/
692                         /* calculate length */
693                         for (m0 = m, len = 0; m ; m = m->m_next)
694                                 len += m->m_len;
695                         if (len > cb->s_mtu) {
696                         }
697                 /* FINISH THIS
698                 } */
699         }
700 }
701 #endif
702
703 int
704 spp_output(struct sppcb *cb, struct mbuf *m0)
705 {
706         struct socket *so = cb->s_nspcb->nsp_socket;
707         struct mbuf *m;
708         struct spidp *si = (struct spidp *) 0;
709         struct sockbuf *sb = &so->so_snd;
710         int len = 0, win, rcv_win;
711         short span, off, recordp = 0;
712         u_short alo;
713         int error = 0, sendalot;
714 #ifdef notdef
715         int idle;
716 #endif
717         struct mbuf *mprev;
718
719         if (m0) {
720                 int mtu = cb->s_mtu;
721                 int datalen;
722                 /*
723                  * Make sure that packet isn't too big.
724                  */
725                 for (m = m0; m ; m = m->m_next) {
726                         mprev = m;
727                         len += m->m_len;
728                         if (m->m_flags & M_EOR)
729                                 recordp = 1;
730                 }
731                 datalen = (cb->s_flags & SF_HO) ?
732                                 len - sizeof (struct sphdr) : len;
733                 if (datalen > mtu) {
734                         if (cb->s_flags & SF_PI) {
735                                 m_freem(m0);
736                                 return (EMSGSIZE);
737                         } else {
738                                 int oldEM = cb->s_cc & SP_EM;
739
740                                 cb->s_cc &= ~SP_EM;
741                                 while (len > mtu) {
742                                         /*
743                                          * Here we are only being called
744                                          * from usrreq(), so it is OK to
745                                          * block.
746                                          */
747                                         m = m_copym(m0, 0, mtu, MB_WAIT);
748                                         if (cb->s_flags & SF_NEWCALL) {
749                                             struct mbuf *mm = m;
750                                             spp_newchecks[7]++;
751                                             while (mm) {
752                                                 mm->m_flags &= ~M_EOR;
753                                                 mm = mm->m_next;
754                                             }
755                                         }
756                                         error = spp_output(cb, m);
757                                         if (error) {
758                                                 cb->s_cc |= oldEM;
759                                                 m_freem(m0);
760                                                 return(error);
761                                         }
762                                         m_adj(m0, mtu);
763                                         len -= mtu;
764                                 }
765                                 cb->s_cc |= oldEM;
766                         }
767                 }
768                 /*
769                  * Force length even, by adding a "garbage byte" if
770                  * necessary.
771                  */
772                 if (len & 1) {
773                         m = mprev;
774                         if (M_TRAILINGSPACE(m) >= 1)
775                                 m->m_len++;
776                         else {
777                                 struct mbuf *m1 = m_get(MB_DONTWAIT, MT_DATA);
778
779                                 if (m1 == 0) {
780                                         m_freem(m0);
781                                         return (ENOBUFS);
782                                 }
783                                 m1->m_len = 1;
784                                 *(mtod(m1, u_char *)) = 0;
785                                 m->m_next = m1;
786                         }
787                 }
788                 m = m_gethdr(MB_DONTWAIT, MT_HEADER);
789                 if (m == 0) {
790                         m_freem(m0);
791                         return (ENOBUFS);
792                 }
793                 /*
794                  * Fill in mbuf with extended SP header
795                  * and addresses and length put into network format.
796                  */
797                 MH_ALIGN(m, sizeof (struct spidp));
798                 m->m_len = sizeof (struct spidp);
799                 m->m_next = m0;
800                 si = mtod(m, struct spidp *);
801                 si->si_i = *cb->s_idp;
802                 si->si_s = cb->s_shdr;
803                 if ((cb->s_flags & SF_PI) && (cb->s_flags & SF_HO)) {
804                         struct sphdr *sh;
805                         if (m0->m_len < sizeof (*sh)) {
806                                 if((m0 = m_pullup(m0, sizeof(*sh))) == NULL) {
807                                         (void) m_free(m);
808                                         m_freem(m0);
809                                         return (EINVAL);
810                                 }
811                                 m->m_next = m0;
812                         }
813                         sh = mtod(m0, struct sphdr *);
814                         si->si_dt = sh->sp_dt;
815                         si->si_cc |= sh->sp_cc & SP_EM;
816                         m0->m_len -= sizeof (*sh);
817                         m0->m_data += sizeof (*sh);
818                         len -= sizeof (*sh);
819                 }
820                 len += sizeof(*si);
821                 if ((cb->s_flags2 & SF_NEWCALL) && recordp) {
822                         si->si_cc  |= SP_EM;
823                         spp_newchecks[8]++;
824                 }
825                 if (cb->s_oobflags & SF_SOOB) {
826                         /*
827                          * Per jqj@cornell:
828                          * make sure OB packets convey exactly 1 byte.
829                          * If the packet is 1 byte or larger, we
830                          * have already guaranted there to be at least
831                          * one garbage byte for the checksum, and
832                          * extra bytes shouldn't hurt!
833                          */
834                         if (len > sizeof(*si)) {
835                                 si->si_cc |= SP_OB;
836                                 len = (1 + sizeof(*si));
837                         }
838                 }
839                 si->si_len = htons((u_short)len);
840                 m->m_pkthdr.len = ((len - 1) | 1) + 1;
841                 /*
842                  * queue stuff up for output
843                  */
844                 sbappendrecord(sb, m);
845                 cb->s_seq++;
846         }
847 #ifdef notdef
848         idle = (cb->s_smax == (cb->s_rack - 1));
849 #endif
850 again:
851         sendalot = 0;
852         off = cb->s_snxt - cb->s_rack;
853         win = min(cb->s_swnd, (cb->s_cwnd/CUNIT));
854
855         /*
856          * If in persist timeout with window of 0, send a probe.
857          * Otherwise, if window is small but nonzero
858          * and timer expired, send what we can and go into
859          * transmit state.
860          */
861         if (cb->s_force == 1 + SPPT_PERSIST) {
862                 if (win != 0) {
863                         cb->s_timer[SPPT_PERSIST] = 0;
864                         cb->s_rxtshift = 0;
865                 }
866         }
867         span = cb->s_seq - cb->s_rack;
868         len = min(span, win) - off;
869
870         if (len < 0) {
871                 /*
872                  * Window shrank after we went into it.
873                  * If window shrank to 0, cancel pending
874                  * restransmission and pull s_snxt back
875                  * to (closed) window.  We will enter persist
876                  * state below.  If the widndow didn't close completely,
877                  * just wait for an ACK.
878                  */
879                 len = 0;
880                 if (win == 0) {
881                         cb->s_timer[SPPT_REXMT] = 0;
882                         cb->s_snxt = cb->s_rack;
883                 }
884         }
885         if (len > 1)
886                 sendalot = 1;
887         rcv_win = sbspace(&so->so_rcv);
888
889         /*
890          * Send if we owe peer an ACK.
891          */
892         if (cb->s_oobflags & SF_SOOB) {
893                 /*
894                  * must transmit this out of band packet
895                  */
896                 cb->s_oobflags &= ~ SF_SOOB;
897                 sendalot = 1;
898                 sppstat.spps_sndurg++;
899                 goto found;
900         }
901         if (cb->s_flags & SF_ACKNOW)
902                 goto send;
903         if (cb->s_state < TCPS_ESTABLISHED)
904                 goto send;
905         /*
906          * Silly window can't happen in spp.
907          * Code from tcp deleted.
908          */
909         if (len)
910                 goto send;
911         /*
912          * Compare available window to amount of window
913          * known to peer (as advertised window less
914          * next expected input.)  If the difference is at least two
915          * packets or at least 35% of the mximum possible window,
916          * then want to send a window update to peer.
917          */
918         if (rcv_win > 0) {
919                 u_short delta =  1 + cb->s_alo - cb->s_ack;
920                 int adv = rcv_win - (delta * cb->s_mtu);
921
922                 if ((so->so_rcv.sb_cc == 0 && adv >= (2 * cb->s_mtu)) ||
923                     (100 * adv / so->so_rcv.sb_hiwat >= 35)) {
924                         sppstat.spps_sndwinup++;
925                         cb->s_flags |= SF_ACKNOW;
926                         goto send;
927                 }
928
929         }
930         /*
931          * Many comments from tcp_output.c are appropriate here
932          * including . . .
933          * If send window is too small, there is data to transmit, and no
934          * retransmit or persist is pending, then go to persist state.
935          * If nothing happens soon, send when timer expires:
936          * if window is nonzero, transmit what we can,
937          * otherwise send a probe.
938          */
939         if (so->so_snd.sb_cc && cb->s_timer[SPPT_REXMT] == 0 &&
940                 cb->s_timer[SPPT_PERSIST] == 0) {
941                         cb->s_rxtshift = 0;
942                         spp_setpersist(cb);
943         }
944         /*
945          * No reason to send a packet, just return.
946          */
947         cb->s_outx = 1;
948         return (0);
949
950 send:
951         /*
952          * Find requested packet.
953          */
954         si = 0;
955         if (len > 0) {
956                 cb->s_want = cb->s_snxt;
957                 for (m = sb->sb_mb; m; m = m->m_act) {
958                         si = mtod(m, struct spidp *);
959                         if (SSEQ_LEQ(cb->s_snxt, si->si_seq))
960                                 break;
961                 }
962         found:
963                 if (si) {
964                         if (si->si_seq == cb->s_snxt)
965                                         cb->s_snxt++;
966                                 else
967                                         sppstat.spps_sndvoid++, si = 0;
968                 }
969         }
970         /*
971          * update window
972          */
973         if (rcv_win < 0)
974                 rcv_win = 0;
975         alo = cb->s_ack - 1 + (rcv_win / ((short)cb->s_mtu));
976         if (SSEQ_LT(alo, cb->s_alo))
977                 alo = cb->s_alo;
978
979         if (si) {
980                 /*
981                  * must make a copy of this packet for
982                  * idp_output to monkey with
983                  */
984                 m = m_copy(dtom(si), 0, (int)M_COPYALL);
985                 if (m == NULL) {
986                         return (ENOBUFS);
987                 }
988                 si = mtod(m, struct spidp *);
989                 if (SSEQ_LT(si->si_seq, cb->s_smax))
990                         sppstat.spps_sndrexmitpack++;
991                 else
992                         sppstat.spps_sndpack++;
993         } else if (cb->s_force || cb->s_flags & SF_ACKNOW) {
994                 /*
995                  * Must send an acknowledgement or a probe
996                  */
997                 if (cb->s_force)
998                         sppstat.spps_sndprobe++;
999                 if (cb->s_flags & SF_ACKNOW)
1000                         sppstat.spps_sndacks++;
1001                 m = m_gethdr(MB_DONTWAIT, MT_HEADER);
1002                 if (m == 0)
1003                         return (ENOBUFS);
1004                 /*
1005                  * Fill in mbuf with extended SP header
1006                  * and addresses and length put into network format.
1007                  */
1008                 MH_ALIGN(m, sizeof (struct spidp));
1009                 m->m_len = sizeof (*si);
1010                 m->m_pkthdr.len = sizeof (*si);
1011                 si = mtod(m, struct spidp *);
1012                 si->si_i = *cb->s_idp;
1013                 si->si_s = cb->s_shdr;
1014                 si->si_seq = cb->s_smax + 1;
1015                 si->si_len = htons(sizeof (*si));
1016                 si->si_cc |= SP_SP;
1017         } else {
1018                 cb->s_outx = 3;
1019                 if (so->so_options & SO_DEBUG || traceallspps)
1020                         spp_trace(SA_OUTPUT, cb->s_state, cb, si, 0);
1021                 return (0);
1022         }
1023         /*
1024          * Stuff checksum and output datagram.
1025          */
1026         if ((si->si_cc & SP_SP) == 0) {
1027                 if (cb->s_force != (1 + SPPT_PERSIST) ||
1028                     cb->s_timer[SPPT_PERSIST] == 0) {
1029                         /*
1030                          * If this is a new packet and we are not currently
1031                          * timing anything, time this one.
1032                          */
1033                         if (SSEQ_LT(cb->s_smax, si->si_seq)) {
1034                                 cb->s_smax = si->si_seq;
1035                                 if (cb->s_rtt == 0) {
1036                                         sppstat.spps_segstimed++;
1037                                         cb->s_rtseq = si->si_seq;
1038                                         cb->s_rtt = 1;
1039                                 }
1040                         }
1041                         /*
1042                          * Set rexmt timer if not currently set,
1043                          * Initial value for retransmit timer is smoothed
1044                          * round-trip time + 2 * round-trip time variance.
1045                          * Initialize shift counter which is used for backoff
1046                          * of retransmit time.
1047                          */
1048                         if (cb->s_timer[SPPT_REXMT] == 0 &&
1049                             cb->s_snxt != cb->s_rack) {
1050                                 cb->s_timer[SPPT_REXMT] = cb->s_rxtcur;
1051                                 if (cb->s_timer[SPPT_PERSIST]) {
1052                                         cb->s_timer[SPPT_PERSIST] = 0;
1053                                         cb->s_rxtshift = 0;
1054                                 }
1055                         }
1056                 } else if (SSEQ_LT(cb->s_smax, si->si_seq)) {
1057                         cb->s_smax = si->si_seq;
1058                 }
1059         } else if (cb->s_state < TCPS_ESTABLISHED) {
1060                 if (cb->s_rtt == 0)
1061                         cb->s_rtt = 1; /* Time initial handshake */
1062                 if (cb->s_timer[SPPT_REXMT] == 0)
1063                         cb->s_timer[SPPT_REXMT] = cb->s_rxtcur;
1064         }
1065         {
1066                 /*
1067                  * Do not request acks when we ack their data packets or
1068                  * when we do a gratuitous window update.
1069                  */
1070                 if (((si->si_cc & SP_SP) == 0) || cb->s_force)
1071                                 si->si_cc |= SP_SA;
1072                 si->si_seq = htons(si->si_seq);
1073                 si->si_alo = htons(alo);
1074                 si->si_ack = htons(cb->s_ack);
1075
1076                 if (idpcksum) {
1077                         si->si_sum = 0;
1078                         len = ntohs(si->si_len);
1079                         if (len & 1)
1080                                 len++;
1081                         si->si_sum = ns_cksum(m, len);
1082                 } else
1083                         si->si_sum = 0xffff;
1084
1085                 cb->s_outx = 4;
1086                 if (so->so_options & SO_DEBUG || traceallspps)
1087                         spp_trace(SA_OUTPUT, cb->s_state, cb, si, 0);
1088
1089                 if (so->so_options & SO_DONTROUTE)
1090                         error = ns_output(m, (struct route *)0, NS_ROUTETOIF);
1091                 else
1092                         error = ns_output(m, &cb->s_nspcb->nsp_route, 0);
1093         }
1094         if (error) {
1095                 return (error);
1096         }
1097         sppstat.spps_sndtotal++;
1098         /*
1099          * Data sent (as far as we can tell).
1100          * If this advertises a larger window than any other segment,
1101          * then remember the size of the advertized window.
1102          * Any pending ACK has now been sent.
1103          */
1104         cb->s_force = 0;
1105         cb->s_flags &= ~(SF_ACKNOW|SF_DELACK);
1106         if (SSEQ_GT(alo, cb->s_alo))
1107                 cb->s_alo = alo;
1108         if (sendalot)
1109                 goto again;
1110         cb->s_outx = 5;
1111         return (0);
1112 }
1113
1114 int spp_do_persist_panics = 0;
1115
1116 void
1117 spp_setpersist(struct sppcb *cb)
1118 {
1119         int t = ((cb->s_srtt >> 2) + cb->s_rttvar) >> 1;
1120
1121         if (cb->s_timer[SPPT_REXMT] && spp_do_persist_panics)
1122                 panic("spp_output REXMT");
1123         /*
1124          * Start/restart persistance timer.
1125          */
1126         SPPT_RANGESET(cb->s_timer[SPPT_PERSIST],
1127             t*spp_backoff[cb->s_rxtshift],
1128             SPPTV_PERSMIN, SPPTV_PERSMAX);
1129         if (cb->s_rxtshift < SPP_MAXRXTSHIFT)
1130                 cb->s_rxtshift++;
1131 }
1132 /*ARGSUSED*/
1133 int
1134 spp_ctloutput(int req, struct socket *so, int level,
1135                 int name, struct mbuf **value)
1136 {
1137         struct mbuf *m;
1138         struct nspcb *nsp = sotonspcb(so);
1139         struct sppcb *cb;
1140         int mask, error = 0;
1141
1142         if (level != NSPROTO_SPP) {
1143                 /* This will have to be changed when we do more general
1144                    stacking of protocols */
1145                 return (idp_ctloutput(req, so, level, name, value));
1146         }
1147         if (nsp == NULL) {
1148                 error = EINVAL;
1149                 goto release;
1150         } else
1151                 cb = nstosppcb(nsp);
1152
1153         switch (req) {
1154
1155         case PRCO_GETOPT:
1156                 if (value == NULL)
1157                         return (EINVAL);
1158                 m = m_get(MB_DONTWAIT, MT_DATA);
1159                 if (m == NULL)
1160                         return (ENOBUFS);
1161                 switch (name) {
1162
1163                 case SO_HEADERS_ON_INPUT:
1164                         mask = SF_HI;
1165                         goto get_flags;
1166
1167                 case SO_HEADERS_ON_OUTPUT:
1168                         mask = SF_HO;
1169                 get_flags:
1170                         m->m_len = sizeof(short);
1171                         *mtod(m, short *) = cb->s_flags & mask;
1172                         break;
1173
1174                 case SO_MTU:
1175                         m->m_len = sizeof(u_short);
1176                         *mtod(m, short *) = cb->s_mtu;
1177                         break;
1178
1179                 case SO_LAST_HEADER:
1180                         m->m_len = sizeof(struct sphdr);
1181                         *mtod(m, struct sphdr *) = cb->s_rhdr;
1182                         break;
1183
1184                 case SO_DEFAULT_HEADERS:
1185                         m->m_len = sizeof(struct spidp);
1186                         *mtod(m, struct sphdr *) = cb->s_shdr;
1187                         break;
1188
1189                 default:
1190                         error = EINVAL;
1191                 }
1192                 *value = m;
1193                 break;
1194
1195         case PRCO_SETOPT:
1196                 if (value == 0 || *value == 0) {
1197                         error = EINVAL;
1198                         break;
1199                 }
1200                 switch (name) {
1201                         int *ok;
1202
1203                 case SO_HEADERS_ON_INPUT:
1204                         mask = SF_HI;
1205                         goto set_head;
1206
1207                 case SO_HEADERS_ON_OUTPUT:
1208                         mask = SF_HO;
1209                 set_head:
1210                         if (cb->s_flags & SF_PI) {
1211                                 ok = mtod(*value, int *);
1212                                 if (*ok)
1213                                         cb->s_flags |= mask;
1214                                 else
1215                                         cb->s_flags &= ~mask;
1216                         } else error = EINVAL;
1217                         break;
1218
1219                 case SO_MTU:
1220                         cb->s_mtu = *(mtod(*value, u_short *));
1221                         break;
1222
1223 #ifdef SF_NEWCALL
1224                 case SO_NEWCALL:
1225                         ok = mtod(*value, int *);
1226                         if (*ok) {
1227                                 cb->s_flags2 |= SF_NEWCALL;
1228                                 spp_newchecks[5]++;
1229                         } else {
1230                                 cb->s_flags2 &= ~SF_NEWCALL;
1231                                 spp_newchecks[6]++;
1232                         }
1233                         break;
1234 #endif
1235
1236                 case SO_DEFAULT_HEADERS:
1237                         {
1238                                 struct sphdr *sp
1239                                                 = mtod(*value, struct sphdr *);
1240                                 cb->s_dt = sp->sp_dt;
1241                                 cb->s_cc = sp->sp_cc & SP_EM;
1242                         }
1243                         break;
1244
1245                 default:
1246                         error = EINVAL;
1247                 }
1248                 m_freem(*value);
1249                 break;
1250         }
1251         release:
1252                 return (error);
1253 }
1254
1255 #warning "spp_usrreq not converted to FreeBSD usrreq style! watch out!"
1256 /*ARGSUSED*/
1257 int
1258 spp_usrreq(struct socket *so, int req, struct mbuf *m, struct mbuf *nam,
1259             struct mbuf *controlp)
1260 {
1261         int error = 0;
1262 #ifdef OBSOLETE         /* not converted to FreeBSD usrreq style XXX */
1263         struct nspcb *nsp = sotonspcb(so);
1264         struct sppcb *cb = NULL;
1265         int s = splnet();
1266         int ostate;
1267         struct mbuf *mm;
1268         struct sockbuf *sb;
1269
1270         if (req == PRU_CONTROL)
1271                 return (ns_control(so, (int)m, (caddr_t)nam,
1272                         (struct ifnet *)controlp));
1273         if (nsp == NULL) {
1274                 if (req != PRU_ATTACH) {
1275                         error = EINVAL;
1276                         goto release;
1277                 }
1278         } else
1279                 cb = nstosppcb(nsp);
1280
1281         ostate = cb ? cb->s_state : 0;
1282
1283         switch (req) {
1284
1285         case PRU_ATTACH:
1286                 if (nsp != NULL) {
1287                         error = EISCONN;
1288                         break;
1289                 }
1290                 error = ns_pcballoc(so, &nspcb);
1291                 if (error)
1292                         break;
1293                 if (so->so_snd.sb_hiwat == 0 || so->so_rcv.sb_hiwat == 0) {
1294                         error = soreserve(so, (u_long) 3072, (u_long) 3072);
1295                         if (error)
1296                                 break;
1297                 }
1298                 nsp = sotonspcb(so);
1299
1300                 /* private PCB */
1301                 mm = m_getclr(MB_DONTWAIT, MT_CONTROL);
1302                 sb = &so->so_snd;
1303
1304                 if (mm == NULL) {
1305                         error = ENOBUFS;
1306                         break;
1307                 }
1308                 cb = mtod(mm, struct sppcb *);
1309                 mm = m_getclr(MB_DONTWAIT, MT_HEADER);
1310                 if (mm == NULL) {
1311                         (void) m_free(dtom(m));
1312                         error = ENOBUFS;
1313                         break;
1314                 }
1315                 cb->s_idp = mtod(mm, struct idp *);
1316                 cb->s_state = TCPS_LISTEN;
1317                 cb->s_smax = -1;
1318                 cb->s_swl1 = -1;
1319                 cb->s_q.si_next = cb->s_q.si_prev = &cb->s_q;
1320                 cb->s_nspcb = nsp;
1321                 cb->s_mtu = 576 - sizeof (struct spidp);
1322                 cb->s_cwnd = sbspace(sb) * CUNIT / cb->s_mtu;
1323                 cb->s_ssthresh = cb->s_cwnd;
1324                 cb->s_cwmx = sbspace(sb) * CUNIT /
1325                                 (2 * sizeof (struct spidp));
1326                 /* Above is recomputed when connecting to account
1327                    for changed buffering or mtu's */
1328                 cb->s_rtt = SPPTV_SRTTBASE;
1329                 cb->s_rttvar = SPPTV_SRTTDFLT << 2;
1330                 SPPT_RANGESET(cb->s_rxtcur,
1331                     ((SPPTV_SRTTBASE >> 2) + (SPPTV_SRTTDFLT << 2)) >> 1,
1332                     SPPTV_MIN, SPPTV_REXMTMAX);
1333                 nsp->nsp_pcb = (caddr_t) cb;
1334                 break;
1335
1336         case PRU_DETACH:
1337                 if (nsp == NULL) {
1338                         error = ENOTCONN;
1339                         break;
1340                 }
1341                 if (cb->s_state > TCPS_LISTEN)
1342                         cb = spp_disconnect(cb);
1343                 else
1344                         cb = spp_close(cb);
1345                 break;
1346
1347         case PRU_BIND:
1348                 error = ns_pcbbind(nsp, nam);
1349                 break;
1350
1351         case PRU_LISTEN:
1352                 if (nsp->nsp_lport == 0)
1353                         error = ns_pcbbind(nsp, (struct mbuf *)0);
1354                 if (error == 0)
1355                         cb->s_state = TCPS_LISTEN;
1356                 break;
1357
1358         /*
1359          * Initiate connection to peer.
1360          * Enter SYN_SENT state, and mark socket as connecting.
1361          * Start keep-alive timer, setup prototype header,
1362          * Send initial system packet requesting connection.
1363          */
1364         case PRU_CONNECT:
1365                 if (nsp->nsp_lport == 0) {
1366                         error = ns_pcbbind(nsp, (struct mbuf *)0);
1367                         if (error)
1368                                 break;
1369                 }
1370                 error = ns_pcbconnect(nsp, nam);
1371                 if (error)
1372                         break;
1373                 soisconnecting(so);
1374                 sppstat.spps_connattempt++;
1375                 cb->s_state = TCPS_SYN_SENT;
1376                 cb->s_did = 0;
1377                 spp_template(cb);
1378                 cb->s_timer[SPPT_KEEP] = SPPTV_KEEP;
1379                 cb->s_force = 1 + SPPTV_KEEP;
1380                 /*
1381                  * Other party is required to respond to
1382                  * the port I send from, but he is not
1383                  * required to answer from where I am sending to,
1384                  * so allow wildcarding.
1385                  * original port I am sending to is still saved in
1386                  * cb->s_dport.
1387                  */
1388                 nsp->nsp_fport = 0;
1389                 error = spp_output(cb, (struct mbuf *) 0);
1390                 break;
1391
1392         case PRU_CONNECT2:
1393                 error = EOPNOTSUPP;
1394                 break;
1395
1396         /*
1397          * We may decide later to implement connection closing
1398          * handshaking at the spp level optionally.
1399          * here is the hook to do it:
1400          */
1401         case PRU_DISCONNECT:
1402                 cb = spp_disconnect(cb);
1403                 break;
1404
1405         /*
1406          * Accept a connection.  Essentially all the work is
1407          * done at higher levels; just return the address
1408          * of the peer, storing through addr.
1409          */
1410         case PRU_ACCEPT: {
1411                 struct sockaddr_ns *sns = mtod(nam, struct sockaddr_ns *);
1412
1413                 nam->m_len = sizeof (struct sockaddr_ns);
1414                 sns->sns_family = AF_NS;
1415                 sns->sns_addr = nsp->nsp_faddr;
1416                 break;
1417                 }
1418
1419         case PRU_SHUTDOWN:
1420                 socantsendmore(so);
1421                 cb = spp_usrclosed(cb);
1422                 if (cb)
1423                         error = spp_output(cb, (struct mbuf *) 0);
1424                 break;
1425
1426         /*
1427          * After a receive, possibly send acknowledgment
1428          * updating allocation.
1429          */
1430         case PRU_RCVD:
1431                 cb->s_flags |= SF_RVD;
1432                 (void) spp_output(cb, (struct mbuf *) 0);
1433                 cb->s_flags &= ~SF_RVD;
1434                 break;
1435
1436         case PRU_ABORT:
1437                 (void) spp_drop(cb, ECONNABORTED);
1438                 break;
1439
1440         case PRU_SENSE:
1441         case PRU_CONTROL:
1442                 m = NULL;
1443                 error = EOPNOTSUPP;
1444                 break;
1445
1446         case PRU_RCVOOB:
1447                 if ((cb->s_oobflags & SF_IOOB) || so->so_oobmark ||
1448                     (so->so_state & SS_RCVATMARK)) {
1449                         m->m_len = 1;
1450                         *mtod(m, caddr_t) = cb->s_iobc;
1451                         break;
1452                 }
1453                 error = EINVAL;
1454                 break;
1455
1456         case PRU_SENDOOB:
1457                 if (sbspace(&so->so_snd) < -512) {
1458                         error = ENOBUFS;
1459                         break;
1460                 }
1461                 cb->s_oobflags |= SF_SOOB;
1462                 /* fall into */
1463         case PRU_SEND:
1464                 if (controlp) {
1465                         u_short *p = mtod(controlp, u_short *);
1466                         spp_newchecks[2]++;
1467                         if ((p[0] == 5) && p[1] == 1) { /* XXXX, for testing */
1468                                 cb->s_shdr.sp_dt = *(u_char *)(&p[2]);
1469                                 spp_newchecks[3]++;
1470                         }
1471                         m_freem(controlp);
1472                 }
1473                 controlp = NULL;
1474                 error = spp_output(cb, m);
1475                 m = NULL;
1476                 break;
1477
1478         case PRU_SOCKADDR:
1479                 ns_setsockaddr(nsp, nam);
1480                 break;
1481
1482         case PRU_PEERADDR:
1483                 ns_setpeeraddr(nsp, nam);
1484                 break;
1485
1486         case PRU_SLOWTIMO:
1487                 cb = spp_timers(cb, (int)nam);
1488                 req |= ((int)nam) << 8;
1489                 break;
1490
1491         case PRU_FASTTIMO:
1492         case PRU_PROTORCV:
1493         case PRU_PROTOSEND:
1494                 error =  EOPNOTSUPP;
1495                 break;
1496
1497         default:
1498                 panic("sp_usrreq");
1499         }
1500         if (cb && (so->so_options & SO_DEBUG || traceallspps))
1501                 spp_trace(SA_USER, (u_char)ostate, cb, (struct spidp *)0, req);
1502 release:
1503         if (controlp != NULL)
1504                 m_freem(controlp);
1505         if (m != NULL)
1506                 m_freem(m);
1507         splx(s);
1508 #endif
1509         return (error);
1510 }
1511
1512 int
1513 spp_usrreq_sp(struct socket *so, int req, struct mbuf *m,
1514                 struct mbuf *nam, struct mbuf *controlp)
1515 {
1516         int error = spp_usrreq(so, req, m, nam, controlp);
1517
1518         if (req == PRU_ATTACH && error == 0) {
1519                 struct nspcb *nsp = sotonspcb(so);
1520                 ((struct sppcb *)nsp->nsp_pcb)->s_flags |=
1521                                         (SF_HI | SF_HO | SF_PI);
1522         }
1523         return (error);
1524 }
1525
1526 /*
1527  * Create template to be used to send spp packets on a connection.
1528  * Called after host entry created, fills
1529  * in a skeletal spp header (choosing connection id),
1530  * minimizing the amount of work necessary when the connection is used.
1531  */
1532 void
1533 spp_template(struct sppcb *cb)
1534 {
1535         struct nspcb *nsp = cb->s_nspcb;
1536         struct idp *idp = cb->s_idp;
1537         struct sockbuf *sb = &(nsp->nsp_socket->so_snd);
1538
1539         idp->idp_pt = NSPROTO_SPP;
1540         idp->idp_sna = nsp->nsp_laddr;
1541         idp->idp_dna = nsp->nsp_faddr;
1542         cb->s_sid = htons(spp_iss);
1543         spp_iss += SPP_ISSINCR/2;
1544         cb->s_alo = 1;
1545         cb->s_cwnd = (sbspace(sb) * CUNIT) / cb->s_mtu;
1546         cb->s_ssthresh = cb->s_cwnd; /* Try to expand fast to full complement
1547                                         of large packets */
1548         cb->s_cwmx = (sbspace(sb) * CUNIT) / (2 * sizeof(struct spidp));
1549         cb->s_cwmx = max(cb->s_cwmx, cb->s_cwnd);
1550                 /* But allow for lots of little packets as well */
1551 }
1552
1553 /*
1554  * Close a SPIP control block:
1555  *      discard spp control block itself
1556  *      discard ns protocol control block
1557  *      wake up any sleepers
1558  */
1559 struct sppcb *
1560 spp_close(struct sppcb *cb)
1561 {
1562         struct spidp_q *s;
1563         struct nspcb *nsp = cb->s_nspcb;
1564         struct socket *so = nsp->nsp_socket;
1565         struct mbuf *m;
1566
1567         s = cb->s_q.si_next;
1568         while (s != &(cb->s_q)) {
1569                 s = s->si_next;
1570                 m = dtom(s->si_prev);
1571                 remque(s->si_prev);
1572                 m_freem(m);
1573         }
1574         (void) m_free(dtom(cb->s_idp));
1575         (void) m_free(dtom(cb));
1576         nsp->nsp_pcb = 0;
1577         soisdisconnected(so);
1578         ns_pcbdetach(nsp);
1579         sppstat.spps_closed++;
1580         return ((struct sppcb *)0);
1581 }
1582 /*
1583  *      Someday we may do level 3 handshaking
1584  *      to close a connection or send a xerox style error.
1585  *      For now, just close.
1586  */
1587 struct sppcb *
1588 spp_usrclosed(struct sppcb *cb)
1589 {
1590         return (spp_close(cb));
1591 }
1592
1593 struct sppcb *
1594 spp_disconnect(struct sppcb *cb)
1595 {
1596         return (spp_close(cb));
1597 }
1598
1599 /*
1600  * Drop connection, reporting
1601  * the specified error.
1602  */
1603 struct sppcb *
1604 spp_drop(struct sppcb *cb, int errno)
1605 {
1606         struct socket *so = cb->s_nspcb->nsp_socket;
1607
1608         /*
1609          * someday, in the xerox world
1610          * we will generate error protocol packets
1611          * announcing that the socket has gone away.
1612          */
1613         if (TCPS_HAVERCVDSYN(cb->s_state)) {
1614                 sppstat.spps_drops++;
1615                 cb->s_state = TCPS_CLOSED;
1616                 /*(void) tcp_output(cb);*/
1617         } else
1618                 sppstat.spps_conndrops++;
1619         so->so_error = errno;
1620         return (spp_close(cb));
1621 }
1622
1623 void
1624 spp_abort(struct nspcb *nsp)
1625 {
1626         spp_close((struct sppcb *)nsp->nsp_pcb);
1627 }
1628
1629 /*
1630  * Fast timeout routine for processing delayed acks
1631  */
1632 void
1633 spp_fasttimo(void)
1634 {
1635         struct nspcb *nsp;
1636         struct sppcb *cb;
1637         int s = splnet();
1638
1639         nsp = nspcb.nsp_next;
1640         if (nsp)
1641         for (; nsp != &nspcb; nsp = nsp->nsp_next)
1642                 if ((cb = (struct sppcb *)nsp->nsp_pcb) &&
1643                     (cb->s_flags & SF_DELACK)) {
1644                         cb->s_flags &= ~SF_DELACK;
1645                         cb->s_flags |= SF_ACKNOW;
1646                         sppstat.spps_delack++;
1647                         (void) spp_output(cb, (struct mbuf *) 0);
1648                 }
1649         splx(s);
1650 }
1651
1652 /*
1653  * spp protocol timeout routine called every 500 ms.
1654  * Updates the timers in all active pcb's and
1655  * causes finite state machine actions if timers expire.
1656  */
1657 void
1658 spp_slowtimo(void)
1659 {
1660         struct nspcb *ip, *ipnxt;
1661         struct sppcb *cb;
1662         int s = splnet();
1663         int i;
1664
1665         /*
1666          * Search through tcb's and update active timers.
1667          */
1668         ip = nspcb.nsp_next;
1669         if (ip == 0) {
1670                 splx(s);
1671                 return;
1672         }
1673         while (ip != &nspcb) {
1674                 cb = nstosppcb(ip);
1675                 ipnxt = ip->nsp_next;
1676                 if (cb == 0)
1677                         goto tpgone;
1678                 for (i = 0; i < SPPT_NTIMERS; i++) {
1679                         if (cb->s_timer[i] && --cb->s_timer[i] == 0) {
1680                         (void) spp_usrreq(cb->s_nspcb->nsp_socket,
1681                                     PRU_SLOWTIMO, (struct mbuf *)0,
1682                                     (struct mbuf *)i, (struct mbuf *)0);
1683                                 if (ipnxt->nsp_prev != ip)
1684                                         goto tpgone;
1685                         }
1686                 }
1687                 cb->s_idle++;
1688                 if (cb->s_rtt)
1689                         cb->s_rtt++;
1690 tpgone:
1691                 ip = ipnxt;
1692         }
1693         spp_iss += SPP_ISSINCR/PR_SLOWHZ;               /* increment iss */
1694         splx(s);
1695 }
1696 /*
1697  * SPP timer processing.
1698  */
1699 struct sppcb *
1700 spp_timers(struct sppcb *cb, int timer)
1701 {
1702         long rexmt;
1703         int win;
1704
1705         cb->s_force = 1 + timer;
1706         switch (timer) {
1707
1708         /*
1709          * 2 MSL timeout in shutdown went off.  TCP deletes connection
1710          * control block.
1711          */
1712         case SPPT_2MSL:
1713                 printf("spp: SPPT_2MSL went off for no reason\n");
1714                 cb->s_timer[timer] = 0;
1715                 break;
1716
1717         /*
1718          * Retransmission timer went off.  Message has not
1719          * been acked within retransmit interval.  Back off
1720          * to a longer retransmit interval and retransmit one packet.
1721          */
1722         case SPPT_REXMT:
1723                 if (++cb->s_rxtshift > SPP_MAXRXTSHIFT) {
1724                         cb->s_rxtshift = SPP_MAXRXTSHIFT;
1725                         sppstat.spps_timeoutdrop++;
1726                         cb = spp_drop(cb, ETIMEDOUT);
1727                         break;
1728                 }
1729                 sppstat.spps_rexmttimeo++;
1730                 rexmt = ((cb->s_srtt >> 2) + cb->s_rttvar) >> 1;
1731                 rexmt *= spp_backoff[cb->s_rxtshift];
1732                 SPPT_RANGESET(cb->s_rxtcur, rexmt, SPPTV_MIN, SPPTV_REXMTMAX);
1733                 cb->s_timer[SPPT_REXMT] = cb->s_rxtcur;
1734                 /*
1735                  * If we have backed off fairly far, our srtt
1736                  * estimate is probably bogus.  Clobber it
1737                  * so we'll take the next rtt measurement as our srtt;
1738                  * move the current srtt into rttvar to keep the current
1739                  * retransmit times until then.
1740                  */
1741                 if (cb->s_rxtshift > SPP_MAXRXTSHIFT / 4 ) {
1742                         cb->s_rttvar += (cb->s_srtt >> 2);
1743                         cb->s_srtt = 0;
1744                 }
1745                 cb->s_snxt = cb->s_rack;
1746                 /*
1747                  * If timing a packet, stop the timer.
1748                  */
1749                 cb->s_rtt = 0;
1750                 /*
1751                  * See very long discussion in tcp_timer.c about congestion
1752                  * window and sstrhesh
1753                  */
1754                 win = min(cb->s_swnd, (cb->s_cwnd/CUNIT)) / 2;
1755                 if (win < 2)
1756                         win = 2;
1757                 cb->s_cwnd = CUNIT;
1758                 cb->s_ssthresh = win * CUNIT;
1759                 (void) spp_output(cb, (struct mbuf *) 0);
1760                 break;
1761
1762         /*
1763          * Persistance timer into zero window.
1764          * Force a probe to be sent.
1765          */
1766         case SPPT_PERSIST:
1767                 sppstat.spps_persisttimeo++;
1768                 spp_setpersist(cb);
1769                 (void) spp_output(cb, (struct mbuf *) 0);
1770                 break;
1771
1772         /*
1773          * Keep-alive timer went off; send something
1774          * or drop connection if idle for too long.
1775          */
1776         case SPPT_KEEP:
1777                 sppstat.spps_keeptimeo++;
1778                 if (cb->s_state < TCPS_ESTABLISHED)
1779                         goto dropit;
1780                 if (cb->s_nspcb->nsp_socket->so_options & SO_KEEPALIVE) {
1781                         if (cb->s_idle >= SPPTV_MAXIDLE)
1782                                 goto dropit;
1783                         sppstat.spps_keepprobe++;
1784                         (void) spp_output(cb, (struct mbuf *) 0);
1785                 } else
1786                         cb->s_idle = 0;
1787                 cb->s_timer[SPPT_KEEP] = SPPTV_KEEP;
1788                 break;
1789         dropit:
1790                 sppstat.spps_keepdrops++;
1791                 cb = spp_drop(cb, ETIMEDOUT);
1792                 break;
1793         }
1794         return (cb);
1795 }
1796 #ifndef lint
1797 int SppcbSize = sizeof (struct sppcb);
1798 int NspcbSize = sizeof (struct nspcb);
1799 #endif /* lint */