]> git.saurik.com Git - apple/xnu.git/blobdiff - bsd/netinet/tcp_input.c
xnu-6153.11.26.tar.gz
[apple/xnu.git] / bsd / netinet / tcp_input.c
index 7767910b8ed9f91ca1c2d0a72e541ee814a9c8f7..d7d04516aa2ea1c0d8d5e6dbd0456a103ed4cef0 100644 (file)
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2000-2016 Apple Inc. All rights reserved.
+ * Copyright (c) 2000-2019 Apple Inc. All rights reserved.
  *
  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
  *
 #include <sys/sysctl.h>
 #include <sys/malloc.h>
 #include <sys/mbuf.h>
-#include <sys/proc.h>          /* for proc0 declaration */
+#include <sys/proc.h>           /* for proc0 declaration */
 #include <sys/protosw.h>
 #include <sys/socket.h>
 #include <sys/socketvar.h>
 #include <sys/syslog.h>
 #include <sys/mcache.h>
+#if !CONFIG_EMBEDDED
 #include <sys/kasl.h>
-#include <kern/cpu_number.h>   /* before tcp_seq.h, for tcp_random18() */
+#endif
+#include <sys/kauth.h>
+#include <kern/cpu_number.h>    /* before tcp_seq.h, for tcp_random18() */
 
 #include <machine/endian.h>
 
 #include <net/if_types.h>
 #include <net/route.h>
 #include <net/ntstat.h>
+#include <net/content_filter.h>
 #include <net/dlil.h>
+#include <net/multi_layer_pkt_log.h>
 
 #include <netinet/in.h>
 #include <netinet/in_systm.h>
 #include <netinet/ip.h>
 #include <netinet/ip_icmp.h>    /* for ICMP_BANDLIM            */
 #include <netinet/in_var.h>
-#include <netinet/icmp_var.h>  /* for ICMP_BANDLIM     */
+#include <netinet/icmp_var.h>   /* for ICMP_BANDLIM    */
 #include <netinet/in_pcb.h>
 #include <netinet/ip_var.h>
 #include <mach/sdt.h>
 u_char tcp_saveipgen[40]; /* the size must be of max ip header, now IPv6 */
 struct tcphdr tcp_savetcp;
 #endif /* TCPDEBUG */
+#include <netinet/tcp_log.h>
 
 #if IPSEC
 #include <netinet6/ipsec.h>
@@ -147,18 +153,16 @@ struct tcphdr tcp_savetcp;
 
 #include <corecrypto/ccaes.h>
 
-#define DBG_LAYER_BEG          NETDBG_CODE(DBG_NETTCP, 0)
-#define DBG_LAYER_END          NETDBG_CODE(DBG_NETTCP, 2)
+#define DBG_LAYER_BEG           NETDBG_CODE(DBG_NETTCP, 0)
+#define DBG_LAYER_END           NETDBG_CODE(DBG_NETTCP, 2)
 #define DBG_FNC_TCP_INPUT       NETDBG_CODE(DBG_NETTCP, (3 << 8))
 #define DBG_FNC_TCP_NEWCONN     NETDBG_CODE(DBG_NETTCP, (7 << 8))
 
-#define        TCP_RTT_HISTORY_EXPIRE_TIME     (60 * TCP_RETRANSHZ)
-#define        TCP_RECV_THROTTLE_WIN   (5 * TCP_RETRANSHZ)
-#define        TCP_STRETCHACK_ENABLE_PKTCNT    2000
-
-tcp_cc tcp_ccgen;
+#define TCP_RTT_HISTORY_EXPIRE_TIME     (60 * TCP_RETRANSHZ)
+#define TCP_RECV_THROTTLE_WIN   (5 * TCP_RETRANSHZ)
+#define TCP_STRETCHACK_ENABLE_PKTCNT    2000
 
-struct tcpstat tcpstat;
+struct  tcpstat tcpstat;
 
 static int log_in_vain = 0;
 SYSCTL_INT(_net_inet_tcp, OID_AUTO, log_in_vain,
@@ -170,28 +174,24 @@ SYSCTL_INT(_net_inet_tcp, OID_AUTO, blackhole,
     CTLFLAG_RW | CTLFLAG_LOCKED, &blackhole, 0,
     "Do not send RST when dropping refused connections");
 
-int tcp_delack_enabled = 3;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, delayed_ack,
-    CTLFLAG_RW | CTLFLAG_LOCKED, &tcp_delack_enabled, 0,
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, delayed_ack,
+    CTLFLAG_RW | CTLFLAG_LOCKED, int, tcp_delack_enabled, 3,
     "Delay ACK to try and piggyback it onto a data packet");
 
-int tcp_lq_overflow = 1;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, tcp_lq_overflow,
-    CTLFLAG_RW | CTLFLAG_LOCKED, &tcp_lq_overflow, 0,
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, tcp_lq_overflow,
+    CTLFLAG_RW | CTLFLAG_LOCKED, int, tcp_lq_overflow, 1,
     "Listen Queue Overflow");
 
-int tcp_recv_bg = 0;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, recvbg, CTLFLAG_RW | CTLFLAG_LOCKED,
-    &tcp_recv_bg, 0, "Receive background");
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, recvbg, CTLFLAG_RW | CTLFLAG_LOCKED,
+    int, tcp_recv_bg, 0, "Receive background");
 
 #if TCP_DROP_SYNFIN
-static int drop_synfin = 1;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, drop_synfin,
-    CTLFLAG_RW | CTLFLAG_LOCKED, &drop_synfin, 0,
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, drop_synfin,
+    CTLFLAG_RW | CTLFLAG_LOCKED, static int, drop_synfin, 1,
     "Drop TCP packets with SYN+FIN set");
 #endif
 
-SYSCTL_NODE(_net_inet_tcp, OID_AUTO, reass, CTLFLAG_RW|CTLFLAG_LOCKED, 0,
+SYSCTL_NODE(_net_inet_tcp, OID_AUTO, reass, CTLFLAG_RW | CTLFLAG_LOCKED, 0,
     "TCP Segment Reassembly Queue");
 
 static int tcp_reass_overflows = 0;
@@ -200,32 +200,27 @@ SYSCTL_INT(_net_inet_tcp_reass, OID_AUTO, overflows,
     "Global number of TCP Segment Reassembly Queue Overflows");
 
 
-__private_extern__ int slowlink_wsize = 8192;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, slowlink_wsize,
-    CTLFLAG_RW | CTLFLAG_LOCKED,
-    &slowlink_wsize, 0, "Maximum advertised window size for slowlink");
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, slowlink_wsize, CTLFLAG_RW | CTLFLAG_LOCKED,
+    __private_extern__ int, slowlink_wsize, 8192,
+    "Maximum advertised window size for slowlink");
 
-int maxseg_unacked = 8;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, maxseg_unacked,
-    CTLFLAG_RW | CTLFLAG_LOCKED, &maxseg_unacked, 0,
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, maxseg_unacked,
+    CTLFLAG_RW | CTLFLAG_LOCKED, int, maxseg_unacked, 8,
     "Maximum number of outstanding segments left unacked");
 
-int tcp_do_rfc3465 = 1;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, rfc3465, CTLFLAG_RW | CTLFLAG_LOCKED,
-    &tcp_do_rfc3465, 0, "");
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, rfc3465, CTLFLAG_RW | CTLFLAG_LOCKED,
+    int, tcp_do_rfc3465, 1, "");
 
-int tcp_do_rfc3465_lim2 = 1;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, rfc3465_lim2,
-    CTLFLAG_RW | CTLFLAG_LOCKED, &tcp_do_rfc3465_lim2, 0,
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, rfc3465_lim2,
+    CTLFLAG_RW | CTLFLAG_LOCKED, int, tcp_do_rfc3465_lim2, 1,
     "Appropriate bytes counting w/ L=2*SMSS");
 
 int rtt_samples_per_slot = 20;
 
-int tcp_allowed_iaj = ALLOWED_IAJ;
 int tcp_acc_iaj_high_thresh = ACC_IAJ_HIGH_THRESH;
 u_int32_t tcp_autorcvbuf_inc_shift = 3;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, recv_allowed_iaj,
-    CTLFLAG_RW | CTLFLAG_LOCKED, &tcp_allowed_iaj, 0,
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, recv_allowed_iaj,
+    CTLFLAG_RW | CTLFLAG_LOCKED, int, tcp_allowed_iaj, ALLOWED_IAJ,
     "Allowed inter-packet arrival jiter");
 #if (DEVELOPMENT || DEBUG)
 SYSCTL_INT(_net_inet_tcp, OID_AUTO, acc_iaj_high_thresh,
@@ -237,26 +232,21 @@ SYSCTL_INT(_net_inet_tcp, OID_AUTO, autorcvbufincshift,
     "Shift for increment in receive socket buffer size");
 #endif /* (DEVELOPMENT || DEBUG) */
 
-u_int32_t tcp_do_autorcvbuf = 1;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, doautorcvbuf,
-    CTLFLAG_RW | CTLFLAG_LOCKED, &tcp_do_autorcvbuf, 0,
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, doautorcvbuf,
+    CTLFLAG_RW | CTLFLAG_LOCKED, u_int32_t, tcp_do_autorcvbuf, 1,
     "Enable automatic socket buffer tuning");
 
-u_int32_t tcp_autorcvbuf_max = 512 * 1024;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, autorcvbufmax,
-    CTLFLAG_RW | CTLFLAG_LOCKED, &tcp_autorcvbuf_max, 0,
-    "Maximum receive socket buffer size");
-
-u_int32_t tcp_autorcvbuf_max_ca = 512 * 1024;
-#if (DEBUG || DEVELOPMENT)
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, autorcvbufmaxca,
-    CTLFLAG_RW | CTLFLAG_LOCKED, &tcp_autorcvbuf_max_ca, 0,
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, autorcvbufmax,
+    CTLFLAG_RW | CTLFLAG_LOCKED, u_int32_t, tcp_autorcvbuf_max, 512 * 1024,
     "Maximum receive socket buffer size");
-#endif /* (DEBUG || DEVELOPMENT) */
 
+#if CONFIG_EMBEDDED
+int sw_lro = 1;
+#else
 int sw_lro = 0;
+#endif  /* !CONFIG_EMBEDDED */
 SYSCTL_INT(_net_inet_tcp, OID_AUTO, lro, CTLFLAG_RW | CTLFLAG_LOCKED,
-        &sw_lro, 0, "Used to coalesce TCP packets");
+    &sw_lro, 0, "Used to coalesce TCP packets");
 
 int lrodebug = 0;
 SYSCTL_INT(_net_inet_tcp, OID_AUTO, lrodbg,
@@ -268,8 +258,6 @@ SYSCTL_INT(_net_inet_tcp, OID_AUTO, lro_startcnt,
     CTLFLAG_RW | CTLFLAG_LOCKED, &lro_start, 0,
     "Segments for starting LRO computed as power of 2");
 
-extern int tcp_do_autosendbuf;
-
 int limited_txmt = 1;
 int early_rexmt = 1;
 int sack_ackadv = 1;
@@ -291,20 +279,32 @@ SYSCTL_INT(_net_inet_tcp, OID_AUTO, sack_ackadv,
 SYSCTL_INT(_net_inet_tcp, OID_AUTO, dsack_enable,
     CTLFLAG_RW | CTLFLAG_LOCKED, &tcp_dsack_enable, 0,
     "use DSACK TCP option to report duplicate segments");
+
 #endif /* (DEVELOPMENT || DEBUG) */
+int tcp_disable_access_to_stats = 1;
+SYSCTL_INT(_net_inet_tcp, OID_AUTO, disable_access_to_stats,
+    CTLFLAG_RW | CTLFLAG_LOCKED, &tcp_disable_access_to_stats, 0,
+    "Disable access to tcpstat");
+
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, challengeack_limit,
+    CTLFLAG_RW | CTLFLAG_LOCKED, uint32_t, tcp_challengeack_limit, 10,
+    "Maximum number of challenge ACKs per connection per second");
+
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, do_rfc5961,
+    CTLFLAG_RW | CTLFLAG_LOCKED, static int, tcp_do_rfc5961, 1,
+    "Enable/Disable full RFC 5961 compliance");
 
-extern int tcp_TCPTV_MIN;
 extern int tcp_acc_iaj_high;
 extern int tcp_acc_iaj_react_limit;
 
 int tcprexmtthresh = 3;
 
 u_int32_t tcp_now;
-struct timeval tcp_uptime;     /* uptime when tcp_now was last updated */
-lck_spin_t *tcp_uptime_lock;   /* Used to sychronize updates to tcp_now */
+struct timeval tcp_uptime;      /* uptime when tcp_now was last updated */
+lck_spin_t *tcp_uptime_lock;    /* Used to sychronize updates to tcp_now */
 
 struct inpcbhead tcb;
-#define        tcb6    tcb  /* for KAME src sync over BSD*'s */
+#define tcb6    tcb  /* for KAME src sync over BSD*'s */
 struct inpcbinfo tcbinfo;
 
 static void tcp_dooptions(struct tcpcb *, u_char *, int, struct tcphdr *,
@@ -312,8 +312,6 @@ static void tcp_dooptions(struct tcpcb *, u_char *, int, struct tcphdr *,
 static void tcp_finalize_options(struct tcpcb *, struct tcpopt *, unsigned int);
 static void tcp_pulloutofband(struct socket *,
     struct tcphdr *, struct mbuf *, int);
-static int tcp_reass(struct tcpcb *, struct tcphdr *, int *, struct mbuf *,
-    struct ifnet *);
 static void tcp_xmit_timer(struct tcpcb *, int, u_int32_t, tcp_seq);
 static inline unsigned int tcp_maxmtu(struct rtentry *);
 static inline int tcp_stretch_ack_enable(struct tcpcb *tp, int thflags);
@@ -330,6 +328,8 @@ static void compute_iaj_meat(struct tcpcb *tp, uint32_t cur_iaj);
 static inline unsigned int tcp_maxmtu6(struct rtentry *);
 #endif
 
+unsigned int get_maxmtu(struct rtentry *);
+
 static void tcp_sbrcv_grow(struct tcpcb *tp, struct sockbuf *sb,
     struct tcpopt *to, u_int32_t tlen, u_int32_t rcvbuf_max);
 void tcp_sbrcv_trim(struct tcpcb *tp, struct sockbuf *sb);
@@ -357,19 +357,19 @@ static void tcp_bad_rexmt_check(struct tcpcb *tp, struct tcphdr *th,
 #define TCP_EARLY_REXMT_WIN (60 * TCP_RETRANSHZ) /* 60 seconds */
 #define TCP_EARLY_REXMT_LIMIT 10
 
-extern void ipfwsyslog( int level, const char *format,...);
+extern void ipfwsyslog( int level, const char *format, ...);
 extern int fw_verbose;
 
 #if IPFIREWALL
 extern void ipfw_stealth_stats_incr_tcp(void);
 
 #define log_in_vain_log( a ) {            \
-        if ( (log_in_vain == 3 ) && (fw_verbose == 2)) {        /* Apple logging, log to ipfw.log */ \
-                ipfwsyslog a ;  \
-        } else if ( (log_in_vain == 4 ) && (fw_verbose == 2)) {   \
-                ipfw_stealth_stats_incr_tcp();                    \
-        }                       \
-        else log a ;            \
+       if ( (log_in_vain == 3 ) && (fw_verbose == 2)) {        /* Apple logging, log to ipfw.log */ \
+               ipfwsyslog a ;  \
+       } else if ( (log_in_vain == 4 ) && (fw_verbose == 2)) {   \
+               ipfw_stealth_stats_incr_tcp();                    \
+       }                       \
+       else log a ;            \
 }
 #else
 #define log_in_vain_log( a ) { log a; }
@@ -377,9 +377,8 @@ extern void ipfw_stealth_stats_incr_tcp(void);
 
 int tcp_rcvunackwin = TCPTV_UNACKWIN;
 int tcp_maxrcvidle = TCPTV_MAXRCVIDLE;
-int tcp_rcvsspktcnt = TCP_RCV_SS_PKTCOUNT;
-SYSCTL_INT(_net_inet_tcp, OID_AUTO, rcvsspktcnt, CTLFLAG_RW | CTLFLAG_LOCKED,
-       &tcp_rcvsspktcnt, 0, "packets to be seen before receiver stretches acks");
+SYSCTL_SKMEM_TCP_INT(OID_AUTO, rcvsspktcnt, CTLFLAG_RW | CTLFLAG_LOCKED,
+    int, tcp_rcvsspktcnt, TCP_RCV_SS_PKTCOUNT, "packets to be seen before receiver stretches acks");
 
 #define DELAY_ACK(tp, th) \
        (CC_ALGO(tp)->delay_ack != NULL && CC_ALGO(tp)->delay_ack(tp, th))
@@ -403,8 +402,9 @@ reset_acc_iaj(struct tcpcb *tp)
 static inline void
 update_iaj_state(struct tcpcb *tp, uint32_t size, int rst_size)
 {
-       if (rst_size > 0)
+       if (rst_size > 0) {
                tp->iaj_size = 0;
+       }
        if (tp->iaj_size == 0 || size >= tp->iaj_size) {
                tp->iaj_size = size;
                tp->iaj_rcv_ts = tcp_now;
@@ -420,8 +420,8 @@ static inline int
 isqrt(unsigned int val)
 {
        unsigned int sqrt_cache[11] = {0, 1, 4, 9, 16, 25, 36, 49, 64, 81, 100};
-       unsigned int temp, g=0, b=0x8000, bshft=15;
-       if ( val <= 100) {
+       unsigned int temp, g = 0, b = 0x8000, bshft = 15;
+       if (val <= 100) {
                for (g = 0; g <= 10; ++g) {
                        if (sqrt_cache[g] > val) {
                                g--;
@@ -438,20 +438,20 @@ isqrt(unsigned int val)
                                val -= temp;
                        }
                        b >>= 1;
-               } while ( b > 0 && val > 0);
+               } while (b > 0 && val > 0);
        }
-       return(g);
+       return g;
 }
 
 /*
-* With LRO, roughly estimate the inter arrival time between
-* each sub coalesced packet as an average. Count the delay
-* cur_iaj to be the delay between the last packet received
-* and the first packet of the LRO stream. Due to round off errors
-* cur_iaj may be the same as lro_delay_factor. Averaging has
-* round off errors too. lro_delay_factor may be close to 0
-* in steady state leading to lower values fed to compute_iaj_meat.
-*/
+ * With LRO, roughly estimate the inter arrival time between
+ * each sub coalesced packet as an average. Count the delay
+ * cur_iaj to be the delay between the last packet received
+ * and the first packet of the LRO stream. Due to round off errors
+ * cur_iaj may be the same as lro_delay_factor. Averaging has
+ * round off errors too. lro_delay_factor may be close to 0
+ * in steady state leading to lower values fed to compute_iaj_meat.
+ */
 void
 compute_iaj(struct tcpcb *tp, int nlropkts, int lro_delay_factor)
 {
@@ -464,22 +464,23 @@ compute_iaj(struct tcpcb *tp, int nlropkts, int lro_delay_factor)
 
        compute_iaj_meat(tp, cur_iaj);
 
-       if (nlropkts <= 1)
+       if (nlropkts <= 1) {
                return;
+       }
 
        nlropkts--;
 
-       timediff = lro_delay_factor/nlropkts;
+       timediff = lro_delay_factor / nlropkts;
 
-       while (nlropkts > 0)
-       {
+       while (nlropkts > 0) {
                compute_iaj_meat(tp, timediff);
                nlropkts--;
        }
 }
 
 static
-void compute_iaj_meat(struct tcpcb *tp, uint32_t cur_iaj)
+void
+compute_iaj_meat(struct tcpcb *tp, uint32_t cur_iaj)
 {
        /* When accumulated IAJ reaches MAX_ACC_IAJ in milliseconds,
         * throttle the receive window to a minimum of MIN_IAJ_WIN packets
@@ -500,8 +501,9 @@ void compute_iaj_meat(struct tcpcb *tp, uint32_t cur_iaj)
         * using standard deviation.
         */
        allowed_iaj = tp->avg_iaj + tp->std_dev_iaj;
-       if (allowed_iaj < tcp_allowed_iaj)
+       if (allowed_iaj < tcp_allowed_iaj) {
                allowed_iaj = tcp_allowed_iaj;
+       }
 
        /* Initially when the connection starts, the senders congestion
         * window is small. During this period we avoid throttling a
@@ -510,18 +512,19 @@ void compute_iaj_meat(struct tcpcb *tp, uint32_t cur_iaj)
         * the first few packets.
         */
        if (tp->iaj_pktcnt > IAJ_IGNORE_PKTCNT) {
-               if ( cur_iaj <= allowed_iaj ) {
-                       if (tp->acc_iaj >= 2)
+               if (cur_iaj <= allowed_iaj) {
+                       if (tp->acc_iaj >= 2) {
                                acc_iaj = tp->acc_iaj - 2;
-                       else
+                       } else {
                                acc_iaj = 0;
-
+                       }
                } else {
                        acc_iaj = tp->acc_iaj + (cur_iaj - allowed_iaj);
                }
 
-               if (acc_iaj > MAX_ACC_IAJ)
+               if (acc_iaj > MAX_ACC_IAJ) {
                        acc_iaj = MAX_ACC_IAJ;
+               }
                tp->acc_iaj = acc_iaj;
        }
 
@@ -533,25 +536,60 @@ void compute_iaj_meat(struct tcpcb *tp, uint32_t cur_iaj)
         * instead of round-down
         */
        tp->avg_iaj = (((tp->avg_iaj << IAJ_DIV_SHIFT) - tp->avg_iaj)
-               + cur_iaj + IAJ_ROUNDUP_CONST) >> IAJ_DIV_SHIFT;
+           + cur_iaj + IAJ_ROUNDUP_CONST) >> IAJ_DIV_SHIFT;
 
        /* Compute Root-mean-square of deviation where mean is a weighted
         * average as described above.
         */
        temp = tp->std_dev_iaj * tp->std_dev_iaj;
        mean = (((temp << IAJ_DIV_SHIFT) - temp)
-               + (cur_iaj_dev * cur_iaj_dev)
-               + IAJ_ROUNDUP_CONST) >> IAJ_DIV_SHIFT;
+           + (cur_iaj_dev * cur_iaj_dev)
+           + IAJ_ROUNDUP_CONST) >> IAJ_DIV_SHIFT;
 
        tp->std_dev_iaj = isqrt(mean);
 
        DTRACE_TCP3(iaj, struct tcpcb *, tp, uint32_t, cur_iaj,
-               uint32_t, allowed_iaj);
+           uint32_t, allowed_iaj);
 
        return;
 }
 #endif /* TRAFFIC_MGT */
 
+/*
+ * Perform rate limit check per connection per second
+ * tp->t_challengeack_last is the last_time diff was greater than 1sec
+ * tp->t_challengeack_count is the number of ACKs sent (within 1sec)
+ * Return TRUE if we shouldn't send the ACK due to rate limitation
+ * Return FALSE if it is still ok to send challenge ACK
+ */
+static boolean_t
+tcp_is_ack_ratelimited(struct tcpcb *tp)
+{
+       boolean_t ret = TRUE;
+       uint32_t now = tcp_now;
+       int32_t diff = 0;
+
+       diff = timer_diff(now, 0, tp->t_challengeack_last, 0);
+       /* If it is first time or diff > 1000ms,
+        * update the challengeack_last and reset the
+        * current count of ACKs
+        */
+       if (tp->t_challengeack_last == 0 || diff >= 1000) {
+               tp->t_challengeack_last = now;
+               tp->t_challengeack_count = 0;
+               ret = FALSE;
+       } else if (tp->t_challengeack_count < tcp_challengeack_limit) {
+               ret = FALSE;
+       }
+
+       /* Careful about wrap-around */
+       if (ret == FALSE && (tp->t_challengeack_count + 1 > 0)) {
+               tp->t_challengeack_count++;
+       }
+
+       return ret;
+}
+
 /* Check if enough amount of data has been acknowledged since
  * bw measurement was started
  */
@@ -560,20 +598,37 @@ tcp_bwmeas_check(struct tcpcb *tp)
 {
        int32_t bw_meas_bytes;
        uint32_t bw, bytes, elapsed_time;
+
+       if (SEQ_LEQ(tp->snd_una, tp->t_bwmeas->bw_start)) {
+               return;
+       }
+
        bw_meas_bytes = tp->snd_una - tp->t_bwmeas->bw_start;
-       if ((tp->t_flagsext & TF_BWMEAS_INPROGRESS) != 0 &&
+       if ((tp->t_flagsext & TF_BWMEAS_INPROGRESS) &&
            bw_meas_bytes >= (int32_t)(tp->t_bwmeas->bw_size)) {
                bytes = bw_meas_bytes;
                elapsed_time = tcp_now - tp->t_bwmeas->bw_ts;
                if (elapsed_time > 0) {
                        bw = bytes / elapsed_time;
-                       if ( bw > 0) {
+                       if (bw > 0) {
                                if (tp->t_bwmeas->bw_sndbw > 0) {
                                        tp->t_bwmeas->bw_sndbw =
-                                           (((tp->t_bwmeas->bw_sndbw << 3) - tp->t_bwmeas->bw_sndbw) + bw) >> 3;
+                                           (((tp->t_bwmeas->bw_sndbw << 3)
+                                           - tp->t_bwmeas->bw_sndbw)
+                                           + bw) >> 3;
                                } else {
                                        tp->t_bwmeas->bw_sndbw = bw;
                                }
+
+                               /* Store the maximum value */
+                               if (tp->t_bwmeas->bw_sndbw_max == 0) {
+                                       tp->t_bwmeas->bw_sndbw_max =
+                                           tp->t_bwmeas->bw_sndbw;
+                               } else {
+                                       tp->t_bwmeas->bw_sndbw_max =
+                                           max(tp->t_bwmeas->bw_sndbw,
+                                           tp->t_bwmeas->bw_sndbw_max);
+                               }
                        }
                }
                tp->t_flagsext &= ~(TF_BWMEAS_INPROGRESS);
@@ -582,7 +637,7 @@ tcp_bwmeas_check(struct tcpcb *tp)
 
 static int
 tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
-    struct ifnet *ifp)
+    struct ifnet *ifp, int *dowakeup)
 {
        struct tseg_qent *q;
        struct tseg_qent *p = NULL;
@@ -591,7 +646,6 @@ tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
        struct inpcb *inp = tp->t_inpcb;
        struct socket *so = inp->inp_socket;
        int flags = 0;
-       int dowakeup = 0;
        struct mbuf *oodata = NULL;
        int copy_oodata = 0;
        u_int16_t qlimit;
@@ -604,8 +658,9 @@ tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
         * Call with th==0 after become established to
         * force pre-ESTABLISHED data up to user socket.
         */
-       if (th == NULL)
+       if (th == NULL) {
                goto present;
+       }
 
        /*
         * If the reassembly queue already has entries or if we are going
@@ -615,8 +670,9 @@ tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
        tcp_reset_stretch_ack(tp);
 
 #if TRAFFIC_MGT
-       if (tp->acc_iaj > 0)
+       if (tp->acc_iaj > 0) {
                reset_acc_iaj(tp);
+       }
 #endif /* TRAFFIC_MGT */
 
        /*
@@ -634,7 +690,7 @@ tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
                tcpstat.tcps_rcvmemdrop++;
                m_freem(m);
                *tlenp = 0;
-               return (0);
+               return 0;
        }
 
        /* Allocate a new queue entry. If we can't, just drop the pkt. XXX */
@@ -642,7 +698,7 @@ tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
        if (te == NULL) {
                tcpstat.tcps_rcvmemdrop++;
                m_freem(m);
-               return (0);
+               return 0;
        }
        tp->t_reassqlen++;
 
@@ -650,8 +706,9 @@ tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
         * Find a segment which begins after this one does.
         */
        LIST_FOREACH(q, &tp->t_segq, tqe_q) {
-               if (SEQ_GT(q->tqe_th->th_seq, th->th_seq))
+               if (SEQ_GT(q->tqe_th->th_seq, th->th_seq)) {
                        break;
+               }
                p = q;
        }
 
@@ -692,6 +749,7 @@ tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
                                        INP_ADD_STAT(inp, cell, wifi, wired,
                                            rxbytes, *tlenp);
                                        tp->t_stat.rxduplicatebytes += *tlenp;
+                                       inp_set_activity_bitmap(inp);
                                }
                                m_freem(m);
                                zfree(tcp_reass_zone, te);
@@ -719,6 +777,7 @@ tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
                INP_ADD_STAT(inp, cell, wifi, wired, rxpackets, 1);
                INP_ADD_STAT(inp, cell, wifi, wired, rxbytes, *tlenp);
                tp->t_stat.rxoutoforderbytes += *tlenp;
+               inp_set_activity_bitmap(inp);
        }
 
        /*
@@ -727,8 +786,9 @@ tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
         */
        while (q) {
                int i = (th->th_seq + *tlenp) - q->tqe_th->th_seq;
-               if (i <= 0)
+               if (i <= 0) {
                        break;
+               }
 
                /*
                 * Report only the first part of partial/non-contiguous
@@ -783,22 +843,24 @@ tcp_reass(struct tcpcb *tp, struct tcphdr *th, int *tlenp, struct mbuf *m,
         * can be copied off to sockbuf after in-order data
         * is copied off.
         */
-       if (!(so->so_state & SS_CANTRCVMORE))
+       if (!(so->so_state & SS_CANTRCVMORE)) {
                copy_oodata = 1;
+       }
 
 present:
        /*
         * Present data to user, advancing rcv_nxt through
         * completed sequence space.
         */
-       if (!TCPS_HAVEESTABLISHED(tp->t_state))
-               return (0);
+       if (!TCPS_HAVEESTABLISHED(tp->t_state)) {
+               return 0;
+       }
        q = LIST_FIRST(&tp->t_segq);
        if (!q || q->tqe_th->th_seq != tp->rcv_nxt) {
                /* Stop using LRO once out of order packets arrive */
                if (tp->t_flagsext & TF_LRO_OFFLOADED) {
                        tcp_lro_remove_state(inp->inp_laddr, inp->inp_faddr,
-                               th->th_dport, th->th_sport);
+                           th->th_dport, th->th_sport);
                        tp->t_flagsext &= ~TF_LRO_OFFLOADED;
                }
 
@@ -806,10 +868,11 @@ present:
                 * continue processing if out-of-order data
                 * can be delivered
                 */
-               if (q && (so->so_flags & SOF_ENABLE_MSGS))
+               if (q && (so->so_flags & SOF_ENABLE_MSGS)) {
                        goto msg_unordered_delivery;
+               }
 
-               return (0);
+               return 0;
        }
 
        /*
@@ -817,8 +880,9 @@ present:
         * connection, it is better to let it finish the job --
         * (radar 16316196)
         */
-       if (tp->t_flagsext & TF_REASS_INPROG)
-               return (0);
+       if (tp->t_flagsext & TF_REASS_INPROG) {
+               return 0;
+       }
 
        tp->t_flagsext |= TF_REASS_INPROG;
        /* lost packet was recovered, so ooo data can be returned */
@@ -831,6 +895,13 @@ present:
                if (so->so_state & SS_CANTRCVMORE) {
                        m_freem(q->tqe_m);
                } else {
+                       /*
+                        * The mbuf may be freed after it has been added to the
+                        * receive socket buffer so we reinitialize th to point
+                        * to a safe copy of the TCP header
+                        */
+                       struct tcphdr saved_tcphdr = {};
+
                        so_recv_data_stat(so, q->tqe_m, 0); /* XXXX */
                        if (so->so_flags & SOF_ENABLE_MSGS) {
                                /*
@@ -842,16 +913,21 @@ present:
                                 * the received data filled a gap, and
                                 * is now in order!
                                 */
-                               if (q == te)
+                               if (q == te) {
                                        copy_oodata = 0;
+                               }
                        }
+                       memcpy(&saved_tcphdr, th, sizeof(struct tcphdr));
                        if (sbappendstream_rcvdemux(so, q->tqe_m,
-                           q->tqe_th->th_seq - (tp->irs + 1), 0))
-                               dowakeup = 1;
+                           q->tqe_th->th_seq - (tp->irs + 1), 0)) {
+                               *dowakeup = 1;
+                       }
+                       th = &saved_tcphdr;
+
                        if (tp->t_flagsext & TF_LRO_OFFLOADED) {
                                tcp_update_lro_seq(tp->rcv_nxt,
-                                inp->inp_laddr, inp->inp_faddr,
-                                th->th_dport, th->th_sport);
+                                   inp->inp_laddr, inp->inp_faddr,
+                                   th->th_dport, th->th_sport);
                        }
                }
                zfree(tcp_reass_zone, q);
@@ -862,21 +938,19 @@ present:
 
 #if INET6
        if ((inp->inp_vflag & INP_IPV6) != 0) {
-
                KERNEL_DEBUG(DBG_LAYER_BEG,
-                    ((inp->inp_fport << 16) | inp->inp_lport),
-                    (((inp->in6p_laddr.s6_addr16[0] & 0xffff) << 16) |
-                     (inp->in6p_faddr.s6_addr16[0] & 0xffff)),
-                    0,0,0);
-       }
-       else
+                   ((inp->inp_fport << 16) | inp->inp_lport),
+                   (((inp->in6p_laddr.s6_addr16[0] & 0xffff) << 16) |
+                   (inp->in6p_faddr.s6_addr16[0] & 0xffff)),
+                   0, 0, 0);
+       } else
 #endif
        {
                KERNEL_DEBUG(DBG_LAYER_BEG,
-                    ((inp->inp_fport << 16) | inp->inp_lport),
-                    (((inp->inp_laddr.s_addr & 0xffff) << 16) |
-                     (inp->inp_faddr.s_addr & 0xffff)),
-                    0,0,0);
+                   ((inp->inp_fport << 16) | inp->inp_lport),
+                   (((inp->inp_laddr.s_addr & 0xffff) << 16) |
+                   (inp->inp_faddr.s_addr & 0xffff)),
+                   0, 0, 0);
        }
 
 msg_unordered_delivery:
