add missing lwkt_msg to manually specified syscall args structure.
[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.3 2003/07/26 21:10:52 rob 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 <netns/ns.h>
52 #include <netns/ns_pcb.h>
53 #include <netns/idp.h>
54 #include <netns/idp_var.h>
55 #include <netns/ns_error.h>
56 #include <netns/sp.h>
57 #include <netns/spidp.h>
58 #include <netns/spp_timer.h>
59 #include <netns/spp_var.h>
60 #include <netns/spp_debug.h>
61
62 /*
63  * SP protocol implementation.
64  */
65 spp_init()
66 {
67
68         spp_iss = 1; /* WRONG !! should fish it out of TODR */
69 }
70 struct spidp spp_savesi;
71 int traceallspps = 0;
72 extern int sppconsdebug;
73 int spp_hardnosed;
74 int spp_use_delack = 0;
75 u_short spp_newchecks[50];
76
77 /*ARGSUSED*/
78 spp_input(m, nsp)
79         struct mbuf *m;
80         struct nspcb *nsp;
81 {
82         struct sppcb *cb;
83         struct spidp *si = mtod(m, struct spidp *);
84         struct socket *so;
85         short ostate;
86         int dropsocket = 0;
87
88
89         sppstat.spps_rcvtotal++;
90         if (nsp == 0) {
91                 panic("No nspcb in spp_input");
92                 return;
93         }
94
95         cb = nstosppcb(nsp);
96         if (cb == 0) goto bad;
97
98         if (m->m_len < sizeof(*si)) {
99                 if ((m = m_pullup(m, sizeof(*si))) == 0) {
100                         sppstat.spps_rcvshort++;
101                         return;
102                 }
103                 si = mtod(m, struct spidp *);
104         }
105         si->si_seq = ntohs(si->si_seq);
106         si->si_ack = ntohs(si->si_ack);
107         si->si_alo = ntohs(si->si_alo);
108
109         so = nsp->nsp_socket;
110         if (so->so_options & SO_DEBUG || traceallspps) {
111                 ostate = cb->s_state;
112                 spp_savesi = *si;
113         }
114         if (so->so_options & SO_ACCEPTCONN) {
115                 struct sppcb *ocb = cb;
116
117                 so = sonewconn(so, 0);
118                 if (so == 0) {
119                         goto drop;
120                 }
121                 /*
122                  * This is ugly, but ....
123                  *
124                  * Mark socket as temporary until we're
125                  * committed to keeping it.  The code at
126                  * ``drop'' and ``dropwithreset'' check the
127                  * flag dropsocket to see if the temporary
128                  * socket created here should be discarded.
129                  * We mark the socket as discardable until
130                  * we're committed to it below in TCPS_LISTEN.
131                  */
132                 dropsocket++;
133                 nsp = (struct nspcb *)so->so_pcb;
134                 nsp->nsp_laddr = si->si_dna;
135                 cb = nstosppcb(nsp);
136                 cb->s_mtu = ocb->s_mtu;         /* preserve sockopts */
137                 cb->s_flags = ocb->s_flags;     /* preserve sockopts */
138                 cb->s_flags2 = ocb->s_flags2;   /* preserve sockopts */
139                 cb->s_state = TCPS_LISTEN;
140         }
141
142         /*
143          * Packet received on connection.
144          * reset idle time and keep-alive timer;
145          */
146         cb->s_idle = 0;
147         cb->s_timer[SPPT_KEEP] = SPPTV_KEEP;
148
149         switch (cb->s_state) {
150
151         case TCPS_LISTEN:{
152                 struct mbuf *am;
153                 struct sockaddr_ns *sns;
154                 struct ns_addr laddr;
155
156                 /*
157                  * If somebody here was carying on a conversation
158                  * and went away, and his pen pal thinks he can
159                  * still talk, we get the misdirected packet.
160                  */
161                 if (spp_hardnosed && (si->si_did != 0 || si->si_seq != 0)) {
162                         spp_istat.gonawy++;
163                         goto dropwithreset;
164                 }
165                 am = m_get(M_DONTWAIT, MT_SONAME);
166                 if (am == NULL)
167                         goto drop;
168                 am->m_len = sizeof (struct sockaddr_ns);
169                 sns = mtod(am, struct sockaddr_ns *);
170                 sns->sns_len = sizeof(*sns);
171                 sns->sns_family = AF_NS;
172                 sns->sns_addr = si->si_sna;
173                 laddr = nsp->nsp_laddr;
174                 if (ns_nullhost(laddr))
175                         nsp->nsp_laddr = si->si_dna;
176                 if (ns_pcbconnect(nsp, am)) {
177                         nsp->nsp_laddr = laddr;
178                         (void) m_free(am);
179                         spp_istat.noconn++;
180                         goto drop;
181                 }
182                 (void) m_free(am);
183                 spp_template(cb);
184                 dropsocket = 0;         /* committed to socket */
185                 cb->s_did = si->si_sid;
186                 cb->s_rack = si->si_ack;
187                 cb->s_ralo = si->si_alo;
188 #define THREEWAYSHAKE
189 #ifdef THREEWAYSHAKE
190                 cb->s_state = TCPS_SYN_RECEIVED;
191                 cb->s_force = 1 + SPPT_KEEP;
192                 sppstat.spps_accepts++;
193                 cb->s_timer[SPPT_KEEP] = SPPTV_KEEP;
194                 }
195                 break;
196         /*
197          * This state means that we have heard a response
198          * to our acceptance of their connection
199          * It is probably logically unnecessary in this
200          * implementation.
201          */
202          case TCPS_SYN_RECEIVED: {
203                 if (si->si_did!=cb->s_sid) {
204                         spp_istat.wrncon++;
205                         goto drop;
206                 }
207 #endif
208                 nsp->nsp_fport =  si->si_sport;
209                 cb->s_timer[SPPT_REXMT] = 0;
210                 cb->s_timer[SPPT_KEEP] = SPPTV_KEEP;
211                 soisconnected(so);
212                 cb->s_state = TCPS_ESTABLISHED;
213                 sppstat.spps_accepts++;
214                 }
215                 break;
216
217         /*
218          * This state means that we have gotten a response
219          * to our attempt to establish a connection.
220          * We fill in the data from the other side,
221          * telling us which port to respond to, instead of the well-
222          * known one we might have sent to in the first place.
223          * We also require that this is a response to our
224          * connection id.
225          */
226         case TCPS_SYN_SENT:
227                 if (si->si_did!=cb->s_sid) {
228                         spp_istat.notme++;
229                         goto drop;
230                 }
231                 sppstat.spps_connects++;
232                 cb->s_did = si->si_sid;
233                 cb->s_rack = si->si_ack;
234                 cb->s_ralo = si->si_alo;
235                 cb->s_dport = nsp->nsp_fport =  si->si_sport;
236                 cb->s_timer[SPPT_REXMT] = 0;
237                 cb->s_flags |= SF_ACKNOW;
238                 soisconnected(so);
239                 cb->s_state = TCPS_ESTABLISHED;
240                 /* Use roundtrip time of connection request for initial rtt */
241                 if (cb->s_rtt) {
242                         cb->s_srtt = cb->s_rtt << 3;
243                         cb->s_rttvar = cb->s_rtt << 1;
244                         SPPT_RANGESET(cb->s_rxtcur,
245                             ((cb->s_srtt >> 2) + cb->s_rttvar) >> 1,
246                             SPPTV_MIN, SPPTV_REXMTMAX);
247                             cb->s_rtt = 0;
248                 }
249         }
250         if (so->so_options & SO_DEBUG || traceallspps)
251                 spp_trace(SA_INPUT, (u_char)ostate, cb, &spp_savesi, 0);
252
253         m->m_len -= sizeof (struct idp);
254         m->m_pkthdr.len -= sizeof (struct idp);
255         m->m_data += sizeof (struct idp);
256
257         if (spp_reass(cb, si)) {
258                 (void) m_freem(m);
259         }
260         if (cb->s_force || (cb->s_flags & (SF_ACKNOW|SF_WIN|SF_RXT)))
261                 (void) spp_output(cb, (struct mbuf *)0);
262         cb->s_flags &= ~(SF_WIN|SF_RXT);
263         return;
264
265 dropwithreset:
266         if (dropsocket)
267                 (void) soabort(so);
268         si->si_seq = ntohs(si->si_seq);
269         si->si_ack = ntohs(si->si_ack);
270         si->si_alo = ntohs(si->si_alo);
271         ns_error(dtom(si), NS_ERR_NOSOCK, 0);
272         if (cb->s_nspcb->nsp_socket->so_options & SO_DEBUG || traceallspps)
273                 spp_trace(SA_DROP, (u_char)ostate, cb, &spp_savesi, 0);
274         return;
275
276 drop:
277 bad:
278         if (cb == 0 || cb->s_nspcb->nsp_socket->so_options & SO_DEBUG ||
279             traceallspps)
280                 spp_trace(SA_DROP, (u_char)ostate, cb, &spp_savesi, 0);
281         m_freem(m);
282 }
283
284 int spprexmtthresh = 3;
285
286 /*
287  * This is structurally similar to the tcp reassembly routine
288  * but its function is somewhat different:  It merely queues
289  * packets up, and suppresses duplicates.
290  */
291 spp_reass(cb, si)
292 struct sppcb *cb;
293 struct spidp *si;
294 {
295         struct spidp_q *q;
296         struct mbuf *m;
297         struct socket *so = cb->s_nspcb->nsp_socket;
298         char packetp = cb->s_flags & SF_HI;
299         int incr;
300         char wakeup = 0;
301
302         if (si == SI(0))
303                 goto present;
304         /*
305          * Update our news from them.
306          */
307         if (si->si_cc & SP_SA)
308                 cb->s_flags |= (spp_use_delack ? SF_DELACK : SF_ACKNOW);
309         if (SSEQ_GT(si->si_alo, cb->s_ralo))
310                 cb->s_flags |= SF_WIN;
311         if (SSEQ_LEQ(si->si_ack, cb->s_rack)) {
312                 if ((si->si_cc & SP_SP) && cb->s_rack != (cb->s_smax + 1)) {
313                         sppstat.spps_rcvdupack++;
314                         /*
315                          * If this is a completely duplicate ack
316                          * and other conditions hold, we assume
317                          * a packet has been dropped and retransmit
318                          * it exactly as in tcp_input().
319                          */
320                         if (si->si_ack != cb->s_rack ||
321                             si->si_alo != cb->s_ralo)
322                                 cb->s_dupacks = 0;
323                         else if (++cb->s_dupacks == spprexmtthresh) {
324                                 u_short onxt = cb->s_snxt;
325                                 int cwnd = cb->s_cwnd;
326
327                                 cb->s_snxt = si->si_ack;
328                                 cb->s_cwnd = CUNIT;
329                                 cb->s_force = 1 + SPPT_REXMT;
330                                 (void) spp_output(cb, (struct mbuf *)0);
331                                 cb->s_timer[SPPT_REXMT] = cb->s_rxtcur;
332                                 cb->s_rtt = 0;
333                                 if (cwnd >= 4 * CUNIT)
334                                         cb->s_cwnd = cwnd / 2;
335                                 if (SSEQ_GT(onxt, cb->s_snxt))
336                                         cb->s_snxt = onxt;
337                                 return (1);
338                         }
339                 } else
340                         cb->s_dupacks = 0;
341                 goto update_window;
342         }
343         cb->s_dupacks = 0;
344         /*
345          * If our correspondent acknowledges data we haven't sent
346          * TCP would drop the packet after acking.  We'll be a little
347          * more permissive
348          */
349         if (SSEQ_GT(si->si_ack, (cb->s_smax + 1))) {
350                 sppstat.spps_rcvacktoomuch++;
351                 si->si_ack = cb->s_smax + 1;
352         }
353         sppstat.spps_rcvackpack++;
354         /*
355          * If transmit timer is running and timed sequence
356          * number was acked, update smoothed round trip time.
357          * See discussion of algorithm in tcp_input.c
358          */
359         if (cb->s_rtt && SSEQ_GT(si->si_ack, cb->s_rtseq)) {
360                 sppstat.spps_rttupdated++;
361                 if (cb->s_srtt != 0) {
362                         short delta;
363                         delta = cb->s_rtt - (cb->s_srtt >> 3);
364                         if ((cb->s_srtt += delta) <= 0)
365                                 cb->s_srtt = 1;
366                         if (delta < 0)
367                                 delta = -delta;
368                         delta -= (cb->s_rttvar >> 2);
369                         if ((cb->s_rttvar += delta) <= 0)
370                                 cb->s_rttvar = 1;
371                 } else {
372                         /*
373                          * No rtt measurement yet
374                          */
375                         cb->s_srtt = cb->s_rtt << 3;
376                         cb->s_rttvar = cb->s_rtt << 1;
377                 }
378                 cb->s_rtt = 0;
379                 cb->s_rxtshift = 0;
380                 SPPT_RANGESET(cb->s_rxtcur,
381                         ((cb->s_srtt >> 2) + cb->s_rttvar) >> 1,
382                         SPPTV_MIN, SPPTV_REXMTMAX);
383         }
384         /*
385          * If all outstanding data is acked, stop retransmit
386          * timer and remember to restart (more output or persist).
387          * If there is more data to be acked, restart retransmit
388          * timer, using current (possibly backed-off) value;
389          */
390         if (si->si_ack == cb->s_smax + 1) {
391                 cb->s_timer[SPPT_REXMT] = 0;
392                 cb->s_flags |= SF_RXT;
393         } else if (cb->s_timer[SPPT_PERSIST] == 0)
394                 cb->s_timer[SPPT_REXMT] = cb->s_rxtcur;
395         /*
396          * When new data is acked, open the congestion window.
397          * If the window gives us less than ssthresh packets
398          * in flight, open exponentially (maxseg at a time).
399          * Otherwise open linearly (maxseg^2 / cwnd at a time).
400          */
401         incr = CUNIT;
402         if (cb->s_cwnd > cb->s_ssthresh)
403                 incr = max(incr * incr / cb->s_cwnd, 1);
404         cb->s_cwnd = min(cb->s_cwnd + incr, cb->s_cwmx);
405         /*
406          * Trim Acked data from output queue.
407          */
408         while ((m = so->so_snd.sb_mb) != NULL) {
409                 if (SSEQ_LT((mtod(m, struct spidp *))->si_seq, si->si_ack))
410                         sbdroprecord(&so->so_snd);
411                 else
412                         break;
413         }
414         sowwakeup(so);
415         cb->s_rack = si->si_ack;
416 update_window:
417         if (SSEQ_LT(cb->s_snxt, cb->s_rack))
418                 cb->s_snxt = cb->s_rack;
419         if (SSEQ_LT(cb->s_swl1, si->si_seq) || cb->s_swl1 == si->si_seq &&
420             (SSEQ_LT(cb->s_swl2, si->si_ack) ||
421              cb->s_swl2 == si->si_ack && SSEQ_LT(cb->s_ralo, si->si_alo))) {
422                 /* keep track of pure window updates */
423                 if ((si->si_cc & SP_SP) && cb->s_swl2 == si->si_ack
424                     && SSEQ_LT(cb->s_ralo, si->si_alo)) {
425                         sppstat.spps_rcvwinupd++;
426                         sppstat.spps_rcvdupack--;
427                 }
428                 cb->s_ralo = si->si_alo;
429                 cb->s_swl1 = si->si_seq;
430                 cb->s_swl2 = si->si_ack;
431                 cb->s_swnd = (1 + si->si_alo - si->si_ack);
432                 if (cb->s_swnd > cb->s_smxw)
433                         cb->s_smxw = cb->s_swnd;
434                 cb->s_flags |= SF_WIN;
435         }
436         /*
437          * If this packet number is higher than that which
438          * we have allocated refuse it, unless urgent
439          */
440         if (SSEQ_GT(si->si_seq, cb->s_alo)) {
441                 if (si->si_cc & SP_SP) {
442                         sppstat.spps_rcvwinprobe++;
443                         return (1);
444                 } else
445                         sppstat.spps_rcvpackafterwin++;
446                 if (si->si_cc & SP_OB) {
447                         if (SSEQ_GT(si->si_seq, cb->s_alo + 60)) {
448                                 ns_error(dtom(si), NS_ERR_FULLUP, 0);
449                                 return (0);
450                         } /* else queue this packet; */
451                 } else {
452                         /*register struct socket *so = cb->s_nspcb->nsp_socket;
453                         if (so->so_state && SS_NOFDREF) {
454                                 ns_error(dtom(si), NS_ERR_NOSOCK, 0);
455                                 (void)spp_close(cb);
456                         } else
457                                        would crash system*/
458                         spp_istat.notyet++;
459                         ns_error(dtom(si), NS_ERR_FULLUP, 0);
460                         return (0);
461                 }
462         }
463         /*
464          * If this is a system packet, we don't need to
465          * queue it up, and won't update acknowledge #
466          */
467         if (si->si_cc & SP_SP) {
468                 return (1);
469         }
470         /*
471          * We have already seen this packet, so drop.
472          */
473         if (SSEQ_LT(si->si_seq, cb->s_ack)) {
474                 spp_istat.bdreas++;
475                 sppstat.spps_rcvduppack++;
476                 if (si->si_seq == cb->s_ack - 1)
477                         spp_istat.lstdup++;
478                 return (1);
479         }
480         /*
481          * Loop through all packets queued up to insert in
482          * appropriate sequence.
483          */
484         for (q = cb->s_q.si_next; q!=&cb->s_q; q = q->si_next) {
485                 if (si->si_seq == SI(q)->si_seq) {
486                         sppstat.spps_rcvduppack++;
487                         return (1);
488                 }
489                 if (SSEQ_LT(si->si_seq, SI(q)->si_seq)) {
490                         sppstat.spps_rcvoopack++;
491                         break;
492                 }
493         }
494         insque(si, q->si_prev);
495         /*
496          * If this packet is urgent, inform process
497          */
498         if (si->si_cc & SP_OB) {
499                 cb->s_iobc = ((char *)si)[1 + sizeof(*si)];
500                 sohasoutofband(so);
501                 cb->s_oobflags |= SF_IOOB;
502         }
503 present:
504 #define SPINC sizeof(struct sphdr)
505         /*
506          * Loop through all packets queued up to update acknowledge
507          * number, and present all acknowledged data to user;
508          * If in packet interface mode, show packet headers.
509          */
510         for (q = cb->s_q.si_next; q!=&cb->s_q; q = q->si_next) {
511                   if (SI(q)->si_seq == cb->s_ack) {
512                         cb->s_ack++;
513                         m = dtom(q);
514                         if (SI(q)->si_cc & SP_OB) {
515                                 cb->s_oobflags &= ~SF_IOOB;
516                                 if (so->so_rcv.sb_cc)
517                                         so->so_oobmark = so->so_rcv.sb_cc;
518                                 else
519                                         so->so_state |= SS_RCVATMARK;
520                         }
521                         q = q->si_prev;
522                         remque(q->si_next);
523                         wakeup = 1;
524                         sppstat.spps_rcvpack++;
525 #ifdef SF_NEWCALL
526                         if (cb->s_flags2 & SF_NEWCALL) {
527                                 struct sphdr *sp = mtod(m, struct sphdr *);
528                                 u_char dt = sp->sp_dt;
529                                 spp_newchecks[4]++;
530                                 if (dt != cb->s_rhdr.sp_dt) {
531                                         struct mbuf *mm =
532                                            m_getclr(M_DONTWAIT, MT_CONTROL);
533                                         spp_newchecks[0]++;
534                                         if (mm != NULL) {
535                                                 u_short *s =
536                                                         mtod(mm, u_short *);
537                                                 cb->s_rhdr.sp_dt = dt;
538                                                 mm->m_len = 5; /*XXX*/
539                                                 s[0] = 5;
540                                                 s[1] = 1;
541                                                 *(u_char *)(&s[2]) = dt;
542                                                 sbappend(&so->so_rcv, mm);
543                                         }
544                                 }
545                                 if (sp->sp_cc & SP_OB) {
546                                         MCHTYPE(m, MT_OOBDATA);
547                                         spp_newchecks[1]++;
548                                         so->so_oobmark = 0;
549                                         so->so_state &= ~SS_RCVATMARK;
550                                 }
551                                 if (packetp == 0) {
552                                         m->m_data += SPINC;
553                                         m->m_len -= SPINC;
554                                         m->m_pkthdr.len -= SPINC;
555                                 }
556                                 if ((sp->sp_cc & SP_EM) || packetp) {
557                                         sbappendrecord(&so->so_rcv, m);
558                                         spp_newchecks[9]++;
559                                 } else
560                                         sbappend(&so->so_rcv, m);
561                         } else
562 #endif
563                         if (packetp) {
564                                 sbappendrecord(&so->so_rcv, m);
565                         } else {
566                                 cb->s_rhdr = *mtod(m, struct sphdr *);
567                                 m->m_data += SPINC;
568                                 m->m_len -= SPINC;
569                                 m->m_pkthdr.len -= SPINC;
570                                 sbappend(&so->so_rcv, m);
571                         }
572                   } else
573                         break;
574         }
575         if (wakeup) sorwakeup(so);
576         return (0);
577 }
578
579 spp_ctlinput(cmd, arg)
580         int cmd;
581         caddr_t arg;
582 {
583         struct ns_addr *na;
584         extern u_char nsctlerrmap[];
585         extern spp_abort(), spp_quench();
586         extern struct nspcb *idp_drop();
587         struct ns_errp *errp;
588         struct nspcb *nsp;
589         struct sockaddr_ns *sns;
590         int type;
591
592         if (cmd < 0 || cmd > PRC_NCMDS)
593                 return;
594         type = NS_ERR_UNREACH_HOST;
595
596         switch (cmd) {
597
598         case PRC_ROUTEDEAD:
599                 return;
600
601         case PRC_IFDOWN:
602         case PRC_HOSTDEAD:
603         case PRC_HOSTUNREACH:
604                 sns = (struct sockaddr_ns *)arg;
605                 if (sns->sns_family != AF_NS)
606                         return;
607                 na = &sns->sns_addr;
608                 break;
609
610         default:
611                 errp = (struct ns_errp *)arg;
612                 na = &errp->ns_err_idp.idp_dna;
613                 type = errp->ns_err_num;
614                 type = ntohs((u_short)type);
615         }
616         switch (type) {
617
618         case NS_ERR_UNREACH_HOST:
619                 ns_pcbnotify(na, (int)nsctlerrmap[cmd], spp_abort, (long) 0);
620                 break;
621
622         case NS_ERR_TOO_BIG:
623         case NS_ERR_NOSOCK:
624                 nsp = ns_pcblookup(na, errp->ns_err_idp.idp_sna.x_port,
625                         NS_WILDCARD);
626                 if (nsp) {
627                         if(nsp->nsp_pcb)
628                                 (void) spp_drop((struct sppcb *)nsp->nsp_pcb,
629                                                 (int)nsctlerrmap[cmd]);
630                         else
631                                 (void) idp_drop(nsp, (int)nsctlerrmap[cmd]);
632                 }
633                 break;
634
635         case NS_ERR_FULLUP:
636                 ns_pcbnotify(na, 0, spp_quench, (long) 0);
637         }
638 }
639 /*
640  * When a source quench is received, close congestion window
641  * to one packet.  We will gradually open it again as we proceed.
642  */
643 spp_quench(nsp)
644         struct nspcb *nsp;
645 {
646         struct sppcb *cb = nstosppcb(nsp);
647
648         if (cb)
649                 cb->s_cwnd = CUNIT;
650 }
651
652 #ifdef notdef
653 int
654 spp_fixmtu(nsp)
655 struct nspcb *nsp;
656 {
657         struct sppcb *cb = (struct sppcb *)(nsp->nsp_pcb);
658         struct mbuf *m;
659         struct spidp *si;
660         struct ns_errp *ep;
661         struct sockbuf *sb;
662         int badseq, len;
663         struct mbuf *firstbad, *m0;
664
665         if (cb) {
666                 /*
667                  * The notification that we have sent
668                  * too much is bad news -- we will
669                  * have to go through queued up so far
670                  * splitting ones which are too big and
671                  * reassigning sequence numbers and checksums.
672                  * we should then retransmit all packets from
673                  * one above the offending packet to the last one
674                  * we had sent (or our allocation)
675                  * then the offending one so that the any queued
676                  * data at our destination will be discarded.
677                  */
678                  ep = (struct ns_errp *)nsp->nsp_notify_param;
679                  sb = &nsp->nsp_socket->so_snd;
680                  cb->s_mtu = ep->ns_err_param;
681                  badseq = SI(&ep->ns_err_idp)->si_seq;
682                  for (m = sb->sb_mb; m; m = m->m_act) {
683                         si = mtod(m, struct spidp *);
684                         if (si->si_seq == badseq)
685                                 break;
686                  }
687                  if (m == 0) return;
688                  firstbad = m;
689                  /*for (;;) {*/
690                         /* calculate length */
691                         for (m0 = m, len = 0; m ; m = m->m_next)
692                                 len += m->m_len;
693                         if (len > cb->s_mtu) {
694                         }
695                 /* FINISH THIS
696                 } */
697         }
698 }
699 #endif
700
701 spp_output(cb, m0)
702         struct sppcb *cb;
703         struct mbuf *m0;
704 {
705         struct socket *so = cb->s_nspcb->nsp_socket;
706         struct mbuf *m;
707         struct spidp *si = (struct spidp *) 0;
708         struct sockbuf *sb = &so->so_snd;
709         int len = 0, win, rcv_win;
710         short span, off, recordp = 0;
711         u_short alo;
712         int error = 0, sendalot;
713 #ifdef notdef
714         int idle;
715 #endif
716         struct mbuf *mprev;
717         extern int idpcksum;
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, M_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(M_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(M_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(M_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 spp_setpersist(cb)
1117         struct sppcb *cb;
1118 {
1119         t = ((cb->s_srtt >> 2) + cb->s_rttvar) >> 1;
1120         extern int spp_backoff[];
1121
1122         if (cb->s_timer[SPPT_REXMT] && spp_do_persist_panics)
1123                 panic("spp_output REXMT");
1124         /*
1125          * Start/restart persistance timer.
1126          */
1127         SPPT_RANGESET(cb->s_timer[SPPT_PERSIST],
1128             t*spp_backoff[cb->s_rxtshift],
1129             SPPTV_PERSMIN, SPPTV_PERSMAX);
1130         if (cb->s_rxtshift < SPP_MAXRXTSHIFT)
1131                 cb->s_rxtshift++;
1132 }
1133 /*ARGSUSED*/
1134 spp_ctloutput(req, so, level, name, value)
1135         int req;
1136         struct socket *so;
1137         int name;
1138         struct mbuf **value;
1139 {
1140         struct mbuf *m;
1141         struct nspcb *nsp = sotonspcb(so);
1142         struct sppcb *cb;
1143         int mask, error = 0;
1144
1145         if (level != NSPROTO_SPP) {
1146                 /* This will have to be changed when we do more general
1147                    stacking of protocols */
1148                 return (idp_ctloutput(req, so, level, name, value));
1149         }
1150         if (nsp == NULL) {
1151                 error = EINVAL;
1152                 goto release;
1153         } else
1154                 cb = nstosppcb(nsp);
1155
1156         switch (req) {
1157
1158         case PRCO_GETOPT:
1159                 if (value == NULL)
1160                         return (EINVAL);
1161                 m = m_get(M_DONTWAIT, MT_DATA);
1162                 if (m == NULL)
1163                         return (ENOBUFS);
1164                 switch (name) {
1165
1166                 case SO_HEADERS_ON_INPUT:
1167                         mask = SF_HI;
1168                         goto get_flags;
1169
1170                 case SO_HEADERS_ON_OUTPUT:
1171                         mask = SF_HO;
1172                 get_flags:
1173                         m->m_len = sizeof(short);
1174                         *mtod(m, short *) = cb->s_flags & mask;
1175                         break;
1176
1177                 case SO_MTU:
1178                         m->m_len = sizeof(u_short);
1179                         *mtod(m, short *) = cb->s_mtu;
1180                         break;
1181
1182                 case SO_LAST_HEADER:
1183                         m->m_len = sizeof(struct sphdr);
1184                         *mtod(m, struct sphdr *) = cb->s_rhdr;
1185                         break;
1186
1187                 case SO_DEFAULT_HEADERS:
1188                         m->m_len = sizeof(struct spidp);
1189                         *mtod(m, struct sphdr *) = cb->s_shdr;
1190                         break;
1191
1192                 default:
1193                         error = EINVAL;
1194                 }
1195                 *value = m;
1196                 break;
1197
1198         case PRCO_SETOPT:
1199                 if (value == 0 || *value == 0) {
1200                         error = EINVAL;
1201                         break;
1202                 }
1203                 switch (name) {
1204                         int *ok;
1205
1206                 case SO_HEADERS_ON_INPUT:
1207                         mask = SF_HI;
1208                         goto set_head;
1209
1210                 case SO_HEADERS_ON_OUTPUT:
1211                         mask = SF_HO;
1212                 set_head:
1213                         if (cb->s_flags & SF_PI) {
1214                                 ok = mtod(*value, int *);
1215                                 if (*ok)
1216                                         cb->s_flags |= mask;
1217                                 else
1218                                         cb->s_flags &= ~mask;
1219                         } else error = EINVAL;
1220                         break;
1221
1222                 case SO_MTU:
1223                         cb->s_mtu = *(mtod(*value, u_short *));
1224                         break;
1225
1226 #ifdef SF_NEWCALL
1227                 case SO_NEWCALL:
1228                         ok = mtod(*value, int *);
1229                         if (*ok) {
1230                                 cb->s_flags2 |= SF_NEWCALL;
1231                                 spp_newchecks[5]++;
1232                         } else {
1233                                 cb->s_flags2 &= ~SF_NEWCALL;
1234                                 spp_newchecks[6]++;
1235                         }
1236                         break;
1237 #endif
1238
1239                 case SO_DEFAULT_HEADERS:
1240                         {
1241                                 struct sphdr *sp
1242                                                 = mtod(*value, struct sphdr *);
1243                                 cb->s_dt = sp->sp_dt;
1244                                 cb->s_cc = sp->sp_cc & SP_EM;
1245                         }
1246                         break;
1247
1248                 default:
1249                         error = EINVAL;
1250                 }
1251                 m_freem(*value);
1252                 break;
1253         }
1254         release:
1255                 return (error);
1256 }
1257
1258 /*ARGSUSED*/
1259 spp_usrreq(so, req, m, nam, controlp)
1260         struct socket *so;
1261         int req;
1262         struct mbuf *m, *nam, *controlp;
1263 {
1264         struct nspcb *nsp = sotonspcb(so);
1265         struct sppcb *cb;
1266         int s = splnet();
1267         int error = 0, ostate;
1268         struct mbuf *mm;
1269         struct sockbuf *sb;
1270
1271         if (req == PRU_CONTROL)
1272                 return (ns_control(so, (int)m, (caddr_t)nam,
1273                         (struct ifnet *)controlp));
1274         if (nsp == NULL) {
1275                 if (req != PRU_ATTACH) {
1276                         error = EINVAL;
1277                         goto release;
1278                 }
1279         } else
1280                 cb = nstosppcb(nsp);
1281
1282         ostate = cb ? cb->s_state : 0;
1283
1284         switch (req) {
1285
1286         case PRU_ATTACH:
1287                 if (nsp != NULL) {
1288                         error = EISCONN;
1289                         break;
1290                 }
1291                 error = ns_pcballoc(so, &nspcb);
1292                 if (error)
1293                         break;
1294                 if (so->so_snd.sb_hiwat == 0 || so->so_rcv.sb_hiwat == 0) {
1295                         error = soreserve(so, (u_long) 3072, (u_long) 3072);
1296                         if (error)
1297                                 break;
1298                 }
1299                 nsp = sotonspcb(so);
1300
1301                 mm = m_getclr(M_DONTWAIT, MT_PCB);
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(M_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         return (error);
1509 }
1510
1511 spp_usrreq_sp(so, req, m, nam, controlp)
1512         struct socket *so;
1513         int req;
1514         struct mbuf *m, *nam, *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 spp_template(cb)
1533         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(cb)
1561         struct sppcb *cb;
1562 {
1563         struct spidp_q *s;
1564         struct nspcb *nsp = cb->s_nspcb;
1565         struct socket *so = nsp->nsp_socket;
1566         struct mbuf *m;
1567
1568         s = cb->s_q.si_next;
1569         while (s != &(cb->s_q)) {
1570                 s = s->si_next;
1571                 m = dtom(s->si_prev);
1572                 remque(s->si_prev);
1573                 m_freem(m);
1574         }
1575         (void) m_free(dtom(cb->s_idp));
1576         (void) m_free(dtom(cb));
1577         nsp->nsp_pcb = 0;
1578         soisdisconnected(so);
1579         ns_pcbdetach(nsp);
1580         sppstat.spps_closed++;
1581         return ((struct sppcb *)0);
1582 }
1583 /*
1584  *      Someday we may do level 3 handshaking
1585  *      to close a connection or send a xerox style error.
1586  *      For now, just close.
1587  */
1588 struct sppcb *
1589 spp_usrclosed(cb)
1590         struct sppcb *cb;
1591 {
1592         return (spp_close(cb));
1593 }
1594 struct sppcb *
1595 spp_disconnect(cb)
1596         struct sppcb *cb;
1597 {
1598         return (spp_close(cb));
1599 }
1600 /*
1601  * Drop connection, reporting
1602  * the specified error.
1603  */
1604 struct sppcb *
1605 spp_drop(cb, errno)
1606         struct sppcb *cb;
1607         int errno;
1608 {
1609         struct socket *so = cb->s_nspcb->nsp_socket;
1610
1611         /*
1612          * someday, in the xerox world
1613          * we will generate error protocol packets
1614          * announcing that the socket has gone away.
1615          */
1616         if (TCPS_HAVERCVDSYN(cb->s_state)) {
1617                 sppstat.spps_drops++;
1618                 cb->s_state = TCPS_CLOSED;
1619                 /*(void) tcp_output(cb);*/
1620         } else
1621                 sppstat.spps_conndrops++;
1622         so->so_error = errno;
1623         return (spp_close(cb));
1624 }
1625
1626 spp_abort(nsp)
1627         struct nspcb *nsp;
1628 {
1629
1630         (void) spp_close((struct sppcb *)nsp->nsp_pcb);
1631 }
1632
1633 int     spp_backoff[SPP_MAXRXTSHIFT+1] =
1634     { 1, 2, 4, 8, 16, 32, 64, 64, 64, 64, 64, 64, 64 };
1635 /*
1636  * Fast timeout routine for processing delayed acks
1637  */
1638 spp_fasttimo()
1639 {
1640         struct nspcb *nsp;
1641         struct sppcb *cb;
1642         int s = splnet();
1643
1644         nsp = nspcb.nsp_next;
1645         if (nsp)
1646         for (; nsp != &nspcb; nsp = nsp->nsp_next)
1647                 if ((cb = (struct sppcb *)nsp->nsp_pcb) &&
1648                     (cb->s_flags & SF_DELACK)) {
1649                         cb->s_flags &= ~SF_DELACK;
1650                         cb->s_flags |= SF_ACKNOW;
1651                         sppstat.spps_delack++;
1652                         (void) spp_output(cb, (struct mbuf *) 0);
1653                 }
1654         splx(s);
1655 }
1656
1657 /*
1658  * spp protocol timeout routine called every 500 ms.
1659  * Updates the timers in all active pcb's and
1660  * causes finite state machine actions if timers expire.
1661  */
1662 spp_slowtimo()
1663 {
1664         struct nspcb *ip, *ipnxt;
1665         struct sppcb *cb;
1666         int s = splnet();
1667         int i;
1668
1669         /*
1670          * Search through tcb's and update active timers.
1671          */
1672         ip = nspcb.nsp_next;
1673         if (ip == 0) {
1674                 splx(s);
1675                 return;
1676         }
1677         while (ip != &nspcb) {
1678                 cb = nstosppcb(ip);
1679                 ipnxt = ip->nsp_next;
1680                 if (cb == 0)
1681                         goto tpgone;
1682                 for (i = 0; i < SPPT_NTIMERS; i++) {
1683                         if (cb->s_timer[i] && --cb->s_timer[i] == 0) {
1684                                 (void) spp_usrreq(cb->s_nspcb->nsp_socket,
1685                                     PRU_SLOWTIMO, (struct mbuf *)0,
1686                                     (struct mbuf *)i, (struct mbuf *)0,
1687                                     (struct mbuf *)0);
1688                                 if (ipnxt->nsp_prev != ip)
1689                                         goto tpgone;
1690                         }
1691                 }
1692                 cb->s_idle++;
1693                 if (cb->s_rtt)
1694                         cb->s_rtt++;
1695 tpgone:
1696                 ip = ipnxt;
1697         }
1698         spp_iss += SPP_ISSINCR/PR_SLOWHZ;               /* increment iss */
1699         splx(s);
1700 }
1701 /*
1702  * SPP timer processing.
1703  */
1704 struct sppcb *
1705 spp_timers(cb, timer)
1706         struct sppcb *cb;
1707         int timer;
1708 {
1709         long rexmt;
1710         int win;
1711
1712         cb->s_force = 1 + timer;
1713         switch (timer) {
1714
1715         /*
1716          * 2 MSL timeout in shutdown went off.  TCP deletes connection
1717          * control block.
1718          */
1719         case SPPT_2MSL:
1720                 printf("spp: SPPT_2MSL went off for no reason\n");
1721                 cb->s_timer[timer] = 0;
1722                 break;
1723
1724         /*
1725          * Retransmission timer went off.  Message has not
1726          * been acked within retransmit interval.  Back off
1727          * to a longer retransmit interval and retransmit one packet.
1728          */
1729         case SPPT_REXMT:
1730                 if (++cb->s_rxtshift > SPP_MAXRXTSHIFT) {
1731                         cb->s_rxtshift = SPP_MAXRXTSHIFT;
1732                         sppstat.spps_timeoutdrop++;
1733                         cb = spp_drop(cb, ETIMEDOUT);
1734                         break;
1735                 }
1736                 sppstat.spps_rexmttimeo++;
1737                 rexmt = ((cb->s_srtt >> 2) + cb->s_rttvar) >> 1;
1738                 rexmt *= spp_backoff[cb->s_rxtshift];
1739                 SPPT_RANGESET(cb->s_rxtcur, rexmt, SPPTV_MIN, SPPTV_REXMTMAX);
1740                 cb->s_timer[SPPT_REXMT] = cb->s_rxtcur;
1741                 /*
1742                  * If we have backed off fairly far, our srtt
1743                  * estimate is probably bogus.  Clobber it
1744                  * so we'll take the next rtt measurement as our srtt;
1745                  * move the current srtt into rttvar to keep the current
1746                  * retransmit times until then.
1747                  */
1748                 if (cb->s_rxtshift > SPP_MAXRXTSHIFT / 4 ) {
1749                         cb->s_rttvar += (cb->s_srtt >> 2);
1750                         cb->s_srtt = 0;
1751                 }
1752                 cb->s_snxt = cb->s_rack;
1753                 /*
1754                  * If timing a packet, stop the timer.
1755                  */
1756                 cb->s_rtt = 0;
1757                 /*
1758                  * See very long discussion in tcp_timer.c about congestion
1759                  * window and sstrhesh
1760                  */
1761                 win = min(cb->s_swnd, (cb->s_cwnd/CUNIT)) / 2;
1762                 if (win < 2)
1763                         win = 2;
1764                 cb->s_cwnd = CUNIT;
1765                 cb->s_ssthresh = win * CUNIT;
1766                 (void) spp_output(cb, (struct mbuf *) 0);
1767                 break;
1768
1769         /*
1770          * Persistance timer into zero window.
1771          * Force a probe to be sent.
1772          */
1773         case SPPT_PERSIST:
1774                 sppstat.spps_persisttimeo++;
1775                 spp_setpersist(cb);
1776                 (void) spp_output(cb, (struct mbuf *) 0);
1777                 break;
1778
1779         /*
1780          * Keep-alive timer went off; send something
1781          * or drop connection if idle for too long.
1782          */
1783         case SPPT_KEEP:
1784                 sppstat.spps_keeptimeo++;
1785                 if (cb->s_state < TCPS_ESTABLISHED)
1786                         goto dropit;
1787                 if (cb->s_nspcb->nsp_socket->so_options & SO_KEEPALIVE) {
1788                         if (cb->s_idle >= SPPTV_MAXIDLE)
1789                                 goto dropit;
1790                         sppstat.spps_keepprobe++;
1791                         (void) spp_output(cb, (struct mbuf *) 0);
1792                 } else
1793                         cb->s_idle = 0;
1794                 cb->s_timer[SPPT_KEEP] = SPPTV_KEEP;
1795                 break;
1796         dropit:
1797                 sppstat.spps_keepdrops++;
1798                 cb = spp_drop(cb, ETIMEDOUT);
1799                 break;
1800         }
1801         return (cb);
1802 }
1803 #ifndef lint
1804 int SppcbSize = sizeof (struct sppcb);
1805 int NspcbSize = sizeof (struct nspcb);
1806 #endif /* lint */