Home | History | Annotate | Line # | Download | only in netinet
tcp_output.c revision 1.141.8.2
      1 /*	$NetBSD: tcp_output.c,v 1.141.8.2 2006/09/14 12:31:55 yamt Exp $	*/
      2 
      3 /*
      4  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  * 3. Neither the name of the project nor the names of its contributors
     16  *    may be used to endorse or promote products derived from this software
     17  *    without specific prior written permission.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
     20  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     22  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
     23  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     24  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     25  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     26  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     27  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29  * SUCH DAMAGE.
     30  */
     31 
     32 /*
     33  *      @(#)COPYRIGHT   1.1 (NRL) 17 January 1995
     34  *
     35  * NRL grants permission for redistribution and use in source and binary
     36  * forms, with or without modification, of the software and documentation
     37  * created at NRL provided that the following conditions are met:
     38  *
     39  * 1. Redistributions of source code must retain the above copyright
     40  *    notice, this list of conditions and the following disclaimer.
     41  * 2. Redistributions in binary form must reproduce the above copyright
     42  *    notice, this list of conditions and the following disclaimer in the
     43  *    documentation and/or other materials provided with the distribution.
     44  * 3. All advertising materials mentioning features or use of this software
     45  *    must display the following acknowledgements:
     46  *      This product includes software developed by the University of
     47  *      California, Berkeley and its contributors.
     48  *      This product includes software developed at the Information
     49  *      Technology Division, US Naval Research Laboratory.
     50  * 4. Neither the name of the NRL nor the names of its contributors
     51  *    may be used to endorse or promote products derived from this software
     52  *    without specific prior written permission.
     53  *
     54  * THE SOFTWARE PROVIDED BY NRL IS PROVIDED BY NRL AND CONTRIBUTORS ``AS
     55  * IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     56  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
     57  * PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL NRL OR
     58  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
     59  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
     60  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
     61  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
     62  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
     63  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
     64  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     65  *
     66  * The views and conclusions contained in the software and documentation
     67  * are those of the authors and should not be interpreted as representing
     68  * official policies, either expressed or implied, of the US Naval
     69  * Research Laboratory (NRL).
     70  */
     71 
     72 /*-
     73  * Copyright (c) 1997, 1998, 2001, 2005, 2006 The NetBSD Foundation, Inc.
     74  * All rights reserved.
     75  *
     76  * This code is derived from software contributed to The NetBSD Foundation
     77  * by Jason R. Thorpe and Kevin M. Lahey of the Numerical Aerospace Simulation
     78  * Facility, NASA Ames Research Center.
     79  * This code is derived from software contributed to The NetBSD Foundation
     80  * by Charles M. Hannum.
     81  * This code is derived from software contributed to The NetBSD Foundation
     82  * by Rui Paulo.
     83  *
     84  * Redistribution and use in source and binary forms, with or without
     85  * modification, are permitted provided that the following conditions
     86  * are met:
     87  * 1. Redistributions of source code must retain the above copyright
     88  *    notice, this list of conditions and the following disclaimer.
     89  * 2. Redistributions in binary form must reproduce the above copyright
     90  *    notice, this list of conditions and the following disclaimer in the
     91  *    documentation and/or other materials provided with the distribution.
     92  * 3. All advertising materials mentioning features or use of this software
     93  *    must display the following acknowledgement:
     94  *	This product includes software developed by the NetBSD
     95  *	Foundation, Inc. and its contributors.
     96  * 4. Neither the name of The NetBSD Foundation nor the names of its
     97  *    contributors may be used to endorse or promote products derived
     98  *    from this software without specific prior written permission.
     99  *
    100  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
    101  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
    102  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
    103  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
    104  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
    105  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
    106  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
    107  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
    108  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
    109  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
    110  * POSSIBILITY OF SUCH DAMAGE.
    111  */
    112 
    113 /*
    114  * Copyright (c) 1982, 1986, 1988, 1990, 1993, 1995
    115  *	The Regents of the University of California.  All rights reserved.
    116  *
    117  * Redistribution and use in source and binary forms, with or without
    118  * modification, are permitted provided that the following conditions
    119  * are met:
    120  * 1. Redistributions of source code must retain the above copyright
    121  *    notice, this list of conditions and the following disclaimer.
    122  * 2. Redistributions in binary form must reproduce the above copyright
    123  *    notice, this list of conditions and the following disclaimer in the
    124  *    documentation and/or other materials provided with the distribution.
    125  * 3. Neither the name of the University nor the names of its contributors
    126  *    may be used to endorse or promote products derived from this software
    127  *    without specific prior written permission.
    128  *
    129  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
    130  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
    131  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
    132  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
    133  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
    134  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
    135  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
    136  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
    137  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
    138  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
    139  * SUCH DAMAGE.
    140  *
    141  *	@(#)tcp_output.c	8.4 (Berkeley) 5/24/95
    142  */
    143 
    144 #include <sys/cdefs.h>
    145 __KERNEL_RCSID(0, "$NetBSD: tcp_output.c,v 1.141.8.2 2006/09/14 12:31:55 yamt Exp $");
    146 
    147 #include "opt_inet.h"
    148 #include "opt_ipsec.h"
    149 #include "opt_tcp_debug.h"
    150 
    151 #include <sys/param.h>
    152 #include <sys/systm.h>
    153 #include <sys/malloc.h>
    154 #include <sys/mbuf.h>
    155 #include <sys/protosw.h>
    156 #include <sys/socket.h>
    157 #include <sys/socketvar.h>
    158 #include <sys/errno.h>
    159 #include <sys/domain.h>
    160 #include <sys/kernel.h>
    161 #ifdef TCP_SIGNATURE
    162 #include <sys/md5.h>
    163 #endif
    164 
    165 #include <net/if.h>
    166 #include <net/route.h>
    167 
    168 #include <netinet/in.h>
    169 #include <netinet/in_systm.h>
    170 #include <netinet/ip.h>
    171 #include <netinet/in_pcb.h>
    172 #include <netinet/ip_var.h>
    173 
    174 #ifdef INET6
    175 #ifndef INET
    176 #include <netinet/in.h>
    177 #endif
    178 #include <netinet/ip6.h>
    179 #include <netinet6/in6_var.h>
    180 #include <netinet6/ip6_var.h>
    181 #include <netinet6/in6_pcb.h>
    182 #include <netinet6/nd6.h>
    183 #endif
    184 
    185 #ifdef FAST_IPSEC
    186 #include <netipsec/ipsec.h>
    187 #include <netipsec/key.h>
    188 #endif	/* FAST_IPSEC*/
    189 #ifdef IPSEC
    190 #include <netinet6/ipsec.h>
    191 #endif
    192 
    193 #include <netinet/tcp.h>
    194 #define	TCPOUTFLAGS
    195 #include <netinet/tcp_fsm.h>
    196 #include <netinet/tcp_seq.h>
    197 #include <netinet/tcp_timer.h>
    198 #include <netinet/tcp_var.h>
    199 #include <netinet/tcpip.h>
    200 #include <netinet/tcp_debug.h>
    201 #include <netinet/in_offload.h>
    202 
    203 #ifdef IPSEC
    204 #include <netkey/key.h>
    205 #endif
    206 
    207 #ifdef notyet
    208 extern struct mbuf *m_copypack();
    209 #endif
    210 
    211 /*
    212  * Knob to enable Congestion Window Monitoring, and control
    213  * the burst size it allows.  Default burst is 4 packets, per
    214  * the Internet draft.
    215  */
    216 int	tcp_cwm = 0;
    217 int	tcp_cwm_burstsize = 4;
    218 
    219 #ifdef TCP_OUTPUT_COUNTERS
    220 #include <sys/device.h>
    221 
    222 extern struct evcnt tcp_output_bigheader;
    223 extern struct evcnt tcp_output_predict_hit;
    224 extern struct evcnt tcp_output_predict_miss;
    225 extern struct evcnt tcp_output_copysmall;
    226 extern struct evcnt tcp_output_copybig;
    227 extern struct evcnt tcp_output_refbig;
    228 
    229 #define	TCP_OUTPUT_COUNTER_INCR(ev)	(ev)->ev_count++
    230 #else
    231 
    232 #define	TCP_OUTPUT_COUNTER_INCR(ev)	/* nothing */
    233 
    234 #endif /* TCP_OUTPUT_COUNTERS */
    235 
    236 static
    237 #ifndef GPROF
    238 inline
    239 #endif
    240 int
    241 tcp_segsize(struct tcpcb *tp, int *txsegsizep, int *rxsegsizep)
    242 {
    243 #ifdef INET
    244 	struct inpcb *inp = tp->t_inpcb;
    245 #endif
    246 #ifdef INET6
    247 	struct in6pcb *in6p = tp->t_in6pcb;
    248 #endif
    249 	struct socket *so = NULL;
    250 	struct rtentry *rt;
    251 	struct ifnet *ifp;
    252 	int size;
    253 	int hdrlen;
    254 	int optlen;
    255 
    256 #ifdef DIAGNOSTIC
    257 	if (tp->t_inpcb && tp->t_in6pcb)
    258 		panic("tcp_segsize: both t_inpcb and t_in6pcb are set");
    259 #endif
    260 	switch (tp->t_family) {
    261 #ifdef INET
    262 	case AF_INET:
    263 		hdrlen = sizeof(struct ip) + sizeof(struct tcphdr);
    264 		break;
    265 #endif
    266 #ifdef INET6
    267 	case AF_INET6:
    268 		hdrlen = sizeof(struct ip6_hdr) + sizeof(struct tcphdr);
    269 		break;
    270 #endif
    271 	default:
    272 		size = tcp_mssdflt;
    273 		goto out;
    274 	}
    275 
    276 	rt = NULL;
    277 #ifdef INET
    278 	if (inp) {
    279 		rt = in_pcbrtentry(inp);
    280 		so = inp->inp_socket;
    281 	}
    282 #endif
    283 #ifdef INET6
    284 	if (in6p) {
    285 		rt = in6_pcbrtentry(in6p);
    286 		so = in6p->in6p_socket;
    287 	}
    288 #endif
    289 	if (rt == NULL) {
    290 		size = tcp_mssdflt;
    291 		goto out;
    292 	}
    293 
    294 	ifp = rt->rt_ifp;
    295 
    296 	size = tcp_mssdflt;
    297 	if (tp->t_mtudisc && rt->rt_rmx.rmx_mtu != 0) {
    298 #ifdef INET6
    299 		if (in6p && rt->rt_rmx.rmx_mtu < IPV6_MMTU) {
    300 			/*
    301 			 * RFC2460 section 5, last paragraph: if path MTU is
    302 			 * smaller than 1280, use 1280 as packet size and
    303 			 * attach fragment header.
    304 			 */
    305 			size = IPV6_MMTU - hdrlen - sizeof(struct ip6_frag);
    306 		} else
    307 			size = rt->rt_rmx.rmx_mtu - hdrlen;
    308 #else
    309 		size = rt->rt_rmx.rmx_mtu - hdrlen;
    310 #endif
    311 	} else if (ifp->if_flags & IFF_LOOPBACK)
    312 		size = ifp->if_mtu - hdrlen;
    313 #ifdef INET
    314 	else if (inp && tp->t_mtudisc)
    315 		size = ifp->if_mtu - hdrlen;
    316 	else if (inp && in_localaddr(inp->inp_faddr))
    317 		size = ifp->if_mtu - hdrlen;
    318 #endif
    319 #ifdef INET6
    320 	else if (in6p) {
    321 #ifdef INET
    322 		if (IN6_IS_ADDR_V4MAPPED(&in6p->in6p_faddr)) {
    323 			/* mapped addr case */
    324 			struct in_addr d;
    325 			bcopy(&in6p->in6p_faddr.s6_addr32[3], &d, sizeof(d));
    326 			if (tp->t_mtudisc || in_localaddr(d))
    327 				size = ifp->if_mtu - hdrlen;
    328 		} else
    329 #endif
    330 		{
    331 			/*
    332 			 * for IPv6, path MTU discovery is always turned on,
    333 			 * or the node must use packet size <= 1280.
    334 			 */
    335 			size = tp->t_mtudisc ? IN6_LINKMTU(ifp) : IPV6_MMTU;
    336 			size -= hdrlen;
    337 		}
    338 	}
    339 #endif
    340  out:
    341 	/*
    342 	 * Now we must make room for whatever extra TCP/IP options are in
    343 	 * the packet.
    344 	 */
    345 	optlen = tcp_optlen(tp);
    346 
    347 	/*
    348 	 * XXX tp->t_ourmss should have the right size, but without this code
    349 	 * fragmentation will occur... need more investigation
    350 	 */
    351 #ifdef INET
    352 	if (inp) {
    353 #if defined(IPSEC) || defined(FAST_IPSEC)
    354 		if (! IPSEC_PCB_SKIP_IPSEC(inp->inp_sp, IPSEC_DIR_OUTBOUND))
    355 			optlen += ipsec4_hdrsiz_tcp(tp);
    356 #endif
    357 		optlen += ip_optlen(inp);
    358 	}
    359 #endif
    360 #ifdef INET6
    361 #ifdef INET
    362 	if (in6p && tp->t_family == AF_INET) {
    363 #if defined(IPSEC) || defined(FAST_IPSEC)
    364 		if (! IPSEC_PCB_SKIP_IPSEC(in6p->in6p_sp, IPSEC_DIR_OUTBOUND))
    365 			optlen += ipsec4_hdrsiz_tcp(tp);
    366 #endif
    367 		/* XXX size -= ip_optlen(in6p); */
    368 	} else
    369 #endif
    370 	if (in6p && tp->t_family == AF_INET6) {
    371 #ifdef IPSEC
    372 		if (! IPSEC_PCB_SKIP_IPSEC(in6p->in6p_sp, IPSEC_DIR_OUTBOUND))
    373 			optlen += ipsec6_hdrsiz_tcp(tp);
    374 #endif
    375 		optlen += ip6_optlen(in6p);
    376 	}
    377 #endif
    378 	size -= optlen;
    379 
    380 	/* there may not be any room for data if mtu is too small */
    381 	if (size < 0)
    382 		return (EMSGSIZE);
    383 
    384 	/*
    385 	 * *rxsegsizep holds *estimated* inbound segment size (estimation
    386 	 * assumes that path MTU is the same for both ways).  this is only
    387 	 * for silly window avoidance, do not use the value for other purposes.
    388 	 *
    389 	 * ipseclen is subtracted from both sides, this may not be right.
    390 	 * I'm not quite sure about this (could someone comment).
    391 	 */
    392 	*txsegsizep = min(tp->t_peermss - optlen, size);
    393 	/*
    394 	 * Never send more than half a buffer full.  This insures that we can
    395 	 * always keep 2 packets on the wire, no matter what SO_SNDBUF is, and
    396 	 * therefore acks will never be delayed unless we run out of data to
    397 	 * transmit.
    398 	 */
    399 	if (so)
    400 		*txsegsizep = min(so->so_snd.sb_hiwat >> 1, *txsegsizep);
    401 	*rxsegsizep = min(tp->t_ourmss - optlen, size);
    402 
    403 	if (*txsegsizep != tp->t_segsz) {
    404 		/*
    405 		 * If the new segment size is larger, we don't want to
    406 		 * mess up the congestion window, but if it is smaller
    407 		 * we'll have to reduce the congestion window to ensure
    408 		 * that we don't get into trouble with initial windows
    409 		 * and the rest.  In any case, if the segment size
    410 		 * has changed, chances are the path has, too, and
    411 		 * our congestion window will be different.
    412 		 */
    413 		if (*txsegsizep < tp->t_segsz) {
    414 			tp->snd_cwnd = max((tp->snd_cwnd / tp->t_segsz)
    415 					   * *txsegsizep, *txsegsizep);
    416 			tp->snd_ssthresh = max((tp->snd_ssthresh / tp->t_segsz)
    417 						* *txsegsizep, *txsegsizep);
    418 		}
    419 		tp->t_segsz = *txsegsizep;
    420 	}
    421 
    422 	return (0);
    423 }
    424 
    425 static
    426 #ifndef GPROF
    427 inline
    428 #endif
    429 int
    430 tcp_build_datapkt(struct tcpcb *tp, struct socket *so, int off,
    431     long len, int hdrlen, struct mbuf **mp)
    432 {
    433 	struct mbuf *m, *m0;
    434 
    435 	if (tp->t_force && len == 1)
    436 		tcpstat.tcps_sndprobe++;
    437 	else if (SEQ_LT(tp->snd_nxt, tp->snd_max)) {
    438 		tcpstat.tcps_sndrexmitpack++;
    439 		tcpstat.tcps_sndrexmitbyte += len;
    440 	} else {
    441 		tcpstat.tcps_sndpack++;
    442 		tcpstat.tcps_sndbyte += len;
    443 	}
    444 #ifdef notyet
    445 	if ((m = m_copypack(so->so_snd.sb_mb, off,
    446 	    (int)len, max_linkhdr + hdrlen)) == 0)
    447 		return (ENOBUFS);
    448 	/*
    449 	 * m_copypack left space for our hdr; use it.
    450 	 */
    451 	m->m_len += hdrlen;
    452 	m->m_data -= hdrlen;
    453 #else
    454 	MGETHDR(m, M_DONTWAIT, MT_HEADER);
    455 	if (__predict_false(m == NULL))
    456 		return (ENOBUFS);
    457 	MCLAIM(m, &tcp_tx_mowner);
    458 
    459 	/*
    460 	 * XXX Because other code assumes headers will fit in
    461 	 * XXX one header mbuf.
    462 	 *
    463 	 * (This code should almost *never* be run.)
    464 	 */
    465 	if (__predict_false((max_linkhdr + hdrlen) > MHLEN)) {
    466 		TCP_OUTPUT_COUNTER_INCR(&tcp_output_bigheader);
    467 		MCLGET(m, M_DONTWAIT);
    468 		if ((m->m_flags & M_EXT) == 0) {
    469 			m_freem(m);
    470 			return (ENOBUFS);
    471 		}
    472 	}
    473 
    474 	m->m_data += max_linkhdr;
    475 	m->m_len = hdrlen;
    476 
    477 	/*
    478 	 * To avoid traversing the whole sb_mb chain for correct
    479 	 * data to send, remember last sent mbuf, its offset and
    480 	 * the sent size.  When called the next time, see if the
    481 	 * data to send is directly following the previous transfer.
    482 	 * This is important for large TCP windows.
    483 	 */
    484 	if (off == 0 || tp->t_lastm == NULL ||
    485 	    (tp->t_lastoff + tp->t_lastlen) != off) {
    486 		TCP_OUTPUT_COUNTER_INCR(&tcp_output_predict_miss);
    487 		/*
    488 		 * Either a new packet or a retransmit.
    489 		 * Start from the beginning.
    490 		 */
    491 		tp->t_lastm = so->so_snd.sb_mb;
    492 		tp->t_inoff = off;
    493 	} else {
    494 		TCP_OUTPUT_COUNTER_INCR(&tcp_output_predict_hit);
    495 		tp->t_inoff += tp->t_lastlen;
    496 	}
    497 
    498 	/* Traverse forward to next packet */
    499 	while (tp->t_inoff > 0) {
    500 		if (tp->t_lastm == NULL)
    501 			panic("tp->t_lastm == NULL");
    502 		if (tp->t_inoff < tp->t_lastm->m_len)
    503 			break;
    504 		tp->t_inoff -= tp->t_lastm->m_len;
    505 		tp->t_lastm = tp->t_lastm->m_next;
    506 	}
    507 
    508 	tp->t_lastoff = off;
    509 	tp->t_lastlen = len;
    510 	m0 = tp->t_lastm;
    511 	off = tp->t_inoff;
    512 
    513 	if (len <= M_TRAILINGSPACE(m)) {
    514 		m_copydata(m0, off, (int) len, mtod(m, caddr_t) + hdrlen);
    515 		m->m_len += len;
    516 		TCP_OUTPUT_COUNTER_INCR(&tcp_output_copysmall);
    517 	} else {
    518 		m->m_next = m_copy(m0, off, (int) len);
    519 		if (m->m_next == NULL) {
    520 			m_freem(m);
    521 			return (ENOBUFS);
    522 		}
    523 #ifdef TCP_OUTPUT_COUNTERS
    524 		if (m->m_next->m_flags & M_EXT)
    525 			TCP_OUTPUT_COUNTER_INCR(&tcp_output_refbig);
    526 		else
    527 			TCP_OUTPUT_COUNTER_INCR(&tcp_output_copybig);
    528 #endif /* TCP_OUTPUT_COUNTERS */
    529 	}
    530 #endif
    531 
    532 	*mp = m;
    533 	return (0);
    534 }
    535 
    536 /*
    537  * Tcp output routine: figure out what should be sent and send it.
    538  */
    539 int
    540 tcp_output(struct tcpcb *tp)
    541 {
    542 	struct socket *so;
    543 	struct route *ro;
    544 	long len, win;
    545 	int off, flags, error;
    546 	struct mbuf *m;
    547 	struct ip *ip;
    548 #ifdef INET6
    549 	struct ip6_hdr *ip6;
    550 #endif
    551 	struct tcphdr *th;
    552 	u_char opt[MAX_TCPOPTLEN];
    553 	unsigned optlen, hdrlen, packetlen;
    554 	unsigned int sack_numblks;
    555 	int idle, sendalot, txsegsize, rxsegsize;
    556 	int txsegsize_nosack;
    557 	int maxburst = TCP_MAXBURST;
    558 	int af;		/* address family on the wire */
    559 	int iphdrlen;
    560 	int has_tso, use_tso;
    561 	int sack_rxmit;
    562 	int sack_bytes_rxmt;
    563 	struct sackhole *p;
    564 #ifdef TCP_SIGNATURE
    565 	int sigoff = 0;
    566 #endif
    567 
    568 #ifdef DIAGNOSTIC
    569 	if (tp->t_inpcb && tp->t_in6pcb)
    570 		panic("tcp_output: both t_inpcb and t_in6pcb are set");
    571 #endif
    572 	so = NULL;
    573 	ro = NULL;
    574 	if (tp->t_inpcb) {
    575 		so = tp->t_inpcb->inp_socket;
    576 		ro = &tp->t_inpcb->inp_route;
    577 	}
    578 #ifdef INET6
    579 	else if (tp->t_in6pcb) {
    580 		so = tp->t_in6pcb->in6p_socket;
    581 		ro = (struct route *)&tp->t_in6pcb->in6p_route;
    582 	}
    583 #endif
    584 
    585 	switch (af = tp->t_family) {
    586 #ifdef INET
    587 	case AF_INET:
    588 		if (tp->t_inpcb)
    589 			break;
    590 #ifdef INET6
    591 		/* mapped addr case */
    592 		if (tp->t_in6pcb)
    593 			break;
    594 #endif
    595 		return (EINVAL);
    596 #endif
    597 #ifdef INET6
    598 	case AF_INET6:
    599 		if (tp->t_in6pcb)
    600 			break;
    601 		return (EINVAL);
    602 #endif
    603 	default:
    604 		return (EAFNOSUPPORT);
    605 	}
    606 
    607 	if (tcp_segsize(tp, &txsegsize, &rxsegsize))
    608 		return (EMSGSIZE);
    609 
    610 	idle = (tp->snd_max == tp->snd_una);
    611 
    612 	/*
    613 	 * Determine if we can use TCP segmentation offload:
    614 	 * - If we're using IPv4
    615 	 * - If there is not an IPsec policy that prevents it
    616 	 * - If the interface can do it
    617 	 */
    618 	has_tso = tp->t_inpcb != NULL &&
    619 #if defined(IPSEC) || defined(FAST_IPSEC)
    620 		  IPSEC_PCB_SKIP_IPSEC(tp->t_inpcb->inp_sp,
    621 		  		       IPSEC_DIR_OUTBOUND) &&
    622 #endif
    623 		  tp->t_inpcb->inp_route.ro_rt != NULL &&
    624 		  (tp->t_inpcb->inp_route.ro_rt->rt_ifp->if_capenable &
    625 		   IFCAP_TSOv4) != 0;
    626 
    627 	/*
    628 	 * Restart Window computation.  From draft-floyd-incr-init-win-03:
    629 	 *
    630 	 *	Optionally, a TCP MAY set the restart window to the
    631 	 *	minimum of the value used for the initial window and
    632 	 *	the current value of cwnd (in other words, using a
    633 	 *	larger value for the restart window should never increase
    634 	 *	the size of cwnd).
    635 	 */
    636 	if (tcp_cwm) {
    637 		/*
    638 		 * Hughes/Touch/Heidemann Congestion Window Monitoring.
    639 		 * Count the number of packets currently pending
    640 		 * acknowledgement, and limit our congestion window
    641 		 * to a pre-determined allowed burst size plus that count.
    642 		 * This prevents bursting once all pending packets have
    643 		 * been acknowledged (i.e. transmission is idle).
    644 		 *
    645 		 * XXX Link this to Initial Window?
    646 		 */
    647 		tp->snd_cwnd = min(tp->snd_cwnd,
    648 		    (tcp_cwm_burstsize * txsegsize) +
    649 		    (tp->snd_nxt - tp->snd_una));
    650 	} else {
    651 		if (idle && (tcp_now - tp->t_rcvtime) >= tp->t_rxtcur) {
    652 			/*
    653 			 * We have been idle for "a while" and no acks are
    654 			 * expected to clock out any data we send --
    655 			 * slow start to get ack "clock" running again.
    656 			 */
    657 			int ss = tcp_init_win;
    658 #ifdef INET
    659 			if (tp->t_inpcb &&
    660 			    in_localaddr(tp->t_inpcb->inp_faddr))
    661 				ss = tcp_init_win_local;
    662 #endif
    663 #ifdef INET6
    664 			if (tp->t_in6pcb &&
    665 			    in6_localaddr(&tp->t_in6pcb->in6p_faddr))
    666 				ss = tcp_init_win_local;
    667 #endif
    668 			tp->snd_cwnd = min(tp->snd_cwnd,
    669 			    TCP_INITIAL_WINDOW(ss, txsegsize));
    670 		}
    671 	}
    672 
    673 	txsegsize_nosack = txsegsize;
    674 again:
    675 	use_tso = has_tso;
    676 	TCP_REASS_LOCK(tp);
    677 	sack_numblks = tcp_sack_numblks(tp);
    678 	if (sack_numblks) {
    679 		if ((tp->rcv_sack_flags & TCPSACK_HAVED) != 0) {
    680 			/* don't duplicate D-SACK. */
    681 			use_tso = 0;
    682 		}
    683 		txsegsize = txsegsize_nosack - TCP_SACK_OPTLEN(sack_numblks);
    684 	} else {
    685 		txsegsize = txsegsize_nosack;
    686 	}
    687 
    688 	/*
    689 	 * Determine length of data that should be transmitted, and
    690 	 * flags that should be used.  If there is some data or critical
    691 	 * controls (SYN, RST) to send, then transmit; otherwise,
    692 	 * investigate further.
    693 	 *
    694 	 * Readjust SACK information to avoid resending duplicate data.
    695 	 */
    696 	if (TCP_SACK_ENABLED(tp) && SEQ_LT(tp->snd_nxt, tp->snd_max))
    697 		tcp_sack_adjust(tp);
    698 	sendalot = 0;
    699 	off = tp->snd_nxt - tp->snd_una;
    700 	win = min(tp->snd_wnd, tp->snd_cwnd);
    701 
    702 	flags = tcp_outflags[tp->t_state];
    703 
    704 	/*
    705 	 * Send any SACK-generated retransmissions.  If we're explicitly trying
    706 	 * to send out new data (when sendalot is 1), bypass this function.
    707 	 * If we retransmit in fast recovery mode, decrement snd_cwnd, since
    708 	 * we're replacing a (future) new transmission with a retransmission
    709 	 * now, and we previously incremented snd_cwnd in tcp_input().
    710 	 */
    711 	/*
    712 	 * Still in sack recovery , reset rxmit flag to zero.
    713 	 */
    714 	sack_rxmit = 0;
    715 	sack_bytes_rxmt = 0;
    716 	len = 0;
    717 	p = NULL;
    718 	do {
    719 		long cwin;
    720 		if (!TCP_SACK_ENABLED(tp))
    721 			break;
    722 		if (tp->t_partialacks < 0)
    723 			break;
    724 		p = tcp_sack_output(tp, &sack_bytes_rxmt);
    725 		if (p == NULL)
    726 			break;
    727 
    728 		cwin = min(tp->snd_wnd, tp->snd_cwnd) - sack_bytes_rxmt;
    729 		if (cwin < 0)
    730 			cwin = 0;
    731 		/* Do not retransmit SACK segments beyond snd_recover */
    732 		if (SEQ_GT(p->end, tp->snd_recover)) {
    733 			/*
    734 			 * (At least) part of sack hole extends beyond
    735 			 * snd_recover. Check to see if we can rexmit data
    736 			 * for this hole.
    737 			 */
    738 			if (SEQ_GEQ(p->rxmit, tp->snd_recover)) {
    739 				/*
    740 				 * Can't rexmit any more data for this hole.
    741 				 * That data will be rexmitted in the next
    742 				 * sack recovery episode, when snd_recover
    743 				 * moves past p->rxmit.
    744 				 */
    745 				p = NULL;
    746 				break;
    747 			}
    748 			/* Can rexmit part of the current hole */
    749 			len = ((long)ulmin(cwin, tp->snd_recover - p->rxmit));
    750 		} else
    751 			len = ((long)ulmin(cwin, p->end - p->rxmit));
    752 		off = p->rxmit - tp->snd_una;
    753 		if (off + len > so->so_snd.sb_cc) {
    754 			/* 1 for TH_FIN */
    755 			KASSERT(off + len == so->so_snd.sb_cc + 1);
    756 			KASSERT(p->rxmit + len == tp->snd_max);
    757 			len = so->so_snd.sb_cc - off;
    758 		}
    759 		if (len > 0) {
    760 			sack_rxmit = 1;
    761 			sendalot = 1;
    762 		}
    763 	} while (/*CONSTCOND*/0);
    764 
    765 	/*
    766 	 * If in persist timeout with window of 0, send 1 byte.
    767 	 * Otherwise, if window is small but nonzero
    768 	 * and timer expired, we will send what we can
    769 	 * and go to transmit state.
    770 	 */
    771 	if (tp->t_force) {
    772 		if (win == 0) {
    773 			/*
    774 			 * If we still have some data to send, then
    775 			 * clear the FIN bit.  Usually this would
    776 			 * happen below when it realizes that we
    777 			 * aren't sending all the data.  However,
    778 			 * if we have exactly 1 byte of unset data,
    779 			 * then it won't clear the FIN bit below,
    780 			 * and if we are in persist state, we wind
    781 			 * up sending the packet without recording
    782 			 * that we sent the FIN bit.
    783 			 *
    784 			 * We can't just blindly clear the FIN bit,
    785 			 * because if we don't have any more data
    786 			 * to send then the probe will be the FIN
    787 			 * itself.
    788 			 */
    789 			if (off < so->so_snd.sb_cc)
    790 				flags &= ~TH_FIN;
    791 			win = 1;
    792 		} else {
    793 			TCP_TIMER_DISARM(tp, TCPT_PERSIST);
    794 			tp->t_rxtshift = 0;
    795 		}
    796 	}
    797 
    798 	if (!TCP_SACK_ENABLED(tp)) {
    799 		if (win < so->so_snd.sb_cc) {
    800 			len = win - off;
    801 			flags &= ~TH_FIN;
    802 		} else
    803 			len = so->so_snd.sb_cc - off;
    804 	} else if (sack_rxmit == 0) {
    805 		if (sack_bytes_rxmt != 0) {
    806 			long cwin;
    807 
    808 			/*
    809 			 * We are inside of a SACK recovery episode and are
    810 			 * sending new data, having retransmitted all the
    811 			 * data possible in the scoreboard.
    812 			 */
    813 			if (tp->snd_wnd < so->so_snd.sb_cc) {
    814 				len = tp->snd_wnd - off;
    815 				flags &= ~TH_FIN;
    816 			} else {
    817 				len = so->so_snd.sb_cc - off;
    818 			}
    819 
    820 			/*
    821 			 * From FreeBSD:
    822 			 *  Don't remove this (len > 0) check !
    823 			 *  We explicitly check for len > 0 here (although it
    824 			 *  isn't really necessary), to work around a gcc
    825 			 *  optimization issue - to force gcc to compute
    826 			 *  len above. Without this check, the computation
    827 			 *  of len is bungled by the optimizer.
    828 			 */
    829 			if (len > 0) {
    830 				cwin = tp->snd_cwnd -
    831 						(tp->snd_nxt - tp->sack_newdata) -
    832 						sack_bytes_rxmt;
    833 				if (cwin < 0)
    834 					cwin = 0;
    835 				if (cwin < len) {
    836 					len = cwin;
    837 					flags &= ~TH_FIN;
    838 				}
    839 			}
    840 		} else if (win < so->so_snd.sb_cc) {
    841 			len = win - off;
    842 			flags &= ~TH_FIN;
    843 		} else
    844 			len = so->so_snd.sb_cc - off;
    845 	}
    846 
    847 	if (len < 0) {
    848 		/*
    849 		 * If FIN has been sent but not acked,
    850 		 * but we haven't been called to retransmit,
    851 		 * len will be -1.  Otherwise, window shrank
    852 		 * after we sent into it.  If window shrank to 0,
    853 		 * cancel pending retransmit, pull snd_nxt back
    854 		 * to (closed) window, and set the persist timer
    855 		 * if it isn't already going.  If the window didn't
    856 		 * close completely, just wait for an ACK.
    857 		 *
    858 		 * If we have a pending FIN, either it has already been
    859 		 * transmitted or it is outside the window, so drop it.
    860 		 * If the FIN has been transmitted, but this is not a
    861 		 * retransmission, then len must be -1.  Therefore we also
    862 		 * prevent here the sending of `gratuitous FINs'.  This
    863 		 * eliminates the need to check for that case below (e.g.
    864 		 * to back up snd_nxt before the FIN so that the sequence
    865 		 * number is correct).
    866 		 */
    867 		len = 0;
    868 		flags &= ~TH_FIN;
    869 		if (win == 0) {
    870 			TCP_TIMER_DISARM(tp, TCPT_REXMT);
    871 			tp->t_rxtshift = 0;
    872 			tp->snd_nxt = tp->snd_una;
    873 			if (TCP_TIMER_ISARMED(tp, TCPT_PERSIST) == 0)
    874 				tcp_setpersist(tp);
    875 		}
    876 	}
    877 	if (len > txsegsize) {
    878 		if (use_tso) {
    879 			/*
    880 			 * Truncate TSO transfers to IP_MAXPACKET, and make
    881 			 * sure that we send equal size transfers down the
    882 			 * stack (rather than big-small-big-small-...).
    883 			 */
    884 			len = (min(len, IP_MAXPACKET) / txsegsize) * txsegsize;
    885 			if (len <= txsegsize) {
    886 				use_tso = 0;
    887 			}
    888 		} else
    889 			len = txsegsize;
    890 		flags &= ~TH_FIN;
    891 		sendalot = 1;
    892 	} else
    893 		use_tso = 0;
    894 	if (sack_rxmit) {
    895 		if (SEQ_LT(p->rxmit + len, tp->snd_una + so->so_snd.sb_cc))
    896 			flags &= ~TH_FIN;
    897 	}
    898 
    899 	win = sbspace(&so->so_rcv);
    900 
    901 	/*
    902 	 * Sender silly window avoidance.  If connection is idle
    903 	 * and can send all data, a maximum segment,
    904 	 * at least a maximum default-size segment do it,
    905 	 * or are forced, do it; otherwise don't bother.
    906 	 * If peer's buffer is tiny, then send
    907 	 * when window is at least half open.
    908 	 * If retransmitting (possibly after persist timer forced us
    909 	 * to send into a small window), then must resend.
    910 	 */
    911 	if (len) {
    912 		if (len >= txsegsize)
    913 			goto send;
    914 		if ((so->so_state & SS_MORETOCOME) == 0 &&
    915 		    ((idle || tp->t_flags & TF_NODELAY) &&
    916 		     len + off >= so->so_snd.sb_cc))
    917 			goto send;
    918 		if (tp->t_force)
    919 			goto send;
    920 		if (len >= tp->max_sndwnd / 2)
    921 			goto send;
    922 		if (SEQ_LT(tp->snd_nxt, tp->snd_max))
    923 			goto send;
    924 		if (sack_rxmit)
    925 			goto send;
    926 	}
    927 
    928 	/*
    929 	 * Compare available window to amount of window known to peer
    930 	 * (as advertised window less next expected input).  If the
    931 	 * difference is at least twice the size of the largest segment
    932 	 * we expect to receive (i.e. two segments) or at least 50% of
    933 	 * the maximum possible window, then want to send a window update
    934 	 * to peer.
    935 	 */
    936 	if (win > 0) {
    937 		/*
    938 		 * "adv" is the amount we can increase the window,
    939 		 * taking into account that we are limited by
    940 		 * TCP_MAXWIN << tp->rcv_scale.
    941 		 */
    942 		long adv = min(win, (long)TCP_MAXWIN << tp->rcv_scale) -
    943 			(tp->rcv_adv - tp->rcv_nxt);
    944 
    945 		if (adv >= (long) (2 * rxsegsize))
    946 			goto send;
    947 		if (2 * adv >= (long) so->so_rcv.sb_hiwat)
    948 			goto send;
    949 	}
    950 
    951 	/*
    952 	 * Send if we owe peer an ACK.
    953 	 */
    954 	if (tp->t_flags & TF_ACKNOW)
    955 		goto send;
    956 	if (flags & (TH_SYN|TH_FIN|TH_RST))
    957 		goto send;
    958 	if (SEQ_GT(tp->snd_up, tp->snd_una))
    959 		goto send;
    960 	/*
    961 	 * In SACK, it is possible for tcp_output to fail to send a segment
    962 	 * after the retransmission timer has been turned off.  Make sure
    963 	 * that the retransmission timer is set.
    964 	 */
    965 	if (TCP_SACK_ENABLED(tp) && SEQ_GT(tp->snd_max, tp->snd_una) &&
    966 	    !TCP_TIMER_ISARMED(tp, TCPT_REXMT) &&
    967 	    !TCP_TIMER_ISARMED(tp, TCPT_PERSIST)) {
    968 		TCP_TIMER_ARM(tp, TCPT_REXMT, tp->t_rxtcur);
    969 		goto just_return;
    970 	}
    971 
    972 	/*
    973 	 * TCP window updates are not reliable, rather a polling protocol
    974 	 * using ``persist'' packets is used to insure receipt of window
    975 	 * updates.  The three ``states'' for the output side are:
    976 	 *	idle			not doing retransmits or persists
    977 	 *	persisting		to move a small or zero window
    978 	 *	(re)transmitting	and thereby not persisting
    979 	 *
    980 	 * tp->t_timer[TCPT_PERSIST]
    981 	 *	is set when we are in persist state.
    982 	 * tp->t_force
    983 	 *	is set when we are called to send a persist packet.
    984 	 * tp->t_timer[TCPT_REXMT]
    985 	 *	is set when we are retransmitting
    986 	 * The output side is idle when both timers are zero.
    987 	 *
    988 	 * If send window is too small, there is data to transmit, and no
    989 	 * retransmit or persist is pending, then go to persist state.
    990 	 * If nothing happens soon, send when timer expires:
    991 	 * if window is nonzero, transmit what we can,
    992 	 * otherwise force out a byte.
    993 	 */
    994 	if (so->so_snd.sb_cc && TCP_TIMER_ISARMED(tp, TCPT_REXMT) == 0 &&
    995 	    TCP_TIMER_ISARMED(tp, TCPT_PERSIST) == 0) {
    996 		tp->t_rxtshift = 0;
    997 		tcp_setpersist(tp);
    998 	}
    999 
   1000 	/*
   1001 	 * No reason to send a segment, just return.
   1002 	 */
   1003 just_return:
   1004 	TCP_REASS_UNLOCK(tp);
   1005 	return (0);
   1006 
   1007 send:
   1008 	/*
   1009 	 * Before ESTABLISHED, force sending of initial options
   1010 	 * unless TCP set not to do any options.
   1011 	 * NOTE: we assume that the IP/TCP header plus TCP options
   1012 	 * always fit in a single mbuf, leaving room for a maximum
   1013 	 * link header, i.e.
   1014 	 *	max_linkhdr + sizeof (struct tcpiphdr) + optlen <= MCLBYTES
   1015 	 */
   1016 	optlen = 0;
   1017 	switch (af) {
   1018 #ifdef INET
   1019 	case AF_INET:
   1020 		iphdrlen = sizeof(struct ip) + sizeof(struct tcphdr);
   1021 		break;
   1022 #endif
   1023 #ifdef INET6
   1024 	case AF_INET6:
   1025 		iphdrlen = sizeof(struct ip6_hdr) + sizeof(struct tcphdr);
   1026 		break;
   1027 #endif
   1028 	default:	/*pacify gcc*/
   1029 		iphdrlen = 0;
   1030 		break;
   1031 	}
   1032 	hdrlen = iphdrlen;
   1033 	if (flags & TH_SYN) {
   1034 		struct rtentry *rt;
   1035 
   1036 		rt = NULL;
   1037 #ifdef INET
   1038 		if (tp->t_inpcb)
   1039 			rt = in_pcbrtentry(tp->t_inpcb);
   1040 #endif
   1041 #ifdef INET6
   1042 		if (tp->t_in6pcb)
   1043 			rt = in6_pcbrtentry(tp->t_in6pcb);
   1044 #endif
   1045 
   1046 		tp->snd_nxt = tp->iss;
   1047 		tp->t_ourmss = tcp_mss_to_advertise(rt != NULL ?
   1048 						    rt->rt_ifp : NULL, af);
   1049 		if ((tp->t_flags & TF_NOOPT) == 0) {
   1050 			opt[0] = TCPOPT_MAXSEG;
   1051 			opt[1] = 4;
   1052 			opt[2] = (tp->t_ourmss >> 8) & 0xff;
   1053 			opt[3] = tp->t_ourmss & 0xff;
   1054 			optlen = 4;
   1055 
   1056 			if ((tp->t_flags & TF_REQ_SCALE) &&
   1057 			    ((flags & TH_ACK) == 0 ||
   1058 			    (tp->t_flags & TF_RCVD_SCALE))) {
   1059 				*((u_int32_t *) (opt + optlen)) = htonl(
   1060 					TCPOPT_NOP << 24 |
   1061 					TCPOPT_WINDOW << 16 |
   1062 					TCPOLEN_WINDOW << 8 |
   1063 					tp->request_r_scale);
   1064 				optlen += 4;
   1065 			}
   1066 			if (tcp_do_sack) {
   1067 				u_int8_t *cp = (u_int8_t *)(opt + optlen);
   1068 
   1069 				cp[0] = TCPOPT_SACK_PERMITTED;
   1070 				cp[1] = 2;
   1071 				cp[2] = TCPOPT_NOP;
   1072 				cp[3] = TCPOPT_NOP;
   1073 				optlen += 4;
   1074 			}
   1075 		}
   1076 	}
   1077 
   1078 	/*
   1079 	 * Send a timestamp and echo-reply if this is a SYN and our side
   1080 	 * wants to use timestamps (TF_REQ_TSTMP is set) or both our side
   1081 	 * and our peer have sent timestamps in our SYN's.
   1082 	 */
   1083 	if ((tp->t_flags & (TF_REQ_TSTMP|TF_NOOPT)) == TF_REQ_TSTMP &&
   1084 	     (flags & TH_RST) == 0 &&
   1085 	    ((flags & (TH_SYN|TH_ACK)) == TH_SYN ||
   1086 	     (tp->t_flags & TF_RCVD_TSTMP))) {
   1087 		u_int32_t *lp = (u_int32_t *)(opt + optlen);
   1088 
   1089 		/* Form timestamp option as shown in appendix A of RFC 1323. */
   1090 		*lp++ = htonl(TCPOPT_TSTAMP_HDR);
   1091 		*lp++ = htonl(TCP_TIMESTAMP(tp));
   1092 		*lp   = htonl(tp->ts_recent);
   1093 		optlen += TCPOLEN_TSTAMP_APPA;
   1094 	}
   1095 
   1096 	/*
   1097 	 * Tack on the SACK block if it is necessary.
   1098 	 */
   1099 	if (sack_numblks) {
   1100 		int sack_len;
   1101 		u_char *bp = (u_char *)(opt + optlen);
   1102 		u_int32_t *lp = (u_int32_t *)(bp + 4);
   1103 		struct ipqent *tiqe;
   1104 
   1105 		sack_len = sack_numblks * 8 + 2;
   1106 		bp[0] = TCPOPT_NOP;
   1107 		bp[1] = TCPOPT_NOP;
   1108 		bp[2] = TCPOPT_SACK;
   1109 		bp[3] = sack_len;
   1110 		if ((tp->rcv_sack_flags & TCPSACK_HAVED) != 0) {
   1111 			sack_numblks--;
   1112 			*lp++ = htonl(tp->rcv_dsack_block.left);
   1113 			*lp++ = htonl(tp->rcv_dsack_block.right);
   1114 			tp->rcv_sack_flags &= ~TCPSACK_HAVED;
   1115 		}
   1116 		for (tiqe = TAILQ_FIRST(&tp->timeq);
   1117 		    sack_numblks > 0; tiqe = TAILQ_NEXT(tiqe, ipqe_timeq)) {
   1118 			KASSERT(tiqe != NULL);
   1119 			sack_numblks--;
   1120 			*lp++ = htonl(tiqe->ipqe_seq);
   1121 			*lp++ = htonl(tiqe->ipqe_seq + tiqe->ipqe_len +
   1122 			    ((tiqe->ipqe_flags & TH_FIN) != 0 ? 1 : 0));
   1123 		}
   1124 		optlen += sack_len + 2;
   1125 	}
   1126 	TCP_REASS_UNLOCK(tp);
   1127 
   1128 #ifdef TCP_SIGNATURE
   1129 #if defined(INET6) && defined(FAST_IPSEC)
   1130 	if (tp->t_family == AF_INET)
   1131 #endif
   1132 	if (tp->t_flags & TF_SIGNATURE) {
   1133 		u_char *bp;
   1134 		/*
   1135 		 * Initialize TCP-MD5 option (RFC2385)
   1136 		 */
   1137 		bp = (u_char *)opt + optlen;
   1138 		*bp++ = TCPOPT_SIGNATURE;
   1139 		*bp++ = TCPOLEN_SIGNATURE;
   1140 		sigoff = optlen + 2;
   1141 		bzero(bp, TCP_SIGLEN);
   1142 		bp += TCP_SIGLEN;
   1143 		optlen += TCPOLEN_SIGNATURE;
   1144 		/*
   1145 		 * Terminate options list and maintain 32-bit alignment.
   1146  		 */
   1147 		*bp++ = TCPOPT_NOP;
   1148 		*bp++ = TCPOPT_EOL;
   1149  		optlen += 2;
   1150  	}
   1151 #endif /* TCP_SIGNATURE */
   1152 
   1153 	hdrlen += optlen;
   1154 
   1155 #ifdef DIAGNOSTIC
   1156 	if (!use_tso && len > txsegsize)
   1157 		panic("tcp data to be sent is larger than segment");
   1158 	else if (use_tso && len > IP_MAXPACKET)
   1159 		panic("tcp data to be sent is larger than max TSO size");
   1160 	if (max_linkhdr + hdrlen > MCLBYTES)
   1161 		panic("tcphdr too big");
   1162 #endif
   1163 
   1164 	/*
   1165 	 * Grab a header mbuf, attaching a copy of data to
   1166 	 * be transmitted, and initialize the header from
   1167 	 * the template for sends on this connection.
   1168 	 */
   1169 	if (len) {
   1170 		error = tcp_build_datapkt(tp, so, off, len, hdrlen, &m);
   1171 		if (error)
   1172 			goto out;
   1173 		/*
   1174 		 * If we're sending everything we've got, set PUSH.
   1175 		 * (This will keep happy those implementations which only
   1176 		 * give data to the user when a buffer fills or
   1177 		 * a PUSH comes in.)
   1178 		 */
   1179 		if (off + len == so->so_snd.sb_cc)
   1180 			flags |= TH_PUSH;
   1181 	} else {
   1182 		if (tp->t_flags & TF_ACKNOW)
   1183 			tcpstat.tcps_sndacks++;
   1184 		else if (flags & (TH_SYN|TH_FIN|TH_RST))
   1185 			tcpstat.tcps_sndctrl++;
   1186 		else if (SEQ_GT(tp->snd_up, tp->snd_una))
   1187 			tcpstat.tcps_sndurg++;
   1188 		else
   1189 			tcpstat.tcps_sndwinup++;
   1190 
   1191 		MGETHDR(m, M_DONTWAIT, MT_HEADER);
   1192 		if (m != NULL && max_linkhdr + hdrlen > MHLEN) {
   1193 			MCLGET(m, M_DONTWAIT);
   1194 			if ((m->m_flags & M_EXT) == 0) {
   1195 				m_freem(m);
   1196 				m = NULL;
   1197 			}
   1198 		}
   1199 		if (m == NULL) {
   1200 			error = ENOBUFS;
   1201 			goto out;
   1202 		}
   1203 		MCLAIM(m, &tcp_tx_mowner);
   1204 		m->m_data += max_linkhdr;
   1205 		m->m_len = hdrlen;
   1206 	}
   1207 	m->m_pkthdr.rcvif = (struct ifnet *)0;
   1208 	switch (af) {
   1209 #ifdef INET
   1210 	case AF_INET:
   1211 		ip = mtod(m, struct ip *);
   1212 #ifdef INET6
   1213 		ip6 = NULL;
   1214 #endif
   1215 		th = (struct tcphdr *)(ip + 1);
   1216 		break;
   1217 #endif
   1218 #ifdef INET6
   1219 	case AF_INET6:
   1220 		ip = NULL;
   1221 		ip6 = mtod(m, struct ip6_hdr *);
   1222 		th = (struct tcphdr *)(ip6 + 1);
   1223 		break;
   1224 #endif
   1225 	default:	/*pacify gcc*/
   1226 		ip = NULL;
   1227 #ifdef INET6
   1228 		ip6 = NULL;
   1229 #endif
   1230 		th = NULL;
   1231 		break;
   1232 	}
   1233 	if (tp->t_template == 0)
   1234 		panic("tcp_output");
   1235 	if (tp->t_template->m_len < iphdrlen)
   1236 		panic("tcp_output");
   1237 	bcopy(mtod(tp->t_template, caddr_t), mtod(m, caddr_t), iphdrlen);
   1238 
   1239 	/*
   1240 	 * If we are starting a connection, send ECN setup
   1241 	 * SYN packet. If we are on a retransmit, we may
   1242 	 * resend those bits a number of times as per
   1243 	 * RFC 3168.
   1244 	 */
   1245 	if (tp->t_state == TCPS_SYN_SENT && tcp_do_ecn) {
   1246 		if (tp->t_flags & TF_SYN_REXMT) {
   1247 			if (tp->t_ecn_retries--)
   1248 				flags |= TH_ECE|TH_CWR;
   1249 		} else {
   1250 			flags |= TH_ECE|TH_CWR;
   1251 			tp->t_ecn_retries = tcp_ecn_maxretries;
   1252 		}
   1253 	}
   1254 
   1255 	if (TCP_ECN_ALLOWED(tp)) {
   1256 		/*
   1257 		 * If the peer has ECN, mark data packets
   1258 		 * ECN capable. Ignore pure ack packets, retransmissions
   1259 		 * and window probes.
   1260 		 */
   1261 		if (len > 0 && SEQ_GEQ(tp->snd_nxt, tp->snd_max) &&
   1262 		    !(tp->t_force && len == 1)) {
   1263 			switch (af) {
   1264 #ifdef INET
   1265 			case AF_INET:
   1266 				tp->t_inpcb->inp_ip.ip_tos |= IPTOS_ECN_ECT0;
   1267 				break;
   1268 #endif
   1269 #ifdef INET6
   1270 			case AF_INET6:
   1271 				ip6->ip6_flow |= htonl(IPTOS_ECN_ECT0 << 20);
   1272 				break;
   1273 #endif
   1274 			}
   1275 			tcpstat.tcps_ecn_ect++;
   1276 		}
   1277 
   1278 		/*
   1279 		 * Reply with proper ECN notifications.
   1280 		 */
   1281 		if (tp->t_flags & TF_ECN_SND_CWR) {
   1282 			flags |= TH_CWR;
   1283 			tp->t_flags &= ~TF_ECN_SND_CWR;
   1284 		}
   1285 		if (tp->t_flags & TF_ECN_SND_ECE) {
   1286 			flags |= TH_ECE;
   1287 		}
   1288 	}
   1289 
   1290 
   1291 	/*
   1292 	 * If we are doing retransmissions, then snd_nxt will
   1293 	 * not reflect the first unsent octet.  For ACK only
   1294 	 * packets, we do not want the sequence number of the
   1295 	 * retransmitted packet, we want the sequence number
   1296 	 * of the next unsent octet.  So, if there is no data
   1297 	 * (and no SYN or FIN), use snd_max instead of snd_nxt
   1298 	 * when filling in ti_seq.  But if we are in persist
   1299 	 * state, snd_max might reflect one byte beyond the
   1300 	 * right edge of the window, so use snd_nxt in that
   1301 	 * case, since we know we aren't doing a retransmission.
   1302 	 * (retransmit and persist are mutually exclusive...)
   1303 	 */
   1304 	if (TCP_SACK_ENABLED(tp) && sack_rxmit) {
   1305 		th->th_seq = htonl(p->rxmit);
   1306 		p->rxmit += len;
   1307 	} else {
   1308 		if (len || (flags & (TH_SYN|TH_FIN)) ||
   1309 		    TCP_TIMER_ISARMED(tp, TCPT_PERSIST))
   1310 			th->th_seq = htonl(tp->snd_nxt);
   1311 		else
   1312 			th->th_seq = htonl(tp->snd_max);
   1313 	}
   1314 	th->th_ack = htonl(tp->rcv_nxt);
   1315 	if (optlen) {
   1316 		bcopy((caddr_t)opt, (caddr_t)(th + 1), optlen);
   1317 		th->th_off = (sizeof (struct tcphdr) + optlen) >> 2;
   1318 	}
   1319 	th->th_flags = flags;
   1320 	/*
   1321 	 * Calculate receive window.  Don't shrink window,
   1322 	 * but avoid silly window syndrome.
   1323 	 */
   1324 	if (win < (long)(so->so_rcv.sb_hiwat / 4) && win < (long)rxsegsize)
   1325 		win = 0;
   1326 	if (win > (long)TCP_MAXWIN << tp->rcv_scale)
   1327 		win = (long)TCP_MAXWIN << tp->rcv_scale;
   1328 	if (win < (long)(int32_t)(tp->rcv_adv - tp->rcv_nxt))
   1329 		win = (long)(int32_t)(tp->rcv_adv - tp->rcv_nxt);
   1330 	th->th_win = htons((u_int16_t) (win>>tp->rcv_scale));
   1331 	if (SEQ_GT(tp->snd_up, tp->snd_nxt)) {
   1332 		u_int32_t urp = tp->snd_up - tp->snd_nxt;
   1333 		if (urp > IP_MAXPACKET)
   1334 			urp = IP_MAXPACKET;
   1335 		th->th_urp = htons((u_int16_t)urp);
   1336 		th->th_flags |= TH_URG;
   1337 	} else
   1338 		/*
   1339 		 * If no urgent pointer to send, then we pull
   1340 		 * the urgent pointer to the left edge of the send window
   1341 		 * so that it doesn't drift into the send window on sequence
   1342 		 * number wraparound.
   1343 		 */
   1344 		tp->snd_up = tp->snd_una;		/* drag it along */
   1345 
   1346 #ifdef TCP_SIGNATURE
   1347 #if defined(INET6) && defined(FAST_IPSEC)
   1348 	if (tp->t_family == AF_INET) /* XXX */
   1349 #endif
   1350 	if (sigoff && (tp->t_flags & TF_SIGNATURE)) {
   1351 		struct secasvar *sav;
   1352 		u_int8_t *sigp;
   1353 
   1354 		sav = tcp_signature_getsav(m, th);
   1355 
   1356 		if (sav == NULL) {
   1357 			if (m)
   1358 				m_freem(m);
   1359 			return (EPERM);
   1360 		}
   1361 
   1362 		m->m_pkthdr.len = hdrlen + len;
   1363 		sigp = (caddr_t)th + sizeof(*th) + sigoff;
   1364 		tcp_signature(m, th, (caddr_t)th - mtod(m, caddr_t), sav, sigp);
   1365 
   1366 		key_sa_recordxfer(sav, m);
   1367 #ifdef FAST_IPSEC
   1368 		KEY_FREESAV(&sav);
   1369 #else
   1370 		key_freesav(sav);
   1371 #endif
   1372 	}
   1373 #endif
   1374 
   1375 	/*
   1376 	 * Set ourselves up to be checksummed just before the packet
   1377 	 * hits the wire.
   1378 	 */
   1379 	switch (af) {
   1380 #ifdef INET
   1381 	case AF_INET:
   1382 		m->m_pkthdr.csum_data = offsetof(struct tcphdr, th_sum);
   1383 		if (use_tso) {
   1384 			m->m_pkthdr.segsz = txsegsize;
   1385 			m->m_pkthdr.csum_flags = M_CSUM_TSOv4;
   1386 		} else {
   1387 			m->m_pkthdr.csum_flags = M_CSUM_TCPv4;
   1388 			if (len + optlen) {
   1389 				/* Fixup the pseudo-header checksum. */
   1390 				/* XXXJRT Not IP Jumbogram safe. */
   1391 				th->th_sum = in_cksum_addword(th->th_sum,
   1392 				    htons((u_int16_t) (len + optlen)));
   1393 			}
   1394 		}
   1395 		break;
   1396 #endif
   1397 #ifdef INET6
   1398 	case AF_INET6:
   1399 		m->m_pkthdr.csum_data = offsetof(struct tcphdr, th_sum);
   1400 		m->m_pkthdr.csum_flags = M_CSUM_TCPv6;
   1401 		if (len + optlen) {
   1402 			/* Fixup the pseudo-header checksum. */
   1403 			/* XXXJRT: Not IPv6 Jumbogram safe. */
   1404 			th->th_sum = in_cksum_addword(th->th_sum,
   1405 			    htons((u_int16_t) (len + optlen)));
   1406 		}
   1407 		break;
   1408 #endif
   1409 	}
   1410 
   1411 	/*
   1412 	 * In transmit state, time the transmission and arrange for
   1413 	 * the retransmit.  In persist state, just set snd_max.
   1414 	 */
   1415 	if (tp->t_force == 0 || TCP_TIMER_ISARMED(tp, TCPT_PERSIST) == 0) {
   1416 		tcp_seq startseq = tp->snd_nxt;
   1417 
   1418 		/*
   1419 		 * Advance snd_nxt over sequence space of this segment.
   1420 		 * There are no states in which we send both a SYN and a FIN,
   1421 		 * so we collapse the tests for these flags.
   1422 		 */
   1423 		if (flags & (TH_SYN|TH_FIN))
   1424 			tp->snd_nxt++;
   1425 		if (sack_rxmit)
   1426 			goto timer;
   1427 		tp->snd_nxt += len;
   1428 		if (SEQ_GT(tp->snd_nxt, tp->snd_max)) {
   1429 			tp->snd_max = tp->snd_nxt;
   1430 			/*
   1431 			 * Time this transmission if not a retransmission and
   1432 			 * not currently timing anything.
   1433 			 */
   1434 			if (tp->t_rtttime == 0) {
   1435 				tp->t_rtttime = tcp_now;
   1436 				tp->t_rtseq = startseq;
   1437 				tcpstat.tcps_segstimed++;
   1438 			}
   1439 		}
   1440 
   1441 		/*
   1442 		 * Set retransmit timer if not currently set,
   1443 		 * and not doing an ack or a keep-alive probe.
   1444 		 * Initial value for retransmit timer is smoothed
   1445 		 * round-trip time + 2 * round-trip time variance.
   1446 		 * Initialize shift counter which is used for backoff
   1447 		 * of retransmit time.
   1448 		 */
   1449 timer:
   1450 		if (TCP_TIMER_ISARMED(tp, TCPT_REXMT) == 0 &&
   1451 			((sack_rxmit && tp->snd_nxt != tp->snd_max) ||
   1452 		    tp->snd_nxt != tp->snd_una)) {
   1453 			if (TCP_TIMER_ISARMED(tp, TCPT_PERSIST)) {
   1454 				TCP_TIMER_DISARM(tp, TCPT_PERSIST);
   1455 				tp->t_rxtshift = 0;
   1456 			}
   1457 			TCP_TIMER_ARM(tp, TCPT_REXMT, tp->t_rxtcur);
   1458 		}
   1459 	} else
   1460 		if (SEQ_GT(tp->snd_nxt + len, tp->snd_max))
   1461 			tp->snd_max = tp->snd_nxt + len;
   1462 
   1463 #ifdef TCP_DEBUG
   1464 	/*
   1465 	 * Trace.
   1466 	 */
   1467 	if (so->so_options & SO_DEBUG)
   1468 		tcp_trace(TA_OUTPUT, tp->t_state, tp, m, 0);
   1469 #endif
   1470 
   1471 	/*
   1472 	 * Fill in IP length and desired time to live and
   1473 	 * send to IP level.  There should be a better way
   1474 	 * to handle ttl and tos; we could keep them in
   1475 	 * the template, but need a way to checksum without them.
   1476 	 */
   1477 	m->m_pkthdr.len = hdrlen + len;
   1478 
   1479 	switch (af) {
   1480 #ifdef INET
   1481 	case AF_INET:
   1482 		ip->ip_len = htons(m->m_pkthdr.len);
   1483 		packetlen = m->m_pkthdr.len;
   1484 		if (tp->t_inpcb) {
   1485 			ip->ip_ttl = tp->t_inpcb->inp_ip.ip_ttl;
   1486 			ip->ip_tos = tp->t_inpcb->inp_ip.ip_tos;
   1487 		}
   1488 #ifdef INET6
   1489 		else if (tp->t_in6pcb) {
   1490 			ip->ip_ttl = in6_selecthlim(tp->t_in6pcb, NULL); /*XXX*/
   1491 			ip->ip_tos = 0;	/*XXX*/
   1492 		}
   1493 #endif
   1494 		break;
   1495 #endif
   1496 #ifdef INET6
   1497 	case AF_INET6:
   1498 		packetlen = m->m_pkthdr.len;
   1499 		ip6->ip6_nxt = IPPROTO_TCP;
   1500 		if (tp->t_in6pcb) {
   1501 			/*
   1502 			 * we separately set hoplimit for every segment, since
   1503 			 * the user might want to change the value via
   1504 			 * setsockopt. Also, desired default hop limit might
   1505 			 * be changed via Neighbor Discovery.
   1506 			 */
   1507 			ip6->ip6_hlim = in6_selecthlim(tp->t_in6pcb,
   1508 				ro->ro_rt ? ro->ro_rt->rt_ifp : NULL);
   1509 		}
   1510 		/* ip6->ip6_flow = ??? */
   1511 		/* ip6_plen will be filled in ip6_output(). */
   1512 		break;
   1513 #endif
   1514 	default:	/*pacify gcc*/
   1515 		packetlen = 0;
   1516 		break;
   1517 	}
   1518 
   1519 	switch (af) {
   1520 #ifdef INET
   1521 	case AF_INET:
   1522 	    {
   1523 		struct mbuf *opts;
   1524 
   1525 		if (tp->t_inpcb)
   1526 			opts = tp->t_inpcb->inp_options;
   1527 		else
   1528 			opts = NULL;
   1529 		error = ip_output(m, opts, ro,
   1530 			(tp->t_mtudisc ? IP_MTUDISC : 0) |
   1531 			(so->so_options & SO_DONTROUTE),
   1532 			(struct ip_moptions *)0, so);
   1533 		break;
   1534 	    }
   1535 #endif
   1536 #ifdef INET6
   1537 	case AF_INET6:
   1538 	    {
   1539 		struct ip6_pktopts *opts;
   1540 
   1541 		if (tp->t_in6pcb)
   1542 			opts = tp->t_in6pcb->in6p_outputopts;
   1543 		else
   1544 			opts = NULL;
   1545 		error = ip6_output(m, opts, (struct route_in6 *)ro,
   1546 			so->so_options & SO_DONTROUTE,
   1547 			(struct ip6_moptions *)0, so, NULL);
   1548 		break;
   1549 	    }
   1550 #endif
   1551 	default:
   1552 		error = EAFNOSUPPORT;
   1553 		break;
   1554 	}
   1555 	if (error) {
   1556 out:
   1557 		if (error == ENOBUFS) {
   1558 			tcpstat.tcps_selfquench++;
   1559 #ifdef INET
   1560 			if (tp->t_inpcb)
   1561 				tcp_quench(tp->t_inpcb, 0);
   1562 #endif
   1563 #ifdef INET6
   1564 			if (tp->t_in6pcb)
   1565 				tcp6_quench(tp->t_in6pcb, 0);
   1566 #endif
   1567 			error = 0;
   1568 		} else if ((error == EHOSTUNREACH || error == ENETDOWN) &&
   1569 		    TCPS_HAVERCVDSYN(tp->t_state)) {
   1570 			tp->t_softerror = error;
   1571 			error = 0;
   1572 		}
   1573 
   1574 		/* Back out the seqence number advance. */
   1575 		if (sack_rxmit)
   1576 			p->rxmit -= len;
   1577 
   1578 		/* Restart the delayed ACK timer, if necessary. */
   1579 		if (tp->t_flags & TF_DELACK)
   1580 			TCP_RESTART_DELACK(tp);
   1581 
   1582 		return (error);
   1583 	}
   1584 
   1585 	if (packetlen > tp->t_pmtud_mtu_sent)
   1586 		tp->t_pmtud_mtu_sent = packetlen;
   1587 
   1588 	tcpstat.tcps_sndtotal++;
   1589 	if (tp->t_flags & TF_DELACK)
   1590 		tcpstat.tcps_delack++;
   1591 
   1592 	/*
   1593 	 * Data sent (as far as we can tell).
   1594 	 * If this advertises a larger window than any other segment,
   1595 	 * then remember the size of the advertised window.
   1596 	 * Any pending ACK has now been sent.
   1597 	 */
   1598 	if (win > 0 && SEQ_GT(tp->rcv_nxt+win, tp->rcv_adv))
   1599 		tp->rcv_adv = tp->rcv_nxt + win;
   1600 	tp->last_ack_sent = tp->rcv_nxt;
   1601 	tp->t_flags &= ~TF_ACKNOW;
   1602 	TCP_CLEAR_DELACK(tp);
   1603 #ifdef DIAGNOSTIC
   1604 	if (maxburst < 0)
   1605 		printf("tcp_output: maxburst exceeded by %d\n", -maxburst);
   1606 #endif
   1607 	if (sendalot && (!tcp_do_newreno || --maxburst))
   1608 		goto again;
   1609 	return (0);
   1610 }
   1611 
   1612 void
   1613 tcp_setpersist(struct tcpcb *tp)
   1614 {
   1615 	int t = ((tp->t_srtt >> 2) + tp->t_rttvar) >> (1 + 2);
   1616 	int nticks;
   1617 
   1618 	if (TCP_TIMER_ISARMED(tp, TCPT_REXMT))
   1619 		panic("tcp_output REXMT");
   1620 	/*
   1621 	 * Start/restart persistance timer.
   1622 	 */
   1623 	if (t < tp->t_rttmin)
   1624 		t = tp->t_rttmin;
   1625 	TCPT_RANGESET(nticks, t * tcp_backoff[tp->t_rxtshift],
   1626 	    TCPTV_PERSMIN, TCPTV_PERSMAX);
   1627 	TCP_TIMER_ARM(tp, TCPT_PERSIST, nticks);
   1628 	if (tp->t_rxtshift < TCP_MAXRXTSHIFT)
   1629 		tp->t_rxtshift++;
   1630 }
   1631 
   1632 #if defined(INET)
   1633 /*
   1634  * tcp4_segment: handle M_CSUM_TSOv4 by software.
   1635  *
   1636  * => always consume m.
   1637  * => call output_func with output_arg for each segments.
   1638  */
   1639 
   1640 int
   1641 tcp4_segment(struct mbuf *m, int (*output_func)(void *, struct mbuf *),
   1642     void *output_arg)
   1643 {
   1644 	int mss;
   1645 	int iphlen;
   1646 	int thlen;
   1647 	int hlen;
   1648 	int len;
   1649 	struct ip *iph;
   1650 	struct tcphdr *th;
   1651 	uint16_t ipid;
   1652 	uint32_t tcpseq;
   1653 	struct mbuf *hdr = NULL;
   1654 	struct mbuf *t;
   1655 	int error = 0;
   1656 
   1657 	KASSERT((m->m_flags & M_PKTHDR) != 0);
   1658 	KASSERT((m->m_pkthdr.csum_flags & M_CSUM_TSOv4) != 0);
   1659 
   1660 	m->m_pkthdr.csum_flags = 0;
   1661 
   1662 	len = m->m_pkthdr.len;
   1663 	KASSERT(len >= sizeof(*iph) + sizeof(*th));
   1664 
   1665 	if (m->m_len < sizeof(*iph)) {
   1666 		m = m_pullup(m, sizeof(*iph));
   1667 		if (m == NULL) {
   1668 			error = ENOMEM;
   1669 			goto quit;
   1670 		}
   1671 	}
   1672 	iph = mtod(m, struct ip *);
   1673 	iphlen = iph->ip_hl * 4;
   1674 	KASSERT(iph->ip_v == IPVERSION);
   1675 	KASSERT(iphlen >= sizeof(*iph));
   1676 	KASSERT(iph->ip_p == IPPROTO_TCP);
   1677 	ipid = ntohs(iph->ip_id);
   1678 
   1679 	hlen = iphlen + sizeof(*th);
   1680 	if (m->m_len < hlen) {
   1681 		m = m_pullup(m, hlen);
   1682 		if (m == NULL) {
   1683 			error = ENOMEM;
   1684 			goto quit;
   1685 		}
   1686 	}
   1687 	th = (void *)(mtod(m, char *) + iphlen);
   1688 	tcpseq = ntohl(th->th_seq);
   1689 	thlen = th->th_off * 4;
   1690 	hlen = iphlen + thlen;
   1691 
   1692 	mss = m->m_pkthdr.segsz;
   1693 	KASSERT(mss != 0);
   1694 	KASSERT(len > hlen);
   1695 
   1696 	t = m_split(m, hlen, M_NOWAIT);
   1697 	if (t == NULL) {
   1698 		error = ENOMEM;
   1699 		goto quit;
   1700 	}
   1701 	hdr = m;
   1702 	m = t;
   1703 	len -= hlen;
   1704 	KASSERT(len % mss == 0);
   1705 	while (len > 0) {
   1706 		struct mbuf *n;
   1707 
   1708 		n = m_dup(hdr, 0, hlen, M_NOWAIT);
   1709 		if (n == NULL) {
   1710 			error = ENOMEM;
   1711 			goto quit;
   1712 		}
   1713 		KASSERT(n->m_len == hlen); /* XXX */
   1714 
   1715 		t = m_split(m, mss, M_NOWAIT);
   1716 		if (t == NULL) {
   1717 			m_freem(n);
   1718 			error = ENOMEM;
   1719 			goto quit;
   1720 		}
   1721 		m_cat(n, m);
   1722 		m = t;
   1723 
   1724 		KASSERT(n->m_len >= hlen); /* XXX */
   1725 
   1726 		n->m_pkthdr.len = hlen + mss;
   1727 		iph = mtod(n, struct ip *);
   1728 		KASSERT(iph->ip_v == IPVERSION);
   1729 		iph->ip_len = htons(n->m_pkthdr.len);
   1730 		iph->ip_id = htons(ipid);
   1731 		th = (void *)(mtod(n, char *) + iphlen);
   1732 		th->th_seq = htonl(tcpseq);
   1733 		iph->ip_sum = 0;
   1734 		iph->ip_sum = in_cksum(n, iphlen);
   1735 		th->th_sum = 0;
   1736 		th->th_sum = in4_cksum(n, IPPROTO_TCP, iphlen, thlen + mss);
   1737 
   1738 		error = (*output_func)(output_arg, n);
   1739 		if (error) {
   1740 			goto quit;
   1741 		}
   1742 
   1743 		tcpseq += mss;
   1744 		ipid++;
   1745 		len -= mss;
   1746 	}
   1747 
   1748 quit:
   1749 	if (hdr != NULL) {
   1750 		m_freem(hdr);
   1751 	}
   1752 	if (m != NULL) {
   1753 		m_freem(m);
   1754 	}
   1755 
   1756 	return error;
   1757 }
   1758 #endif /* defined(INET) */
   1759