@@ -889,8 +963,8 @@ msg_unordered_delivery:
                oodata = m_copym(te->tqe_m, 0, M_COPYALL, M_DONTWAIT);
                if (oodata != NULL) {
                        if (sbappendmsgstream_rcv(&so->so_rcv, oodata,
-                               te->tqe_th->th_seq - (tp->irs + 1), 1)) {
-                               dowakeup = 1;
+                           te->tqe_th->th_seq - (tp->irs + 1), 1)) {
+                               *dowakeup = 1;
                                tcpstat.tcps_msg_unopkts++;
                        } else {
                                tcpstat.tcps_msg_unoappendfail++;
@@ -898,9 +972,7 @@ msg_unordered_delivery:
                }
        }
 
-       if (dowakeup)
-               sorwakeup(so); /* done with socket lock held */
-       return (flags);
+       return flags;
 }
 
 /*
@@ -909,20 +981,22 @@ msg_unordered_delivery:
  */
 static void
 tcp_reduce_congestion_window(
-       struct tcpcb    *tp)
+       struct tcpcb    *tp)
 {
        /*
         * If the current tcp cc module has
         * defined a hook for tasks to run
         * before entering FR, call it
         */
-       if (CC_ALGO(tp)->pre_fr != NULL)
+       if (CC_ALGO(tp)->pre_fr != NULL) {
                CC_ALGO(tp)->pre_fr(tp);
+       }
        ENTER_FASTRECOVERY(tp);
-       if (tp->t_flags & TF_SENTFIN)
+       if (tp->t_flags & TF_SENTFIN) {
                tp->snd_recover = tp->snd_max - 1;
-       else
+       } else {
                tp->snd_recover = tp->snd_max;
+       }
        tp->t_timer[TCPT_REXMT] = 0;
        tp->t_timer[TCPT_PTO] = 0;
        tp->t_rtttime = 0;
@@ -956,7 +1030,7 @@ tcp_adaptive_rwtimo_check(struct tcpcb *tp, int tlen)
            && tlen > 0 &&
            tp->t_state == TCPS_ESTABLISHED) {
                tp->t_timer[TCPT_KEEP] = OFFSET_FROM_START(tp,
-                       (TCP_REXMTVAL(tp) << 1));
+                   (TCP_REXMTVAL(tp) << 1));
                tp->t_flagsext |= TF_DETECT_READSTALL;
                tp->t_rtimo_probes = 0;
        }
@@ -966,7 +1040,7 @@ inline void
 tcp_keepalive_reset(struct tcpcb *tp)
 {
        tp->t_timer[TCPT_KEEP] = OFFSET_FROM_START(tp,
-               TCP_CONN_KEEPIDLE(tp));
+           TCP_CONN_KEEPIDLE(tp));
        tp->t_flagsext &= ~(TF_DETECT_READSTALL);
        tp->t_rtimo_probes = 0;
 }
@@ -1004,12 +1078,12 @@ tcp6_input(struct mbuf **mp, int *offp, int proto)
 
                        IF_TCP_STATINC(ifp, icmp6unreach);
 
-                       return (IPPROTO_DONE);
+                       return IPPROTO_DONE;
                }
        }
 
        tcp_input(m, *offp);
-       return (IPPROTO_DONE);
+       return IPPROTO_DONE;
 }
 #endif
 
@@ -1033,17 +1107,17 @@ tcp_cansbgrow(struct sockbuf *sb)
        u_int32_t sbspacelim = ((nmbclusters >> 4) << MCLSHIFT);
 
        if ((total_sbmb_cnt < mblim) &&
-               (sb->sb_hiwat < sbspacelim)) {
-               return(1);
+           (sb->sb_hiwat < sbspacelim)) {
+               return 1;
        } else {
                OSIncrementAtomic64(&sbmb_limreached);
        }
-       return(0);
+       return 0;
 }
 
 static void
 tcp_sbrcv_reserve(struct tcpcb *tp, struct sockbuf *sbrcv,
-       u_int32_t newsize, u_int32_t idealsize, u_int32_t rcvbuf_max)
+    u_int32_t newsize, u_int32_t idealsize, u_int32_t rcvbuf_max)
 {
        /* newsize should not exceed max */
        newsize = min(newsize, rcvbuf_max);
@@ -1056,7 +1130,7 @@ tcp_sbrcv_reserve(struct tcpcb *tp, struct sockbuf *sbrcv,
 
        /* Set new socket buffer size */
        if (newsize > sbrcv->sb_hiwat &&
-               (sbreserve(sbrcv, newsize) == 1)) {
+           (sbreserve(sbrcv, newsize) == 1)) {
                sbrcv->sb_idealsize = min(max(sbrcv->sb_idealsize,
                    (idealsize != 0) ? idealsize : newsize), rcvbuf_max);
 
@@ -1064,7 +1138,7 @@ tcp_sbrcv_reserve(struct tcpcb *tp, struct sockbuf *sbrcv,
                 * window scale
                 */
                sbrcv->sb_idealsize = min(sbrcv->sb_idealsize,
-                       TCP_MAXWIN << tp->rcv_scale);
+                   TCP_MAXWIN << tp->rcv_scale);
        }
 }
 
@@ -1075,7 +1149,7 @@ tcp_sbrcv_reserve(struct tcpcb *tp, struct sockbuf *sbrcv,
  */
 static void
 tcp_sbrcv_grow(struct tcpcb *tp, struct sockbuf *sbrcv,
-       struct tcpopt *to, u_int32_t pktlen, u_int32_t rcvbuf_max)
+    struct tcpopt *to, u_int32_t pktlen, u_int32_t rcvbuf_max)
 {
        struct socket *so = sbrcv->sb_so;
 
@@ -1091,18 +1165,18 @@ tcp_sbrcv_grow(struct tcpcb *tp, struct sockbuf *sbrcv,
         * recovery should not change the receive window
         */
        if (tcp_do_autorcvbuf == 0 ||
-               (sbrcv->sb_flags & SB_AUTOSIZE) == 0 ||
-               tcp_cansbgrow(sbrcv) == 0 ||
-               sbrcv->sb_hiwat >= rcvbuf_max ||
-               (tp->t_flagsext & TF_RECV_THROTTLE) ||
-               (so->so_flags1 & SOF1_EXTEND_BK_IDLE_WANTED) ||
-               !LIST_EMPTY(&tp->t_segq)) {
+           (sbrcv->sb_flags & SB_AUTOSIZE) == 0 ||
+           tcp_cansbgrow(sbrcv) == 0 ||
+           sbrcv->sb_hiwat >= rcvbuf_max ||
+           (tp->t_flagsext & TF_RECV_THROTTLE) ||
+           (so->so_flags1 & SOF1_EXTEND_BK_IDLE_WANTED) ||
+           !LIST_EMPTY(&tp->t_segq)) {
                /* Can not resize the socket buffer, just return */
                goto out;
        }
 
        if (TSTMP_GT(tcp_now,
-               tp->rfbuf_ts + TCPTV_RCVBUFIDLE)) {
+           tp->rfbuf_ts + TCPTV_RCVBUFIDLE)) {
                /* If there has been an idle period in the
                 * connection, just restart the measurement
                 */
@@ -1117,8 +1191,8 @@ tcp_sbrcv_grow(struct tcpcb *tp, struct sockbuf *sbrcv,
                 * the high water mark.
                 */
                if (TSTMP_GEQ(tcp_now,
-                       tp->rfbuf_ts + TCPTV_RCVNOTS_QUANTUM)) {
-                       if (tp->rfbuf_cnt >= TCP_RCVNOTS_BYTELEVEL) {
+                   tp->rfbuf_ts + TCPTV_RCVNOTS_QUANTUM)) {
+                       if (tp->rfbuf_cnt + pktlen >= TCP_RCVNOTS_BYTELEVEL) {
                                tcp_sbrcv_reserve(tp, sbrcv,
                                    tcp_autorcvbuf_max, 0,
                                    tcp_autorcvbuf_max);
@@ -1139,8 +1213,9 @@ tcp_sbrcv_grow(struct tcpcb *tp, struct sockbuf *sbrcv,
                 * on the link.
                 */
                if (TSTMP_GEQ(to->to_tsecr, tp->rfbuf_ts)) {
-                       if (tp->rfbuf_cnt > (sbrcv->sb_hiwat -
-                               (sbrcv->sb_hiwat >> 1))) {
+                       if (tp->rfbuf_cnt + pktlen > (sbrcv->sb_hiwat -
+                           (sbrcv->sb_hiwat >> 1))) {
+                               tp->rfbuf_cnt += pktlen;
                                int32_t rcvbuf_inc, min_incr;
                                /*
                                 * Increment the receive window by a
@@ -1162,14 +1237,28 @@ tcp_sbrcv_grow(struct tcpcb *tp, struct sockbuf *sbrcv,
                                 * at least
                                 */
                                min_incr = tp->t_maxseg << tcp_autorcvbuf_inc_shift;
-                               if (rcvbuf_inc < min_incr)
+                               if (rcvbuf_inc < min_incr) {
                                        rcvbuf_inc = min_incr;
+                               }
 
                                rcvbuf_inc =
                                    (rcvbuf_inc / tp->t_maxseg) * tp->t_maxseg;
                                tcp_sbrcv_reserve(tp, sbrcv,
                                    sbrcv->sb_hiwat + rcvbuf_inc,
-                                   (tp->rfbuf_cnt * 2), rcvbuf_max);
+                                   (tp->rfbuf_cnt << 1), rcvbuf_max);
+                       }
+                       /* Measure instantaneous receive bandwidth */
+                       if (tp->t_bwmeas != NULL && tp->rfbuf_cnt > 0 &&
+                           TSTMP_GT(tcp_now, tp->rfbuf_ts)) {
+                               u_int32_t rcv_bw;
+                               rcv_bw = tp->rfbuf_cnt /
+                                   (int)(tcp_now - tp->rfbuf_ts);
+                               if (tp->t_bwmeas->bw_rcvbw_max == 0) {
+                                       tp->t_bwmeas->bw_rcvbw_max = rcv_bw;
+                               } else {
+                                       tp->t_bwmeas->bw_rcvbw_max = max(
+                                               tp->t_bwmeas->bw_rcvbw_max, rcv_bw);
+                               }
                        }
                        goto out;
                } else {
@@ -1193,7 +1282,7 @@ void
 tcp_sbrcv_trim(struct tcpcb *tp, struct sockbuf *sbrcv)
 {
        if (tcp_do_autorcvbuf == 1 && sbrcv->sb_idealsize > 0 &&
-               sbrcv->sb_hiwat > sbrcv->sb_idealsize) {
+           sbrcv->sb_hiwat > sbrcv->sb_idealsize) {
                int32_t trim;
                /* compute the difference between ideal and current sizes */
                u_int32_t diff = sbrcv->sb_hiwat - sbrcv->sb_idealsize;
@@ -1211,16 +1300,18 @@ tcp_sbrcv_trim(struct tcpcb *tp, struct sockbuf *sbrcv)
                u_int32_t leave = max(advwin, (sbrcv->sb_idealsize >> 4));
 
                /* Sometimes leave can be zero, in that case leave at least
-                * a few segments worth of space.
+                * a few segments worth of space.
                 */
-               if (leave == 0)
+               if (leave == 0) {
                        leave = tp->t_maxseg << tcp_autorcvbuf_inc_shift;
+               }
 
                trim = sbrcv->sb_hiwat - (sbrcv->sb_cc + leave);
                trim = imin(trim, (int32_t)diff);
 
-               if (trim > 0)
+               if (trim > 0) {
                        sbreserve(sbrcv, (sbrcv->sb_hiwat - trim));
+               }
        }
 }
 
@@ -1234,10 +1325,10 @@ void
 tcp_sbsnd_trim(struct sockbuf *sbsnd)
 {
        if (tcp_do_autosendbuf == 1 &&
-               ((sbsnd->sb_flags & (SB_AUTOSIZE | SB_TRIM)) ==
-                       (SB_AUTOSIZE | SB_TRIM)) &&
-               (sbsnd->sb_idealsize > 0) &&
-               (sbsnd->sb_hiwat > sbsnd->sb_idealsize)) {
+           ((sbsnd->sb_flags & (SB_AUTOSIZE | SB_TRIM)) ==
+           (SB_AUTOSIZE | SB_TRIM)) &&
+           (sbsnd->sb_idealsize > 0) &&
+           (sbsnd->sb_hiwat > sbsnd->sb_idealsize)) {
                u_int32_t trim = 0;
                if (sbsnd->sb_cc <= sbsnd->sb_idealsize) {
                        trim = sbsnd->sb_hiwat - sbsnd->sb_idealsize;
@@ -1246,8 +1337,9 @@ tcp_sbsnd_trim(struct sockbuf *sbsnd)
                }
                sbreserve(sbsnd, (sbsnd->sb_hiwat - trim));
        }
-       if (sbsnd->sb_hiwat <= sbsnd->sb_idealsize)
+       if (sbsnd->sb_hiwat <= sbsnd->sb_idealsize) {
                sbsnd->sb_flags &= ~(SB_TRIM);
+       }
 }
 
 /*
@@ -1265,8 +1357,8 @@ tcp_sbrcv_tstmp_check(struct tcpcb *tp)
        struct sockbuf *sbrcv = &so->so_rcv;
 
        if ((tp->t_flags & (TF_REQ_TSTMP | TF_RCVD_TSTMP)) !=
-               (TF_REQ_TSTMP | TF_RCVD_TSTMP) &&
-               (sbrcv->sb_flags & SB_AUTOSIZE) != 0) {
+           (TF_REQ_TSTMP | TF_RCVD_TSTMP) &&
+           (sbrcv->sb_flags & SB_AUTOSIZE) != 0) {
                tcp_sbrcv_reserve(tp, sbrcv, newsize, 0, newsize);
        }
 }
@@ -1294,21 +1386,24 @@ static inline int
 tcp_stretch_ack_enable(struct tcpcb *tp, int thflags)
 {
        if (tp->rcv_by_unackwin >= (maxseg_unacked * tp->t_maxseg) &&
-           TSTMP_GEQ(tp->rcv_unackwin, tcp_now))
+           TSTMP_GEQ(tp->rcv_unackwin, tcp_now)) {
                tp->t_flags |= TF_STREAMING_ON;
-       else
+       } else {
                tp->t_flags &= ~TF_STREAMING_ON;
+       }
 
        /* If there has been an idle time, reset streaming detection */
-       if (TSTMP_GT(tcp_now, tp->rcv_unackwin + tcp_maxrcvidle))
+       if (TSTMP_GT(tcp_now, tp->rcv_unackwin + tcp_maxrcvidle)) {
                tp->t_flags &= ~TF_STREAMING_ON;
+       }
 
        /*
         * If there are flags other than TH_ACK set, reset streaming
         * detection
         */
-       if (thflags & ~TH_ACK)
+       if (thflags & ~TH_ACK) {
                tp->t_flags &= ~TF_STREAMING_ON;
+       }
 
        if (tp->t_flagsext & TF_DISABLE_STRETCHACK) {
                if (tp->rcv_nostrack_pkts >= TCP_STRETCHACK_ENABLE_PKTCNT) {
@@ -1320,14 +1415,14 @@ tcp_stretch_ack_enable(struct tcpcb *tp, int thflags)
                }
        }
 
-       if (!(tp->t_flagsext & (TF_NOSTRETCHACK|TF_DISABLE_STRETCHACK)) &&
+       if (!(tp->t_flagsext & (TF_NOSTRETCHACK | TF_DISABLE_STRETCHACK)) &&
            (tp->t_flags & TF_STREAMING_ON) &&
            (!(tp->t_flagsext & TF_RCVUNACK_WAITSS) ||
            (tp->rcv_waitforss >= tcp_rcvsspktcnt))) {
-               return(1);
+               return 1;
        }
 
-       return(0);
+       return 0;
 }
 
 /*
@@ -1339,8 +1434,9 @@ tcp_stretch_ack_enable(struct tcpcb *tp, int thflags)
 void
 tcp_reset_stretch_ack(struct tcpcb *tp)
 {
-       tp->t_flags &= ~(TF_STRETCHACK|TF_STREAMING_ON);
+       tp->t_flags &= ~(TF_STRETCHACK | TF_STREAMING_ON);
        tp->rcv_by_unackwin = 0;
+       tp->rcv_by_unackhalfwin = 0;
        tp->rcv_unackwin = tcp_now + tcp_rcvunackwin;
 
        /*
@@ -1367,29 +1463,32 @@ tcp_reset_stretch_ack(struct tcpcb *tp)
  */
 int
 tcp_detect_bad_rexmt(struct tcpcb *tp, struct tcphdr *th,
-       struct tcpopt *to, u_int32_t rxtime)
+    struct tcpopt *to, u_int32_t rxtime)
 {
        int32_t tdiff, bad_rexmt_win;
        bad_rexmt_win = (tp->t_srtt >> (TCP_RTT_SHIFT + 1));
 
        /* If the ack has ECN CE bit, then cwnd has to be adjusted */
-       if (TCP_ECN_ENABLED(tp) && (th->th_flags & TH_ECE))
-               return (0);
+       if (TCP_ECN_ENABLED(tp) && (th->th_flags & TH_ECE)) {
+               return 0;
+       }
        if (TSTMP_SUPPORTED(tp)) {
                if (rxtime > 0 && (to->to_flags & TOF_TS)
                    && to->to_tsecr != 0
-                   && TSTMP_LT(to->to_tsecr, rxtime))
-                   return (1);
+                   && TSTMP_LT(to->to_tsecr, rxtime)) {
+                       return 1;
+               }
        } else {
                if ((tp->t_rxtshift == 1
                    || (tp->t_flagsext & TF_SENT_TLPROBE))
                    && rxtime > 0) {
                        tdiff = (int32_t)(tcp_now - rxtime);
-                       if (tdiff < bad_rexmt_win)
-                               return(1);
+                       if (tdiff < bad_rexmt_win) {
+                               return 1;
+                       }
                }
        }
-       return(0);
+       return 0;
 }
 
 
@@ -1412,16 +1511,17 @@ tcp_bad_rexmt_restore_state(struct tcpcb *tp, struct tcphdr *th)
                tp->snd_ssthresh = tp->snd_ssthresh_prev;
 
                /* Initialize cwnd to the initial window */
-               if (CC_ALGO(tp)->cwnd_init != NULL)
+               if (CC_ALGO(tp)->cwnd_init != NULL) {
                        CC_ALGO(tp)->cwnd_init(tp);
+               }
 
                tp->snd_cwnd = fsize + min(acked, tp->snd_cwnd);
-
        } else {
                tp->snd_cwnd = tp->snd_cwnd_prev;
                tp->snd_ssthresh = tp->snd_ssthresh_prev;
-               if (tp->t_flags & TF_WASFRECOVERY)
+               if (tp->t_flags & TF_WASFRECOVERY) {
                        ENTER_FASTRECOVERY(tp);
+               }
 
                /* Do not use the loss flight size in this case */
                tp->t_lossflightsize = 0;
@@ -1518,8 +1618,9 @@ out:
                        tcp_pmtud_revert_segment_size(tp);
                }
        }
-       if (tp->t_pmtud_start_ts > 0)
+       if (tp->t_pmtud_start_ts > 0) {
                tp->t_pmtud_start_ts = 0;
+       }
 }
 
 /*
@@ -1535,7 +1636,7 @@ out:
  * packet reordering.
  */
 static void
-tcp_early_rexmt_check (struct tcpcb *tp, struct tcphdr *th)
+tcp_early_rexmt_check(struct tcpcb *tp, struct tcphdr *th)
 {
        u_int32_t obytes, snd_off;
        int32_t snd_len;
@@ -1557,7 +1658,7 @@ tcp_early_rexmt_check (struct tcpcb *tp, struct tcphdr *th)
                if (SACK_ENABLED(tp) &&
                    !TAILQ_EMPTY(&tp->snd_holes)) {
                        obytes = (tp->snd_max - tp->snd_fack) +
-                               tp->sackhint.sack_bytes_rexmit;
+                           tp->sackhint.sack_bytes_rexmit;
                } else {
                        obytes = (tp->snd_max - tp->snd_una);
                }
@@ -1578,8 +1679,9 @@ tcp_early_rexmt_check (struct tcpcb *tp, struct tcphdr *th)
                        u_int32_t osegs;
 
                        osegs = obytes / tp->t_maxseg;
-                       if ((osegs * tp->t_maxseg) < obytes)
+                       if ((osegs * tp->t_maxseg) < obytes) {
                                osegs++;
+                       }
 
                        /*
                         * Since the connection might have already
@@ -1602,8 +1704,9 @@ tcp_early_rexmt_check (struct tcpcb *tp, struct tcphdr *th)
                                tp->t_rexmtthresh =
                                    max(tp->t_rexmtthresh, tp->t_dupacks);
 
-                               if (tp->t_early_rexmt_count == 0)
+                               if (tp->t_early_rexmt_count == 0) {
                                        tp->t_early_rexmt_win = tcp_now;
+                               }
 
                                if (tp->t_flagsext & TF_SENT_TLPROBE) {
                                        tcpstat.tcps_tlp_recovery++;
@@ -1637,15 +1740,16 @@ tcp_tfo_syn(struct tcpcb *tp, struct tcpopt *to)
        unsigned char len;
 
        if (!(to->to_flags & (TOF_TFO | TOF_TFOREQ)) ||
-           !(tcp_fastopen & TCP_FASTOPEN_SERVER))
-               return (FALSE);
+           !(tcp_fastopen & TCP_FASTOPEN_SERVER)) {
+               return FALSE;
+       }
 
        if ((to->to_flags & TOF_TFOREQ)) {
                tp->t_tfo_flags |= TFO_F_OFFER_COOKIE;
 
                tp->t_tfo_stats |= TFO_S_COOKIEREQ_RECV;
                tcpstat.tcps_tfo_cookie_req_rcv++;
-               return (FALSE);
+               return FALSE;
        }
 
        /* Ok, then it must be an offered cookie. We need to check that ... */
@@ -1659,13 +1763,13 @@ tcp_tfo_syn(struct tcpcb *tp, struct tcpopt *to)
 
                tp->t_tfo_stats |= TFO_S_COOKIE_INVALID;
                tcpstat.tcps_tfo_cookie_invalid++;
-               return (FALSE);
+               return FALSE;
        }
 
        if (OSIncrementAtomic(&tcp_tfo_halfcnt) >= tcp_tfo_backlog) {
                /* Need to decrement again as we just increased it... */
                OSDecrementAtomic(&tcp_tfo_halfcnt);
-               return (FALSE);
+               return FALSE;
        }
 
        tp->t_tfo_flags |= TFO_F_COOKIE_VALID;
@@ -1673,7 +1777,7 @@ tcp_tfo_syn(struct tcpcb *tp, struct tcpopt *to)
        tp->t_tfo_stats |= TFO_S_SYNDATA_RCV;
        tcpstat.tcps_tfo_syn_data_rcv++;
 
-       return (TRUE);
+       return TRUE;
 }
 
 static void
@@ -1706,7 +1810,8 @@ tcp_tfo_synack(struct tcpcb *tp, struct tcpopt *to)
                 * rexmit the SYN. If that's the case, it's better to start
                 * backing of TFO-cookie requests.
                 */
-               if (tp->t_tfo_flags & TFO_F_SYN_LOSS) {
+               if (!(tp->t_flagsext & TF_FASTOPEN_FORCE_ENABLE) &&
+                   tp->t_tfo_flags & TFO_F_SYN_LOSS) {
                        tp->t_tfo_stats |= TFO_S_SYN_LOSS;
                        tcpstat.tcps_tfo_syn_loss++;
 
@@ -1725,18 +1830,17 @@ tcp_tfo_synack(struct tcpcb *tp, struct tcpopt *to)
 static void
 tcp_tfo_rcv_probe(struct tcpcb *tp, int tlen)
 {
-       if (tlen == 0) {
-               tp->t_tfo_probe_state = TFO_PROBE_PROBING;
-
-               /*
-                * We send the probe out rather quickly (after one RTO). It does not
-                * really hurt that much, it's only one additional segment on the wire.
-                */
-               tp->t_timer[TCPT_KEEP] = OFFSET_FROM_START(tp, (TCP_REXMTVAL(tp)));
-       } else {
-               /* If SYN/ACK+data, don't probe. We got the data! */
-               tcp_heuristic_tfo_rcv_good(tp);
+       if (tlen != 0) {
+               return;
        }
+
+       tp->t_tfo_probe_state = TFO_PROBE_PROBING;
+
+       /*
+        * We send the probe out rather quickly (after one RTO). It does not
+        * really hurt that much, it's only one additional segment on the wire.
+        */
+       tp->t_timer[TCPT_KEEP] = OFFSET_FROM_START(tp, (TCP_REXMTVAL(tp)));
 }
 
 static void
@@ -1745,9 +1849,6 @@ tcp_tfo_rcv_data(struct tcpcb *tp)
        /* Transition from PROBING to NONE as data has been received */
        if (tp->t_tfo_probe_state >= TFO_PROBE_PROBING) {
                tp->t_tfo_probe_state = TFO_PROBE_NONE;
-
-               /* Data has been received - we are good to go! */
-               tcp_heuristic_tfo_rcv_good(tp);
        }
 }
 
@@ -1782,16 +1883,33 @@ tcp_update_window(struct tcpcb *tp, int thflags, struct tcphdr * th,
            (tp->snd_wl2 == th->th_ack && tiwin > tp->snd_wnd))))) {
                /* keep track of pure window updates */
                if (tlen == 0 &&
-                   tp->snd_wl2 == th->th_ack && tiwin > tp->snd_wnd)
+                   tp->snd_wl2 == th->th_ack && tiwin > tp->snd_wnd) {
                        tcpstat.tcps_rcvwinupd++;
+               }
                tp->snd_wnd = tiwin;
                tp->snd_wl1 = th->th_seq;
                tp->snd_wl2 = th->th_ack;
-               if (tp->snd_wnd > tp->max_sndwnd)
+               if (tp->snd_wnd > tp->max_sndwnd) {
                        tp->max_sndwnd = tp->snd_wnd;
-               return (true);
+               }
+
+               if (tp->t_inpcb->inp_socket->so_flags & SOF_MP_SUBFLOW) {
+                       mptcp_update_window_wakeup(tp);
+               }
+               return true;
+       }
+       return false;
+}
+
+static void
+tcp_handle_wakeup(struct socket *so, int read_wakeup, int write_wakeup)
+{
+       if (read_wakeup != 0) {
+               sorwakeup(so);
+       }
+       if (write_wakeup != 0) {
+               sowwakeup(so);
        }
-       return (false);
 }
 
 void
@@ -1808,6 +1926,8 @@ tcp_input(struct mbuf *m, int off0)
        int thflags;
        struct socket *so = 0;
        int todrop, acked, ourfinisacked, needoutput = 0;
+       int read_wakeup = 0;
+       int write_wakeup = 0;
        struct in_addr laddr;
 #if INET6
        struct in6_addr laddr6;
@@ -1815,7 +1935,7 @@ tcp_input(struct mbuf *m, int off0)
        int dropsocket = 0;
        int iss = 0, nosock = 0;
        u_int32_t tiwin, sack_bytes_acked = 0;
-       struct tcpopt to;               /* options in this segment */
+       struct tcpopt to;               /* options in this segment */
 #if TCPDEBUG
        short ostate = 0;
 #endif
@@ -1838,9 +1958,25 @@ tcp_input(struct mbuf *m, int off0)
        boolean_t wired = (!wifi && IFNET_IS_WIRED(ifp));
        boolean_t recvd_dsack = FALSE;
        struct tcp_respond_args tra;
+       int prev_t_state;
+       boolean_t check_cfil = cfil_filter_present();
+       bool findpcb_iterated = false;
+       /*
+        * The mbuf may be freed after it has been added to the receive socket
+        * buffer or the reassembly queue, so we reinitialize th to point to a
+        * safe copy of the TCP header
+        */
+       struct tcphdr saved_tcphdr = {};
+       /*
+        * Save copy of the IPv4/IPv6 header.
+        * Note: use array of uint32_t to silence compiler warning when casting
+        * to a struct ip6_hdr pointer.
+        */
+#define MAX_IPWORDS ((sizeof(struct ip) + MAX_IPOPTLEN) / sizeof(uint32_t))
+       uint32_t saved_hdr[MAX_IPWORDS];
 
-#define TCP_INC_VAR(stat, npkts) do {                  \
-               stat += npkts;                          \
+#define TCP_INC_VAR(stat, npkts) do {                   \
+               stat += npkts;                          \
 } while (0)
 
        TCP_INC_VAR(tcpstat.tcps_rcvtotal, nlropkts);
@@ -1854,7 +1990,7 @@ tcp_input(struct mbuf *m, int off0)
        }
        if (fwd_tag != NULL) {
                struct ip_fwd_tag *ipfwd_tag =
-                       (struct ip_fwd_tag *)(fwd_tag+1);
+                   (struct ip_fwd_tag *)(fwd_tag + 1);
 
                next_hop = ipfwd_tag->next_hop;
                m_tag_delete(m, fwd_tag);
@@ -1866,9 +2002,9 @@ tcp_input(struct mbuf *m, int off0)
        int isipv6;
 #endif /* INET6 */
        int rstreason; /* For badport_bandlim accounting purposes */
-       struct proc *proc0=current_proc();
+       struct proc *proc0 = current_proc();
 
-       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_START,0,0,0,0,0);
+       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_START, 0, 0, 0, 0, 0);
 
 #if INET6
        isipv6 = (mtod(m, struct ip *)->ip_v == 6) ? 1 : 0;
@@ -1888,12 +2024,14 @@ tcp_input(struct mbuf *m, int off0)
                tlen = sizeof(*ip6) + ntohs(ip6->ip6_plen) - off0;
                th = (struct tcphdr *)(void *)((caddr_t)ip6 + off0);
 
-               if (tcp_input_checksum(AF_INET6, m, th, off0, tlen))
+               if (tcp_input_checksum(AF_INET6, m, th, off0, tlen)) {
+                       TCP_LOG_DROP_PKT(ip6, th, ifp, "IPv6 bad tcp checksum");
                        goto dropnosock;
+               }
 
                KERNEL_DEBUG(DBG_LAYER_BEG, ((th->th_dport << 16) | th->th_sport),
-                    (((ip6->ip6_src.s6_addr16[0]) << 16) | (ip6->ip6_dst.s6_addr16[0])),
-                    th->th_seq, th->th_ack, th->th_win);
+                   (((ip6->ip6_src.s6_addr16[0]) << 16) | (ip6->ip6_dst.s6_addr16[0])),
+                   th->th_seq, th->th_ack, th->th_win);
                /*
                 * Be proactive about unspecified IPv6 address in source.
                 * As we use all-zero to indicate unbounded/unconnected pcb,
@@ -1905,78 +2043,83 @@ tcp_input(struct mbuf *m, int off0)
                if (IN6_IS_ADDR_UNSPECIFIED(&ip6->ip6_src)) {
                        /* XXX stat */
                        IF_TCP_STATINC(ifp, unspecv6);
+                       TCP_LOG_DROP_PKT(ip6, th, ifp, "src IPv6 address unspecified");
                        goto dropnosock;
                }
                DTRACE_TCP5(receive, struct mbuf *, m, struct inpcb *, NULL,
-                       struct ip6_hdr *, ip6, struct tcpcb *, NULL,
-                       struct tcphdr *, th);
+                   struct ip6_hdr *, ip6, struct tcpcb *, NULL,
+                   struct tcphdr *, th);
 
                ip_ecn = (ntohl(ip6->ip6_flow) >> 20) & IPTOS_ECN_MASK;
        } else
 #endif /* INET6 */
        {
-       /*
-        * Get IP and TCP header together in first mbuf.
-        * Note: IP leaves IP header in first mbuf.
-        */
-       if (off0 > sizeof (struct ip)) {
-               ip_stripoptions(m, (struct mbuf *)0);
-               off0 = sizeof(struct ip);
-       }
-       if (m->m_len < sizeof (struct tcpiphdr)) {
-               if ((m = m_pullup(m, sizeof (struct tcpiphdr))) == 0) {
-                       tcpstat.tcps_rcvshort++;
-                       return;
+               /*
+                * Get IP and TCP header together in first mbuf.
+                * Note: IP leaves IP header in first mbuf.
+                */
+               if (off0 > sizeof(struct ip)) {
+                       ip_stripoptions(m);
+                       off0 = sizeof(struct ip);
+               }
+               if (m->m_len < sizeof(struct tcpiphdr)) {
+                       if ((m = m_pullup(m, sizeof(struct tcpiphdr))) == 0) {
+                               tcpstat.tcps_rcvshort++;
+                               return;
+                       }
                }
-       }
 
-       /* Expect 32-bit aligned data pointer on strict-align platforms */
-       MBUF_STRICT_DATA_ALIGNMENT_CHECK_32(m);
+               /* Expect 32-bit aligned data pointer on strict-align platforms */
+               MBUF_STRICT_DATA_ALIGNMENT_CHECK_32(m);
 
-       ip = mtod(m, struct ip *);
-       th = (struct tcphdr *)(void *)((caddr_t)ip + off0);
-       tlen = ip->ip_len;
+               ip = mtod(m, struct ip *);
+               th = (struct tcphdr *)(void *)((caddr_t)ip + off0);
+               tlen = ip->ip_len;
 
-       if (tcp_input_checksum(AF_INET, m, th, off0, tlen))
-               goto dropnosock;
+               if (tcp_input_checksum(AF_INET, m, th, off0, tlen)) {
+                       TCP_LOG_DROP_PKT(ip, th, ifp, "IPv4 bad tcp checksum");
+                       goto dropnosock;
+               }
 
 #if INET6
-       /* Re-initialization for later version check */
-       ip->ip_v = IPVERSION;
+               /* Re-initialization for later version check */
+               ip->ip_v = IPVERSION;
 #endif
-       ip_ecn = (ip->ip_tos & IPTOS_ECN_MASK);
-
-       DTRACE_TCP5(receive, struct mbuf *, m, struct inpcb *, NULL,
-               struct ip *, ip, struct tcpcb *, NULL, struct tcphdr *, th);
+               ip_ecn = (ip->ip_tos & IPTOS_ECN_MASK);
 
-       KERNEL_DEBUG(DBG_LAYER_BEG, ((th->th_dport << 16) | th->th_sport),
-               (((ip->ip_src.s_addr & 0xffff) << 16) | (ip->ip_dst.s_addr & 0xffff)),
-                 th->th_seq, th->th_ack, th->th_win);
+               DTRACE_TCP5(receive, struct mbuf *, m, struct inpcb *, NULL,
+                   struct ip *, ip, struct tcpcb *, NULL, struct tcphdr *, th);
 
+               KERNEL_DEBUG(DBG_LAYER_BEG, ((th->th_dport << 16) | th->th_sport),
+                   (((ip->ip_src.s_addr & 0xffff) << 16) | (ip->ip_dst.s_addr & 0xffff)),
+                   th->th_seq, th->th_ack, th->th_win);
        }
 
+#define TCP_LOG_HDR (isipv6 ? (void *)ip6 : (void *)ip)
+
        /*
         * Check that TCP offset makes sense,
         * pull out TCP options and adjust length.
         */
        off = th->th_off << 2;
-       if (off < sizeof (struct tcphdr) || off > tlen) {
+       if (off < sizeof(struct tcphdr) || off > tlen) {
                tcpstat.tcps_rcvbadoff++;
                IF_TCP_STATINC(ifp, badformat);
+               TCP_LOG_DROP_PKT(TCP_LOG_HDR, th, ifp, "bad tcp offset");
                goto dropnosock;
        }
-       tlen -= off;    /* tlen is used instead of ti->ti_len */
-       if (off > sizeof (struct tcphdr)) {
+       tlen -= off;    /* tlen is used instead of ti->ti_len */
+       if (off > sizeof(struct tcphdr)) {
 #if INET6
                if (isipv6) {
-                       IP6_EXTHDR_CHECK(m, off0, off, return);
+                       IP6_EXTHDR_CHECK(m, off0, off, return );
                        ip6 = mtod(m, struct ip6_hdr *);
                        th = (struct tcphdr *)(void *)((caddr_t)ip6 + off0);
                } else
 #endif /* INET6 */
                {
                        if (m->m_len < sizeof(struct ip) + off) {
-                               if ((m = m_pullup(m, sizeof (struct ip) + off)) == 0) {
+                               if ((m = m_pullup(m, sizeof(struct ip) + off)) == 0) {
                                        tcpstat.tcps_rcvshort++;
                                        return;
                                }
@@ -1984,7 +2127,7 @@ tcp_input(struct mbuf *m, int off0)
                                th = (struct tcphdr *)(void *)((caddr_t)ip + off0);
                        }
                }
-               optlen = off - sizeof (struct tcphdr);
+               optlen = off - sizeof(struct tcphdr);
                optp = (u_char *)(th + 1);
                /*
                 * Do quick retrieval of timestamp options ("options
@@ -1994,14 +2137,14 @@ tcp_input(struct mbuf *m, int off0)
                 * tcp_dooptions(), etc.
                 */
                if ((optlen == TCPOLEN_TSTAMP_APPA ||
-                       (optlen > TCPOLEN_TSTAMP_APPA &&
-                       optp[TCPOLEN_TSTAMP_APPA] == TCPOPT_EOL)) &&
-                       *(u_int32_t *)(void *)optp == htonl(TCPOPT_TSTAMP_HDR) &&
-                       (th->th_flags & TH_SYN) == 0) {
+                   (optlen > TCPOLEN_TSTAMP_APPA &&
+                   optp[TCPOLEN_TSTAMP_APPA] == TCPOPT_EOL)) &&
+                   *(u_int32_t *)(void *)optp == htonl(TCPOPT_TSTAMP_HDR) &&
+                   (th->th_flags & TH_SYN) == 0) {
                        to.to_flags |= TOF_TS;
                        to.to_tsval = ntohl(*(u_int32_t *)(void *)(optp + 4));
                        to.to_tsecr = ntohl(*(u_int32_t *)(void *)(optp + 8));
-                       optp = NULL;    /* we've parsed the options */
+                       optp = NULL;    /* we've parsed the options */
                }
        }
        thflags = th->th_flags;
@@ -2014,8 +2157,9 @@ tcp_input(struct mbuf *m, int off0)
         *
         * This is a violation of the TCP specification.
         */
-       if (drop_synfin && (thflags & (TH_SYN|TH_FIN)) == (TH_SYN|TH_FIN)) {
+       if (drop_synfin && (thflags & (TH_SYN | TH_FIN)) == (TH_SYN | TH_FIN)) {
                IF_TCP_STATINC(ifp, synfin);
+               TCP_LOG_DROP_PKT(TCP_LOG_HDR, th, ifp, "drop SYN FIN");
                goto dropnosock;
        }
 #endif
@@ -2042,20 +2186,21 @@ tcp_input(struct mbuf *m, int off0)
         * absence of a PCB, when scoped routing (and thus source interface
         * selection) are enabled.
         */
-       if ((m->m_pkthdr.pkt_flags & PKTF_LOOP) || m->m_pkthdr.rcvif == NULL)
+       if ((m->m_pkthdr.pkt_flags & PKTF_LOOP) || m->m_pkthdr.rcvif == NULL) {
                ifscope = IFSCOPE_NONE;
-       else
+       } else {
                ifscope = m->m_pkthdr.rcvif->if_index;
+       }
 
-       /*
-        * Convert TCP protocol specific fields to host format.
-        */
+       /*
+        * Convert TCP protocol specific fields to host format.
+        */
 
 #if BYTE_ORDER != BIG_ENDIAN
-       NTOHL(th->th_seq);
-       NTOHL(th->th_ack);
-       NTOHS(th->th_win);
-       NTOHS(th->th_urp);
+       NTOHL(th->th_seq);
+       NTOHL(th->th_ack);
+       NTOHS(th->th_win);
+       NTOHS(th->th_urp);
 #endif
 
        /*
@@ -2077,7 +2222,7 @@ findpcb:
                 * already got one like this?
                 */
                inp = in_pcblookup_hash(&tcbinfo, ip->ip_src, th->th_sport,
-                       ip->ip_dst, th->th_dport, 0, m->m_pkthdr.rcvif);
+                   ip->ip_dst, th->th_dport, 0, m->m_pkthdr.rcvif);
                if (!inp) {
                        /*
                         * No, then it's new. Try find the ambushing socket
@@ -2089,24 +2234,24 @@ findpcb:
                        } else {
                                inp = in_pcblookup_hash(&tcbinfo,
                                    ip->ip_src, th->th_sport,
-                                   next_hop->sin_addr,
+                                   next_hop->sin_addr,
                                    ntohs(next_hop->sin_port), 1,
                                    m->m_pkthdr.rcvif);
                        }
                }
        } else
-#endif /* IPFIREWALL_FORWARD */
-      {
+#endif  /* IPFIREWALL_FORWARD */
+       {
 #if INET6
-       if (isipv6)
-               inp = in6_pcblookup_hash(&tcbinfo, &ip6->ip6_src, th->th_sport,
-                                        &ip6->ip6_dst, th->th_dport, 1,
-                                        m->m_pkthdr.rcvif);
-       else
+               if (isipv6) {
+                       inp = in6_pcblookup_hash(&tcbinfo, &ip6->ip6_src, th->th_sport,
+                           &ip6->ip6_dst, th->th_dport, 1,
+                           m->m_pkthdr.rcvif);
+               } else
 #endif /* INET6 */
-       inp = in_pcblookup_hash(&tcbinfo, ip->ip_src, th->th_sport,
-           ip->ip_dst, th->th_dport, 1, m->m_pkthdr.rcvif);
-      }
+               inp = in_pcblookup_hash(&tcbinfo, ip->ip_src, th->th_sport,
+                   ip->ip_dst, th->th_dport, 1, m->m_pkthdr.rcvif);
+       }
 
        /*
         * Use the interface scope information from the PCB for outbound
@@ -2114,8 +2259,9 @@ findpcb:
         * enabled, tcp_respond will use the scope of the interface where
         * the segment arrived on.
         */
-       if (inp != NULL && (inp->inp_flags & INP_BOUND_IF))
+       if (inp != NULL && (inp->inp_flags & INP_BOUND_IF)) {
                ifscope = inp->inp_boundifp->if_index;
+       }
 
        /*
         * If the state is CLOSED (i.e., TCB does not exist) then
@@ -2143,56 +2289,63 @@ findpcb:
                        }
                        switch (log_in_vain) {
                        case 1:
-                               if(thflags & TH_SYN)
+                               if (thflags & TH_SYN) {
                                        log(LOG_INFO,
-                                               "Connection attempt to TCP %s:%d from %s:%d\n",
-                                               dbuf, ntohs(th->th_dport),
-                                               sbuf,
-                                               ntohs(th->th_sport));
+                                           "Connection attempt to TCP %s:%d from %s:%d\n",
+                                           dbuf, ntohs(th->th_dport),
+                                           sbuf,
+                                           ntohs(th->th_sport));
+                               }
                                break;
                        case 2:
                                log(LOG_INFO,
-                                       "Connection attempt to TCP %s:%d from %s:%d flags:0x%x\n",
-                                       dbuf, ntohs(th->th_dport), sbuf,
-                                       ntohs(th->th_sport), thflags);
+                                   "Connection attempt to TCP %s:%d from %s:%d flags:0x%x\n",
+                                   dbuf, ntohs(th->th_dport), sbuf,
+                                   ntohs(th->th_sport), thflags);
                                break;
                        case 3:
                        case 4:
                                if ((thflags & TH_SYN) && !(thflags & TH_ACK) &&
-                                       !(m->m_flags & (M_BCAST | M_MCAST)) &&
+                                   !(m->m_flags & (M_BCAST | M_MCAST)) &&
 #if INET6
-                                       ((isipv6 && !IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst, &ip6->ip6_src)) ||
-                                        (!isipv6 && ip->ip_dst.s_addr != ip->ip_src.s_addr))
+                                   ((isipv6 && !IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst, &ip6->ip6_src)) ||
+                                   (!isipv6 && ip->ip_dst.s_addr != ip->ip_src.s_addr))
 #else
-                                       ip->ip_dst.s_addr != ip->ip_src.s_addr
+                                   ip->ip_dst.s_addr != ip->ip_src.s_addr
 #endif
-                                        )
+                                   ) {
                                        log_in_vain_log((LOG_INFO,
-                                               "Stealth Mode connection attempt to TCP %s:%d from %s:%d\n",
-                                               dbuf, ntohs(th->th_dport),
-                                               sbuf,
-                                               ntohs(th->th_sport)));
+                                           "Stealth Mode connection attempt to TCP %s:%d from %s:%d\n",
+                                           dbuf, ntohs(th->th_dport),
+                                           sbuf,
+                                           ntohs(th->th_sport)));
+                               }
                                break;
                        default:
                                break;
                        }
                }
                if (blackhole) {
-                       if (m->m_pkthdr.rcvif && m->m_pkthdr.rcvif->if_type != IFT_LOOP)
-
+                       if (m->m_pkthdr.rcvif && m->m_pkthdr.rcvif->if_type != IFT_LOOP) {
                                switch (blackhole) {
                                case 1:
-                                       if (thflags & TH_SYN)
+                                       if (thflags & TH_SYN) {
+                                               TCP_LOG_DROP_PKT(TCP_LOG_HDR, th, ifp, "blackhole 1 syn for closed port");
                                                goto dropnosock;
+                                       }
                                        break;
                                case 2:
+                                       TCP_LOG_DROP_PKT(TCP_LOG_HDR, th, ifp, "blackhole 2 closed port");
                                        goto dropnosock;
                                default:
+                                       TCP_LOG_DROP_PKT(TCP_LOG_HDR, th, ifp, "blackhole closed port");
                                        goto dropnosock;
                                }
+                       }
                }
                rstreason = BANDLIM_RST_CLOSEDPORT;
                IF_TCP_STATINC(ifp, noconnnolist);
+               TCP_LOG_DROP_PKT(TCP_LOG_HDR, th, ifp, "closed port");
                goto dropwithresetnosock;
        }
        so = inp->inp_socket;
@@ -2206,71 +2359,153 @@ findpcb:
 #if TEMPDEBUG
                printf("tcp_input: no more socket for inp=%x. This shouldn't happen\n", inp);
 #endif
+               TCP_LOG_DROP_PKT(TCP_LOG_HDR, th, ifp, "inp_socket NULL");
                goto dropnosock;
        }
 
-       tcp_lock(so, 1, 0);
+       socket_lock(so, 1);
        if (in_pcb_checkstate(inp, WNT_RELEASE, 1) == WNT_STOPUSING) {
-               tcp_unlock(so, 1, (void *)2);
-               inp = NULL;     // pretend we didn't find it
+               socket_unlock(so, 1);
+               inp = NULL;     // pretend we didn't find it
+               TCP_LOG_DROP_PKT(TCP_LOG_HDR, th, ifp, "inp state WNT_STOPUSING");
                goto dropnosock;
        }
 
-#if NECP
-#if INET6
-       if (isipv6) {
-               if (!necp_socket_is_allowed_to_send_recv_v6(inp,
-                   th->th_dport, th->th_sport, &ip6->ip6_dst,
-                   &ip6->ip6_src, ifp, NULL, NULL)) {
-                       IF_TCP_STATINC(ifp, badformatipsec);
-                       goto drop;
+       if (!isipv6 && inp->inp_faddr.s_addr != INADDR_ANY) {
+               if (inp->inp_faddr.s_addr != ip->ip_src.s_addr ||
+                   inp->inp_laddr.s_addr != ip->ip_dst.s_addr ||
+                   inp->inp_fport != th->th_sport ||
+                   inp->inp_lport != th->th_dport) {
+                       os_log_error(OS_LOG_DEFAULT, "%s 5-tuple does not match: %u:%u %u:%u\n",
+                           __func__,
+                           ntohs(inp->inp_fport), ntohs(th->th_sport),
+                           ntohs(inp->inp_lport), ntohs(th->th_dport));
+                       if (findpcb_iterated) {
+                               goto drop;
+                       }
+                       findpcb_iterated = true;
+                       socket_unlock(so, 1);
+                       inp = NULL;
+                       goto findpcb;
                }
-       } else
-#endif
-       {
-               if (!necp_socket_is_allowed_to_send_recv_v4(inp,
-                   th->th_dport, th->th_sport, &ip->ip_dst, &ip->ip_src,
-                   ifp, NULL, NULL)) {
-                       IF_TCP_STATINC(ifp, badformatipsec);
-                       goto drop;
+       } else if (isipv6 && !IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_faddr)) {
+               if (!IN6_ARE_ADDR_EQUAL(&inp->in6p_faddr, &ip6->ip6_src) ||
+                   !IN6_ARE_ADDR_EQUAL(&inp->in6p_laddr, &ip6->ip6_dst) ||
+                   inp->inp_fport != th->th_sport ||
+                   inp->inp_lport != th->th_dport) {
+                       os_log_error(OS_LOG_DEFAULT, "%s 5-tuple does not match: %u:%u %u:%u\n",
+                           __func__,
+                           ntohs(inp->inp_fport), ntohs(th->th_sport),
+                           ntohs(inp->inp_lport), ntohs(th->th_dport));
+                       if (findpcb_iterated) {
+                               goto drop;
+                       }
+                       findpcb_iterated = true;
+                       socket_unlock(so, 1);
+                       inp = NULL;
+                       goto findpcb;
                }
        }
-#endif /* NECP */
 
        tp = intotcpcb(inp);
-       if (tp == 0) {
+       if (tp == NULL) {
                rstreason = BANDLIM_RST_CLOSEDPORT;
                IF_TCP_STATINC(ifp, noconnlist);
+               TCP_LOG_DROP_PKT(TCP_LOG_HDR, th, ifp, "tp is NULL");
                goto dropwithreset;
        }
-       if (tp->t_state == TCPS_CLOSED)
+
+       TCP_LOG_TH_FLAGS(TCP_LOG_HDR, th, tp, false, ifp);
+
+       if (tp->t_state == TCPS_CLOSED) {
+               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "tp state TCPS_CLOSED");
+               goto drop;
+       }
+
+#if NECP
+       if (so->so_state & SS_ISCONNECTED) {
+               // Connected TCP sockets have a fully-bound local and remote,
+               // so the policy check doesn't need to override addresses
+               if (!necp_socket_is_allowed_to_send_recv(inp, ifp, NULL, NULL, NULL)) {
+                       TCP_LOG_DROP_NECP(TCP_LOG_HDR, th, intotcpcb(inp), false);
+                       IF_TCP_STATINC(ifp, badformat);
+                       goto drop;
+               }
+       } else {
+               /*
+                * If the proc_uuid_policy table has been updated since the last use
+                * of the listening socket (i.e., the proc_uuid_policy_table_gencount
+                * has been updated), the flags in the socket may be out of date.
+                * If INP2_WANT_APP_POLICY is stale, inbound packets may
+                * be dropped by NECP if the socket should now match a per-app
+                * exception policy.
+                * In order to avoid this refresh the proc_uuid_policy state to
+                * potentially recalculate the socket's flags before checking
+                * with NECP.
+                */
+               (void) inp_update_policy(inp);
+#if INET6
+               if (isipv6) {
+                       if (!necp_socket_is_allowed_to_send_recv_v6(inp,
+                           th->th_dport, th->th_sport, &ip6->ip6_dst,
+                           &ip6->ip6_src, ifp, NULL, NULL, NULL)) {
+                               TCP_LOG_DROP_NECP(TCP_LOG_HDR, th, intotcpcb(inp), false);
+                               IF_TCP_STATINC(ifp, badformat);
+                               goto drop;
+                       }
+               } else
+#endif
+               {
+                       if (!necp_socket_is_allowed_to_send_recv_v4(inp,
+                           th->th_dport, th->th_sport, &ip->ip_dst, &ip->ip_src,
+                           ifp, NULL, NULL, NULL)) {
+                               TCP_LOG_DROP_NECP(TCP_LOG_HDR, th, intotcpcb(inp), false);
+                               IF_TCP_STATINC(ifp, badformat);
+                               goto drop;
+                       }
+               }
+       }
+#endif /* NECP */
+
+       prev_t_state = tp->t_state;
+
+       /* If none of the FIN|SYN|RST|ACK flag is set, drop */
+       if (tcp_do_rfc5961 && (thflags & TH_ACCEPT) == 0) {
+               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "rfc5961 TH_ACCEPT == 0");
                goto drop;
+       }
 
        /* Unscale the window into a 32-bit value. */
-       if ((thflags & TH_SYN) == 0)
+       if ((thflags & TH_SYN) == 0) {
                tiwin = th->th_win << tp->snd_scale;
-       else
+       } else {
                tiwin = th->th_win;
+       }
+
 
 #if CONFIG_MACF_NET
-       if (mac_inpcb_check_deliver(inp, m, AF_INET, SOCK_STREAM))
+       if (mac_inpcb_check_deliver(inp, m, AF_INET, SOCK_STREAM)) {
+               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "mac_inpcb_check_deliver failed");
                goto drop;
+       }
 #endif
 
        /* Avoid processing packets while closing a listen socket */
        if (tp->t_state == TCPS_LISTEN &&
-               (so->so_options & SO_ACCEPTCONN) == 0)
+           (so->so_options & SO_ACCEPTCONN) == 0) {
+               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "closing a listening socket");
                goto drop;
+       }
 
-       if (so->so_options & (SO_DEBUG|SO_ACCEPTCONN)) {
+       if (so->so_options & (SO_DEBUG | SO_ACCEPTCONN)) {
 #if TCPDEBUG
                if (so->so_options & SO_DEBUG) {
                        ostate = tp->t_state;
 #if INET6
-                       if (isipv6)
+                       if (isipv6) {
                                bcopy((char *)ip6, (char *)tcp_saveipgen,
-                                     sizeof(*ip6));
-                       else
+                                   sizeof(*ip6));
+                       else
 #endif /* INET6 */
                        bcopy((char *)ip, (char *)tcp_saveipgen, sizeof(*ip));
                        tcp_savetcp = *th;
@@ -2281,13 +2516,15 @@ findpcb:
                        struct socket *so2;
                        struct socket *oso;
                        struct sockaddr_storage from;
+                       struct sockaddr_storage to2;
 #if INET6
                        struct inpcb *oinp = sotoinpcb(so);
 #endif /* INET6 */
                        struct ifnet *head_ifscope;
                        unsigned int head_nocell, head_recvanyif,
-                                    head_noexpensive, head_awdl_unrestricted,
-                                    head_intcoproc_allowed;
+                           head_noexpensive, head_awdl_unrestricted,
+                           head_intcoproc_allowed, head_external_port,
+                           head_noconstrained;
 
                        /* Get listener's bound-to-interface, if any */
                        head_ifscope = (inp->inp_flags & INP_BOUND_IF) ?
@@ -2298,8 +2535,10 @@ findpcb:
                        head_recvanyif = (inp->inp_flags & INP_RECV_ANYIF);
                        /* Get listener's no-expensive information, if any */
                        head_noexpensive = INP_NO_EXPENSIVE(inp);
+                       head_noconstrained = INP_NO_CONSTRAINED(inp);
                        head_awdl_unrestricted = INP_AWDL_UNRESTRICTED(inp);
                        head_intcoproc_allowed = INP_INTCOPROC_ALLOWED(inp);
+                       head_external_port = (inp->inp_flags2 & INP2_EXTERNAL_PORT);
 
                        /*
                         * If the state is LISTEN then ignore segment if it contains an RST.
@@ -2307,13 +2546,15 @@ findpcb:
                         * If it does not contain a SYN then it is not interesting; drop it.
                         * If it is from this socket, drop it, it must be forged.
                         */
-                       if ((thflags & (TH_RST|TH_ACK|TH_SYN)) != TH_SYN) {
+                       if ((thflags & (TH_RST | TH_ACK | TH_SYN)) != TH_SYN) {
                                IF_TCP_STATINC(ifp, listbadsyn);
 
                                if (thflags & TH_RST) {
+                                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "SYN with RST");
                                        goto drop;
                                }
                                if (thflags & TH_ACK) {
+                                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "SYN with ACK");
                                        tp = NULL;
                                        tcpstat.tcps_badsyn++;
                                        rstreason = BANDLIM_RST_OPENPORT;
@@ -2322,19 +2563,24 @@ findpcb:
 
                                /* We come here if there is no SYN set */
                                tcpstat.tcps_badsyn++;
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "bad SYN");
                                goto drop;
                        }
-                       KERNEL_DEBUG(DBG_FNC_TCP_NEWCONN | DBG_FUNC_START,0,0,0,0,0);
+                       KERNEL_DEBUG(DBG_FNC_TCP_NEWCONN | DBG_FUNC_START, 0, 0, 0, 0, 0);
                        if (th->th_dport == th->th_sport) {
 #if INET6
                                if (isipv6) {
                                        if (IN6_ARE_ADDR_EQUAL(&ip6->ip6_dst,
-                                                       &ip6->ip6_src))
+                                           &ip6->ip6_src)) {
+                                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "bad tuple same port");
                                                goto drop;
+                                       }
                                } else
 #endif /* INET6 */
-                                       if (ip->ip_dst.s_addr == ip->ip_src.s_addr)
-                                               goto drop;
+                               if (ip->ip_dst.s_addr == ip->ip_src.s_addr) {
+                                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "bad tuple same IPv4 address");
+                                       goto drop;
+                               }
                        }
                        /*
                         * RFC1122 4.2.3.10, p. 104: discard bcast/mcast SYN
@@ -2344,20 +2590,26 @@ findpcb:
                         * Packets with a multicast source address should also
                         * be discarded.
                         */
-                       if (m->m_flags & (M_BCAST|M_MCAST))
+                       if (m->m_flags & (M_BCAST | M_MCAST)) {
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "mbuf M_BCAST | M_MCAST");
                                goto drop;
+                       }
 #if INET6
                        if (isipv6) {
                                if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) ||
-                                       IN6_IS_ADDR_MULTICAST(&ip6->ip6_src))
+                                   IN6_IS_ADDR_MULTICAST(&ip6->ip6_src)) {
+                                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "IN6_IS_ADDR_MULTICAST");
                                        goto drop;
+                               }
                        } else
 #endif
                        if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr)) ||
-                               IN_MULTICAST(ntohl(ip->ip_src.s_addr)) ||
-                               ip->ip_src.s_addr == htonl(INADDR_BROADCAST) ||
-                               in_broadcast(ip->ip_dst, m->m_pkthdr.rcvif))
+                           IN_MULTICAST(ntohl(ip->ip_src.s_addr)) ||
+                           ip->ip_src.s_addr == htonl(INADDR_BROADCAST) ||
+                           in_broadcast(ip->ip_dst, m->m_pkthdr.rcvif)) {
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "multicast or broadcast address");
                                goto drop;
+                       }
 
 
 #if INET6
@@ -2385,15 +2637,16 @@ findpcb:
                                                tp = NULL;
                                                rstreason = BANDLIM_RST_OPENPORT;
                                                IF_TCP_STATINC(ifp, deprecate6);
+                                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "deprecated IPv6 address");
                                                goto dropwithreset;
                                        }
                                }
                        }
 #endif
-                       if (so->so_filt) {
+                       if (so->so_filt || check_cfil) {
 #if INET6
                                if (isipv6) {
-                                       struct sockaddr_in6     *sin6 = (struct sockaddr_in6*)&from;
+                                       struct sockaddr_in6     *sin6 = (struct sockaddr_in6*)&from;
 
                                        sin6->sin6_len = sizeof(*sin6);
                                        sin6->sin6_family = AF_INET6;
@@ -2401,8 +2654,16 @@ findpcb:
                                        sin6->sin6_flowinfo = 0;
                                        sin6->sin6_addr = ip6->ip6_src;
                                        sin6->sin6_scope_id = 0;
-                               }
-                               else
+
+                                       sin6 = (struct sockaddr_in6*)&to2;
+
+                                       sin6->sin6_len = sizeof(struct sockaddr_in6);
+                                       sin6->sin6_family = AF_INET6;
+                                       sin6->sin6_port = th->th_dport;
+                                       sin6->sin6_flowinfo = 0;
+                                       sin6->sin6_addr = ip6->ip6_dst;
+                                       sin6->sin6_scope_id = 0;
+                               } else
 #endif
                                {
                                        struct sockaddr_in *sin = (struct sockaddr_in*)&from;
@@ -2411,7 +2672,17 @@ findpcb:
                                        sin->sin_family = AF_INET;
                                        sin->sin_port = th->th_sport;
                                        sin->sin_addr = ip->ip_src;
+
+                                       sin = (struct sockaddr_in*)&to2;
+
+                                       sin->sin_len = sizeof(struct sockaddr_in);
+                                       sin->sin_family = AF_INET;
+                                       sin->sin_port = th->th_dport;
+                                       sin->sin_addr = ip->ip_dst;
                                }
+                       }
+
+                       if (so->so_filt) {
                                so2 = sonewconn(so, 0, (struct sockaddr*)&from);
                        } else {
                                so2 = sonewconn(so, 0, NULL);
@@ -2419,13 +2690,16 @@ findpcb:
                        if (so2 == 0) {
                                tcpstat.tcps_listendrop++;
                                if (tcp_dropdropablreq(so)) {
-                                       if (so->so_filt)
+                                       if (so->so_filt) {
                                                so2 = sonewconn(so, 0, (struct sockaddr*)&from);
-                                       else
+                                       } else {
                                                so2 = sonewconn(so, 0, NULL);
+                                       }
                                }
-                               if (!so2)
+                               if (!so2) {
+                                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, " listen drop");
                                        goto drop;
+                               }
                        }
 
                        /* Point "inp" and "tp" in tandem to new socket */
@@ -2433,10 +2707,10 @@ findpcb:
                        tp = intotcpcb(inp);
 
                        oso = so;
-                       tcp_unlock(so, 0, 0); /* Unlock but keep a reference on listener for now */
+                       socket_unlock(so, 0); /* Unlock but keep a reference on listener for now */
 
                        so = so2;
-                       tcp_lock(so, 1, 0);
+                       socket_lock(so, 1);
                        /*
                         * Mark socket as temporary until we're
                         * committed to keeping it.  The code at
@@ -2464,31 +2738,43 @@ findpcb:
                        /*
                         * Inherit restrictions from listener.
                         */
-                       if (head_nocell)
+                       if (head_nocell) {
                                inp_set_nocellular(inp);
-                       if (head_noexpensive)
+                       }
+                       if (head_noexpensive) {
                                inp_set_noexpensive(inp);
-                       if (head_awdl_unrestricted)
+                       }
+                       if (head_noconstrained) {
+                               inp_set_noconstrained(inp);
+                       }
+                       if (head_awdl_unrestricted) {
                                inp_set_awdl_unrestricted(inp);
-                       if (head_intcoproc_allowed)
+                       }
+                       if (head_intcoproc_allowed) {
                                inp_set_intcoproc_allowed(inp);
+                       }
                        /*
                         * Inherit {IN,IN6}_RECV_ANYIF from listener.
                         */
-                       if (head_recvanyif)
+                       if (head_recvanyif) {
                                inp->inp_flags |= INP_RECV_ANYIF;
-                       else
+                       } else {
                                inp->inp_flags &= ~INP_RECV_ANYIF;
+                       }
+
+                       if (head_external_port) {
+                               inp->inp_flags2 |= INP2_EXTERNAL_PORT;
+                       }
 #if INET6
-                       if (isipv6)
+                       if (isipv6) {
                                inp->in6p_laddr = ip6->ip6_dst;
-                       else {
+                       else {
                                inp->inp_vflag &= ~INP_IPV6;
                                inp->inp_vflag |= INP_IPV4;
 #endif /* INET6 */
-                               inp->inp_laddr = ip->ip_dst;
+                       inp->inp_laddr = ip->ip_dst;
 #if INET6
-                       }
+               }
 #endif /* INET6 */
                        inp->inp_lport = th->th_dport;
                        if (in_pcbinshash(inp, 0) != 0) {
@@ -2497,83 +2783,104 @@ findpcb:
                                 * put the PCB on the hash lists.
                                 */
 #if INET6
-                               if (isipv6)
+                               if (isipv6) {
                                        inp->in6p_laddr = in6addr_any;
-                               else
+                               else
 #endif /* INET6 */
-                                       inp->inp_laddr.s_addr = INADDR_ANY;
+                               inp->inp_laddr.s_addr = INADDR_ANY;
                                inp->inp_lport = 0;
-                               tcp_lock(oso, 0, 0);    /* release ref on parent */
-                               tcp_unlock(oso, 1, 0);
+                               socket_lock(oso, 0);    /* release ref on parent */
+                               socket_unlock(oso, 1);
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, " in_pcbinshash failed");
                                goto drop;
                        }
 #if INET6
                        if (isipv6) {
-                               /*
-                                * Inherit socket options from the listening
-                                * socket.
-                                * Note that in6p_inputopts are not (even
-                                * should not be) copied, since it stores
+                               /*
+                                * Inherit socket options from the listening
+                                * socket.
+                                * Note that in6p_inputopts are not (even
+                                * should not be) copied, since it stores
                                 * previously received options and is used to
-                                * detect if each new option is different than
-                                * the previous one and hence should be passed
-                                * to a user.
-                                * If we copied in6p_inputopts, a user would
-                                * not be able to receive options just after
-                                * calling the accept system call.
-                                */
+                                * detect if each new option is different than
+                                * the previous one and hence should be passed
+                                * to a user.
+                                * If we copied in6p_inputopts, a user would
+                                * not be able to receive options just after
+                                * calling the accept system call.
+                                */
                                inp->inp_flags |=
-                                       oinp->inp_flags & INP_CONTROLOPTS;
-                               if (oinp->in6p_outputopts)
-                                       inp->in6p_outputopts =
-                                               ip6_copypktopts(oinp->in6p_outputopts,
-                                                               M_NOWAIT);
+                                   oinp->inp_flags & INP_CONTROLOPTS;
+                               if (oinp->in6p_outputopts) {
+                                       inp->in6p_outputopts =
+                                           ip6_copypktopts(oinp->in6p_outputopts,
+                                           M_NOWAIT);
+                               }
                        } else
 #endif /* INET6 */
                        {
                                inp->inp_options = ip_srcroute();
                                inp->inp_ip_tos = oinp->inp_ip_tos;
                        }
-                       tcp_lock(oso, 0, 0);
+                       socket_lock(oso, 0);
 #if IPSEC
                        /* copy old policy into new socket's */
-                       if (sotoinpcb(oso)->inp_sp)
-                       {
+                       if (sotoinpcb(oso)->inp_sp) {
                                int error = 0;
                                /* Is it a security hole here to silently fail to copy the policy? */
-                               if (inp->inp_sp != NULL)
+                               if (inp->inp_sp != NULL) {
                                        error = ipsec_init_policy(so, &inp->inp_sp);
-                               if (error != 0 || ipsec_copy_policy(sotoinpcb(oso)->inp_sp, inp->inp_sp))
+                               }
+                               if (error != 0 || ipsec_copy_policy(sotoinpcb(oso)->inp_sp, inp->inp_sp)) {
                                        printf("tcp_input: could not copy policy\n");
+                               }
                        }
 #endif
                        /* inherit states from the listener */
                        DTRACE_TCP4(state__change, void, NULL, struct inpcb *, inp,
-                               struct tcpcb *, tp, int32_t, TCPS_LISTEN);
+                           struct tcpcb *, tp, int32_t, TCPS_LISTEN);
                        tp->t_state = TCPS_LISTEN;
-                       tp->t_flags |= tp0->t_flags & (TF_NOPUSH|TF_NOOPT|TF_NODELAY);
-                       tp->t_flagsext |= (tp0->t_flagsext & (TF_RXTFINDROP|TF_NOTIMEWAIT|TF_FASTOPEN));
+                       tp->t_flags |= tp0->t_flags & (TF_NOPUSH | TF_NOOPT | TF_NODELAY);
+                       tp->t_flagsext |= (tp0->t_flagsext & (TF_RXTFINDROP | TF_NOTIMEWAIT | TF_FASTOPEN));
                        tp->t_keepinit = tp0->t_keepinit;
                        tp->t_keepcnt = tp0->t_keepcnt;
                        tp->t_keepintvl = tp0->t_keepintvl;
                        tp->t_adaptive_wtimo = tp0->t_adaptive_wtimo;
                        tp->t_adaptive_rtimo = tp0->t_adaptive_rtimo;
                        tp->t_inpcb->inp_ip_ttl = tp0->t_inpcb->inp_ip_ttl;
-                       if ((so->so_flags & SOF_NOTSENT_LOWAT) != 0)
+                       if ((so->so_flags & SOF_NOTSENT_LOWAT) != 0) {
                                tp->t_notsent_lowat = tp0->t_notsent_lowat;
+                       }
                        tp->t_inpcb->inp_flags2 |=
                            tp0->t_inpcb->inp_flags2 & INP2_KEEPALIVE_OFFLOAD;
 
                        /* now drop the reference on the listener */
-                       tcp_unlock(oso, 1, 0);
+                       socket_unlock(oso, 1);
 
-                       tcp_set_max_rwinscale(tp, so, TCP_AUTORCVBUF_MAX(ifp));
+                       tcp_set_max_rwinscale(tp, so, ifp);
 
-                       KERNEL_DEBUG(DBG_FNC_TCP_NEWCONN | DBG_FUNC_END,0,0,0,0,0);
+#if CONTENT_FILTER
+                       if (check_cfil) {
+                               int error = cfil_sock_attach(so2, (struct sockaddr*)&to2, (struct sockaddr*)&from,
+                                   CFS_CONNECTION_DIR_IN);
+                               if (error != 0) {
+                                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, " cfil_sock_attach failed");
+                                       goto drop;
+                               }
+                       }
+#endif /* CONTENT_FILTER */
+
+                       KERNEL_DEBUG(DBG_FNC_TCP_NEWCONN | DBG_FUNC_END, 0, 0, 0, 0, 0);
                }
        }
-       lck_mtx_assert(&((struct inpcb *)so->so_pcb)->inpcb_mtx,
-               LCK_MTX_ASSERT_OWNED);
+       socket_lock_assert_owned(so);
+
+       if (net_mpklog_enabled && (m->m_pkthdr.rcvif->if_xflags & IFXF_MPK_LOG)) {
+               MPKL_TCP_INPUT(tcp_mpkl_log_object,
+                   ntohs(tp->t_inpcb->inp_lport), ntohs(tp->t_inpcb->inp_fport),
+                   th->th_seq, th->th_ack, tlen, thflags,
+                   so->last_pid, so->so_log_seqn++);
+       }
 
        if (tp->t_state == TCPS_ESTABLISHED && tlen > 0) {
                /*
@@ -2592,29 +2899,31 @@ findpcb:
                } else {
                        tp->t_flags &= ~(TF_STRETCHACK);
                }
-               if (TSTMP_GT(tp->rcv_unackwin, tcp_now)) {
+               if (TSTMP_GT(tp->rcv_unackwin - (tcp_rcvunackwin >> 1), tcp_now)) {
+                       tp->rcv_by_unackhalfwin += (tlen + off);
                        tp->rcv_by_unackwin += (tlen + off);
                } else {
                        tp->rcv_unackwin = tcp_now + tcp_rcvunackwin;
-                       tp->rcv_by_unackwin = tlen + off;
+                       tp->rcv_by_unackwin = tp->rcv_by_unackhalfwin + tlen + off;
+                       tp->rcv_by_unackhalfwin = tlen + off;
                }
        }
 
        /*
         * Keep track of how many bytes were received in the LRO packet
         */
-       if ((pktf_sw_lro_pkt) && (nlropkts > 2))  {
+       if ((pktf_sw_lro_pkt) && (nlropkts > 2)) {
                tp->t_lropktlen += tlen;
        }
        /*
         * Explicit Congestion Notification - Flag that we need to send ECT if
-        *      + The IP Congestion experienced flag was set.
-        *      + Socket is in established state
-        *      + We negotiated ECN in the TCP setup
-        *      + This isn't a pure ack (tlen > 0)
-        *      + The data is in the valid window
+        *      + The IP Congestion experienced flag was set.
+        *      + Socket is in established state
+        *      + We negotiated ECN in the TCP setup
+        *      + This isn't a pure ack (tlen > 0)
+        *      + The data is in the valid window
         *
-        *      TE_SENDECE will be cleared when we receive a packet with TH_CWR set.
+        *      TE_SENDECE will be cleared when we receive a packet with TH_CWR set.
         */
        if (ip_ecn == IPTOS_ECN_CE && tp->t_state == TCPS_ESTABLISHED &&
            TCP_ECN_ENABLED(tp) && tlen > 0 &&
@@ -2665,7 +2974,7 @@ findpcb:
                        tcpstat.tcps_ecn_fallback_ce++;
                        tcp_heuristic_ecn_aggressive(tp);
                        tp->ecn_flags |= TE_CEHEURI_SET;
-                       INP_INC_IFNET_STAT(inp,ecn_fallback_ce);
+                       INP_INC_IFNET_STAT(inp, ecn_fallback_ce);
                } else {
                        /* We tracked the first ECN_MIN_CE_PROBES segments, we
                         * now know that the path is good.
@@ -2681,10 +2990,10 @@ findpcb:
         * we want to avoid doing LRO if the remote end is not up to date
         * on initial window support and starts with 1 or 2 packets as its IW.
         */
-        if (sw_lro && (tp->t_flagsext & TF_LRO_OFFLOADED) &&
-               ((tcp_now - tp->t_rcvtime) >= (TCP_IDLETIMEOUT(tp)))) {
+       if (sw_lro && (tp->t_flagsext & TF_LRO_OFFLOADED) &&
+           ((tcp_now - tp->t_rcvtime) >= (TCP_IDLETIMEOUT(tp)))) {
                turnoff_lro = 1;
-        }
+       }
 
        /* Update rcvtime as a new segment was received on the connection */
        tp->t_rcvtime = tcp_now;
@@ -2693,32 +3002,39 @@ findpcb:
         * Segment received on connection.
         * Reset idle time and keep-alive timer.
         */
-       if (TCPS_HAVEESTABLISHED(tp->t_state))
+       if (TCPS_HAVEESTABLISHED(tp->t_state)) {
                tcp_keepalive_reset(tp);
 
+               if (tp->t_mpsub) {
+                       mptcp_reset_keepalive(tp);
+               }
+       }
+
        /*
         * Process options if not in LISTEN state,
         * else do it below (after getting remote address).
         */
        if (tp->t_state != TCPS_LISTEN && optp) {
                tcp_dooptions(tp, optp, optlen, th, &to);
+       }
 #if MPTCP
-               if (mptcp_input_preproc(tp, m, drop_hdrlen) != 0) {
-                       tp->t_flags |= TF_ACKNOW;
-                       (void) tcp_output(tp);
-                       tcp_check_timer_state(tp);
-                       tcp_unlock(so, 1, 0);
-                       KERNEL_DEBUG(DBG_FNC_TCP_INPUT |
-                           DBG_FUNC_END,0,0,0,0,0);
-                       return;
-               }
-#endif /* MPTCP */
+       if (tp->t_state != TCPS_LISTEN && (so->so_flags & SOF_MP_SUBFLOW) &&
+           mptcp_input_preproc(tp, m, th, drop_hdrlen) != 0) {
+               tp->t_flags |= TF_ACKNOW;
+               (void) tcp_output(tp);
+               tcp_check_timer_state(tp);
+               socket_unlock(so, 1);
+               KERNEL_DEBUG(DBG_FNC_TCP_INPUT |
+                   DBG_FUNC_END, 0, 0, 0, 0, 0);
+               return;
        }
+#endif /* MPTCP */
        if (tp->t_state == TCPS_SYN_SENT && (thflags & TH_SYN)) {
                if (!(thflags & TH_ACK) ||
                    (SEQ_GT(th->th_ack, tp->iss) &&
-                   SEQ_LEQ(th->th_ack, tp->snd_max)))
+                   SEQ_LEQ(th->th_ack, tp->snd_max))) {
                        tcp_finalize_options(tp, &to, ifscope);
+               }
        }
 
 #if TRAFFIC_MGT
@@ -2734,10 +3050,10 @@ findpcb:
         * to queuing in edge/access routers.
         */
        if (tp->t_state == TCPS_ESTABLISHED &&
-           (thflags & (TH_SYN|TH_FIN|TH_RST|TH_URG|TH_ACK|TH_ECE|TH_PUSH)) == TH_ACK &&
-           ((tp->t_flags & (TF_NEEDSYN|TF_NEEDFIN)) == 0) &&
+           (thflags & (TH_SYN | TH_FIN | TH_RST | TH_URG | TH_ACK | TH_ECE | TH_PUSH)) == TH_ACK &&
+           ((tp->t_flags & (TF_NEEDSYN | TF_NEEDFIN)) == 0) &&
            ((to.to_flags & TOF_TS) == 0 ||
-            TSTMP_GEQ(to.to_tsval, tp->ts_recent)) &&
+           TSTMP_GEQ(to.to_tsval, tp->ts_recent)) &&
            th->th_seq == tp->rcv_nxt && LIST_EMPTY(&tp->t_segq)) {
                int seg_size = tlen;
                if (tp->iaj_pktcnt <= IAJ_IGNORE_PKTCNT) {
@@ -2747,8 +3063,8 @@ findpcb:
                if (m->m_pkthdr.pkt_flags & PKTF_SW_LRO_PKT) {
                        seg_size = m->m_pkthdr.lro_pktlen;
                }
-               if ( tp->iaj_size == 0 || seg_size > tp->iaj_size ||
-                       (seg_size == tp->iaj_size && tp->iaj_rcv_ts == 0)) {
+               if (tp->iaj_size == 0 || seg_size > tp->iaj_size ||
+                   (seg_size == tp->iaj_size && tp->iaj_rcv_ts == 0)) {
                        /*
                         * State related to inter-arrival jitter is
                         * uninitialized or we are trying to find a good
@@ -2761,13 +3077,14 @@ findpcb:
                                 * Compute inter-arrival jitter taking
                                 * this packet as the second packet
                                 */
-                               if (pktf_sw_lro_pkt)
+                               if (pktf_sw_lro_pkt) {
                                        compute_iaj(tp, nlropkts,
                                            m->m_pkthdr.lro_elapsed);
-                               else
+                               } else {
                                        compute_iaj(tp, 1, 0);
+                               }
                        }
-                       if (seg_size  < tp->iaj_size) {
+                       if (seg_size < tp->iaj_size) {
                                /*
                                 * There is a smaller packet in the stream.
                                 * Some times the maximum size supported
@@ -2811,14 +3128,13 @@ findpcb:
         * be TH_NEEDSYN.
         */
        if (tp->t_state == TCPS_ESTABLISHED &&
-           (thflags & (TH_SYN|TH_FIN|TH_RST|TH_URG|TH_ACK|TH_ECE|TH_CWR)) == TH_ACK &&
-           ((tp->t_flags & (TF_NEEDSYN|TF_NEEDFIN)) == 0) &&
+           (thflags & (TH_SYN | TH_FIN | TH_RST | TH_URG | TH_ACK | TH_ECE | TH_CWR)) == TH_ACK &&
+           ((tp->t_flags & (TF_NEEDSYN | TF_NEEDFIN)) == 0) &&
            ((to.to_flags & TOF_TS) == 0 ||
-            TSTMP_GEQ(to.to_tsval, tp->ts_recent)) &&
+           TSTMP_GEQ(to.to_tsval, tp->ts_recent)) &&
            th->th_seq == tp->rcv_nxt &&
            tiwin && tiwin == tp->snd_wnd &&
            tp->snd_nxt == tp->snd_max) {
-
                /*
                 * If last ACK falls within this segment's sequence numbers,
                 * record the timestamp.
@@ -2826,7 +3142,7 @@ findpcb:
                 * proposal of the tcplw@cray.com list (Braden 1993/04/26).
                 */
                if ((to.to_flags & TOF_TS) != 0 &&
-                  SEQ_LEQ(th->th_seq, tp->last_ack_sent)) {
+                   SEQ_LEQ(th->th_seq, tp->last_ack_sent)) {
                        tp->ts_recent_age = tcp_now;
                        tp->ts_recent = to.to_tsval;
                }
@@ -2861,8 +3177,9 @@ findpcb:
                                 * calculations in this function
                                 * assume that snd_una is not updated yet.
                                 */
-                               if (CC_ALGO(tp)->congestion_avd != NULL)
+                               if (CC_ALGO(tp)->congestion_avd != NULL) {
                                        CC_ALGO(tp)->congestion_avd(tp, th);
+                               }
                                tcp_ccdbg_trace(tp, th, TCP_CC_INSEQ_ACK_RCVD);
                                sbdrop(&so->so_snd, acked);
                                if (so->so_flags & SOF_ENABLE_MSGS) {
@@ -2872,8 +3189,9 @@ findpcb:
                                tcp_sbsnd_trim(&so->so_snd);
 
                                if (SEQ_GT(tp->snd_una, tp->snd_recover) &&
-                                   SEQ_LEQ(th->th_ack, tp->snd_recover))
+                                   SEQ_LEQ(th->th_ack, tp->snd_recover)) {
                                        tp->snd_recover = th->th_ack - 1;
+                               }
                                tp->snd_una = th->th_ack;
 
                                TCP_RESET_REXMT_STATE(tp);
@@ -2910,16 +3228,19 @@ findpcb:
                                }
                                if (!SLIST_EMPTY(&tp->t_rxt_segments) &&
                                    !TCP_DSACK_SEQ_IN_WINDOW(tp,
-                                   tp->t_dsack_lastuna, tp->snd_una))
+                                   tp->t_dsack_lastuna, tp->snd_una)) {
                                        tcp_rxtseg_clean(tp);
+                               }
 
                                if ((tp->t_flagsext & TF_MEASURESNDBW) != 0 &&
-                                       tp->t_bwmeas != NULL)
+                                   tp->t_bwmeas != NULL) {
                                        tcp_bwmeas_check(tp);
+                               }
 
-                               sowwakeup(so); /* has to be done with socket lock held */
-                               if (!SLIST_EMPTY(&tp->t_notify_ack))
+                               write_wakeup = 1;
+                               if (!SLIST_EMPTY(&tp->t_notify_ack)) {
                                        tcp_notify_acknowledgement(tp, so);
+                               }
 
                                if ((so->so_snd.sb_cc) || (tp->t_flags & TF_ACKNOW)) {
                                        (void) tcp_output(tp);
@@ -2928,8 +3249,11 @@ findpcb:
                                tcp_tfo_rcv_ack(tp, th);
 
                                tcp_check_timer_state(tp);
-                               tcp_unlock(so, 1, 0);
-                               KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END,0,0,0,0,0);
+
+                               tcp_handle_wakeup(so, read_wakeup, write_wakeup);
+
+                               socket_unlock(so, 1);
+                               KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END, 0, 0, 0, 0, 0);
                                return;
                        }
                } else if (th->th_ack == tp->snd_una &&
@@ -2942,32 +3266,33 @@ findpcb:
                         */
 
                        /*
-                        * If this is a connection in steady state, start
+                        * If this is a connection in steady state, start
                         * coalescing packets belonging to this flow.
                         */
                        if (turnoff_lro) {
                                tcp_lro_remove_state(tp->t_inpcb->inp_laddr,
-                                       tp->t_inpcb->inp_faddr,
-                                       tp->t_inpcb->inp_lport,
-                                       tp->t_inpcb->inp_fport);
+                                   tp->t_inpcb->inp_faddr,
+                                   tp->t_inpcb->inp_lport,
+                                   tp->t_inpcb->inp_fport);
                                tp->t_flagsext &= ~TF_LRO_OFFLOADED;
                                tp->t_idleat = tp->rcv_nxt;
                        } else if (sw_lro && !pktf_sw_lro_pkt && !isipv6 &&
                            (so->so_flags & SOF_USELRO) &&
                            !IFNET_IS_CELLULAR(m->m_pkthdr.rcvif) &&
-                           (m->m_pkthdr.rcvif->if_type != IFT_LOOP) &&
+                           (m->m_pkthdr.rcvif->if_type != IFT_LOOP) &&
                            ((th->th_seq - tp->irs) >
                            (tp->t_maxseg << lro_start)) &&
                            ((tp->t_idleat == 0) || ((th->th_seq -
-                            tp->t_idleat) > (tp->t_maxseg << lro_start)))) {
+                           tp->t_idleat) > (tp->t_maxseg << lro_start)))) {
                                tp->t_flagsext |= TF_LRO_OFFLOADED;
                                tcp_start_coalescing(ip, th, tlen);
                                tp->t_idleat = 0;
                        }
 
                        /* Clean receiver SACK report if present */
-                       if (SACK_ENABLED(tp) && tp->rcv_numsacks)
+                       if (SACK_ENABLED(tp) && tp->rcv_numsacks) {
                                tcp_clean_sackreport(tp);
+                       }
                        ++tcpstat.tcps_preddat;
                        tp->rcv_nxt += tlen;
                        /*
@@ -2990,8 +3315,9 @@ findpcb:
                                        INP_ADD_STAT(inp, cell, wifi, wired,
                                            rxpackets, 1);
                                }
-                               INP_ADD_STAT(inp, cell, wifi, wired,rxbytes,
+                               INP_ADD_STAT(inp, cell, wifi, wired, rxbytes,
                                    tlen);
+                               inp_set_activity_bitmap(inp);
                        }
 
                        /*
@@ -2999,8 +3325,9 @@ findpcb:
                         * connection is in streaming mode and the last
                         * packet was not an end-of-write
                         */
-                       if (tp->t_flags & TF_STREAMING_ON)
+                       if (tp->t_flags & TF_STREAMING_ON) {
                                tcp_compute_rtt(tp, &to, th);
+                       }
 
                        tcp_sbrcv_grow(tp, &so->so_rcv, &to, tlen,
                            TCP_AUTORCVBUF_MAX(ifp));
@@ -3009,34 +3336,44 @@ findpcb:
                         * Add data to socket buffer.
                         */
                        so_recv_data_stat(so, m, 0);
-                       m_adj(m, drop_hdrlen);  /* delayed header drop */
+                       m_adj(m, drop_hdrlen);  /* delayed header drop */
 
                        /*
                         * If message delivery (SOF_ENABLE_MSGS) is enabled on
                         * this socket, deliver the packet received as an
                         * in-order message with sequence number attached to it.
                         */
+                       if (isipv6) {
+                               memcpy(&saved_hdr, ip6, sizeof(struct ip6_hdr));
+                               ip6 = (struct ip6_hdr *)&saved_hdr[0];
+                       } else {
+                               memcpy(&saved_hdr, ip, ip->ip_hl << 2);
+                               ip = (struct ip *)&saved_hdr[0];
+                       }
+                       memcpy(&saved_tcphdr, th, sizeof(struct tcphdr));
                        if (sbappendstream_rcvdemux(so, m,
                            th->th_seq - (tp->irs + 1), 0)) {
-                               sorwakeup(so);
+                               mptcp_handle_input(so);
+                               read_wakeup = 1;
                        }
+                       th = &saved_tcphdr;
+
 #if INET6
                        if (isipv6) {
                                KERNEL_DEBUG(DBG_LAYER_END, ((th->th_dport << 16) | th->th_sport),
-                                       (((ip6->ip6_src.s6_addr16[0]) << 16) | (ip6->ip6_dst.s6_addr16[0])),
-                                       th->th_seq, th->th_ack, th->th_win);
-                       }
-                       else
+                                   (((ip6->ip6_src.s6_addr16[0]) << 16) | (ip6->ip6_dst.s6_addr16[0])),
+                                   th->th_seq, th->th_ack, th->th_win);
+                       } else
 #endif
                        {
                                KERNEL_DEBUG(DBG_LAYER_END, ((th->th_dport << 16) | th->th_sport),
-                                       (((ip->ip_src.s_addr & 0xffff) << 16) | (ip->ip_dst.s_addr & 0xffff)),
-                                       th->th_seq, th->th_ack, th->th_win);
+                                   (((ip->ip_src.s_addr & 0xffff) << 16) | (ip->ip_dst.s_addr & 0xffff)),
+                                   th->th_seq, th->th_ack, th->th_win);
                        }
                        TCP_INC_VAR(tp->t_unacksegs, nlropkts);
-                       if (DELAY_ACK(tp, th))  {
+                       if (DELAY_ACK(tp, th)) {
                                if ((tp->t_flags & TF_DELACK) == 0) {
-                                       tp->t_flags |= TF_DELACK;
+                                       tp->t_flags |= TF_DELACK;
                                        tp->t_timer[TCPT_DELACK] = OFFSET_FROM_START(tp, tcp_delack);
                                }
                        } else {
@@ -3046,12 +3383,16 @@ findpcb:
 
                        tcp_adaptive_rwtimo_check(tp, tlen);
 
-                       if (tlen > 0)
+                       if (tlen > 0) {
                                tcp_tfo_rcv_data(tp);
+                       }
 
                        tcp_check_timer_state(tp);
-                       tcp_unlock(so, 1, 0);
-                       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END,0,0,0,0,0);
+
+                       tcp_handle_wakeup(so, read_wakeup, write_wakeup);
+
+                       socket_unlock(so, 1);
+                       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END, 0, 0, 0, 0, 0);
                        return;
                }
        }
@@ -3062,14 +3403,14 @@ findpcb:
         * Receive window is amount of space in rcv queue,
         * but not less than advertised window.
         */
-       lck_mtx_assert(&((struct inpcb *)so->so_pcb)->inpcb_mtx,
-           LCK_MTX_ASSERT_OWNED);
+       socket_lock_assert_owned(so);
        win = tcp_sbspace(tp);
-       if (win < 0)
+       if (win < 0) {
                win = 0;
-       else {  /* clip rcv window to 4K for modems */
-               if (tp->t_flags & TF_SLOWLINK && slowlink_wsize > 0)
+       } else { /* clip rcv window to 4K for modems */
+               if (tp->t_flags & TF_SLOWLINK && slowlink_wsize > 0) {
                        win = min(win, slowlink_wsize);
+               }
        }
        tp->rcv_wnd = imax(win, (int)(tp->rcv_adv - tp->rcv_nxt));
 #if MPTCP
@@ -3079,17 +3420,16 @@ findpcb:
         */
        if ((tp->t_mpflags & TMPF_MPTCP_TRUE) &&
            (mp_tp = tptomptp(tp))) {
-               MPT_LOCK(mp_tp);
-               if (tp->rcv_wnd > mp_tp->mpt_rcvwnd) {
-                       tp->rcv_wnd = imax(mp_tp->mpt_rcvwnd, (int)(tp->rcv_adv - tp->rcv_nxt));
+               socket_lock_assert_owned(mptetoso(mp_tp->mpt_mpte));
+
+               if (tp->rcv_wnd > (int)(mp_tp->mpt_rcvadv - (uint32_t)mp_tp->mpt_rcvnxt)) {
+                       tp->rcv_wnd = mp_tp->mpt_rcvadv - (uint32_t)mp_tp->mpt_rcvnxt;
                        tcpstat.tcps_mp_reducedwin++;
                }
-               MPT_UNLOCK(mp_tp);
        }
 #endif /* MPTCP */
 
        switch (tp->t_state) {
-
        /*
         * Initialize tp->rcv_nxt, and tp->irs, select an initial
         * tp->iss, and send a segment:
@@ -3105,51 +3445,61 @@ findpcb:
                struct sockaddr_in6 *sin6;
 #endif
 
-               lck_mtx_assert(&((struct inpcb *)so->so_pcb)->inpcb_mtx,
-                   LCK_MTX_ASSERT_OWNED);
+               socket_lock_assert_owned(so);
+
+               /* Clear the logging flags inherited from the listening socket */
+               tp->t_log_flags = 0;
+               tp->t_flagsext &= ~TF_LOGGED_CONN_SUMMARY;
+
 #if INET6
                if (isipv6) {
                        MALLOC(sin6, struct sockaddr_in6 *, sizeof *sin6,
-                              M_SONAME, M_NOWAIT);
-                       if (sin6 == NULL)
+                           M_SONAME, M_NOWAIT);
+                       if (sin6 == NULL) {
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "LISTEN malloc M_SONAME failed");
                                goto drop;
+                       }
                        bzero(sin6, sizeof(*sin6));
                        sin6->sin6_family = AF_INET6;
                        sin6->sin6_len = sizeof(*sin6);
                        sin6->sin6_addr = ip6->ip6_src;
                        sin6->sin6_port = th->th_sport;
                        laddr6 = inp->in6p_laddr;
-                       if (IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr))
+                       if (IN6_IS_ADDR_UNSPECIFIED(&inp->in6p_laddr)) {
                                inp->in6p_laddr = ip6->ip6_dst;
+                       }
                        if (in6_pcbconnect(inp, (struct sockaddr *)sin6,
-                                          proc0)) {
+                           proc0)) {
                                inp->in6p_laddr = laddr6;
                                FREE(sin6, M_SONAME);
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, " LISTEN in6_pcbconnect failed");
                                goto drop;
                        }
                        FREE(sin6, M_SONAME);
                } else
 #endif
-           {
-                       lck_mtx_assert(
-                           &((struct inpcb *)so->so_pcb)->inpcb_mtx,
-                           LCK_MTX_ASSERT_OWNED);
+               {
+                       socket_lock_assert_owned(so);
                        MALLOC(sin, struct sockaddr_in *, sizeof *sin, M_SONAME,
-                      M_NOWAIT);
-                       if (sin == NULL)
+                           M_NOWAIT);
+                       if (sin == NULL) {
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "LISTEN malloc M_SONAME failed");
                                goto drop;
+                       }
                        sin->sin_family = AF_INET;
                        sin->sin_len = sizeof(*sin);
                        sin->sin_addr = ip->ip_src;
                        sin->sin_port = th->th_sport;
                        bzero((caddr_t)sin->sin_zero, sizeof(sin->sin_zero));
                        laddr = inp->inp_laddr;
-                       if (inp->inp_laddr.s_addr == INADDR_ANY)
+                       if (inp->inp_laddr.s_addr == INADDR_ANY) {
                                inp->inp_laddr = ip->ip_dst;
+                       }
                        if (in_pcbconnect(inp, (struct sockaddr *)sin, proc0,
                            IFSCOPE_NONE, NULL)) {
                                inp->inp_laddr = laddr;
                                FREE(sin, M_SONAME);
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, " LISTEN in_pcbconnect failed");
                                goto drop;
                        }
                        FREE(sin, M_SONAME);
@@ -3158,14 +3508,15 @@ findpcb:
                tcp_dooptions(tp, optp, optlen, th, &to);
                tcp_finalize_options(tp, &to, ifscope);
 
-               if (tfo_enabled(tp) && tcp_tfo_syn(tp, &to))
+               if (tfo_enabled(tp) && tcp_tfo_syn(tp, &to)) {
                        isconnected = TRUE;
+               }
 
-               if (iss)
+               if (iss) {
                        tp->iss = iss;
-               else {
+               else {
                        tp->iss = tcp_new_isn(tp);
-               }
+               }
                tp->irs = th->th_seq;
                tcp_sendseqinit(tp);
                tcp_rcvseqinit(tp);
@@ -3175,18 +3526,21 @@ findpcb:
                 *   set SND.WND = SEG.WND,
                 *   initialize CCsend and CCrecv.
                 */
-               tp->snd_wnd = tiwin;    /* initial send-window */
+               tp->snd_wnd = tiwin;    /* initial send-window */
+               tp->max_sndwnd = tp->snd_wnd;
                tp->t_flags |= TF_ACKNOW;
                tp->t_unacksegs = 0;
                DTRACE_TCP4(state__change, void, NULL, struct inpcb *, inp,
-                       struct tcpcb *, tp, int32_t, TCPS_SYN_RECEIVED);
+                   struct tcpcb *, tp, int32_t, TCPS_SYN_RECEIVED);
                tp->t_state = TCPS_SYN_RECEIVED;
                tp->t_timer[TCPT_KEEP] = OFFSET_FROM_START(tp,
-                       TCP_CONN_KEEPINIT(tp));
-               dropsocket = 0;         /* committed to socket */
+                   TCP_CONN_KEEPINIT(tp));
+               tp->t_connect_time = tcp_now;
+               dropsocket = 0;         /* committed to socket */
 
-               if (inp->inp_flowhash == 0)
+               if (inp->inp_flowhash == 0) {
                        inp->inp_flowhash = inp_calc_flowhash(inp);
+               }
 #if INET6
                /* update flowinfo - RFC 6437 */
                if (inp->inp_flow == 0 &&
@@ -3205,8 +3559,13 @@ findpcb:
                        tp->ecn_flags |= (TE_SETUPRECEIVED | TE_SENDIPECT);
                }
 
+               /*
+                * The address and connection state are finalized
+                */
+               TCP_LOG_CONNECT(tp, false, 0);
+
                goto trimthenstep6;
-               }
+       }
 
        /*
         * If the state is SYN_RECEIVED and the seg contains an ACK,
@@ -3215,10 +3574,11 @@ findpcb:
        case TCPS_SYN_RECEIVED:
                if ((thflags & TH_ACK) &&
                    (SEQ_LEQ(th->th_ack, tp->snd_una) ||
-                    SEQ_GT(th->th_ack, tp->snd_max))) {
-                               rstreason = BANDLIM_RST_OPENPORT;
-                               IF_TCP_STATINC(ifp, ooopacket);
-                               goto dropwithreset;
+                   SEQ_GT(th->th_ack, tp->snd_max))) {
+                       rstreason = BANDLIM_RST_OPENPORT;
+                       IF_TCP_STATINC(ifp, ooopacket);
+                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "SYN_RECEIVED bad ACK");
+                       goto dropwithreset;
                }
 
                /*
@@ -3229,8 +3589,9 @@ findpcb:
                 */
                if ((thflags & TH_SYN) &&
                    (tp->irs == th->th_seq) &&
-                   !(to.to_flags & TOF_SCALE))
+                   !(to.to_flags & TOF_SCALE)) {
                        tp->t_flags &= ~TF_RCVD_SCALE;
+               }
                break;
 
        /*
@@ -3248,32 +3609,46 @@ findpcb:
        case TCPS_SYN_SENT:
                if ((thflags & TH_ACK) &&
                    (SEQ_LEQ(th->th_ack, tp->iss) ||
-                    SEQ_GT(th->th_ack, tp->snd_max))) {
+                   SEQ_GT(th->th_ack, tp->snd_max))) {
                        rstreason = BANDLIM_UNLIMITED;
                        IF_TCP_STATINC(ifp, ooopacket);
+                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "SYN_SENT bad ACK");
                        goto dropwithreset;
                }
                if (thflags & TH_RST) {
                        if ((thflags & TH_ACK) != 0) {
-#if MPTCP
-                               if ((so->so_flags & SOF_MPTCP_FASTJOIN) &&
-                                       SEQ_GT(th->th_ack, tp->iss+1)) {
-                                       so->so_flags &= ~SOF_MPTCP_FASTJOIN;
-                                       /* ignore the RST and retransmit SYN */
-                                       goto drop;
+                               if (tfo_enabled(tp) &&
+                                   !(tp->t_flagsext & TF_FASTOPEN_FORCE_ENABLE)) {
+                                       tcp_heuristic_tfo_rst(tp);
+                               }
+                               if ((tp->ecn_flags & (TE_SETUPSENT | TE_RCVD_SYN_RST)) == TE_SETUPSENT) {
+                                       /*
+                                        * On local connections, send
+                                        * non-ECN syn one time before
+                                        * dropping the connection
+                                        */
+                                       if (tp->t_flags & TF_LOCAL) {
+                                               tp->ecn_flags |= TE_RCVD_SYN_RST;
+                                               goto drop;
+                                       } else {
+                                               tcp_heuristic_ecn_synrst(tp);
+                                       }
                                }
-#endif /* MPTCP */
                                soevent(so,
                                    (SO_FILT_HINT_LOCKED |
                                    SO_FILT_HINT_CONNRESET));
                                tp = tcp_drop(tp, ECONNREFUSED);
                                postevent(so, 0, EV_RESET);
                        }
+                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "SYN_SENT got RST");
                        goto drop;
                }
-               if ((thflags & TH_SYN) == 0)
+               if ((thflags & TH_SYN) == 0) {
+                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "SYN_SENT no SYN");
                        goto drop;
-               tp->snd_wnd = th->th_win;       /* initial send window */
+               }
+               tp->snd_wnd = th->th_win;       /* initial send window */
+               tp->max_sndwnd = tp->snd_wnd;
 
                tp->irs = th->th_seq;
                tcp_rcvseqinit(tp);
@@ -3294,8 +3669,9 @@ findpcb:
                                        tcpstat.tcps_ecn_not_supported++;
                                }
                                if (tp->ecn_flags & TE_SETUPSENT &&
-                                   tp->t_rxtshift > 0)
+                                   tp->t_rxtshift > 0) {
                                        tcp_heuristic_ecn_loss(tp);
+                               }
 
                                /* non-ECN-setup SYN-ACK */
                                tp->ecn_flags &= ~TE_SENDIPECT;
@@ -3313,9 +3689,10 @@ findpcb:
                        }
 
                        tp->rcv_adv += min(tp->rcv_wnd, TCP_MAXWIN << tp->rcv_scale);
-                       tp->snd_una++;          /* SYN is acked */
-                       if (SEQ_LT(tp->snd_nxt, tp->snd_una))
+                       tp->snd_una++;          /* SYN is acked */
+                       if (SEQ_LT(tp->snd_nxt, tp->snd_una)) {
                                tp->snd_nxt = tp->snd_una;
+                       }
 
                        /*
                         * We have sent more in the SYN than what is being
@@ -3323,21 +3700,39 @@ findpcb:
                         * We should restart the sending from what the receiver
                         * has acknowledged immediately.
                         */
-                       if (SEQ_GT(tp->snd_nxt, th->th_ack))
+                       if (SEQ_GT(tp->snd_nxt, th->th_ack)) {
+                               /*
+                                * rdar://problem/33214601
+                                * There is a middlebox that acks all but one
+                                * byte and still drops the data.
+                                */
+                               if (!(tp->t_flagsext & TF_FASTOPEN_FORCE_ENABLE) &&
+                                   (tp->t_tfo_stats & TFO_S_SYN_DATA_SENT) &&
+                                   tp->snd_max == th->th_ack + 1 &&
+                                   tp->snd_max > tp->snd_una + 1) {
+                                       tcp_heuristic_tfo_middlebox(tp);
+
+                                       so->so_error = ENODATA;
+                                       soevent(so,
+                                           (SO_FILT_HINT_LOCKED | SO_FILT_HINT_MP_SUB_ERROR));
+
+                                       tp->t_tfo_stats |= TFO_S_ONE_BYTE_PROXY;
+                               }
+
                                tp->snd_max = tp->snd_nxt = th->th_ack;
+                       }
 
                        /*
                         * If there's data, delay ACK; if there's also a FIN
                         * ACKNOW will be turned on later.
                         */
                        TCP_INC_VAR(tp->t_unacksegs, nlropkts);
-                       if (DELAY_ACK(tp, th) && tlen != 0 ) {
+                       if (DELAY_ACK(tp, th) && tlen != 0) {
                                if ((tp->t_flags & TF_DELACK) == 0) {
                                        tp->t_flags |= TF_DELACK;
                                        tp->t_timer[TCPT_DELACK] = OFFSET_FROM_START(tp, tcp_delack);
                                }
-                       }
-                       else {
+                       } else {
                                tp->t_flags |= TF_ACKNOW;
                        }
                        /*
@@ -3356,6 +3751,8 @@ findpcb:
                                tp->t_state = TCPS_FIN_WAIT_1;
                                tp->t_flags &= ~TF_NEEDFIN;
                                thflags &= ~TH_SYN;
+
+                               TCP_LOG_CONNECTION_SUMMARY(tp);
                        } else {
                                DTRACE_TCP4(state__change, void, NULL,
                                    struct inpcb *, inp, struct tcpcb *,
@@ -3364,9 +3761,10 @@ findpcb:
                                tp->t_timer[TCPT_KEEP] =
                                    OFFSET_FROM_START(tp,
                                    TCP_CONN_KEEPIDLE(tp));
-                               if (nstat_collect)
+                               if (nstat_collect) {
                                        nstat_route_connect_success(
-                                           inp->inp_route.ro_rt);
+                                               inp->inp_route.ro_rt);
+                               }
                                /*
                                 * The SYN is acknowledged but una is not
                                 * updated yet. So pass the value of
@@ -3382,14 +3780,9 @@ findpcb:
                        if ((!(tp->t_mpflags & TMPF_MPTCP_TRUE)) &&
                            (tp->t_mpflags & TMPF_SENT_JOIN)) {
                                isconnected = FALSE;
-                               /* Start data xmit if fastjoin */
-                               if (mptcp_fastjoin && (so->so_flags & SOF_MPTCP_FASTJOIN)) {
-                                       soevent(so, (SO_FILT_HINT_LOCKED |
-                                           SO_FILT_HINT_MPFASTJ));
-                               }
                        } else
 #endif /* MPTCP */
-                               isconnected = TRUE;
+                       isconnected = TRUE;
 
                        if ((tp->t_tfo_flags & (TFO_F_COOKIE_REQ | TFO_F_COOKIE_SENT)) ||
                            (tp->t_tfo_stats & TFO_S_SYN_DATA_SENT)) {
@@ -3400,17 +3793,17 @@ findpcb:
                                        tp->t_tfo_stats |= TFO_S_SYN_DATA_ACKED;
                                        tcpstat.tcps_tfo_syn_data_acked++;
 #if MPTCP
-                                       if (so->so_flags & SOF_MP_SUBFLOW)
+                                       if (so->so_flags & SOF_MP_SUBFLOW) {
                                                so->so_flags1 |= SOF1_TFO_REWIND;
+                                       }
 #endif
-                                       if (!(tp->t_tfo_flags & TFO_F_NO_RCVPROBING))
-                                               tcp_tfo_rcv_probe(tp, tlen);
+                                       tcp_tfo_rcv_probe(tp, tlen);
                                }
                        }
                } else {
                        /*
                         *  Received initial SYN in SYN-SENT[*] state => simul-
-                        *  taneous open.  If segment contains CC option and there is
+                        *  taneous open.  If segment contains CC option and there is
                         *  a cached CC, apply TAO test; if it succeeds, connection is
                         *  half-synchronized.  Otherwise, do 3-way handshake:
                         *        SYN-SENT -> SYN-RECEIVED
@@ -3419,7 +3812,7 @@ findpcb:
                        tp->t_flags |= TF_ACKNOW;
                        tp->t_timer[TCPT_REXMT] = 0;
                        DTRACE_TCP4(state__change, void, NULL, struct inpcb *, inp,
-                               struct tcpcb *, tp, int32_t, TCPS_SYN_RECEIVED);
+                           struct tcpcb *, tp, int32_t, TCPS_SYN_RECEIVED);
                        tp->t_state = TCPS_SYN_RECEIVED;
 
                        /*
@@ -3454,8 +3847,9 @@ trimthenstep6:
                 *  processing in the middle of step 5, ack processing.
                 *  Otherwise, goto step 6.
                 */
-               if (thflags & TH_ACK)
+               if (thflags & TH_ACK) {
                        goto process_ACK;
+               }
                goto step6;
        /*
         * If the state is LAST_ACK or CLOSING or TIME_WAIT:
@@ -3466,16 +3860,27 @@ trimthenstep6:
        case TCPS_LAST_ACK:
        case TCPS_CLOSING:
        case TCPS_TIME_WAIT:
-               break;  /* continue normal processing */
+               break;  /* continue normal processing */
 
        /* Received a SYN while connection is already established.
         * This is a "half open connection and other anomalies" described
         * in RFC793 page 34, send an ACK so the remote reset the connection
-        * or recovers by adjusting its sequence numberering
+        * or recovers by adjusting its sequence numbering. Sending an ACK is
+        * in accordance with RFC 5961 Section 4.2
         */
        case TCPS_ESTABLISHED:
-               if (thflags & TH_SYN)
-                       goto dropafterack;
+               if (thflags & TH_SYN) {
+                       /* Drop the packet silently if we have reached the limit */
+                       if (tcp_do_rfc5961 && tcp_is_ack_ratelimited(tp)) {
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "ESTABLISHED rfc5961 rate limited");
+                               goto drop;
+                       } else {
+                               /* Send challenge ACK */
+                               tcpstat.tcps_synchallenge++;
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "ESTABLISHED rfc5961 challenge ACK");
+                               goto dropafterack;
+                       }
+               }
                break;
        }
 
@@ -3513,6 +3918,11 @@ trimthenstep6:
         *   only accepting RSTs where the sequence number is equal to
         *   last_ack_sent.  In all other states (the states in which a
         *   RST is more likely), the more permissive check is used.
+        * RFC 5961 Section 3.2: if the RST bit is set, sequence # is
+        *    within the receive window and last_ack_sent == seq,
+        *    then reset the connection. Otherwise if the seq doesn't
+        *    match last_ack_sent, TCP must send challenge ACK. Perform
+        *    rate limitation when sending the challenge ACK.
         * If we have multiple segments in flight, the intial reset
         * segment sequence numbers will be to the left of last_ack_sent,
         * but they will eventually catch up.
@@ -3545,60 +3955,74 @@ trimthenstep6:
         *                     there is already a RST in flight from the peer.
         *                     In that case, accept the RST for non-established
         *                     state if it's one off from last_ack_sent.
-
+        *
         */
        if (thflags & TH_RST) {
                if ((SEQ_GEQ(th->th_seq, tp->last_ack_sent) &&
                    SEQ_LT(th->th_seq, tp->last_ack_sent + tp->rcv_wnd)) ||
                    (tp->rcv_wnd == 0 &&
                    ((tp->last_ack_sent == th->th_seq) ||
-                   ((tp->last_ack_sent -1) == th->th_seq)))) {
-                       switch (tp->t_state) {
+                   ((tp->last_ack_sent - 1) == th->th_seq)))) {
+                       if (tcp_do_rfc5961 == 0 || tp->last_ack_sent == th->th_seq) {
+                               switch (tp->t_state) {
+                               case TCPS_SYN_RECEIVED:
+                                       IF_TCP_STATINC(ifp, rstinsynrcv);
+                                       so->so_error = ECONNREFUSED;
+                                       goto close;
+
+                               case TCPS_ESTABLISHED:
+                                       if (tcp_do_rfc5961 == 0 && tp->last_ack_sent != th->th_seq) {
+                                               tcpstat.tcps_badrst++;
+                                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "ESTABLISHED rfc5961 bad RST");
+                                               goto drop;
+                                       }
+                                       if (TCP_ECN_ENABLED(tp) &&
+                                           tp->snd_una == tp->iss + 1 &&
+                                           SEQ_GT(tp->snd_max, tp->snd_una)) {
+                                               /*
+                                                * If the first data packet on an
+                                                * ECN connection, receives a RST
+                                                * increment the heuristic
+                                                */
+                                               tcp_heuristic_ecn_droprst(tp);
+                                       }
+                               case TCPS_FIN_WAIT_1:
+                               case TCPS_CLOSE_WAIT:
+                               /*
+                                *  Drop through ...
+                                */
+                               case TCPS_FIN_WAIT_2:
+                                       so->so_error = ECONNRESET;
+close:
+                                       postevent(so, 0, EV_RESET);
+                                       soevent(so,
+                                           (SO_FILT_HINT_LOCKED |
+                                           SO_FILT_HINT_CONNRESET));
+
+                                       tcpstat.tcps_drops++;
+                                       tp = tcp_close(tp);
+                                       break;
 
-                       case TCPS_SYN_RECEIVED:
-                               IF_TCP_STATINC(ifp, rstinsynrcv);
-                               so->so_error = ECONNREFUSED;
-                               goto close;
+                               case TCPS_CLOSING:
+                               case TCPS_LAST_ACK:
+                                       tp = tcp_close(tp);
+                                       break;
 
-                       case TCPS_ESTABLISHED:
-                               if (tp->last_ack_sent != th->th_seq) {
-                                       tcpstat.tcps_badrst++;
-                                       goto drop;
+                               case TCPS_TIME_WAIT:
+                                       break;
                                }
-                               if (TCP_ECN_ENABLED(tp) &&
-                                   tp->snd_una == tp->iss + 1 &&
-                                   SEQ_GT(tp->snd_max, tp->snd_una)) {
-                                       /*
-                                        * If the first data packet on an
-                                        * ECN connection, receives a RST
-                                        * increment the heuristic
-                                        */
-                                       tcp_heuristic_ecn_droprst(tp);
+                       } else if (tcp_do_rfc5961) {
+                               tcpstat.tcps_badrst++;
+                               /* Drop if we have reached the ACK limit */
+                               if (tcp_is_ack_ratelimited(tp)) {
+                                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "ESTABLISHED rfc5961 rate limited");
+                                       goto drop;
+                               } else {
+                                       /* Send challenge ACK */
+                                       tcpstat.tcps_rstchallenge++;
+                                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "ESTABLISHED rfc5961 challenge ACK");
+                                       goto dropafterack;
                                }
-                       case TCPS_FIN_WAIT_1:
-                       case TCPS_CLOSE_WAIT:
-                               /*
-                                 Drop through ...
-                               */
-                       case TCPS_FIN_WAIT_2:
-                               so->so_error = ECONNRESET;
-                       close:
-                               postevent(so, 0, EV_RESET);
-                               soevent(so,
-                                   (SO_FILT_HINT_LOCKED |
-                                   SO_FILT_HINT_CONNRESET));
-
-                               tcpstat.tcps_drops++;
-                               tp = tcp_close(tp);
-                               break;
-
-                       case TCPS_CLOSING:
-                       case TCPS_LAST_ACK:
-                               tp = tcp_close(tp);
-                               break;
-
-                       case TCPS_TIME_WAIT:
-                               break;
                        }
                }
                goto drop;
@@ -3610,7 +4034,6 @@ trimthenstep6:
         */
        if ((to.to_flags & TOF_TS) != 0 && tp->ts_recent &&
            TSTMP_LT(to.to_tsval, tp->ts_recent)) {
-
                /* Check to see if ts_recent is over 24 days old.  */
                if ((int)(tcp_now - tp->ts_recent_age) > TCP_PAWS_IDLE) {
                        /*
@@ -3648,15 +4071,17 @@ trimthenstep6:
 
                        if (nstat_collect) {
                                nstat_route_rx(tp->t_inpcb->inp_route.ro_rt,
-                                       1, tlen, NSTAT_RX_FLAG_DUPLICATE);
+                                   1, tlen, NSTAT_RX_FLAG_DUPLICATE);
                                INP_ADD_STAT(inp, cell, wifi, wired,
                                    rxpackets, 1);
                                INP_ADD_STAT(inp, cell, wifi, wired,
                                    rxbytes, tlen);
                                tp->t_stat.rxduplicatebytes += tlen;
+                               inp_set_activity_bitmap(inp);
                        }
-                       if (tlen > 0)
+                       if (tlen > 0) {
                                goto dropafterack;
+                       }
                        goto drop;
                }
        }
@@ -3671,22 +4096,33 @@ trimthenstep6:
        if (tp->t_state == TCPS_SYN_RECEIVED && SEQ_LT(th->th_seq, tp->irs)) {
                rstreason = BANDLIM_RST_OPENPORT;
                IF_TCP_STATINC(ifp, dospacket);
+               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "SYN_RECEIVED bad SEQ");
                goto dropwithreset;
        }
 
+       /*
+        * Check if there is old data at the beginning of the window
+        * i.e. the sequence number is before rcv_nxt
+        */
        todrop = tp->rcv_nxt - th->th_seq;
        if (todrop > 0) {
+               boolean_t is_syn_set = FALSE;
+
                if (thflags & TH_SYN) {
+                       is_syn_set = TRUE;
                        thflags &= ~TH_SYN;
                        th->th_seq++;
-                       if (th->th_urp > 1)
+                       if (th->th_urp > 1) {
                                th->th_urp--;
-                       else
+                       } else {
                                thflags &= ~TH_URG;
+                       }
                        todrop--;
                }
                /*
                 * Following if statement from Stevens, vol. 2, p. 960.
+                * The amount of duplicate data is greater than or equal
+                * to the size of the segment - entire segment is duplicate
                 */
                if (todrop > tlen
                    || (todrop == tlen && (thflags & TH_FIN) == 0)) {
@@ -3700,12 +4136,23 @@ trimthenstep6:
                        /*
                         * Send an ACK to resynchronize and drop any data.
                         * But keep on processing for RST or ACK.
+                        *
+                        * If the SYN bit was originally set, then only send
+                        * an ACK if we are not rate-limiting this connection.
                         */
-                       tp->t_flags |= TF_ACKNOW;
+                       if (tcp_do_rfc5961 && is_syn_set) {
+                               if (!tcp_is_ack_ratelimited(tp)) {
+                                       tcpstat.tcps_synchallenge++;
+                                       tp->t_flags |= TF_ACKNOW;
+                               }
+                       } else {
+                               tp->t_flags |= TF_ACKNOW;
+                       }
+
                        if (todrop == 1) {
                                /* This could be a keepalive */
                                soevent(so, SO_FILT_HINT_LOCKED |
-                                       SO_FILT_HINT_KEEPALIVE);
+                                   SO_FILT_HINT_KEEPALIVE);
                        }
                        todrop = tlen;
                        tcpstat.tcps_rcvduppack++;
@@ -3726,17 +4173,18 @@ trimthenstep6:
                }
                if (nstat_collect) {
                        nstat_route_rx(tp->t_inpcb->inp_route.ro_rt, 1,
-                               todrop, NSTAT_RX_FLAG_DUPLICATE);
+                           todrop, NSTAT_RX_FLAG_DUPLICATE);
                        INP_ADD_STAT(inp, cell, wifi, wired, rxpackets, 1);
                        INP_ADD_STAT(inp, cell, wifi, wired, rxbytes, todrop);
                        tp->t_stat.rxduplicatebytes += todrop;
+                       inp_set_activity_bitmap(inp);
                }
-               drop_hdrlen += todrop;  /* drop from the top afterwards */
+               drop_hdrlen += todrop;  /* drop from the top afterwards */
                th->th_seq += todrop;
                tlen -= todrop;
-               if (th->th_urp > todrop)
+               if (th->th_urp > todrop) {
                        th->th_urp -= todrop;
-               else {
+               else {
                        thflags &= ~TH_URG;
                        th->th_urp = 0;
                }
@@ -3748,26 +4196,43 @@ trimthenstep6:
         * Send also a RST when we received a data segment after we've
         * sent our FIN when the socket is defunct.
         * Note that an MPTCP subflow socket would have SS_NOFDREF set
-        * by default so check to make sure that we test for SOF_MP_SUBFLOW
-        * socket flag (which would be cleared when the socket is closed.)
+        * by default. So, if it's an MPTCP-subflow we rather check the
+        * MPTCP-level's socket state for SS_NOFDREF.
         */
-       if (!(so->so_flags & SOF_MP_SUBFLOW) && tlen &&
-           (((so->so_state & SS_NOFDREF) &&
-           tp->t_state > TCPS_CLOSE_WAIT) ||
-           ((so->so_flags & SOF_DEFUNCT) &&
-           tp->t_state > TCPS_FIN_WAIT_1))) {
-               tp = tcp_close(tp);
-               tcpstat.tcps_rcvafterclose++;
-               rstreason = BANDLIM_UNLIMITED;
-               IF_TCP_STATINC(ifp, cleanup);
-               goto dropwithreset;
+       if (tlen) {
+               boolean_t close_it = FALSE;
+
+               if (!(so->so_flags & SOF_MP_SUBFLOW) && (so->so_state & SS_NOFDREF) &&
+                   tp->t_state > TCPS_CLOSE_WAIT) {
+                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "SS_NOFDREF");
+                       close_it = TRUE;
+               }
+
+               if ((so->so_flags & SOF_MP_SUBFLOW) && (mptetoso(tptomptp(tp)->mpt_mpte)->so_state & SS_NOFDREF) &&
+                   tp->t_state > TCPS_CLOSE_WAIT) {
+                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "SOF_MP_SUBFLOW SS_NOFDREF");
+                       close_it = TRUE;
+               }
+
+               if ((so->so_flags & SOF_DEFUNCT) && tp->t_state > TCPS_FIN_WAIT_1) {
+                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "SOF_DEFUNCT");
+                       close_it = TRUE;
+               }
+
+               if (close_it) {
+                       tp = tcp_close(tp);
+                       tcpstat.tcps_rcvafterclose++;
+                       rstreason = BANDLIM_UNLIMITED;
+                       IF_TCP_STATINC(ifp, cleanup);
+                       goto dropwithreset;
+               }
        }
 
        /*
         * If segment ends after window, drop trailing data
         * (and PUSH and FIN); if nothing left, just ACK.
         */
-       todrop = (th->th_seq+tlen) - (tp->rcv_nxt+tp->rcv_wnd);
+       todrop = (th->th_seq + tlen) - (tp->rcv_nxt + tp->rcv_wnd);
        if (todrop > 0) {
                tcpstat.tcps_rcvpackafterwin++;
                if (todrop >= tlen) {
@@ -3783,7 +4248,7 @@ trimthenstep6:
                            SEQ_GT(th->th_seq, tp->rcv_nxt)) {
                                iss = tcp_new_isn(tp);
                                tp = tcp_close(tp);
-                               tcp_unlock(so, 1, 0);
+                               socket_unlock(so, 1);
                                goto findpcb;
                        }
                        /*
@@ -3796,13 +4261,15 @@ trimthenstep6:
                        if (tp->rcv_wnd == 0 && th->th_seq == tp->rcv_nxt) {
                                tp->t_flags |= TF_ACKNOW;
                                tcpstat.tcps_rcvwinprobe++;
-                       } else
+                       } else {
                                goto dropafterack;
-               } else
+                       }
+               } else {
                        tcpstat.tcps_rcvbyteafterwin += todrop;
+               }
                m_adj(m, -todrop);
                tlen -= todrop;
-               thflags &= ~(TH_PUSH|TH_FIN);
+               thflags &= ~(TH_PUSH | TH_FIN);
        }
 
        /*
@@ -3826,21 +4293,40 @@ trimthenstep6:
        if ((to.to_flags & TOF_TS) != 0 &&
            SEQ_LEQ(th->th_seq, tp->last_ack_sent) &&
            SEQ_LEQ(tp->last_ack_sent, th->th_seq + tlen +
-               ((thflags & (TH_SYN|TH_FIN)) != 0))) {
+           ((thflags & (TH_SYN | TH_FIN)) != 0))) {
                tp->ts_recent_age = tcp_now;
                tp->ts_recent = to.to_tsval;
        }
 
        /*
-        * If a SYN is in the window, then this is an
+        * Stevens: If a SYN is in the window, then this is an
         * error and we send an RST and drop the connection.
+        *
+        * RFC 5961 Section 4.2
+        * Send challenge ACK for any SYN in synchronized state
+        * Perform rate limitation in doing so.
         */
        if (thflags & TH_SYN) {
-               tp = tcp_drop(tp, ECONNRESET);
-               rstreason = BANDLIM_UNLIMITED;
-               postevent(so, 0, EV_RESET);
-               IF_TCP_STATINC(ifp, synwindow);
-               goto dropwithreset;
+               if (tcp_do_rfc5961) {
+                       tcpstat.tcps_badsyn++;
+                       /* Drop if we have reached ACK limit */
+                       if (tcp_is_ack_ratelimited(tp)) {
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "rfc5961 bad SYN rate limited");
+                               goto drop;
+                       } else {
+                               /* Send challenge ACK */
+                               tcpstat.tcps_synchallenge++;
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "rfc5961 bad SYN challenge ack");
+                               goto dropafterack;
+                       }
+               } else {
+                       tp = tcp_drop(tp, ECONNRESET);
+                       rstreason = BANDLIM_UNLIMITED;
+                       postevent(so, 0, EV_RESET);
+                       IF_TCP_STATINC(ifp, synwindow);
+                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "bad SYN");
+                       goto dropwithreset;
+               }
        }
 
        /*
@@ -3872,15 +4358,19 @@ trimthenstep6:
                                 * We need to make absolutely sure that we are
                                 * going to reply upon a duplicate SYN-segment.
                                 */
-                               if (th->th_flags & TH_SYN)
+                               if (th->th_flags & TH_SYN) {
                                        needoutput = 1;
+                               }
                        }
 
                        goto step6;
-               } else if (tp->t_flags & TF_ACKNOW)
+               } else if (tp->t_flags & TF_ACKNOW) {
+                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "bad ACK");
                        goto dropafterack;
-               else
+               } else {
+                       TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "bad ACK");
                        goto drop;
+               }
        }
 
        /*
@@ -3888,7 +4378,6 @@ trimthenstep6:
         */
 
        switch (tp->t_state) {
-
        /*
         * In SYN_RECEIVED state, the ack ACKs our SYN, so enter
         * ESTABLISHED state and continue processing.
@@ -3903,6 +4392,7 @@ trimthenstep6:
                        tp->snd_scale = tp->requested_s_scale;
                        tp->rcv_scale = tp->request_r_scale;
                        tp->snd_wnd = th->th_win << tp->snd_scale;
+                       tp->max_sndwnd = tp->snd_wnd;
                        tiwin = tp->snd_wnd;
                }
                /*
@@ -3918,16 +4408,19 @@ trimthenstep6:
                            struct tcpcb *, tp, int32_t, TCPS_FIN_WAIT_1);
                        tp->t_state = TCPS_FIN_WAIT_1;
                        tp->t_flags &= ~TF_NEEDFIN;
+
+                       TCP_LOG_CONNECTION_SUMMARY(tp);
                } else {
                        DTRACE_TCP4(state__change, void, NULL,
                            struct inpcb *, inp,
                            struct tcpcb *, tp, int32_t, TCPS_ESTABLISHED);
                        tp->t_state = TCPS_ESTABLISHED;
                        tp->t_timer[TCPT_KEEP] = OFFSET_FROM_START(tp,
-                               TCP_CONN_KEEPIDLE(tp));
-                       if (nstat_collect)
+                           TCP_CONN_KEEPIDLE(tp));
+                       if (nstat_collect) {
                                nstat_route_connect_success(
-                                   tp->t_inpcb->inp_route.ro_rt);
+                                       tp->t_inpcb->inp_route.ro_rt);
+                       }
                        /*
                         * The SYN is acknowledged but una is not updated
                         * yet. So pass the value of ack to compute
@@ -3939,9 +4432,19 @@ trimthenstep6:
                 * If segment contains data or ACK, will call tcp_reass()
                 * later; if not, do so now to pass queued data to user.
                 */
-               if (tlen == 0 && (thflags & TH_FIN) == 0)
+               if (tlen == 0 && (thflags & TH_FIN) == 0) {
+                       if (isipv6) {
+                               memcpy(&saved_hdr, ip6, sizeof(struct ip6_hdr));
+                               ip6 = (struct ip6_hdr *)&saved_hdr[0];
+                       } else {
+                               memcpy(&saved_hdr, ip, ip->ip_hl << 2);
+                               ip = (struct ip *)&saved_hdr[0];
+                       }
+                       memcpy(&saved_tcphdr, th, sizeof(struct tcphdr));
                        (void) tcp_reass(tp, (struct tcphdr *)0, &tlen,
-                           NULL, ifp);
+                           NULL, ifp, &read_wakeup);
+                       th = &saved_tcphdr;
+               }
                tp->snd_wl1 = th->th_seq - 1;
 
 #if MPTCP
@@ -3954,7 +4457,7 @@ trimthenstep6:
                        isconnected = FALSE;
                } else
 #endif /* MPTCP */
-                       isconnected = TRUE;
+               isconnected = TRUE;
                if ((tp->t_tfo_flags & TFO_F_COOKIE_VALID)) {
                        /* Done this when receiving the SYN */
                        isconnected = FALSE;
@@ -3980,9 +4483,10 @@ trimthenstep6:
                 * handled by the label "dodata" right after step6.
                 */
                if (so->so_snd.sb_cc) {
-                       tp->snd_una++;  /* SYN is acked */
-                       if (SEQ_LT(tp->snd_nxt, tp->snd_una))
+                       tp->snd_una++;  /* SYN is acked */
+                       if (SEQ_LT(tp->snd_nxt, tp->snd_una)) {
                                tp->snd_nxt = tp->snd_una;
+                       }
 
                        /*
                         * No duplicate-ACK handling is needed. So, we
@@ -3996,14 +4500,15 @@ trimthenstep6:
                         */
                        if (SACK_ENABLED(tp) &&
                            (to.to_nsacks > 0 ||
-                            !TAILQ_EMPTY(&tp->snd_holes)))
+                           !TAILQ_EMPTY(&tp->snd_holes))) {
                                tcp_sack_doack(tp, &to, th,
                                    &sack_bytes_acked);
+                       }
 
                        goto process_ACK;
                }
 
-               /* FALLTHROUGH */
+       /* FALLTHROUGH */
 
        /*
         * In ESTABLISHED state: drop duplicate ACKs; ACK out of range
@@ -4022,7 +4527,20 @@ trimthenstep6:
        case TCPS_TIME_WAIT:
                if (SEQ_GT(th->th_ack, tp->snd_max)) {
                        tcpstat.tcps_rcvacktoomuch++;
-                       goto dropafterack;
+                       if (tcp_do_rfc5961 && tcp_is_ack_ratelimited(tp)) {
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "rfc5961 rcvacktoomuch");
+                               goto drop;
+                       } else {
+                               goto dropafterack;
+                       }
+               }
+               if (tcp_do_rfc5961 && SEQ_LT(th->th_ack, tp->snd_una - tp->max_sndwnd)) {
+                       if (tcp_is_ack_ratelimited(tp)) {
+                               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "rfc5961 bad ACK");
+                               goto drop;
+                       } else {
+                               goto dropafterack;
+                       }
                }
                if (SACK_ENABLED(tp) && to.to_nsacks > 0) {
                        recvd_dsack = tcp_sack_process_dsack(tp, &to, th);
@@ -4040,11 +4558,12 @@ trimthenstep6:
                }
 
                if (SACK_ENABLED(tp) &&
-                   (to.to_nsacks > 0 || !TAILQ_EMPTY(&tp->snd_holes)))
+                   (to.to_nsacks > 0 || !TAILQ_EMPTY(&tp->snd_holes))) {
                        tcp_sack_doack(tp, &to, th, &sack_bytes_acked);
+               }
 
 #if MPTCP
-               if ((tp->t_mpuna) && (SEQ_GEQ(th->th_ack, tp->t_mpuna))) {
+               if (tp->t_mpuna && SEQ_GEQ(th->th_ack, tp->t_mpuna)) {
                        if (tp->t_mpflags & TMPF_PREESTABLISHED) {
                                /* MP TCP establishment succeeded */
                                tp->t_mpuna = 0;
@@ -4054,11 +4573,6 @@ trimthenstep6:
                                                    ~TMPF_PREESTABLISHED;
                                                tp->t_mpflags |=
                                                    TMPF_MPTCP_TRUE;
-                                               so->so_flags |= SOF_MPTCP_TRUE;
-                                               mptcplog((LOG_DEBUG, "MPTCP "
-                                                   "Sockets: %s \n",__func__),
-                                                   MPTCP_SOCKET_DBG,
-                                                   MPTCP_LOGLVL_LOG);
 
                                                tp->t_timer[TCPT_JACK_RXMT] = 0;
                                                tp->t_mprxtshift = 0;
@@ -4068,7 +4582,6 @@ trimthenstep6:
                                        }
                                } else {
                                        isconnected = TRUE;
-                                       tp->t_mpflags &= ~TMPF_SENT_KEYS;
                                }
                        }
                }
@@ -4096,8 +4609,9 @@ trimthenstep6:
                                 * instead of the dupack
                                 */
                                if ((thflags & TH_FIN) &&
-                                   !TCPS_HAVERCVDFIN(tp->t_state))
+                                   !TCPS_HAVERCVDFIN(tp->t_state)) {
                                        break;
+                               }
 process_dupack:
 #if MPTCP
                                /*
@@ -4123,8 +4637,9 @@ process_dupack:
                                 * so that we can process partial acks
                                 * correctly
                                 */
-                               if (tp->ecn_flags & TE_INRECOVERY)
+                               if (tp->ecn_flags & TE_INRECOVERY) {
                                        tp->ecn_flags &= ~TE_INRECOVERY;
+                               }
 
                                tcpstat.tcps_rcvdupack++;
                                ++tp->t_dupacks;
@@ -4136,16 +4651,18 @@ process_dupack:
                                if (tp->t_early_rexmt_count > 0 &&
                                    TSTMP_GEQ(tcp_now,
                                    (tp->t_early_rexmt_win +
-                                   TCP_EARLY_REXMT_WIN)))
+                                   TCP_EARLY_REXMT_WIN))) {
                                        tp->t_early_rexmt_count = 0;
+                               }
 
                                /*
                                 * Is early retransmit needed? We check for
                                 * this when the connection is waiting for
                                 * duplicate acks to enter fast recovery.
                                 */
-                               if (!IN_FASTRECOVERY(tp))
+                               if (!IN_FASTRECOVERY(tp)) {
                                        tcp_early_rexmt_check(tp, th);
+                               }
 
                                /*
                                 * If we've seen exactly rexmt threshold
@@ -4173,8 +4690,7 @@ process_dupack:
                                        tp->t_dupacks = 0;
                                        tp->t_rexmtthresh = tcprexmtthresh;
                                } else if (tp->t_dupacks > tp->t_rexmtthresh ||
-                                       IN_FASTRECOVERY(tp)) {
-
+                                   IN_FASTRECOVERY(tp)) {
                                        /*
                                         * If this connection was seeing packet
                                         * reordering, then recovery might be
@@ -4183,8 +4699,8 @@ process_dupack:
                                         */
                                        if (SACK_ENABLED(tp) && !IN_FASTRECOVERY(tp) &&
                                            (tp->t_flagsext &
-                                           (TF_PKTS_REORDERED|TF_DELAY_RECOVERY)) ==
-                                           (TF_PKTS_REORDERED|TF_DELAY_RECOVERY)) {
+                                           (TF_PKTS_REORDERED | TF_DELAY_RECOVERY)) ==
+                                           (TF_PKTS_REORDERED | TF_DELAY_RECOVERY)) {
                                                /*
                                                 * Since the SACK information is already
                                                 * updated, this ACK will be dropped
@@ -4203,20 +4719,22 @@ process_dupack:
                                                 * worth of data in flight.
                                                 */
                                                awnd = (tp->snd_nxt - tp->snd_fack) +
-                                                       tp->sackhint.sack_bytes_rexmit;
+                                                   tp->sackhint.sack_bytes_rexmit;
                                                if (awnd < tp->snd_ssthresh) {
                                                        tp->snd_cwnd += tp->t_maxseg;
-                                                       if (tp->snd_cwnd > tp->snd_ssthresh)
+                                                       if (tp->snd_cwnd > tp->snd_ssthresh) {
                                                                tp->snd_cwnd = tp->snd_ssthresh;
+                                                       }
                                                }
                                        } else {
                                                tp->snd_cwnd += tp->t_maxseg;
                                        }
 
                                        /* Process any window updates */
-                                       if (tiwin > tp->snd_wnd)
+                                       if (tiwin > tp->snd_wnd) {
                                                tcp_update_window(tp, thflags,
                                                    th, tiwin, tlen);
+                                       }
                                        tcp_ccdbg_trace(tp, th,
                                            TCP_CC_IN_FASTRECOVERY);
 
@@ -4247,10 +4765,11 @@ process_dupack:
                                                        break;
                                                }
                                        }
-                                       if (tp->t_flags & TF_SENTFIN)
+                                       if (tp->t_flags & TF_SENTFIN) {
                                                tp->snd_recover = tp->snd_max - 1;
-                                       else
+                                       } else {
                                                tp->snd_recover = tp->snd_max;
+                                       }
                                        tp->t_timer[TCPT_PTO] = 0;
                                        tp->t_rtttime = 0;
 
@@ -4262,7 +4781,7 @@ process_dupack:
                                         */
                                        if (SACK_ENABLED(tp) &&
                                            (tp->t_flagsext &
-                                           (TF_PKTS_REORDERED|TF_DELAY_RECOVERY))
+                                           (TF_PKTS_REORDERED | TF_DELAY_RECOVERY))
                                            == TF_PKTS_REORDERED &&
                                            !IN_FASTRECOVERY(tp) &&
                                            tp->t_reorderwin > 0 &&
@@ -4284,12 +4803,14 @@ process_dupack:
                                         * defined a hook for tasks to run
                                         * before entering FR, call it
                                         */
-                                       if (CC_ALGO(tp)->pre_fr != NULL)
+                                       if (CC_ALGO(tp)->pre_fr != NULL) {
                                                CC_ALGO(tp)->pre_fr(tp);
+                                       }
                                        ENTER_FASTRECOVERY(tp);
                                        tp->t_timer[TCPT_REXMT] = 0;
-                                       if (TCP_ECN_ENABLED(tp))
+                                       if (TCP_ECN_ENABLED(tp)) {
                                                tp->ecn_flags |= TE_SENDCWR;
+                                       }
 
                                        if (SACK_ENABLED(tp)) {
                                                tcpstat.tcps_sack_recovery_episode++;
@@ -4300,10 +4821,11 @@ process_dupack:
                                                    ~TF_CWND_NONVALIDATED;
 
                                                /* Process any window updates */
-                                               if (tiwin > tp->snd_wnd)
+                                               if (tiwin > tp->snd_wnd) {
                                                        tcp_update_window(
-                                                           tp, thflags,
-                                                           th, tiwin, tlen);
+                                                               tp, thflags,
+                                                               th, tiwin, tlen);
+                                               }
 
                                                tcp_ccdbg_trace(tp, th,
                                                    TCP_CC_ENTER_FASTRECOVERY);
@@ -4314,28 +4836,30 @@ process_dupack:
                                        tp->snd_cwnd = tp->t_maxseg;
 
                                        /* Process any window updates */
-                                       if (tiwin > tp->snd_wnd)
+                                       if (tiwin > tp->snd_wnd) {
                                                tcp_update_window(tp,
                                                    thflags,
                                                    th, tiwin, tlen);
+                                       }
 
                                        (void) tcp_output(tp);
                                        if (tp->t_flagsext & TF_CWND_NONVALIDATED) {
                                                tcp_cc_adjust_nonvalidated_cwnd(tp);
                                        } else {
                                                tp->snd_cwnd = tp->snd_ssthresh +
-                                                    tp->t_maxseg * tp->t_dupacks;
+                                                   tp->t_maxseg * tp->t_dupacks;
                                        }
-                                       if (SEQ_GT(onxt, tp->snd_nxt))
+                                       if (SEQ_GT(onxt, tp->snd_nxt)) {
                                                tp->snd_nxt = onxt;
+                                       }
 
                                        tcp_ccdbg_trace(tp, th,
                                            TCP_CC_ENTER_FASTRECOVERY);
                                        goto drop;
                                } else if (limited_txmt &&
-                                       ALLOW_LIMITED_TRANSMIT(tp) &&
-                                       (!(SACK_ENABLED(tp)) || sack_bytes_acked > 0) &&
-                                       (so->so_snd.sb_cc - (tp->snd_max - tp->snd_una)) > 0) {
+                                   ALLOW_LIMITED_TRANSMIT(tp) &&
+                                   (!(SACK_ENABLED(tp)) || sack_bytes_acked > 0) &&
+                                   (so->so_snd.sb_cc - (tp->snd_max - tp->snd_una)) > 0) {
                                        u_int32_t incr = (tp->t_maxseg * tp->t_dupacks);
 
                                        /* Use Limited Transmit algorithm on the first two
@@ -4364,26 +4888,29 @@ process_dupack:
                                 * recovery, the subsequent ACKs should
                                 * not be treated as partial acks.
                                 */
-                               if (tp->ecn_flags & TE_INRECOVERY)
+                               if (tp->ecn_flags & TE_INRECOVERY) {
                                        goto process_ACK;
+                               }
 
-                               if (SACK_ENABLED(tp))
+                               if (SACK_ENABLED(tp)) {
                                        tcp_sack_partialack(tp, th);
-                               else
+                               } else {
                                        tcp_newreno_partial_ack(tp, th);
+                               }
                                tcp_ccdbg_trace(tp, th, TCP_CC_PARTIAL_ACK);
                        } else {
                                EXIT_FASTRECOVERY(tp);
-                               if (CC_ALGO(tp)->post_fr != NULL)
+                               if (CC_ALGO(tp)->post_fr != NULL) {
                                        CC_ALGO(tp)->post_fr(tp, th);
+                               }
                                tp->t_pipeack = 0;
                                tcp_clear_pipeack_state(tp);
                                tcp_ccdbg_trace(tp, th,
                                    TCP_CC_EXIT_FASTRECOVERY);
                        }
                } else if ((tp->t_flagsext &
-                       (TF_PKTS_REORDERED|TF_DELAY_RECOVERY))
-                       == (TF_PKTS_REORDERED|TF_DELAY_RECOVERY)) {
+                   (TF_PKTS_REORDERED | TF_DELAY_RECOVERY))
+                   == (TF_PKTS_REORDERED | TF_DELAY_RECOVERY)) {
                        /*
                         * If the ack acknowledges upto snd_recover or if
                         * it acknowledges all the snd holes, exit
@@ -4464,16 +4991,24 @@ process_ACK:
                        tp->t_timer[TCPT_REXMT] = 0;
                        tp->t_timer[TCPT_PTO] = 0;
                        needoutput = 1;
-               } else if (tp->t_timer[TCPT_PERSIST] == 0)
+               } else if (tp->t_timer[TCPT_PERSIST] == 0) {
                        tp->t_timer[TCPT_REXMT] = OFFSET_FROM_START(tp,
                            tp->t_rxtcur);
+               }
+
+               if ((prev_t_state == TCPS_SYN_SENT ||
+                   prev_t_state == TCPS_SYN_RECEIVED) &&
+                   tp->t_state == TCPS_ESTABLISHED) {
+                       TCP_LOG_RTT_INFO(tp);
+               }
 
                /*
                 * If no data (only SYN) was ACK'd, skip rest of ACK
                 * processing.
                 */
-               if (acked == 0)
+               if (acked == 0) {
                        goto step6;
+               }
 
                /*
                 * When outgoing data has been acked (except the SYN+data), we
@@ -4481,8 +5016,9 @@ process_ACK:
                 */
                if ((tp->t_tfo_stats & TFO_S_SYN_DATA_SENT) &&
                    !(tp->t_tfo_flags & TFO_F_NO_SNDPROBING) &&
-                   !(th->th_flags & TH_SYN))
-                       tcp_heuristic_tfo_snd_good(tp);
+                   !(th->th_flags & TH_SYN)) {
+                       tp->t_tfo_flags |= TFO_F_NO_SNDPROBING;
+               }
 
                /*
                 * If TH_ECE is received, make sure that ECN is enabled
@@ -4496,7 +5032,7 @@ process_ACK:
                         */
                        if (!IN_FASTRECOVERY(tp)) {
                                tcp_reduce_congestion_window(tp);
-                               tp->ecn_flags |= (TE_INRECOVERY|TE_SENDCWR);
+                               tp->ecn_flags |= (TE_INRECOVERY | TE_SENDCWR);
                                /*
                                 * Also note that the connection received
                                 * ECE atleast once
@@ -4517,8 +5053,9 @@ process_ACK:
                 * not updated yet.
                 */
                if (!IN_FASTRECOVERY(tp)) {
-                       if (CC_ALGO(tp)->ack_rcvd != NULL)
+                       if (CC_ALGO(tp)->ack_rcvd != NULL) {
                                CC_ALGO(tp)->ack_rcvd(tp, th);
+                       }
                        tcp_ccdbg_trace(tp, th, TCP_CC_ACK_RCVD);
                }
                if (acked > so->so_snd.sb_cc) {
@@ -4526,57 +5063,58 @@ process_ACK:
                        sbdrop(&so->so_snd, (int)so->so_snd.sb_cc);
                        if (so->so_flags & SOF_ENABLE_MSGS) {
                                so->so_msg_state->msg_serial_bytes -=
-                                       (int)so->so_snd.sb_cc;
+                                   (int)so->so_snd.sb_cc;
                        }
                        ourfinisacked = 1;
                } else {
                        sbdrop(&so->so_snd, acked);
                        if (so->so_flags & SOF_ENABLE_MSGS) {
                                so->so_msg_state->msg_serial_bytes -=
-                                       acked;
+                                   acked;
                        }
                        tcp_sbsnd_trim(&so->so_snd);
                        tp->snd_wnd -= acked;
                        ourfinisacked = 0;
                }
                /* detect una wraparound */
-               if ( !IN_FASTRECOVERY(tp) &&
+               if (!IN_FASTRECOVERY(tp) &&
                    SEQ_GT(tp->snd_una, tp->snd_recover) &&
-                   SEQ_LEQ(th->th_ack, tp->snd_recover))
+                   SEQ_LEQ(th->th_ack, tp->snd_recover)) {
                        tp->snd_recover = th->th_ack - 1;
+               }
 
                if (IN_FASTRECOVERY(tp) &&
-                   SEQ_GEQ(th->th_ack, tp->snd_recover))
+                   SEQ_GEQ(th->th_ack, tp->snd_recover)) {
                        EXIT_FASTRECOVERY(tp);
+               }
 
                tp->snd_una = th->th_ack;
 
                if (SACK_ENABLED(tp)) {
-                       if (SEQ_GT(tp->snd_una, tp->snd_recover))
+                       if (SEQ_GT(tp->snd_una, tp->snd_recover)) {
                                tp->snd_recover = tp->snd_una;
+                       }
                }
-               if (SEQ_LT(tp->snd_nxt, tp->snd_una))
+               if (SEQ_LT(tp->snd_nxt, tp->snd_una)) {
                        tp->snd_nxt = tp->snd_una;
+               }
                if (!SLIST_EMPTY(&tp->t_rxt_segments) &&
                    !TCP_DSACK_SEQ_IN_WINDOW(tp, tp->t_dsack_lastuna,
-                   tp->snd_una))
+                   tp->snd_una)) {
                        tcp_rxtseg_clean(tp);
+               }
                if ((tp->t_flagsext & TF_MEASURESNDBW) != 0 &&
-                       tp->t_bwmeas != NULL)
+                   tp->t_bwmeas != NULL) {
                        tcp_bwmeas_check(tp);
+               }
 
-               /*
-                * sowwakeup must happen after snd_una, et al. are
-                * updated so that the sequence numbers are in sync with
-                * so_snd
-                */
-               sowwakeup(so);
+               write_wakeup = 1;
 
-               if (!SLIST_EMPTY(&tp->t_notify_ack))
+               if (!SLIST_EMPTY(&tp->t_notify_ack)) {
                        tcp_notify_acknowledgement(tp, so);
+               }
 
                switch (tp->t_state) {
-
                /*
                 * In FIN_WAIT_1 STATE in addition to the processing
                 * for the ESTABLISHED state if our FIN is now acknowledged
@@ -4593,14 +5131,14 @@ process_ACK:
                                 */
                                if (so->so_state & SS_CANTRCVMORE) {
                                        tp->t_timer[TCPT_2MSL] = OFFSET_FROM_START(tp,
-                                               TCP_CONN_MAXIDLE(tp));
+                                           TCP_CONN_MAXIDLE(tp));
                                        isconnected = FALSE;
                                        isdisconnected = TRUE;
                                }
                                DTRACE_TCP4(state__change, void, NULL,
-                                       struct inpcb *, inp,
-                                       struct tcpcb *, tp,
-                                       int32_t, TCPS_FIN_WAIT_2);
+                                   struct inpcb *, inp,
+                                   struct tcpcb *, tp,
+                                   int32_t, TCPS_FIN_WAIT_2);
                                tp->t_state = TCPS_FIN_WAIT_2;
                                /* fall through and make sure we also recognize
                                 * data ACKed with the FIN
@@ -4608,7 +5146,7 @@ process_ACK:
                        }
                        break;
 
-               /*
+               /*
                 * In CLOSING STATE in addition to the processing for
                 * the ESTABLISHED state if the ACK acknowledges our FIN
                 * then enter the TIME-WAIT state, otherwise ignore
@@ -4617,9 +5155,9 @@ process_ACK:
                case TCPS_CLOSING:
                        if (ourfinisacked) {
                                DTRACE_TCP4(state__change, void, NULL,
-                                       struct inpcb *, inp,
-                                       struct tcpcb *, tp,
-                                       int32_t, TCPS_TIME_WAIT);
+                                   struct inpcb *, inp,
+                                   struct tcpcb *, tp,
+                                   int32_t, TCPS_TIME_WAIT);
                                tp->t_state = TCPS_TIME_WAIT;
                                tcp_canceltimers(tp);
                                if (tp->t_flagsext & TF_NOTIMEWAIT) {
@@ -4680,8 +5218,9 @@ step6:
        /*
         * Update window information.
         */
-       if (tcp_update_window(tp, thflags, th, tiwin, tlen))
+       if (tcp_update_window(tp, thflags, th, tiwin, tlen)) {
                needoutput = 1;
+       }
 
        /*
         * Process segments with URG.
@@ -4695,9 +5234,9 @@ step6:
                 * actually wanting to send this much urgent data.
                 */
                if (th->th_urp + so->so_rcv.sb_cc > sb_max) {
-                       th->th_urp = 0;                 /* XXX */
-                       thflags &= ~TH_URG;             /* XXX */
-                       goto dodata;                    /* XXX */
+                       th->th_urp = 0;                 /* XXX */
+                       thflags &= ~TH_URG;             /* XXX */
+                       goto dodata;                    /* XXX */
                }
                /*
                 * If this segment advances the known urgent pointer,
@@ -4713,7 +5252,7 @@ step6:
                 * of data past the urgent section as the original
                 * spec states (in one of two places).
                 */
-               if (SEQ_GT(th->th_seq+th->th_urp, tp->rcv_up)) {
+               if (SEQ_GT(th->th_seq + th->th_urp, tp->rcv_up)) {
                        tp->rcv_up = th->th_seq + th->th_urp;
                        so->so_oobmark = so->so_rcv.sb_cc +
                            (tp->rcv_up - tp->rcv_nxt) - 1;
@@ -4732,19 +5271,21 @@ step6:
                 */
                if (th->th_urp <= (u_int32_t)tlen
 #if SO_OOBINLINE
-                    && (so->so_options & SO_OOBINLINE) == 0
+                   && (so->so_options & SO_OOBINLINE) == 0
 #endif
-                    )
+                   ) {
                        tcp_pulloutofband(so, th, m,
-                               drop_hdrlen);   /* hdr drop is delayed */
+                           drop_hdrlen);       /* hdr drop is delayed */
+               }
        } else {
                /*
                 * If no out of band data is expected,
                 * pull receive urgent pointer along
                 * with the receive window.
                 */
-               if (SEQ_GT(tp->rcv_nxt, tp->rcv_up))
+               if (SEQ_GT(tp->rcv_nxt, tp->rcv_up)) {
                        tp->rcv_up = tp->rcv_nxt;
+               }
        }
 dodata:
 
@@ -4763,6 +5304,7 @@ dodata:
         */
        if (inp->inp_state == INPCB_STATE_DEAD) {
                /* Just drop the packet that we are processing and return */
+               TCP_LOG_DROP_PCB(TCP_LOG_HDR, th, tp, false, "INPCB_STATE_DEAD");
                goto drop;
        }
 
@@ -4780,11 +5322,11 @@ dodata:
        if ((tlen || (thflags & TH_FIN)) &&
            TCPS_HAVERCVDFIN(tp->t_state) == 0 &&
            (TCPS_HAVEESTABLISHED(tp->t_state) ||
-            (tp->t_state == TCPS_SYN_RECEIVED &&
-            (tp->t_tfo_flags & TFO_F_COOKIE_VALID)))) {
+           (tp->t_state == TCPS_SYN_RECEIVED &&
+           (tp->t_tfo_flags & TFO_F_COOKIE_VALID)))) {
                tcp_seq save_start = th->th_seq;
                tcp_seq save_end = th->th_seq + tlen;
-               m_adj(m, drop_hdrlen);  /* delayed header drop */
+               m_adj(m, drop_hdrlen);  /* delayed header drop */
                /*
                 * Insert segment which includes th into TCP reassembly queue
                 * with control block tp.  Set thflags to whether reassembly now
@@ -4804,18 +5346,18 @@ dodata:
                         * connection is in streaming mode and the last
                         * packet was not an end-of-write
                         */
-                       if (tp->t_flags & TF_STREAMING_ON)
+                       if (tp->t_flags & TF_STREAMING_ON) {
                                tcp_compute_rtt(tp, &to, th);
+                       }
 
                        if (DELAY_ACK(tp, th) &&
-                               ((tp->t_flags & TF_ACKNOW) == 0) ) {
+                           ((tp->t_flags & TF_ACKNOW) == 0)) {
                                if ((tp->t_flags & TF_DELACK) == 0) {
                                        tp->t_flags |= TF_DELACK;
                                        tp->t_timer[TCPT_DELACK] =
-                                               OFFSET_FROM_START(tp, tcp_delack);
+                                           OFFSET_FROM_START(tp, tcp_delack);
                                }
-                       }
-                       else {
+                       } else {
                                tp->t_flags |= TF_ACKNOW;
                        }
                        tp->rcv_nxt += tlen;
@@ -4832,50 +5374,76 @@ dodata:
                                }
                                INP_ADD_STAT(inp, cell, wifi, wired,
                                    rxbytes, tlen);
+                               inp_set_activity_bitmap(inp);
                        }
                        tcp_sbrcv_grow(tp, &so->so_rcv, &to, tlen,
                            TCP_AUTORCVBUF_MAX(ifp));
                        so_recv_data_stat(so, m, drop_hdrlen);
 
+                       if (isipv6) {
+                               memcpy(&saved_hdr, ip6, sizeof(struct ip6_hdr));
+                               ip6 = (struct ip6_hdr *)&saved_hdr[0];
+                       } else {
+                               memcpy(&saved_hdr, ip, ip->ip_hl << 2);
+                               ip = (struct ip *)&saved_hdr[0];
+                       }
+                       memcpy(&saved_tcphdr, th, sizeof(struct tcphdr));
                        if (sbappendstream_rcvdemux(so, m,
                            th->th_seq - (tp->irs + 1), 0)) {
-                               sorwakeup(so);
+                               read_wakeup = 1;
                        }
+                       th = &saved_tcphdr;
                } else {
-                       thflags = tcp_reass(tp, th, &tlen, m, ifp);
+                       if (isipv6) {
+                               memcpy(&saved_hdr, ip6, sizeof(struct ip6_hdr));
+                               ip6 = (struct ip6_hdr *)&saved_hdr[0];
+                       } else {
+                               memcpy(&saved_hdr, ip, ip->ip_hl << 2);
+                               ip = (struct ip *)&saved_hdr[0];
+                       }
+                       memcpy(&saved_tcphdr, th, sizeof(struct tcphdr));
+                       thflags = tcp_reass(tp, th, &tlen, m, ifp, &read_wakeup);
+                       th = &saved_tcphdr;
                        tp->t_flags |= TF_ACKNOW;
                }
 
                if ((tlen > 0 || (th->th_flags & TH_FIN)) && SACK_ENABLED(tp)) {
-                       if (th->th_flags & TH_FIN)
+                       if (th->th_flags & TH_FIN) {
                                save_end++;
+                       }
                        tcp_update_sack_list(tp, save_start, save_end);
                }
 
                tcp_adaptive_rwtimo_check(tp, tlen);
 
-               if (tlen > 0)
+               if (tlen > 0) {
                        tcp_tfo_rcv_data(tp);
+               }
 
-               if (tp->t_flags & TF_DELACK)
-               {
+               if (tp->t_flags & TF_DELACK) {
 #if INET6
                        if (isipv6) {
                                KERNEL_DEBUG(DBG_LAYER_END, ((th->th_dport << 16) | th->th_sport),
-                                       (((ip6->ip6_src.s6_addr16[0]) << 16) | (ip6->ip6_dst.s6_addr16[0])),
-                                       th->th_seq, th->th_ack, th->th_win);
-                       }
-                       else
+                                   (((ip6->ip6_src.s6_addr16[0]) << 16) | (ip6->ip6_dst.s6_addr16[0])),
+                                   th->th_seq, th->th_ack, th->th_win);
+                       } else
 #endif
                        {
                                KERNEL_DEBUG(DBG_LAYER_END, ((th->th_dport << 16) | th->th_sport),
-                                       (((ip->ip_src.s_addr & 0xffff) << 16) | (ip->ip_dst.s_addr & 0xffff)),
-                                       th->th_seq, th->th_ack, th->th_win);
+                                   (((ip->ip_src.s_addr & 0xffff) << 16) | (ip->ip_dst.s_addr & 0xffff)),
+                                   th->th_seq, th->th_ack, th->th_win);
                        }
-
                }
        } else {
-               m_freem(m);
+               if ((so->so_flags & SOF_MP_SUBFLOW) && tlen == 0 &&
+                   (m->m_pkthdr.pkt_flags & PKTF_MPTCP_DFIN) &&
+                   (m->m_pkthdr.pkt_flags & PKTF_MPTCP)) {
+                       m_adj(m, drop_hdrlen);  /* delayed header drop */
+                       mptcp_input(tptomptp(tp)->mpt_mpte, m);
+                       tp->t_flags |= TF_ACKNOW;
+               } else {
+                       m_freem(m);
+               }
                thflags &= ~TH_FIN;
        }
 
@@ -4906,8 +5474,7 @@ dodata:
                        tp->rcv_nxt++;
                }
                switch (tp->t_state) {
-
-               /*
+               /*
                 * In SYN_RECEIVED and ESTABLISHED STATES
                 * enter the CLOSE_WAIT state.
                 */
@@ -4915,30 +5482,30 @@ dodata:
                        tp->t_starttime = tcp_now;
                case TCPS_ESTABLISHED:
                        DTRACE_TCP4(state__change, void, NULL, struct inpcb *, inp,
-                               struct tcpcb *, tp, int32_t, TCPS_CLOSE_WAIT);
+                           struct tcpcb *, tp, int32_t, TCPS_CLOSE_WAIT);
                        tp->t_state = TCPS_CLOSE_WAIT;
                        break;
 
-               /*
+               /*
                 * If still in FIN_WAIT_1 STATE FIN has not been acked so
                 * enter the CLOSING state.
                 */
                case TCPS_FIN_WAIT_1:
                        DTRACE_TCP4(state__change, void, NULL, struct inpcb *, inp,
-                               struct tcpcb *, tp, int32_t, TCPS_CLOSING);
+                           struct tcpcb *, tp, int32_t, TCPS_CLOSING);
                        tp->t_state = TCPS_CLOSING;
                        break;
 
-               /*
+               /*
                 * In FIN_WAIT_2 state enter the TIME_WAIT state,
                 * starting the time-wait timer, turning off the other
                 * standard timers.
                 */
                case TCPS_FIN_WAIT_2:
                        DTRACE_TCP4(state__change, void, NULL,
-                               struct inpcb *, inp,
-                               struct tcpcb *, tp,
-                               int32_t, TCPS_TIME_WAIT);
+                           struct inpcb *, inp,
+                           struct tcpcb *, tp,
+                           int32_t, TCPS_TIME_WAIT);
                        tp->t_state = TCPS_TIME_WAIT;
                        tcp_canceltimers(tp);
                        tp->t_flags |= TF_ACKNOW;
@@ -4959,11 +5526,16 @@ dodata:
                }
        }
 #if TCPDEBUG
-       if (so->so_options & SO_DEBUG)
+       if (so->so_options & SO_DEBUG) {
                tcp_trace(TA_INPUT, ostate, tp, (void *)tcp_saveipgen,
-                         &tcp_savetcp, 0);
+                   &tcp_savetcp, 0);
+       }
 #endif
 
+       if (read_wakeup) {
+               mptcp_handle_input(so);
+       }
+
        /*
         * Return any desired output.
         */
@@ -4973,9 +5545,10 @@ dodata:
 
        tcp_check_timer_state(tp);
 
+       tcp_handle_wakeup(so, read_wakeup, write_wakeup);
 
-       tcp_unlock(so, 1, 0);
-       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END,0,0,0,0,0);
+       socket_unlock(so, 1);
+       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END, 0, 0, 0, 0, 0);
        return;
 
 dropafterack:
@@ -4996,23 +5569,27 @@ dropafterack:
         */
        if (tp->t_state == TCPS_SYN_RECEIVED && (thflags & TH_ACK) &&
            (SEQ_GT(tp->snd_una, th->th_ack) ||
-            SEQ_GT(th->th_ack, tp->snd_max)) ) {
+           SEQ_GT(th->th_ack, tp->snd_max))) {
                rstreason = BANDLIM_RST_OPENPORT;
                IF_TCP_STATINC(ifp, dospacket);
                goto dropwithreset;
        }
 #if TCPDEBUG
-       if (so->so_options & SO_DEBUG)
+       if (so->so_options & SO_DEBUG) {
                tcp_trace(TA_DROP, ostate, tp, (void *)tcp_saveipgen,
-                         &tcp_savetcp, 0);
+                   &tcp_savetcp, 0);
+       }
 #endif
        m_freem(m);
        tp->t_flags |= TF_ACKNOW;
+
        (void) tcp_output(tp);
 
+       tcp_handle_wakeup(so, read_wakeup, write_wakeup);
+
        /* Don't need to check timer state as we should have done it during tcp_output */
-       tcp_unlock(so, 1, 0);
-       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END,0,0,0,0,0);
+       socket_unlock(so, 1);
+       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END, 0, 0, 0, 0, 0);
        return;
 dropwithresetnosock:
        nosock = 1;
@@ -5022,58 +5599,66 @@ dropwithreset:
         * Make ACK acceptable to originator of segment.
         * Don't bother to respond if destination was broadcast/multicast.
         */
-       if ((thflags & TH_RST) || m->m_flags & (M_BCAST|M_MCAST))
+       if ((thflags & TH_RST) || m->m_flags & (M_BCAST | M_MCAST)) {
                goto drop;
+       }
 #if INET6
        if (isipv6) {
                if (IN6_IS_ADDR_MULTICAST(&ip6->ip6_dst) ||
-                   IN6_IS_ADDR_MULTICAST(&ip6->ip6_src))
+                   IN6_IS_ADDR_MULTICAST(&ip6->ip6_src)) {
                        goto drop;
+               }
        } else
 #endif /* INET6 */
        if (IN_MULTICAST(ntohl(ip->ip_dst.s_addr)) ||
            IN_MULTICAST(ntohl(ip->ip_src.s_addr)) ||
            ip->ip_src.s_addr == htonl(INADDR_BROADCAST) ||
-           in_broadcast(ip->ip_dst, m->m_pkthdr.rcvif))
+           in_broadcast(ip->ip_dst, m->m_pkthdr.rcvif)) {
                goto drop;
+       }
        /* IPv6 anycast check is done at tcp6_input() */
 
        /*
         * Perform bandwidth limiting.
         */
 #if ICMP_BANDLIM
-       if (badport_bandlim(rstreason) < 0)
+       if (badport_bandlim(rstreason) < 0) {
                goto drop;
+       }
 #endif
 
 #if TCPDEBUG
-       if (tp == 0 || (tp->t_inpcb->inp_socket->so_options & SO_DEBUG))
+       if (tp == 0 || (tp->t_inpcb->inp_socket->so_options & SO_DEBUG)) {
                tcp_trace(TA_DROP, ostate, tp, (void *)tcp_saveipgen,
-                         &tcp_savetcp, 0);
+                   &tcp_savetcp, 0);
+       }
 #endif
        bzero(&tra, sizeof(tra));
        tra.ifscope = ifscope;
        tra.awdl_unrestricted = 1;
        tra.intcoproc_allowed = 1;
-       if (thflags & TH_ACK)
+       if (thflags & TH_ACK) {
                /* mtod() below is safe as long as hdr dropping is delayed */
                tcp_respond(tp, mtod(m, void *), th, m, (tcp_seq)0, th->th_ack,
                    TH_RST, &tra);
-       else {
-               if (thflags & TH_SYN)
+       else {
+               if (thflags & TH_SYN) {
                        tlen++;
+               }
                /* mtod() below is safe as long as hdr dropping is delayed */
-               tcp_respond(tp, mtod(m, void *), th, m, th->th_seq+tlen,
-                   (tcp_seq)0, TH_RST|TH_ACK, &tra);
+               tcp_respond(tp, mtod(m, void *), th, m, th->th_seq + tlen,
+                   (tcp_seq)0, TH_RST | TH_ACK, &tra);
        }
        /* destroy temporarily created socket */
        if (dropsocket) {
                (void) soabort(so);
-               tcp_unlock(so, 1, 0);
+               socket_unlock(so, 1);
        } else if ((inp != NULL) && (nosock == 0)) {
-               tcp_unlock(so, 1, 0);
+               tcp_handle_wakeup(so, read_wakeup, write_wakeup);
+
+               socket_unlock(so, 1);
        }
-       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END,0,0,0,0,0);
+       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END, 0, 0, 0, 0, 0);
        return;
 dropnosock:
        nosock = 1;
@@ -5082,20 +5667,22 @@ drop:
         * Drop space held by incoming segment and return.
         */
 #if TCPDEBUG
-       if (tp == 0 || (tp->t_inpcb->inp_socket->so_options & SO_DEBUG))
+       if (tp == 0 || (tp->t_inpcb->inp_socket->so_options & SO_DEBUG)) {
                tcp_trace(TA_DROP, ostate, tp, (void *)tcp_saveipgen,
-                         &tcp_savetcp, 0);
+                   &tcp_savetcp, 0);
+       }
 #endif
        m_freem(m);
        /* destroy temporarily created socket */
        if (dropsocket) {
                (void) soabort(so);
-               tcp_unlock(so, 1, 0);
-       }
-       else if (nosock == 0) {
-               tcp_unlock(so, 1, 0);
+               socket_unlock(so, 1);
+       } else if (nosock == 0) {
+               tcp_handle_wakeup(so, read_wakeup, write_wakeup);
+
+               socket_unlock(so, 1);
        }
-       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END,0,0,0,0,0);
+       KERNEL_DEBUG(DBG_FNC_TCP_INPUT | DBG_FUNC_END, 0, 0, 0, 0, 0);
        return;
 }
 
@@ -5111,27 +5698,31 @@ tcp_dooptions(struct tcpcb *tp, u_char *cp, int cnt, struct tcphdr *th,
 
        for (; cnt > 0; cnt -= optlen, cp += optlen) {
                opt = cp[0];
-               if (opt == TCPOPT_EOL)
+               if (opt == TCPOPT_EOL) {
                        break;
-               if (opt == TCPOPT_NOP)
+               }
+               if (opt == TCPOPT_NOP) {
                        optlen = 1;
-               else {
-                       if (cnt < 2)
+               else {
+                       if (cnt < 2) {
                                break;
+                       }
                        optlen = cp[1];
-                       if (optlen < 2 || optlen > cnt)
+                       if (optlen < 2 || optlen > cnt) {
                                break;
+                       }
                }
                switch (opt) {
-
                default:
                        continue;
 
                case TCPOPT_MAXSEG:
-                       if (optlen != TCPOLEN_MAXSEG)
+                       if (optlen != TCPOLEN_MAXSEG) {
                                continue;
-                       if (!(th->th_flags & TH_SYN))
+                       }
+                       if (!(th->th_flags & TH_SYN)) {
                                continue;
+                       }
                        bcopy((char *) cp + 2, (char *) &mss, sizeof(mss));
                        NTOHS(mss);
                        to->to_mss = mss;
@@ -5139,17 +5730,20 @@ tcp_dooptions(struct tcpcb *tp, u_char *cp, int cnt, struct tcphdr *th,
                        break;
 
                case TCPOPT_WINDOW:
-                       if (optlen != TCPOLEN_WINDOW)
+                       if (optlen != TCPOLEN_WINDOW) {
                                continue;
-                       if (!(th->th_flags & TH_SYN))
+                       }
+                       if (!(th->th_flags & TH_SYN)) {
                                continue;
+                       }
                        to->to_flags |= TOF_SCALE;
                        to->to_requested_s_scale = min(cp[2], TCP_MAX_WINSHIFT);
                        break;
 
                case TCPOPT_TIMESTAMP:
-                       if (optlen != TCPOLEN_TIMESTAMP)
+                       if (optlen != TCPOLEN_TIMESTAMP) {
                                continue;
+                       }
                        to->to_flags |= TOF_TS;
                        bcopy((char *)cp + 2,
                            (char *)&to->to_tsval, sizeof(to->to_tsval));
@@ -5159,19 +5753,23 @@ tcp_dooptions(struct tcpcb *tp, u_char *cp, int cnt, struct tcphdr *th,
                        NTOHL(to->to_tsecr);
                        /* Re-enable sending Timestamps if we received them */
                        if (!(tp->t_flags & TF_REQ_TSTMP) &&
-                           tcp_do_rfc1323 == 1)
+                           tcp_do_rfc1323 == 1) {
                                tp->t_flags |= TF_REQ_TSTMP;
+                       }
                        break;
                case TCPOPT_SACK_PERMITTED:
                        if (!tcp_do_sack ||
-                           optlen != TCPOLEN_SACK_PERMITTED)
+                           optlen != TCPOLEN_SACK_PERMITTED) {
                                continue;
-                       if (th->th_flags & TH_SYN)
+                       }
+                       if (th->th_flags & TH_SYN) {
                                to->to_flags |= TOF_SACK;
+                       }
                        break;
                case TCPOPT_SACK:
-                       if (optlen <= 2 || (optlen - 2) % TCPOLEN_SACK != 0)
+                       if (optlen <= 2 || (optlen - 2) % TCPOLEN_SACK != 0) {
                                continue;
+                       }
                        to->to_nsacks = (optlen - 2) / TCPOLEN_SACK;
                        to->to_sacks = cp + 2;
                        tcpstat.tcps_sack_rcv_blocks++;
@@ -5179,18 +5777,21 @@ tcp_dooptions(struct tcpcb *tp, u_char *cp, int cnt, struct tcphdr *th,
                        break;
                case TCPOPT_FASTOPEN:
                        if (optlen == TCPOLEN_FASTOPEN_REQ) {
-                               if (tp->t_state != TCPS_LISTEN)
+                               if (tp->t_state != TCPS_LISTEN) {
                                        continue;
+                               }
 
                                to->to_flags |= TOF_TFOREQ;
                        } else {
                                if (optlen < TCPOLEN_FASTOPEN_REQ ||
                                    (optlen - TCPOLEN_FASTOPEN_REQ) > TFO_COOKIE_LEN_MAX ||
-                                   (optlen - TCPOLEN_FASTOPEN_REQ) < TFO_COOKIE_LEN_MIN)
+                                   (optlen - TCPOLEN_FASTOPEN_REQ) < TFO_COOKIE_LEN_MIN) {
                                        continue;
+                               }
                                if (tp->t_state != TCPS_LISTEN &&
-                                   tp->t_state != TCPS_SYN_SENT)
+                                   tp->t_state != TCPS_SYN_SENT) {
                                        continue;
+                               }
 
                                to->to_flags |= TOF_TFO;
                                to->to_tfo = cp + 1;
@@ -5213,23 +5814,25 @@ tcp_finalize_options(struct tcpcb *tp, struct tcpopt *to, unsigned int ifscope)
                tp->t_flags |= TF_RCVD_TSTMP;
                tp->ts_recent = to->to_tsval;
                tp->ts_recent_age = tcp_now;
-
        }
-       if (to->to_flags & TOF_MSS)
+       if (to->to_flags & TOF_MSS) {
                tcp_mss(tp, to->to_mss, ifscope);
+       }
        if (SACK_ENABLED(tp)) {
-               if (!(to->to_flags & TOF_SACK))
+               if (!(to->to_flags & TOF_SACK)) {
                        tp->t_flagsext &= ~(TF_SACK_ENABLE);
-               else
+               } else {
                        tp->t_flags |= TF_SACK_PERMIT;
+               }
        }
        if (to->to_flags & TOF_SCALE) {
                tp->t_flags |= TF_RCVD_SCALE;
                tp->requested_s_scale = to->to_requested_s_scale;
 
                /* Re-enable window scaling, if the option is received */
-               if (tp->request_r_scale > 0)
+               if (tp->request_r_scale > 0) {
                        tp->t_flags |= TF_REQ_SCALE;
+               }
        }
 }
 
@@ -5253,16 +5856,18 @@ tcp_pulloutofband(struct socket *so, struct tcphdr *th, struct mbuf *m, int off)
 
                        tp->t_iobc = *cp;
                        tp->t_oobflags |= TCPOOB_HAVEDATA;
-                       bcopy(cp+1, cp, (unsigned)(m->m_len - cnt - 1));
+                       bcopy(cp + 1, cp, (unsigned)(m->m_len - cnt - 1));
                        m->m_len--;
-                       if (m->m_flags & M_PKTHDR)
+                       if (m->m_flags & M_PKTHDR) {
                                m->m_pkthdr.len--;
+                       }
                        return;
                }
                cnt -= m->m_len;
                m = m->m_next;
-               if (m == 0)
+               if (m == 0) {
                        break;
+               }
        }
        panic("tcp_pulloutofband");
 }
@@ -5271,7 +5876,7 @@ uint32_t
 get_base_rtt(struct tcpcb *tp)
 {
        struct rtentry *rt = tp->t_inpcb->inp_route.ro_rt;
-       return ((rt == NULL) ? 0 : rt->rtt_min);
+       return (rt == NULL) ? 0 : rt->rtt_min;
 }
 
 /* Each value of RTT base represents the minimum RTT seen in a minute.
@@ -5283,8 +5888,9 @@ update_base_rtt(struct tcpcb *tp, uint32_t rtt)
        u_int32_t base_rtt, i;
        struct rtentry *rt;
 
-       if ((rt = tp->t_inpcb->inp_route.ro_rt) == NULL)
+       if ((rt = tp->t_inpcb->inp_route.ro_rt) == NULL) {
                return;
+       }
        if (rt->rtt_expire_ts == 0) {
                RT_LOCK_SPIN(rt);
                if (rt->rtt_expire_ts != 0) {
@@ -5321,8 +5927,9 @@ update:
                if ((int)(tcp_now - rt->rtt_expire_ts) >=
                    TCP_RTT_HISTORY_EXPIRE_TIME) {
                        rt->rtt_index++;
-                       if (rt->rtt_index >= NRTT_HIST)
+                       if (rt->rtt_index >= NRTT_HIST) {
                                rt->rtt_index = 0;
+                       }
                        rt->rtt_hist[rt->rtt_index] = rtt;
                        rt->rtt_expire_ts = tcp_now;
                } else {
@@ -5334,17 +5941,19 @@ update:
                for (i = 0; i < NRTT_HIST; ++i) {
                        if (rt->rtt_hist[i] != 0 &&
                            (rt->rtt_min == 0 ||
-                           rt->rtt_hist[i] < rt->rtt_min))
+                           rt->rtt_hist[i] < rt->rtt_min)) {
                                rt->rtt_min = rt->rtt_hist[i];
+                       }
                }
                RT_UNLOCK(rt);
        } else {
                rt->rtt_hist[rt->rtt_index] =
                    min(rt->rtt_hist[rt->rtt_index], rtt);
-               if (rt->rtt_min == 0)
+               if (rt->rtt_min == 0) {
                        rt->rtt_min = rtt;
-               else
+               } else {
                        rt->rtt_min = min(rt->rtt_min, rtt);
+               }
        }
 }
 
@@ -5382,17 +5991,17 @@ tcp_compute_rtt(struct tcpcb *tp, struct tcpopt *to, struct tcphdr *th)
                        /* Compute the max of the pipeack samples */
                        pipe_ack_val = tcp_get_max_pipeack(tp);
                        tp->t_pipeack = (pipe_ack_val >
-                                   TCP_CC_CWND_INIT_BYTES) ?
-                                   pipe_ack_val : 0;
+                           TCP_CC_CWND_INIT_BYTES) ?
+                           pipe_ack_val : 0;
                }
                /* start another measurement */
                tp->t_rtttime = 0;
        }
        if (((to->to_flags & TOF_TS) != 0) &&
-               (to->to_tsecr != 0) &&
-               TSTMP_GEQ(tcp_now, to->to_tsecr)) {
+           (to->to_tsecr != 0) &&
+           TSTMP_GEQ(tcp_now, to->to_tsecr)) {
                tcp_xmit_timer(tp, (tcp_now - to->to_tsecr),
-                       to->to_tsecr, th->th_ack);
+                   to->to_tsecr, th->th_ack);
        } else if (rtt > 0) {
                tcp_xmit_timer(tp, rtt, 0, th->th_ack);
        }
@@ -5404,9 +6013,12 @@ tcp_compute_rtt(struct tcpcb *tp, struct tcpopt *to, struct tcphdr *th)
  */
 static void
 tcp_xmit_timer(struct tcpcb *tp, int rtt,
-       u_int32_t tsecr, tcp_seq th_ack)
+    u_int32_t tsecr, tcp_seq th_ack)
 {
        int delta;
+       int old_srtt = tp->t_srtt;
+       int old_rttvar = tp->t_rttvar;
+       bool log_rtt = false;
 
        /*
         * On AWDL interface, the initial RTT measurement on SYN
@@ -5416,8 +6028,9 @@ tcp_xmit_timer(struct tcpcb *tp, int rtt,
         */
        if (tp->t_inpcb->inp_last_outifp != NULL &&
            (tp->t_inpcb->inp_last_outifp->if_eflags & IFEF_AWDL) &&
-           th_ack == tp->iss + 1)
+           th_ack == tp->iss + 1) {
                return;
+       }
 
        if (tp->t_flagsext & TF_RECOMPUTE_RTT) {
                if (SEQ_GT(th_ack, tp->snd_una) &&
@@ -5436,8 +6049,9 @@ tcp_xmit_timer(struct tcpcb *tp, int rtt,
                        tp->t_rttvar = max(tp->t_rttvar_prev, (rtt >> 1));
                        tp->t_rttvar = tp->t_rttvar << TCP_RTTVAR_SHIFT;
 
-                       if (tp->t_rttbest > (tp->t_srtt + tp->t_rttvar))
+                       if (tp->t_rttbest > (tp->t_srtt + tp->t_rttvar)) {
                                tp->t_rttbest = tp->t_srtt + tp->t_rttvar;
+                       }
 
                        goto compute_rto;
                } else {
@@ -5468,10 +6082,11 @@ tcp_xmit_timer(struct tcpcb *tp, int rtt,
                 * tcp_now, this extra adjustment is not needed.
                 */
                delta = (rtt << TCP_DELTA_SHIFT)
-                       - (tp->t_srtt >> (TCP_RTT_SHIFT - TCP_DELTA_SHIFT));
+                   - (tp->t_srtt >> (TCP_RTT_SHIFT - TCP_DELTA_SHIFT));
 
-               if ((tp->t_srtt += delta) <= 0)
+               if ((tp->t_srtt += delta) <= 0) {
                        tp->t_srtt = 1;
+               }
 
                /*
                 * We accumulate a smoothed rtt variance (actually, a
@@ -5483,14 +6098,17 @@ tcp_xmit_timer(struct tcpcb *tp, int rtt,
                 * (rttvar = rttvar*3/4 + |delta| / 4).  This replaces
                 * rfc793's wired-in beta.
                 */
-               if (delta < 0)
+               if (delta < 0) {
                        delta = -delta;
+               }
                delta -= tp->t_rttvar >> (TCP_RTTVAR_SHIFT - TCP_DELTA_SHIFT);
-               if ((tp->t_rttvar += delta) <= 0)
+               if ((tp->t_rttvar += delta) <= 0) {
                        tp->t_rttvar = 1;
-               if (tp->t_rttbest == 0  ||
-                       tp->t_rttbest > (tp->t_srtt + tp->t_rttvar))
+               }
+               if (tp->t_rttbest == 0 ||
+                   tp->t_rttbest > (tp->t_srtt + tp->t_rttvar)) {
                        tp->t_rttbest = tp->t_srtt + tp->t_rttvar;
+               }
        } else {
                /*
                 * No rtt measurement yet - use the unsmoothed rtt.
@@ -5503,7 +6121,7 @@ tcp_xmit_timer(struct tcpcb *tp, int rtt,
 
 compute_rto:
        nstat_route_rtt(tp->t_inpcb->inp_route.ro_rt, tp->t_srtt,
-               tp->t_rttvar);
+           tp->t_rttvar);
 
        /*
         * the retransmit should happen at rtt + 4 * rttvar.
@@ -5517,8 +6135,8 @@ compute_rto:
         * the minimum feasible timer (which is 2 ticks).
         */
        TCPT_RANGESET(tp->t_rxtcur, TCP_REXMTVAL(tp),
-               max(tp->t_rttmin, rtt + 2), TCPTV_REXMTMAX,
-               TCP_ADD_REXMTSLOP(tp));
+           max(tp->t_rttmin, rtt + 2), TCPTV_REXMTMAX,
+           TCP_ADD_REXMTSLOP(tp));
 
        /*
         * We received an ack for a packet that wasn't retransmitted;
@@ -5528,20 +6146,37 @@ compute_rto:
         * and the return path might not be symmetrical).
         */
        tp->t_softerror = 0;
+
+       if (log_rtt) {
+               TCP_LOG_RTT_INFO(tp);
+       }
+
+       TCP_LOG_RTT_CHANGE(tp, old_srtt, old_rttvar);
 }
 
 static inline unsigned int
 tcp_maxmtu(struct rtentry *rt)
 {
        unsigned int maxmtu;
+       int interface_mtu = 0;
 
        RT_LOCK_ASSERT_HELD(rt);
-       if (rt->rt_rmx.rmx_mtu == 0)
-               maxmtu = rt->rt_ifp->if_mtu;
-       else
-               maxmtu = MIN(rt->rt_rmx.rmx_mtu, rt->rt_ifp->if_mtu);
+       interface_mtu = rt->rt_ifp->if_mtu;
+
+       if (rt_key(rt)->sa_family == AF_INET &&
+           INTF_ADJUST_MTU_FOR_CLAT46(rt->rt_ifp)) {
+               interface_mtu = IN6_LINKMTU(rt->rt_ifp);
+               /* Further adjust the size for CLAT46 expansion */
+               interface_mtu -= CLAT46_HDR_EXPANSION_OVERHD;
+       }
+
+       if (rt->rt_rmx.rmx_mtu == 0) {
+               maxmtu = interface_mtu;
+       } else {
+               maxmtu = MIN(rt->rt_rmx.rmx_mtu, interface_mtu);
+       }
 
-       return (maxmtu);
+       return maxmtu;
 }
 
 #if INET6
@@ -5552,21 +6187,45 @@ tcp_maxmtu6(struct rtentry *rt)
        struct nd_ifinfo *ndi = NULL;
 
        RT_LOCK_ASSERT_HELD(rt);
-       if ((ndi = ND_IFINFO(rt->rt_ifp)) != NULL && !ndi->initialized)
+       if ((ndi = ND_IFINFO(rt->rt_ifp)) != NULL && !ndi->initialized) {
                ndi = NULL;
-       if (ndi != NULL)
+       }
+       if (ndi != NULL) {
                lck_mtx_lock(&ndi->lock);
-       if (rt->rt_rmx.rmx_mtu == 0)
+       }
+       if (rt->rt_rmx.rmx_mtu == 0) {
                maxmtu = IN6_LINKMTU(rt->rt_ifp);
-       else
+       } else {
                maxmtu = MIN(rt->rt_rmx.rmx_mtu, IN6_LINKMTU(rt->rt_ifp));
-       if (ndi != NULL)
+       }
+       if (ndi != NULL) {
                lck_mtx_unlock(&ndi->lock);
+       }
 
-       return (maxmtu);
+       return maxmtu;
 }
 #endif
 
+unsigned int
+get_maxmtu(struct rtentry *rt)
+{
+       unsigned int maxmtu = 0;
+
+       RT_LOCK_ASSERT_NOTHELD(rt);
+
+       RT_LOCK(rt);
+
+       if (rt_key(rt)->sa_family == AF_INET6) {
+               maxmtu = tcp_maxmtu6(rt);
+       } else {
+               maxmtu = tcp_maxmtu(rt);
+       }
+
+       RT_UNLOCK(rt);
+
+       return maxmtu;
+}
+
 /*
  * Determine a reasonable value for maxseg size.
  * If the route is known, check route for mtu.
@@ -5611,10 +6270,19 @@ tcp_mss(struct tcpcb *tp, int offer, unsigned int input_ifscope)
 #endif
 
        inp = tp->t_inpcb;
+
+       so = inp->inp_socket;
+       /*
+        * Nothing left to send after the socket is defunct or TCP is in the closed state
+        */
+       if ((so->so_state & SS_DEFUNCT) || tp->t_state == TCPS_CLOSED) {
+               return;
+       }
+
 #if INET6
        isipv6 = ((inp->inp_vflag & INP_IPV6) != 0) ? 1 : 0;
-       min_protoh = isipv6 ? sizeof (struct ip6_hdr) + sizeof (struct tcphdr)
-                           : sizeof (struct tcpiphdr);
+       min_protoh = isipv6 ? sizeof(struct ip6_hdr) + sizeof(struct tcphdr)
+           : sizeof(struct tcpiphdr);
 #else
 #define min_protoh  (sizeof (struct tcpiphdr))
 #endif
@@ -5622,8 +6290,7 @@ tcp_mss(struct tcpcb *tp, int offer, unsigned int input_ifscope)
 #if INET6
        if (isipv6) {
                rt = tcp_rtlookup6(inp, input_ifscope);
-       }
-       else
+       } else
 #endif /* INET6 */
        {
                rt = tcp_rtlookup(inp, input_ifscope);
@@ -5633,9 +6300,9 @@ tcp_mss(struct tcpcb *tp, int offer, unsigned int input_ifscope)
        if (rt == NULL) {
                tp->t_maxopd = tp->t_maxseg =
 #if INET6
-               isipv6 ? tcp_v6mssdflt :
+                   isipv6 ? tcp_v6mssdflt :
 #endif /* INET6 */
-               tcp_mssdflt;
+                   tcp_mssdflt;
                return;
        }
        ifp = rt->rt_ifp;
@@ -5650,26 +6317,26 @@ tcp_mss(struct tcpcb *tp, int offer, unsigned int input_ifscope)
            ifp->if_baudrate > 9600 && ifp->if_baudrate <= 128000) {
                tp->t_flags |= TF_SLOWLINK;
        }
-       so = inp->inp_socket;
 
        taop = rmx_taop(rt->rt_rmx);
        /*
         * Offer == -1 means that we didn't receive SYN yet,
         * use cached value in that case;
         */
-       if (offer == -1)
+       if (offer == -1) {
                offer = taop->tao_mssopt;
+       }
        /*
         * Offer == 0 means that there was no MSS on the SYN segment,
         * in this case we use tcp_mssdflt.
         */
-       if (offer == 0)
+       if (offer == 0) {
                offer =
 #if INET6
-                       isipv6 ? tcp_v6mssdflt :
+                   isipv6 ? tcp_v6mssdflt :
 #endif /* INET6 */
-                       tcp_mssdflt;
-       else {
+                   tcp_mssdflt;
+       else {
                /*
                 * Prevent DoS attack with too small MSS. Round up
                 * to at least minmss.
@@ -5712,12 +6379,14 @@ tcp_mss(struct tcpcb *tp, int offer, unsigned int input_ifscope)
        if (rt->rt_rmx.rmx_mtu == 0) {
 #if INET6
                if (isipv6) {
-                       if (!isnetlocal)
+                       if (!isnetlocal) {
                                mss = min(mss, tcp_v6mssdflt);
+                       }
                } else
 #endif /* INET6 */
-               if (!isnetlocal)
+               if (!isnetlocal) {
                        mss = min(mss, tcp_mssdflt);
+               }
        }
 
        mss = min(mss, offer);
@@ -5734,10 +6403,11 @@ tcp_mss(struct tcpcb *tp, int offer, unsigned int input_ifscope)
         * origoffer==-1 indicates, that no segments were received yet.
         * In this case we just guess.
         */
-       if ((tp->t_flags & (TF_REQ_TSTMP|TF_NOOPT)) == TF_REQ_TSTMP &&
+       if ((tp->t_flags & (TF_REQ_TSTMP | TF_NOOPT)) == TF_REQ_TSTMP &&
            (origoffer == -1 ||
-            (tp->t_flags & TF_RCVD_TSTMP) == TF_RCVD_TSTMP))
+           (tp->t_flags & TF_RCVD_TSTMP) == TF_RCVD_TSTMP)) {
                mss -= TCPOLEN_TSTAMP_APPA;
+       }
 
 #if MPTCP
        mss -= mptcp_adj_mss(tp, FALSE);
@@ -5761,17 +6431,20 @@ tcp_mss(struct tcpcb *tp, int offer, unsigned int input_ifscope)
        bufsize = rt->rt_rmx.rmx_sendpipe;
        if (bufsize < so->so_snd.sb_hiwat)
 #endif
-               bufsize = so->so_snd.sb_hiwat;
-       if (bufsize < mss)
+       bufsize = so->so_snd.sb_hiwat;
+       if (bufsize < mss) {
                mss = bufsize;
-       else {
+       else {
                bufsize = (((bufsize + (u_int64_t)mss - 1) / (u_int64_t)mss) * (u_int64_t)mss);
-               if (bufsize > sb_max_corrected)
+               if (bufsize > sb_max_corrected) {
                        bufsize = sb_max_corrected;
+               }
                (void)sbreserve(&so->so_snd, bufsize);
        }
        tp->t_maxseg = mss;
 
+       ASSERT(tp->t_maxseg);
+
        /*
         * Update MSS using recommendation from link status report. This is
         * temporary
@@ -5782,11 +6455,12 @@ tcp_mss(struct tcpcb *tp, int offer, unsigned int input_ifscope)
        bufsize = rt->rt_rmx.rmx_recvpipe;
        if (bufsize < so->so_rcv.sb_hiwat)
 #endif
-               bufsize = so->so_rcv.sb_hiwat;
+       bufsize = so->so_rcv.sb_hiwat;
        if (bufsize > mss) {
                bufsize = (((bufsize + (u_int64_t)mss - 1) / (u_int64_t)mss) * (u_int64_t)mss);
-               if (bufsize > sb_max_corrected)
+               if (bufsize > sb_max_corrected) {
                        bufsize = sb_max_corrected;
+               }
                (void)sbreserve(&so->so_rcv, bufsize);
        }
 
@@ -5809,8 +6483,9 @@ tcp_mss(struct tcpcb *tp, int offer, unsigned int input_ifscope)
         * Set the slow-start flight size depending on whether this
         * is a local network or not.
         */
-       if (CC_ALGO(tp)->cwnd_init != NULL)
+       if (CC_ALGO(tp)->cwnd_init != NULL) {
                CC_ALGO(tp)->cwnd_init(tp);
+       }
 
        tcp_ccdbg_trace(tp, NULL, TCP_CC_CWND_INIT);
 
@@ -5833,24 +6508,24 @@ tcp_mssopt(struct tcpcb *tp)
 
 #if INET6
        isipv6 = ((tp->t_inpcb->inp_vflag & INP_IPV6) != 0) ? 1 : 0;
-       min_protoh = isipv6 ? sizeof (struct ip6_hdr) + sizeof (struct tcphdr)
-                           : sizeof (struct tcpiphdr);
+       min_protoh = isipv6 ? sizeof(struct ip6_hdr) + sizeof(struct tcphdr)
+           : sizeof(struct tcpiphdr);
 #else
 #define min_protoh  (sizeof (struct tcpiphdr))
 #endif
 
 #if INET6
-       if (isipv6)
+       if (isipv6) {
                rt = tcp_rtlookup6(tp->t_inpcb, IFSCOPE_NONE);
-       else
+       else
 #endif /* INET6 */
        rt = tcp_rtlookup(tp->t_inpcb, IFSCOPE_NONE);
        if (rt == NULL) {
-               return (
+               return
 #if INET6
-                       isipv6 ? tcp_v6mssdflt :
+                       isipv6 ? tcp_v6mssdflt :
 #endif /* INET6 */
-                       tcp_mssdflt);
+                       tcp_mssdflt;
        }
        /*
         * Slower link window correction:
@@ -5876,7 +6551,7 @@ tcp_mssopt(struct tcpcb *tp)
        mss = necp_socket_get_effective_mtu(tp->t_inpcb, mss);
 #endif /* NECP */
 
-       return (mss - min_protoh);
+       return mss - min_protoh;
 }
 
 /*
@@ -5888,32 +6563,34 @@ tcp_mssopt(struct tcpcb *tp)
 static void
 tcp_newreno_partial_ack(struct tcpcb *tp, struct tcphdr *th)
 {
-               tcp_seq onxt = tp->snd_nxt;
-               u_int32_t  ocwnd = tp->snd_cwnd;
-               tp->t_timer[TCPT_REXMT] = 0;
-               tp->t_timer[TCPT_PTO] = 0;
-               tp->t_rtttime = 0;
-               tp->snd_nxt = th->th_ack;
-               /*
-                * Set snd_cwnd to one segment beyond acknowledged offset
-                * (tp->snd_una has not yet been updated when this function
-                *  is called)
-                */
-               tp->snd_cwnd = tp->t_maxseg + BYTES_ACKED(th, tp);
-               tp->t_flags |= TF_ACKNOW;
-               (void) tcp_output(tp);
-               tp->snd_cwnd = ocwnd;
-               if (SEQ_GT(onxt, tp->snd_nxt))
-                       tp->snd_nxt = onxt;
-               /*
-                * Partial window deflation.  Relies on fact that tp->snd_una
-                * not updated yet.
-                */
-               if (tp->snd_cwnd > BYTES_ACKED(th, tp))
-                       tp->snd_cwnd -= BYTES_ACKED(th, tp);
-               else
-                       tp->snd_cwnd = 0;
-               tp->snd_cwnd += tp->t_maxseg;
+       tcp_seq onxt = tp->snd_nxt;
+       u_int32_t  ocwnd = tp->snd_cwnd;
+       tp->t_timer[TCPT_REXMT] = 0;
+       tp->t_timer[TCPT_PTO] = 0;
+       tp->t_rtttime = 0;
+       tp->snd_nxt = th->th_ack;
+       /*
+        * Set snd_cwnd to one segment beyond acknowledged offset
+        * (tp->snd_una has not yet been updated when this function
+        *  is called)
+        */
+       tp->snd_cwnd = tp->t_maxseg + BYTES_ACKED(th, tp);
+       tp->t_flags |= TF_ACKNOW;
+       (void) tcp_output(tp);
+       tp->snd_cwnd = ocwnd;
+       if (SEQ_GT(onxt, tp->snd_nxt)) {
+               tp->snd_nxt = onxt;
+       }
+       /*
+        * Partial window deflation.  Relies on fact that tp->snd_una
+        * not updated yet.
+        */
+       if (tp->snd_cwnd > BYTES_ACKED(th, tp)) {
+               tp->snd_cwnd -= BYTES_ACKED(th, tp);
+       } else {
+               tp->snd_cwnd = 0;
+       }
+       tp->snd_cwnd += tp->t_maxseg;
 }
 
 /*
@@ -5937,14 +6614,16 @@ tcp_dropdropablreq(struct socket *head)
        struct inpcb *inp = NULL;
        struct tcpcb *tp;
 
-       if ((head->so_options & SO_ACCEPTCONN) == 0)
-               return (0);
+       if ((head->so_options & SO_ACCEPTCONN) == 0) {
+               return 0;
+       }
 
-       if (TAILQ_EMPTY(&head->so_incomp))
-               return (0);
+       if (TAILQ_EMPTY(&head->so_incomp)) {
+               return 0;
+       }
 
        so_acquire_accept_list(head, NULL);
-       socket_unlock(head, NULL);
+       socket_unlock(head, 0);
 
        /*
         * Check if there is any socket in the incomp queue
@@ -5957,15 +6636,15 @@ tcp_dropdropablreq(struct socket *head)
                tp = intotcpcb(inp);
                if (tp != NULL && tp->t_state == TCPS_CLOSED &&
                    so->so_head != NULL &&
-                   (so->so_state & (SS_INCOMP|SS_CANTSENDMORE|SS_CANTRCVMORE)) ==
-                   (SS_INCOMP|SS_CANTSENDMORE|SS_CANTRCVMORE)) {
+                   (so->so_state & (SS_INCOMP | SS_CANTSENDMORE | SS_CANTRCVMORE)) ==
+                   (SS_INCOMP | SS_CANTSENDMORE | SS_CANTRCVMORE)) {
                        /*
                         * The listen socket is already locked but we
                         * can lock this socket here without lock ordering
                         * issues because it is in the incomp queue and
                         * is not visible to others.
                         */
-                       if (lck_mtx_try_lock(&inp->inpcb_mtx)) {
+                       if (socket_try_lock(so)) {
                                so->so_usecount++;
                                goto found_victim;
                        } else {
@@ -5984,15 +6663,17 @@ tcp_dropdropablreq(struct socket *head)
        }
 
        qlen = head->so_incqlen;
-       if (rnd == 0)
+       if (rnd == 0) {
                rnd = RandomULong();
+       }
 
        if (++cur_cnt > qlen || old_cnt > qlen) {
                rnd = (314159 * rnd + 66329) & 0xffff;
                j = ((qlen + 1) * rnd) >> 16;
 
-               while (j-- && so)
+               while (j-- && so) {
                        so = TAILQ_NEXT(so, so_list);
+               }
        }
        /* Find a connection that is not already closing (or being served) */
        while (so) {
@@ -6000,8 +6681,7 @@ tcp_dropdropablreq(struct socket *head)
 
                sonext = TAILQ_NEXT(so, so_list);
 
-               if (in_pcb_checkstate(inp, WNT_ACQUIRE, 0)
-                       != WNT_STOPUSING) {
+               if (in_pcb_checkstate(inp, WNT_ACQUIRE, 0) != WNT_STOPUSING) {
                        /*
                         * Avoid the issue of a socket being accepted
                         * by one input thread and being dropped by
@@ -6009,11 +6689,11 @@ tcp_dropdropablreq(struct socket *head)
                         * on this mutex, then grab the next socket in
                         * line.
                         */
-                       if (lck_mtx_try_lock(&inp->inpcb_mtx)) {
+                       if (socket_try_lock(so)) {
                                so->so_usecount++;
                                if ((so->so_usecount == 2) &&
                                    (so->so_state & SS_INCOMP) &&
-                                   !(so->so_flags & SOF_INCOMP_INPROGRESS))  {
+                                   !(so->so_flags & SOF_INCOMP_INPROGRESS)) {
                                        break;
                                } else {
                                        /*
@@ -6021,7 +6701,7 @@ tcp_dropdropablreq(struct socket *head)
                                         * used in any other way
                                         */
                                        in_pcb_checkstate(inp, WNT_RELEASE, 1);
-                                       tcp_unlock(so, 1, 0);
+                                       socket_unlock(so, 1);
                                }
                        } else {
                                /*
@@ -6038,25 +6718,25 @@ tcp_dropdropablreq(struct socket *head)
        if (so == NULL) {
                socket_lock(head, 0);
                so_release_accept_list(head);
-               return (0);
+               return 0;
        }
 
        /* Makes sure socket is still in the right state to be discarded */
 
        if (in_pcb_checkstate(inp, WNT_RELEASE, 1) == WNT_STOPUSING) {
-               tcp_unlock(so, 1, 0);
+               socket_unlock(so, 1);
                socket_lock(head, 0);
                so_release_accept_list(head);
-               return (0);
+               return 0;
        }
 
 found_victim:
        if (so->so_usecount != 2 || !(so->so_state & SS_INCOMP)) {
                /* do not discard: that socket is being accepted */
-               tcp_unlock(so, 1, 0);
+               socket_unlock(so, 1);
                socket_lock(head, 0);
                so_release_accept_list(head);
-               return (0);
+               return 0;
        }
 
        socket_lock(head, 0);
@@ -6067,9 +6747,9 @@ found_victim:
        so->so_flags |= SOF_OVERFLOW;
        so->so_head = NULL;
        so_release_accept_list(head);
-       tcp_unlock(head, 0, 0);
+       socket_unlock(head, 0);
 
-       lck_mtx_assert(&inp->inpcb_mtx, LCK_MTX_ASSERT_OWNED);
+       socket_lock_assert_owned(so);
        tp = sototcpcb(so);
 
        tcp_close(tp);
@@ -6083,18 +6763,18 @@ found_victim:
                 */
                VERIFY(so->so_usecount > 0);
                so->so_usecount--;
-               tcp_unlock(so, 1, 0);
+               socket_unlock(so, 1);
        } else {
                /*
                 * Unlock this socket and leave the reference on.
                 * We need to acquire the pcbinfo lock in order to
                 * fully dispose it off
                 */
-               tcp_unlock(so, 0, 0);
+               socket_unlock(so, 0);
 
                lck_rw_lock_exclusive(tcbinfo.ipi_lock);
 
-               tcp_lock(so, 0, 0);
+               socket_lock(so, 0);
                /* Release the reference held for so_incomp queue */
                VERIFY(so->so_usecount > 0);
                so->so_usecount--;
@@ -6108,7 +6788,7 @@ found_victim:
                         * was unlocked. This socket will have to be
                         * garbage collected later
                         */
-                       tcp_unlock(so, 1, 0);
+                       socket_unlock(so, 1);
                } else {
                        /* Drop the reference held for this function */
                        VERIFY(so->so_usecount > 0);
@@ -6120,8 +6800,8 @@ found_victim:
        }
        tcpstat.tcps_drops++;
 
-       tcp_lock(head, 0, 0);
-       return(1);
+       socket_lock(head, 0);
+       return 1;
 }
 
 /* Set background congestion control on a socket */
@@ -6135,10 +6815,11 @@ tcp_set_background_cc(struct socket *so)
 void
 tcp_set_foreground_cc(struct socket *so)
 {
-       if (tcp_use_newreno)
+       if (tcp_use_newreno) {
                tcp_set_new_cc(so, TCP_CC_ALGO_NEWRENO_INDEX);
-       else
+       } else {
                tcp_set_new_cc(so, TCP_CC_ALGO_CUBIC_INDEX);
+       }
 }
 
 static void
@@ -6148,17 +6829,18 @@ tcp_set_new_cc(struct socket *so, uint16_t cc_index)
        struct tcpcb *tp = intotcpcb(inp);
        u_char old_cc_index = 0;
        if (tp->tcp_cc_index != cc_index) {
-
                old_cc_index = tp->tcp_cc_index;
 
-               if (CC_ALGO(tp)->cleanup != NULL)
+               if (CC_ALGO(tp)->cleanup != NULL) {
                        CC_ALGO(tp)->cleanup(tp);
+               }
                tp->tcp_cc_index = cc_index;
 
                tcp_cc_allocate_state(tp);
 
-               if (CC_ALGO(tp)->switch_to != NULL)
+               if (CC_ALGO(tp)->switch_to != NULL) {
                        CC_ALGO(tp)->switch_to(tp, old_cc_index);
+               }
 
                tcp_ccdbg_trace(tp, NULL, TCP_CC_CHANGE_ALGO);
        }
@@ -6167,8 +6849,9 @@ tcp_set_new_cc(struct socket *so, uint16_t cc_index)
 void
 tcp_set_recv_bg(struct socket *so)
 {
-       if (!IS_TCP_RECV_BG(so))
+       if (!IS_TCP_RECV_BG(so)) {
                so->so_flags1 |= SOF1_TRAFFIC_MGT_TCP_RECVBG;
+       }
 
        /* Unset Large Receive Offload on background sockets */
        so_set_lro(so, SO_TC_BK);
@@ -6177,8 +6860,9 @@ tcp_set_recv_bg(struct socket *so)
 void
 tcp_clear_recv_bg(struct socket *so)
 {
-       if (IS_TCP_RECV_BG(so))
+       if (IS_TCP_RECV_BG(so)) {
                so->so_flags1 &= ~(SOF1_TRAFFIC_MGT_TCP_RECVBG);
+       }
 
        /*
         * Set/unset use of Large Receive Offload depending on
@@ -6195,8 +6879,9 @@ inp_fc_unthrottle_tcp(struct inpcb *inp)
         * Back off the slow-start threshold and enter
         * congestion avoidance phase
         */
-       if (CC_ALGO(tp)->pre_fr != NULL)
+       if (CC_ALGO(tp)->pre_fr != NULL) {
                CC_ALGO(tp)->pre_fr(tp);
+       }
 
        tp->snd_cwnd = tp->snd_ssthresh;
        tp->t_flagsext &= ~TF_CWND_NONVALIDATED;
@@ -6227,50 +6912,26 @@ tcp_getstat SYSCTL_HANDLER_ARGS
 #pragma unused(oidp, arg1, arg2)
 
        int error;
+       struct tcpstat *stat;
+       stat = &tcpstat;
+#if !CONFIG_EMBEDDED
+       struct tcpstat zero_stat;
+
+       if (tcp_disable_access_to_stats &&
+           !kauth_cred_issuser(kauth_cred_get())) {
+               bzero(&zero_stat, sizeof(zero_stat));
+               stat = &zero_stat;
+       }
 
-       proc_t caller = PROC_NULL;
-       proc_t caller_parent = PROC_NULL;
-       char command_name[MAXCOMLEN + 1] = "";
-       char parent_name[MAXCOMLEN + 1] = "";
-
-       if ((caller = proc_self()) != PROC_NULL) {
-               /* get process name */
-               strlcpy(command_name, caller->p_comm, sizeof(command_name));
-
-               /* get parent process name if possible */
-               if ((caller_parent = proc_find(caller->p_ppid)) != PROC_NULL) {
-                       strlcpy(parent_name, caller_parent->p_comm,
-                           sizeof(parent_name));
-                       proc_rele(caller_parent);
-               }
-
-               if ((escape_str(command_name, strlen(command_name),
-                   sizeof(command_name)) == 0) &&
-                   (escape_str(parent_name, strlen(parent_name),
-                   sizeof(parent_name)) == 0)) {
-                       kern_asl_msg(LOG_DEBUG, "messagetracer",
-                           5,
-                           "com.apple.message.domain",
-                           "com.apple.kernel.tcpstat", /* 1 */
-                           "com.apple.message.signature",
-                           "tcpstat", /* 2 */
-                           "com.apple.message.signature2", command_name, /* 3 */
-                           "com.apple.message.signature3", parent_name, /* 4 */
-                           "com.apple.message.summarize", "YES", /* 5 */
-                           NULL);
-               }
-       }
-       if (caller != PROC_NULL)
-               proc_rele(caller);
+#endif /* !CONFIG_EMBEDDED */
 
        if (req->oldptr == 0) {
-               req->oldlen= (size_t)sizeof(struct tcpstat);
+               req->oldlen = (size_t)sizeof(struct tcpstat);
        }
 
-       error = SYSCTL_OUT(req, &tcpstat, MIN(sizeof (tcpstat), req->oldlen));
-
-        return (error);
+       error = SYSCTL_OUT(req, stat, MIN(sizeof(tcpstat), req->oldlen));
 
+       return error;
 }
 
 /*
@@ -6286,8 +6947,12 @@ tcp_input_checksum(int af, struct mbuf *m, struct tcphdr *th, int off, int tlen)
                struct ip *ip = mtod(m, struct ip *);
                struct ipovly *ipov = (struct ipovly *)ip;
 
-               if (m->m_pkthdr.pkt_flags & PKTF_SW_LRO_DID_CSUM)
-                       return (0);
+               if (m->m_pkthdr.pkt_flags & PKTF_SW_LRO_DID_CSUM) {
+                       return 0;
+               }
+
+               /* ip_stripoptions() must have been called before we get here */
+               ASSERT((ip->ip_hl << 2) == sizeof(*ip));
 
                if ((hwcksum_rx || (ifp->if_flags & IFF_LOOPBACK) ||
                    (m->m_pkthdr.pkt_flags & PKTF_LOOP)) &&
@@ -6295,33 +6960,59 @@ tcp_input_checksum(int af, struct mbuf *m, struct tcphdr *th, int off, int tlen)
                        if (m->m_pkthdr.csum_flags & CSUM_PSEUDO_HDR) {
                                th->th_sum = m->m_pkthdr.csum_rx_val;
                        } else {
-                               uint16_t sum = m->m_pkthdr.csum_rx_val;
-                               uint16_t start = m->m_pkthdr.csum_rx_start;
+                               uint32_t sum = m->m_pkthdr.csum_rx_val;
+                               uint32_t start = m->m_pkthdr.csum_rx_start;
+                               int32_t trailer = (m_pktlen(m) - (off + tlen));
 
                                /*
                                 * Perform 1's complement adjustment of octets
                                 * that got included/excluded in the hardware-
                                 * calculated checksum value.  Ignore cases
-                                * where the value includes or excludes the IP
-                                * header span, as the sum for those octets
-                                * would already be 0xffff and thus no-op.
+                                * where the value already includes the entire
+                                * IP header span, as the sum for those octets
+                                * would already be 0 by the time we get here;
+                                * IP has already performed its header checksum
+                                * checks.  If we do need to adjust, restore
+                                * the original fields in the IP header when
+                                * computing the adjustment value.  Also take
+                                * care of any trailing bytes and subtract out
+                                * their partial sum.
                                 */
+                               ASSERT(trailer >= 0);
                                if ((m->m_pkthdr.csum_flags & CSUM_PARTIAL) &&
-                                   start != 0 && (off - start) != off) {
-#if BYTE_ORDER != BIG_ENDIAN
+                                   ((start != 0 && start != off) || trailer)) {
+                                       uint32_t swbytes = (uint32_t)trailer;
+
                                        if (start < off) {
+                                               ip->ip_len += sizeof(*ip);
+#if BYTE_ORDER != BIG_ENDIAN
                                                HTONS(ip->ip_len);
                                                HTONS(ip->ip_off);
+#endif /* BYTE_ORDER != BIG_ENDIAN */
                                        }
-#endif
                                        /* callee folds in sum */
-                                       sum = m_adj_sum16(m, start, off, sum);
-#if BYTE_ORDER != BIG_ENDIAN
+                                       sum = m_adj_sum16(m, start, off,
+                                           tlen, sum);
+                                       if (off > start) {
+                                               swbytes += (off - start);
+                                       } else {
+                                               swbytes += (start - off);
+                                       }
+
                                        if (start < off) {
+#if BYTE_ORDER != BIG_ENDIAN
                                                NTOHS(ip->ip_off);
                                                NTOHS(ip->ip_len);
+#endif /* BYTE_ORDER != BIG_ENDIAN */
+                                               ip->ip_len -= sizeof(*ip);
+                                       }
+
+                                       if (swbytes != 0) {
+                                               tcp_in_cksum_stats(swbytes);
+                                       }
+                                       if (trailer != 0) {
+                                               m_adj(m, -trailer);
                                        }
-#endif
                                }
 
                                /* callee folds in sum */
@@ -6335,16 +7026,16 @@ tcp_input_checksum(int af, struct mbuf *m, struct tcphdr *th, int off, int tlen)
                        int len;
                        char b[9];
 
-                       bcopy(ipov->ih_x1, b, sizeof (ipov->ih_x1));
-                       bzero(ipov->ih_x1, sizeof (ipov->ih_x1));
+                       bcopy(ipov->ih_x1, b, sizeof(ipov->ih_x1));
+                       bzero(ipov->ih_x1, sizeof(ipov->ih_x1));
                        ip_sum = ipov->ih_len;
                        ipov->ih_len = (u_short)tlen;
 #if BYTE_ORDER != BIG_ENDIAN
                        HTONS(ipov->ih_len);
 #endif
-                       len = sizeof (struct ip) + tlen;
+                       len = sizeof(struct ip) + tlen;
                        th->th_sum = in_cksum(m, len);
-                       bcopy(b, ipov->ih_x1, sizeof (ipov->ih_x1));
+                       bcopy(b, ipov->ih_x1, sizeof(ipov->ih_x1));
                        ipov->ih_len = ip_sum;
 
                        tcp_in_cksum_stats(len);
@@ -6355,8 +7046,9 @@ tcp_input_checksum(int af, struct mbuf *m, struct tcphdr *th, int off, int tlen)
        case AF_INET6: {
                struct ip6_hdr *ip6 = mtod(m, struct ip6_hdr *);
 
-               if (m->m_pkthdr.pkt_flags & PKTF_SW_LRO_DID_CSUM)
-                       return (0);
+               if (m->m_pkthdr.pkt_flags & PKTF_SW_LRO_DID_CSUM) {
+                       return 0;
+               }
 
                if ((hwcksum_rx || (ifp->if_flags & IFF_LOOPBACK) ||
                    (m->m_pkthdr.pkt_flags & PKTF_LOOP)) &&
@@ -6364,21 +7056,26 @@ tcp_input_checksum(int af, struct mbuf *m, struct tcphdr *th, int off, int tlen)
                        if (m->m_pkthdr.csum_flags & CSUM_PSEUDO_HDR) {
                                th->th_sum = m->m_pkthdr.csum_rx_val;
                        } else {
-                               uint16_t sum = m->m_pkthdr.csum_rx_val;
-                               uint16_t start = m->m_pkthdr.csum_rx_start;
+                               uint32_t sum = m->m_pkthdr.csum_rx_val;
+                               uint32_t start = m->m_pkthdr.csum_rx_start;
+                               int32_t trailer = (m_pktlen(m) - (off + tlen));
 
                                /*
                                 * Perform 1's complement adjustment of octets
                                 * that got included/excluded in the hardware-
-                                * calculated checksum value.
+                                * calculated checksum value.  Also take care
+                                * of any trailing bytes and subtract out their
+                                * partial sum.
                                 */
+                               ASSERT(trailer >= 0);
                                if ((m->m_pkthdr.csum_flags & CSUM_PARTIAL) &&
-                                   start != off) {
-                                       uint16_t s, d;
+                                   (start != off || trailer != 0)) {
+                                       uint16_t s = 0, d = 0;
+                                       uint32_t swbytes = (uint32_t)trailer;
 
                                        if (IN6_IS_SCOPE_EMBED(&ip6->ip6_src)) {
                                                s = ip6->ip6_src.s6_addr16[1];
-                                               ip6->ip6_src.s6_addr16[1] = 0 ;
+                                               ip6->ip6_src.s6_addr16[1] = 0;
                                        }
                                        if (IN6_IS_SCOPE_EMBED(&ip6->ip6_dst)) {
                                                d = ip6->ip6_dst.s6_addr16[1];
@@ -6386,17 +7083,32 @@ tcp_input_checksum(int af, struct mbuf *m, struct tcphdr *th, int off, int tlen)
                                        }
 
                                        /* callee folds in sum */
-                                       sum = m_adj_sum16(m, start, off, sum);
+                                       sum = m_adj_sum16(m, start, off,
+                                           tlen, sum);
+                                       if (off > start) {
+                                               swbytes += (off - start);
+                                       } else {
+                                               swbytes += (start - off);
+                                       }
 
-                                       if (IN6_IS_SCOPE_EMBED(&ip6->ip6_src))
+                                       if (IN6_IS_SCOPE_EMBED(&ip6->ip6_src)) {
                                                ip6->ip6_src.s6_addr16[1] = s;
-                                       if (IN6_IS_SCOPE_EMBED(&ip6->ip6_dst))
+                                       }
+                                       if (IN6_IS_SCOPE_EMBED(&ip6->ip6_dst)) {
                                                ip6->ip6_dst.s6_addr16[1] = d;
+                                       }
+
+                                       if (swbytes != 0) {
+                                               tcp_in6_cksum_stats(swbytes);
+                                       }
+                                       if (trailer != 0) {
+                                               m_adj(m, -trailer);
+                                       }
                                }
 
                                th->th_sum = in6_pseudo(
-                                   &ip6->ip6_src, &ip6->ip6_dst,
-                                   sum + htonl(tlen + IPPROTO_TCP));
+                                       &ip6->ip6_src, &ip6->ip6_dst,
+                                       sum + htonl(tlen + IPPROTO_TCP));
                        }
                        th->th_sum ^= 0xffff;
                } else {
@@ -6414,12 +7126,13 @@ tcp_input_checksum(int af, struct mbuf *m, struct tcphdr *th, int off, int tlen)
        if (th->th_sum != 0) {
                tcpstat.tcps_rcvbadsum++;
                IF_TCP_STATINC(ifp, badformat);
-               return (-1);
+               return -1;
        }
 
-       return (0);
+       return 0;
 }
 
+
 SYSCTL_PROC(_net_inet_tcp, TCPCTL_STATS, stats,
     CTLTYPE_STRUCT | CTLFLAG_RD | CTLFLAG_LOCKED, 0, 0, tcp_getstat,
     "S,tcpstat", "TCP statistics (struct tcpstat, netinet/tcp_var.h)");
@@ -6432,8 +7145,9 @@ sysctl_rexmtthresh SYSCTL_HANDLER_ARGS
        int error, val = tcprexmtthresh;
 
        error = sysctl_handle_int(oidp, &val, 0, req);
-       if (error || !req->newptr)
-                return (error);
+       if (error || !req->newptr) {
+               return error;
+       }
 
        /*
         * Constrain the number of duplicate ACKs
@@ -6441,14 +7155,15 @@ sysctl_rexmtthresh SYSCTL_HANDLER_ARGS
         * to either 2 or 3
         */
 
-        if (val < 2 || val > 3)
-               return (EINVAL);
+       if (val < 2 || val > 3) {
+               return EINVAL;
+       }
 
-        tcprexmtthresh = val;
+       tcprexmtthresh = val;
 
-       return (0);
+       return 0;
 }
 
 SYSCTL_PROC(_net_inet_tcp, OID_AUTO, rexmt_thresh, CTLTYPE_INT | CTLFLAG_RW |
-       CTLFLAG_LOCKED, &tcprexmtthresh, 0, &sysctl_rexmtthresh, "I",
-       "Duplicate ACK Threshold for Fast Retransmit");
+    CTLFLAG_LOCKED, &tcprexmtthresh, 0, &sysctl_rexmtthresh, "I",
+    "Duplicate ACK Threshold for Fast Retransmit");