xref: /xnu-8020.121.3/bsd/net/classq/classq_fq_codel.c (revision fdd8201d7b966f0c3ea610489d29bd841d358941)
1*fdd8201dSApple OSS Distributions /*
2*fdd8201dSApple OSS Distributions  * Copyright (c) 2016-2021 Apple Inc. All rights reserved.
3*fdd8201dSApple OSS Distributions  *
4*fdd8201dSApple OSS Distributions  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
5*fdd8201dSApple OSS Distributions  *
6*fdd8201dSApple OSS Distributions  * This file contains Original Code and/or Modifications of Original Code
7*fdd8201dSApple OSS Distributions  * as defined in and that are subject to the Apple Public Source License
8*fdd8201dSApple OSS Distributions  * Version 2.0 (the 'License'). You may not use this file except in
9*fdd8201dSApple OSS Distributions  * compliance with the License. The rights granted to you under the License
10*fdd8201dSApple OSS Distributions  * may not be used to create, or enable the creation or redistribution of,
11*fdd8201dSApple OSS Distributions  * unlawful or unlicensed copies of an Apple operating system, or to
12*fdd8201dSApple OSS Distributions  * circumvent, violate, or enable the circumvention or violation of, any
13*fdd8201dSApple OSS Distributions  * terms of an Apple operating system software license agreement.
14*fdd8201dSApple OSS Distributions  *
15*fdd8201dSApple OSS Distributions  * Please obtain a copy of the License at
16*fdd8201dSApple OSS Distributions  * http://www.opensource.apple.com/apsl/ and read it before using this file.
17*fdd8201dSApple OSS Distributions  *
18*fdd8201dSApple OSS Distributions  * The Original Code and all software distributed under the License are
19*fdd8201dSApple OSS Distributions  * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
20*fdd8201dSApple OSS Distributions  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
21*fdd8201dSApple OSS Distributions  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
22*fdd8201dSApple OSS Distributions  * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
23*fdd8201dSApple OSS Distributions  * Please see the License for the specific language governing rights and
24*fdd8201dSApple OSS Distributions  * limitations under the License.
25*fdd8201dSApple OSS Distributions  *
26*fdd8201dSApple OSS Distributions  * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
27*fdd8201dSApple OSS Distributions  */
28*fdd8201dSApple OSS Distributions 
29*fdd8201dSApple OSS Distributions #include <sys/cdefs.h>
30*fdd8201dSApple OSS Distributions #include <sys/param.h>
31*fdd8201dSApple OSS Distributions #include <sys/mbuf.h>
32*fdd8201dSApple OSS Distributions #include <sys/socket.h>
33*fdd8201dSApple OSS Distributions #include <sys/sockio.h>
34*fdd8201dSApple OSS Distributions #include <sys/systm.h>
35*fdd8201dSApple OSS Distributions #include <sys/sysctl.h>
36*fdd8201dSApple OSS Distributions #include <sys/syslog.h>
37*fdd8201dSApple OSS Distributions #include <sys/proc.h>
38*fdd8201dSApple OSS Distributions #include <sys/errno.h>
39*fdd8201dSApple OSS Distributions #include <sys/kernel.h>
40*fdd8201dSApple OSS Distributions #include <sys/kauth.h>
41*fdd8201dSApple OSS Distributions #include <sys/sdt.h>
42*fdd8201dSApple OSS Distributions #include <kern/zalloc.h>
43*fdd8201dSApple OSS Distributions #include <netinet/in.h>
44*fdd8201dSApple OSS Distributions 
45*fdd8201dSApple OSS Distributions #include <net/classq/classq.h>
46*fdd8201dSApple OSS Distributions #include <net/classq/if_classq.h>
47*fdd8201dSApple OSS Distributions #include <net/pktsched/pktsched.h>
48*fdd8201dSApple OSS Distributions #include <net/pktsched/pktsched_fq_codel.h>
49*fdd8201dSApple OSS Distributions #include <net/classq/classq_fq_codel.h>
50*fdd8201dSApple OSS Distributions 
51*fdd8201dSApple OSS Distributions #include <netinet/tcp_var.h>
52*fdd8201dSApple OSS Distributions 
53*fdd8201dSApple OSS Distributions static uint32_t flowq_size;                     /* size of flowq */
54*fdd8201dSApple OSS Distributions static struct mcache *flowq_cache = NULL;       /* mcache for flowq */
55*fdd8201dSApple OSS Distributions 
56*fdd8201dSApple OSS Distributions #define FQ_ZONE_MAX     (32 * 1024)     /* across all interfaces */
57*fdd8201dSApple OSS Distributions 
58*fdd8201dSApple OSS Distributions #define DTYPE_NODROP    0       /* no drop */
59*fdd8201dSApple OSS Distributions #define DTYPE_FORCED    1       /* a "forced" drop */
60*fdd8201dSApple OSS Distributions #define DTYPE_EARLY     2       /* an "unforced" (early) drop */
61*fdd8201dSApple OSS Distributions 
62*fdd8201dSApple OSS Distributions void
fq_codel_init(void)63*fdd8201dSApple OSS Distributions fq_codel_init(void)
64*fdd8201dSApple OSS Distributions {
65*fdd8201dSApple OSS Distributions 	if (flowq_cache != NULL) {
66*fdd8201dSApple OSS Distributions 		return;
67*fdd8201dSApple OSS Distributions 	}
68*fdd8201dSApple OSS Distributions 
69*fdd8201dSApple OSS Distributions 	flowq_size = sizeof(fq_t);
70*fdd8201dSApple OSS Distributions 	flowq_cache = mcache_create("fq.flowq", flowq_size, sizeof(uint64_t),
71*fdd8201dSApple OSS Distributions 	    0, MCR_SLEEP);
72*fdd8201dSApple OSS Distributions 	if (flowq_cache == NULL) {
73*fdd8201dSApple OSS Distributions 		panic("%s: failed to allocate flowq_cache", __func__);
74*fdd8201dSApple OSS Distributions 		/* NOTREACHED */
75*fdd8201dSApple OSS Distributions 		__builtin_unreachable();
76*fdd8201dSApple OSS Distributions 	}
77*fdd8201dSApple OSS Distributions }
78*fdd8201dSApple OSS Distributions 
79*fdd8201dSApple OSS Distributions void
fq_codel_reap_caches(boolean_t purge)80*fdd8201dSApple OSS Distributions fq_codel_reap_caches(boolean_t purge)
81*fdd8201dSApple OSS Distributions {
82*fdd8201dSApple OSS Distributions 	mcache_reap_now(flowq_cache, purge);
83*fdd8201dSApple OSS Distributions }
84*fdd8201dSApple OSS Distributions 
85*fdd8201dSApple OSS Distributions fq_t *
fq_alloc(classq_pkt_type_t ptype)86*fdd8201dSApple OSS Distributions fq_alloc(classq_pkt_type_t ptype)
87*fdd8201dSApple OSS Distributions {
88*fdd8201dSApple OSS Distributions 	fq_t *fq = NULL;
89*fdd8201dSApple OSS Distributions 	fq = mcache_alloc(flowq_cache, MCR_SLEEP);
90*fdd8201dSApple OSS Distributions 	if (fq == NULL) {
91*fdd8201dSApple OSS Distributions 		log(LOG_ERR, "%s: unable to allocate from flowq_cache\n", __func__);
92*fdd8201dSApple OSS Distributions 		return NULL;
93*fdd8201dSApple OSS Distributions 	}
94*fdd8201dSApple OSS Distributions 
95*fdd8201dSApple OSS Distributions 	bzero(fq, flowq_size);
96*fdd8201dSApple OSS Distributions 	fq->fq_ptype = ptype;
97*fdd8201dSApple OSS Distributions 	if (ptype == QP_MBUF) {
98*fdd8201dSApple OSS Distributions 		MBUFQ_INIT(&fq->fq_mbufq);
99*fdd8201dSApple OSS Distributions 	}
100*fdd8201dSApple OSS Distributions #if SKYWALK
101*fdd8201dSApple OSS Distributions 	else {
102*fdd8201dSApple OSS Distributions 		VERIFY(ptype == QP_PACKET);
103*fdd8201dSApple OSS Distributions 		KPKTQ_INIT(&fq->fq_kpktq);
104*fdd8201dSApple OSS Distributions 	}
105*fdd8201dSApple OSS Distributions #endif /* SKYWALK */
106*fdd8201dSApple OSS Distributions 	CLASSQ_PKT_INIT(&fq->fq_dq_head);
107*fdd8201dSApple OSS Distributions 	CLASSQ_PKT_INIT(&fq->fq_dq_tail);
108*fdd8201dSApple OSS Distributions 	fq->fq_in_dqlist = false;
109*fdd8201dSApple OSS Distributions 	return fq;
110*fdd8201dSApple OSS Distributions }
111*fdd8201dSApple OSS Distributions 
112*fdd8201dSApple OSS Distributions void
fq_destroy(fq_t * fq)113*fdd8201dSApple OSS Distributions fq_destroy(fq_t *fq)
114*fdd8201dSApple OSS Distributions {
115*fdd8201dSApple OSS Distributions 	VERIFY(fq->fq_flags & FQF_DESTROYED);
116*fdd8201dSApple OSS Distributions 	VERIFY(fq_empty(fq));
117*fdd8201dSApple OSS Distributions 	VERIFY(!(fq->fq_flags & (FQF_NEW_FLOW | FQF_OLD_FLOW)));
118*fdd8201dSApple OSS Distributions 	VERIFY(fq->fq_bytes == 0);
119*fdd8201dSApple OSS Distributions 	mcache_free(flowq_cache, fq);
120*fdd8201dSApple OSS Distributions }
121*fdd8201dSApple OSS Distributions 
122*fdd8201dSApple OSS Distributions static inline void
fq_detect_dequeue_stall(fq_if_t * fqs,fq_t * flowq,fq_if_classq_t * fq_cl,u_int64_t * now)123*fdd8201dSApple OSS Distributions fq_detect_dequeue_stall(fq_if_t *fqs, fq_t *flowq, fq_if_classq_t *fq_cl,
124*fdd8201dSApple OSS Distributions     u_int64_t *now)
125*fdd8201dSApple OSS Distributions {
126*fdd8201dSApple OSS Distributions 	u_int64_t maxgetqtime;
127*fdd8201dSApple OSS Distributions 	if (FQ_IS_DELAYHIGH(flowq) || flowq->fq_getqtime == 0 ||
128*fdd8201dSApple OSS Distributions 	    fq_empty(flowq) ||
129*fdd8201dSApple OSS Distributions 	    flowq->fq_bytes < FQ_MIN_FC_THRESHOLD_BYTES) {
130*fdd8201dSApple OSS Distributions 		return;
131*fdd8201dSApple OSS Distributions 	}
132*fdd8201dSApple OSS Distributions 	maxgetqtime = flowq->fq_getqtime + fqs->fqs_update_interval;
133*fdd8201dSApple OSS Distributions 	if ((*now) > maxgetqtime) {
134*fdd8201dSApple OSS Distributions 		/*
135*fdd8201dSApple OSS Distributions 		 * there was no dequeue in an update interval worth of
136*fdd8201dSApple OSS Distributions 		 * time. It means that the queue is stalled.
137*fdd8201dSApple OSS Distributions 		 */
138*fdd8201dSApple OSS Distributions 		FQ_SET_DELAY_HIGH(flowq);
139*fdd8201dSApple OSS Distributions 		fq_cl->fcl_stat.fcl_dequeue_stall++;
140*fdd8201dSApple OSS Distributions 		os_log_error(OS_LOG_DEFAULT, "%s: dequeue stall num: %d, "
141*fdd8201dSApple OSS Distributions 		    "scidx: %d, flow: 0x%x, iface: %s", __func__,
142*fdd8201dSApple OSS Distributions 		    fq_cl->fcl_stat.fcl_dequeue_stall, flowq->fq_sc_index,
143*fdd8201dSApple OSS Distributions 		    flowq->fq_flowhash, if_name(fqs->fqs_ifq->ifcq_ifp));
144*fdd8201dSApple OSS Distributions 	}
145*fdd8201dSApple OSS Distributions }
146*fdd8201dSApple OSS Distributions 
147*fdd8201dSApple OSS Distributions void
fq_head_drop(fq_if_t * fqs,fq_t * fq)148*fdd8201dSApple OSS Distributions fq_head_drop(fq_if_t *fqs, fq_t *fq)
149*fdd8201dSApple OSS Distributions {
150*fdd8201dSApple OSS Distributions 	pktsched_pkt_t pkt;
151*fdd8201dSApple OSS Distributions 	volatile uint32_t *pkt_flags;
152*fdd8201dSApple OSS Distributions 	uint64_t *pkt_timestamp;
153*fdd8201dSApple OSS Distributions 	struct ifclassq *ifq = fqs->fqs_ifq;
154*fdd8201dSApple OSS Distributions 
155*fdd8201dSApple OSS Distributions 	_PKTSCHED_PKT_INIT(&pkt);
156*fdd8201dSApple OSS Distributions 	fq_getq_flow_internal(fqs, fq, &pkt);
157*fdd8201dSApple OSS Distributions 	if (pkt.pktsched_pkt_mbuf == NULL) {
158*fdd8201dSApple OSS Distributions 		return;
159*fdd8201dSApple OSS Distributions 	}
160*fdd8201dSApple OSS Distributions 
161*fdd8201dSApple OSS Distributions 	pktsched_get_pkt_vars(&pkt, &pkt_flags, &pkt_timestamp, NULL, NULL,
162*fdd8201dSApple OSS Distributions 	    NULL, NULL);
163*fdd8201dSApple OSS Distributions 
164*fdd8201dSApple OSS Distributions 	*pkt_timestamp = 0;
165*fdd8201dSApple OSS Distributions 	switch (pkt.pktsched_ptype) {
166*fdd8201dSApple OSS Distributions 	case QP_MBUF:
167*fdd8201dSApple OSS Distributions 		*pkt_flags &= ~PKTF_PRIV_GUARDED;
168*fdd8201dSApple OSS Distributions 		break;
169*fdd8201dSApple OSS Distributions #if SKYWALK
170*fdd8201dSApple OSS Distributions 	case QP_PACKET:
171*fdd8201dSApple OSS Distributions 		/* sanity check */
172*fdd8201dSApple OSS Distributions 		ASSERT((*pkt_flags & ~PKT_F_COMMON_MASK) == 0);
173*fdd8201dSApple OSS Distributions 		break;
174*fdd8201dSApple OSS Distributions #endif /* SKYWALK */
175*fdd8201dSApple OSS Distributions 	default:
176*fdd8201dSApple OSS Distributions 		VERIFY(0);
177*fdd8201dSApple OSS Distributions 		/* NOTREACHED */
178*fdd8201dSApple OSS Distributions 		__builtin_unreachable();
179*fdd8201dSApple OSS Distributions 	}
180*fdd8201dSApple OSS Distributions 
181*fdd8201dSApple OSS Distributions 	IFCQ_DROP_ADD(ifq, 1, pktsched_get_pkt_len(&pkt));
182*fdd8201dSApple OSS Distributions 	IFCQ_CONVERT_LOCK(ifq);
183*fdd8201dSApple OSS Distributions 	pktsched_free_pkt(&pkt);
184*fdd8201dSApple OSS Distributions }
185*fdd8201dSApple OSS Distributions 
186*fdd8201dSApple OSS Distributions 
187*fdd8201dSApple OSS Distributions static int
fq_compressor(fq_if_t * fqs,fq_t * fq,fq_if_classq_t * fq_cl,pktsched_pkt_t * pkt)188*fdd8201dSApple OSS Distributions fq_compressor(fq_if_t *fqs, fq_t *fq, fq_if_classq_t *fq_cl,
189*fdd8201dSApple OSS Distributions     pktsched_pkt_t *pkt)
190*fdd8201dSApple OSS Distributions {
191*fdd8201dSApple OSS Distributions 	classq_pkt_type_t ptype = fq->fq_ptype;
192*fdd8201dSApple OSS Distributions 	uint32_t comp_gencnt = 0;
193*fdd8201dSApple OSS Distributions 	uint64_t *pkt_timestamp;
194*fdd8201dSApple OSS Distributions 	uint64_t old_timestamp = 0;
195*fdd8201dSApple OSS Distributions 	uint32_t old_pktlen = 0;
196*fdd8201dSApple OSS Distributions 	struct ifclassq *ifq = fqs->fqs_ifq;
197*fdd8201dSApple OSS Distributions 
198*fdd8201dSApple OSS Distributions 	if (__improbable(!tcp_do_ack_compression)) {
199*fdd8201dSApple OSS Distributions 		return 0;
200*fdd8201dSApple OSS Distributions 	}
201*fdd8201dSApple OSS Distributions 
202*fdd8201dSApple OSS Distributions 	pktsched_get_pkt_vars(pkt, NULL, &pkt_timestamp, NULL, NULL, NULL,
203*fdd8201dSApple OSS Distributions 	    &comp_gencnt);
204*fdd8201dSApple OSS Distributions 
205*fdd8201dSApple OSS Distributions 	if (comp_gencnt == 0) {
206*fdd8201dSApple OSS Distributions 		return 0;
207*fdd8201dSApple OSS Distributions 	}
208*fdd8201dSApple OSS Distributions 
209*fdd8201dSApple OSS Distributions 	fq_cl->fcl_stat.fcl_pkts_compressible++;
210*fdd8201dSApple OSS Distributions 
211*fdd8201dSApple OSS Distributions 	if (fq_empty(fq)) {
212*fdd8201dSApple OSS Distributions 		return 0;
213*fdd8201dSApple OSS Distributions 	}
214*fdd8201dSApple OSS Distributions 
215*fdd8201dSApple OSS Distributions 	if (ptype == QP_MBUF) {
216*fdd8201dSApple OSS Distributions 		struct mbuf *m = MBUFQ_LAST(&fq->fq_mbufq);
217*fdd8201dSApple OSS Distributions 
218*fdd8201dSApple OSS Distributions 		if (comp_gencnt != m->m_pkthdr.comp_gencnt) {
219*fdd8201dSApple OSS Distributions 			return 0;
220*fdd8201dSApple OSS Distributions 		}
221*fdd8201dSApple OSS Distributions 
222*fdd8201dSApple OSS Distributions 		/* If we got until here, we should merge/replace the segment */
223*fdd8201dSApple OSS Distributions 		MBUFQ_REMOVE(&fq->fq_mbufq, m);
224*fdd8201dSApple OSS Distributions 		old_pktlen = m_pktlen(m);
225*fdd8201dSApple OSS Distributions 		old_timestamp = m->m_pkthdr.pkt_timestamp;
226*fdd8201dSApple OSS Distributions 
227*fdd8201dSApple OSS Distributions 		IFCQ_CONVERT_LOCK(fqs->fqs_ifq);
228*fdd8201dSApple OSS Distributions 		m_freem(m);
229*fdd8201dSApple OSS Distributions 	}
230*fdd8201dSApple OSS Distributions #if SKYWALK
231*fdd8201dSApple OSS Distributions 	else {
232*fdd8201dSApple OSS Distributions 		struct __kern_packet *kpkt = KPKTQ_LAST(&fq->fq_kpktq);
233*fdd8201dSApple OSS Distributions 
234*fdd8201dSApple OSS Distributions 		if (comp_gencnt != kpkt->pkt_comp_gencnt) {
235*fdd8201dSApple OSS Distributions 			return 0;
236*fdd8201dSApple OSS Distributions 		}
237*fdd8201dSApple OSS Distributions 
238*fdd8201dSApple OSS Distributions 		/* If we got until here, we should merge/replace the segment */
239*fdd8201dSApple OSS Distributions 		KPKTQ_REMOVE(&fq->fq_kpktq, kpkt);
240*fdd8201dSApple OSS Distributions 		old_pktlen = kpkt->pkt_length;
241*fdd8201dSApple OSS Distributions 		old_timestamp = kpkt->pkt_timestamp;
242*fdd8201dSApple OSS Distributions 
243*fdd8201dSApple OSS Distributions 		IFCQ_CONVERT_LOCK(fqs->fqs_ifq);
244*fdd8201dSApple OSS Distributions 		pp_free_packet(*(struct kern_pbufpool **)(uintptr_t)&
245*fdd8201dSApple OSS Distributions 		    (((struct __kern_quantum *)kpkt)->qum_pp),
246*fdd8201dSApple OSS Distributions 		    (uint64_t)kpkt);
247*fdd8201dSApple OSS Distributions 	}
248*fdd8201dSApple OSS Distributions #endif /* SKYWALK */
249*fdd8201dSApple OSS Distributions 
250*fdd8201dSApple OSS Distributions 	fq->fq_bytes -= old_pktlen;
251*fdd8201dSApple OSS Distributions 	fq_cl->fcl_stat.fcl_byte_cnt -= old_pktlen;
252*fdd8201dSApple OSS Distributions 	fq_cl->fcl_stat.fcl_pkt_cnt--;
253*fdd8201dSApple OSS Distributions 	IFCQ_DEC_LEN(ifq);
254*fdd8201dSApple OSS Distributions 	IFCQ_DEC_BYTES(ifq, old_pktlen);
255*fdd8201dSApple OSS Distributions 
256*fdd8201dSApple OSS Distributions 	*pkt_timestamp = old_timestamp;
257*fdd8201dSApple OSS Distributions 
258*fdd8201dSApple OSS Distributions 	return CLASSQEQ_COMPRESSED;
259*fdd8201dSApple OSS Distributions }
260*fdd8201dSApple OSS Distributions 
261*fdd8201dSApple OSS Distributions int
fq_addq(fq_if_t * fqs,pktsched_pkt_t * pkt,fq_if_classq_t * fq_cl)262*fdd8201dSApple OSS Distributions fq_addq(fq_if_t *fqs, pktsched_pkt_t *pkt, fq_if_classq_t *fq_cl)
263*fdd8201dSApple OSS Distributions {
264*fdd8201dSApple OSS Distributions 	int droptype = DTYPE_NODROP, fc_adv = 0, ret = CLASSQEQ_SUCCESS;
265*fdd8201dSApple OSS Distributions 	u_int64_t now;
266*fdd8201dSApple OSS Distributions 	fq_t *fq = NULL;
267*fdd8201dSApple OSS Distributions 	uint64_t *pkt_timestamp;
268*fdd8201dSApple OSS Distributions 	volatile uint32_t *pkt_flags;
269*fdd8201dSApple OSS Distributions 	uint32_t pkt_flowid, cnt;
270*fdd8201dSApple OSS Distributions 	uint8_t pkt_proto, pkt_flowsrc;
271*fdd8201dSApple OSS Distributions 
272*fdd8201dSApple OSS Distributions 	cnt = pkt->pktsched_pcnt;
273*fdd8201dSApple OSS Distributions 	pktsched_get_pkt_vars(pkt, &pkt_flags, &pkt_timestamp, &pkt_flowid,
274*fdd8201dSApple OSS Distributions 	    &pkt_flowsrc, &pkt_proto, NULL);
275*fdd8201dSApple OSS Distributions 
276*fdd8201dSApple OSS Distributions 	/*
277*fdd8201dSApple OSS Distributions 	 * XXX Not walking the chain to set this flag on every packet.
278*fdd8201dSApple OSS Distributions 	 * This flag is only used for debugging. Nothing is affected if it's
279*fdd8201dSApple OSS Distributions 	 * not set.
280*fdd8201dSApple OSS Distributions 	 */
281*fdd8201dSApple OSS Distributions 	switch (pkt->pktsched_ptype) {
282*fdd8201dSApple OSS Distributions 	case QP_MBUF:
283*fdd8201dSApple OSS Distributions 		/* See comments in <rdar://problem/14040693> */
284*fdd8201dSApple OSS Distributions 		VERIFY(!(*pkt_flags & PKTF_PRIV_GUARDED));
285*fdd8201dSApple OSS Distributions 		*pkt_flags |= PKTF_PRIV_GUARDED;
286*fdd8201dSApple OSS Distributions 		break;
287*fdd8201dSApple OSS Distributions #if SKYWALK
288*fdd8201dSApple OSS Distributions 	case QP_PACKET:
289*fdd8201dSApple OSS Distributions 		/* sanity check */
290*fdd8201dSApple OSS Distributions 		ASSERT((*pkt_flags & ~PKT_F_COMMON_MASK) == 0);
291*fdd8201dSApple OSS Distributions 		break;
292*fdd8201dSApple OSS Distributions #endif /* SKYWALK */
293*fdd8201dSApple OSS Distributions 	default:
294*fdd8201dSApple OSS Distributions 		VERIFY(0);
295*fdd8201dSApple OSS Distributions 		/* NOTREACHED */
296*fdd8201dSApple OSS Distributions 		__builtin_unreachable();
297*fdd8201dSApple OSS Distributions 	}
298*fdd8201dSApple OSS Distributions 
299*fdd8201dSApple OSS Distributions 	/*
300*fdd8201dSApple OSS Distributions 	 * Timestamps for every packet must be set prior to entering this path.
301*fdd8201dSApple OSS Distributions 	 */
302*fdd8201dSApple OSS Distributions 	now = *pkt_timestamp;
303*fdd8201dSApple OSS Distributions 	ASSERT(now > 0);
304*fdd8201dSApple OSS Distributions 
305*fdd8201dSApple OSS Distributions 	/* find the flowq for this packet */
306*fdd8201dSApple OSS Distributions 	fq = fq_if_hash_pkt(fqs, pkt_flowid, pktsched_get_pkt_svc(pkt),
307*fdd8201dSApple OSS Distributions 	    now, TRUE, pkt->pktsched_ptype);
308*fdd8201dSApple OSS Distributions 	if (__improbable(fq == NULL)) {
309*fdd8201dSApple OSS Distributions 		DTRACE_IP1(memfail__drop, fq_if_t *, fqs);
310*fdd8201dSApple OSS Distributions 		/* drop the packet if we could not allocate a flow queue */
311*fdd8201dSApple OSS Distributions 		fq_cl->fcl_stat.fcl_drop_memfailure += cnt;
312*fdd8201dSApple OSS Distributions 		return CLASSQEQ_DROP;
313*fdd8201dSApple OSS Distributions 	}
314*fdd8201dSApple OSS Distributions 	VERIFY(fq->fq_ptype == pkt->pktsched_ptype);
315*fdd8201dSApple OSS Distributions 
316*fdd8201dSApple OSS Distributions 	fq_detect_dequeue_stall(fqs, fq, fq_cl, &now);
317*fdd8201dSApple OSS Distributions 
318*fdd8201dSApple OSS Distributions 	if (__improbable(FQ_IS_DELAYHIGH(fq) || FQ_IS_OVERWHELMING(fq))) {
319*fdd8201dSApple OSS Distributions 		if ((fq->fq_flags & FQF_FLOWCTL_CAPABLE) &&
320*fdd8201dSApple OSS Distributions 		    (*pkt_flags & PKTF_FLOW_ADV)) {
321*fdd8201dSApple OSS Distributions 			fc_adv = 1;
322*fdd8201dSApple OSS Distributions 			/*
323*fdd8201dSApple OSS Distributions 			 * If the flow is suspended or it is not
324*fdd8201dSApple OSS Distributions 			 * TCP/QUIC, drop the chain.
325*fdd8201dSApple OSS Distributions 			 */
326*fdd8201dSApple OSS Distributions 			if ((pkt_proto != IPPROTO_TCP) &&
327*fdd8201dSApple OSS Distributions 			    (pkt_proto != IPPROTO_QUIC)) {
328*fdd8201dSApple OSS Distributions 				droptype = DTYPE_EARLY;
329*fdd8201dSApple OSS Distributions 				fq_cl->fcl_stat.fcl_drop_early += cnt;
330*fdd8201dSApple OSS Distributions 				IFCQ_DROP_ADD(fqs->fqs_ifq, cnt, pktsched_get_pkt_len(pkt));
331*fdd8201dSApple OSS Distributions 			}
332*fdd8201dSApple OSS Distributions 			DTRACE_IP6(flow__adv, fq_if_t *, fqs,
333*fdd8201dSApple OSS Distributions 			    fq_if_classq_t *, fq_cl, fq_t *, fq,
334*fdd8201dSApple OSS Distributions 			    int, droptype, pktsched_pkt_t *, pkt,
335*fdd8201dSApple OSS Distributions 			    uint32_t, cnt);
336*fdd8201dSApple OSS Distributions 		} else {
337*fdd8201dSApple OSS Distributions 			/*
338*fdd8201dSApple OSS Distributions 			 * Need to drop packets to make room for the new
339*fdd8201dSApple OSS Distributions 			 * ones. Try to drop from the head of the queue
340*fdd8201dSApple OSS Distributions 			 * instead of the latest packets.
341*fdd8201dSApple OSS Distributions 			 */
342*fdd8201dSApple OSS Distributions 			if (!fq_empty(fq)) {
343*fdd8201dSApple OSS Distributions 				uint32_t i;
344*fdd8201dSApple OSS Distributions 
345*fdd8201dSApple OSS Distributions 				for (i = 0; i < cnt; i++) {
346*fdd8201dSApple OSS Distributions 					fq_head_drop(fqs, fq);
347*fdd8201dSApple OSS Distributions 				}
348*fdd8201dSApple OSS Distributions 				droptype = DTYPE_NODROP;
349*fdd8201dSApple OSS Distributions 			} else {
350*fdd8201dSApple OSS Distributions 				droptype = DTYPE_EARLY;
351*fdd8201dSApple OSS Distributions 			}
352*fdd8201dSApple OSS Distributions 			fq_cl->fcl_stat.fcl_drop_early += cnt;
353*fdd8201dSApple OSS Distributions 
354*fdd8201dSApple OSS Distributions 			DTRACE_IP6(no__flow__adv, fq_if_t *, fqs,
355*fdd8201dSApple OSS Distributions 			    fq_if_classq_t *, fq_cl, fq_t *, fq,
356*fdd8201dSApple OSS Distributions 			    int, droptype, pktsched_pkt_t *, pkt,
357*fdd8201dSApple OSS Distributions 			    uint32_t, cnt);
358*fdd8201dSApple OSS Distributions 		}
359*fdd8201dSApple OSS Distributions 	}
360*fdd8201dSApple OSS Distributions 
361*fdd8201dSApple OSS Distributions 	/* Set the return code correctly */
362*fdd8201dSApple OSS Distributions 	if (__improbable(fc_adv == 1 && droptype != DTYPE_FORCED)) {
363*fdd8201dSApple OSS Distributions 		if (fq_if_add_fcentry(fqs, pkt, pkt_flowsrc, fq, fq_cl)) {
364*fdd8201dSApple OSS Distributions 			fq->fq_flags |= FQF_FLOWCTL_ON;
365*fdd8201dSApple OSS Distributions 			/* deliver flow control advisory error */
366*fdd8201dSApple OSS Distributions 			if (droptype == DTYPE_NODROP) {
367*fdd8201dSApple OSS Distributions 				ret = CLASSQEQ_SUCCESS_FC;
368*fdd8201dSApple OSS Distributions 			} else {
369*fdd8201dSApple OSS Distributions 				/* dropped due to flow control */
370*fdd8201dSApple OSS Distributions 				ret = CLASSQEQ_DROP_FC;
371*fdd8201dSApple OSS Distributions 			}
372*fdd8201dSApple OSS Distributions 		} else {
373*fdd8201dSApple OSS Distributions 			/*
374*fdd8201dSApple OSS Distributions 			 * if we could not flow control the flow, it is
375*fdd8201dSApple OSS Distributions 			 * better to drop
376*fdd8201dSApple OSS Distributions 			 */
377*fdd8201dSApple OSS Distributions 			droptype = DTYPE_FORCED;
378*fdd8201dSApple OSS Distributions 			ret = CLASSQEQ_DROP_FC;
379*fdd8201dSApple OSS Distributions 			fq_cl->fcl_stat.fcl_flow_control_fail++;
380*fdd8201dSApple OSS Distributions 		}
381*fdd8201dSApple OSS Distributions 		DTRACE_IP3(fc__ret, fq_if_t *, fqs, int, droptype, int, ret);
382*fdd8201dSApple OSS Distributions 	}
383*fdd8201dSApple OSS Distributions 
384*fdd8201dSApple OSS Distributions 	/*
385*fdd8201dSApple OSS Distributions 	 * If the queue length hits the queue limit, drop a chain with the
386*fdd8201dSApple OSS Distributions 	 * same number of packets from the front of the queue for a flow with
387*fdd8201dSApple OSS Distributions 	 * maximum number of bytes. This will penalize heavy and unresponsive
388*fdd8201dSApple OSS Distributions 	 * flows. It will also avoid a tail drop.
389*fdd8201dSApple OSS Distributions 	 */
390*fdd8201dSApple OSS Distributions 	if (__improbable(droptype == DTYPE_NODROP &&
391*fdd8201dSApple OSS Distributions 	    fq_if_at_drop_limit(fqs))) {
392*fdd8201dSApple OSS Distributions 		uint32_t i;
393*fdd8201dSApple OSS Distributions 
394*fdd8201dSApple OSS Distributions 		if (fqs->fqs_large_flow == fq) {
395*fdd8201dSApple OSS Distributions 			/*
396*fdd8201dSApple OSS Distributions 			 * Drop from the head of the current fq. Since a
397*fdd8201dSApple OSS Distributions 			 * new packet will be added to the tail, it is ok
398*fdd8201dSApple OSS Distributions 			 * to leave fq in place.
399*fdd8201dSApple OSS Distributions 			 */
400*fdd8201dSApple OSS Distributions 			DTRACE_IP5(large__flow, fq_if_t *, fqs,
401*fdd8201dSApple OSS Distributions 			    fq_if_classq_t *, fq_cl, fq_t *, fq,
402*fdd8201dSApple OSS Distributions 			    pktsched_pkt_t *, pkt, uint32_t, cnt);
403*fdd8201dSApple OSS Distributions 
404*fdd8201dSApple OSS Distributions 			for (i = 0; i < cnt; i++) {
405*fdd8201dSApple OSS Distributions 				fq_head_drop(fqs, fq);
406*fdd8201dSApple OSS Distributions 			}
407*fdd8201dSApple OSS Distributions 			fq_cl->fcl_stat.fcl_drop_overflow += cnt;
408*fdd8201dSApple OSS Distributions 
409*fdd8201dSApple OSS Distributions 			/*
410*fdd8201dSApple OSS Distributions 			 * TCP and QUIC will react to the loss of those head dropped pkts
411*fdd8201dSApple OSS Distributions 			 * and adjust send rate.
412*fdd8201dSApple OSS Distributions 			 */
413*fdd8201dSApple OSS Distributions 			if ((fq->fq_flags & FQF_FLOWCTL_CAPABLE) &&
414*fdd8201dSApple OSS Distributions 			    (*pkt_flags & PKTF_FLOW_ADV) &&
415*fdd8201dSApple OSS Distributions 			    (pkt_proto != IPPROTO_TCP) &&
416*fdd8201dSApple OSS Distributions 			    (pkt_proto != IPPROTO_QUIC)) {
417*fdd8201dSApple OSS Distributions 				if (fq_if_add_fcentry(fqs, pkt, pkt_flowsrc, fq, fq_cl)) {
418*fdd8201dSApple OSS Distributions 					fq->fq_flags |= FQF_FLOWCTL_ON;
419*fdd8201dSApple OSS Distributions 					FQ_SET_OVERWHELMING(fq);
420*fdd8201dSApple OSS Distributions 					fq_cl->fcl_stat.fcl_overwhelming++;
421*fdd8201dSApple OSS Distributions 					/* deliver flow control advisory error */
422*fdd8201dSApple OSS Distributions 					ret = CLASSQEQ_SUCCESS_FC;
423*fdd8201dSApple OSS Distributions 				}
424*fdd8201dSApple OSS Distributions 			}
425*fdd8201dSApple OSS Distributions 		} else {
426*fdd8201dSApple OSS Distributions 			if (fqs->fqs_large_flow == NULL) {
427*fdd8201dSApple OSS Distributions 				droptype = DTYPE_FORCED;
428*fdd8201dSApple OSS Distributions 				fq_cl->fcl_stat.fcl_drop_overflow += cnt;
429*fdd8201dSApple OSS Distributions 				ret = CLASSQEQ_DROP;
430*fdd8201dSApple OSS Distributions 
431*fdd8201dSApple OSS Distributions 				DTRACE_IP5(no__large__flow, fq_if_t *, fqs,
432*fdd8201dSApple OSS Distributions 				    fq_if_classq_t *, fq_cl, fq_t *, fq,
433*fdd8201dSApple OSS Distributions 				    pktsched_pkt_t *, pkt, uint32_t, cnt);
434*fdd8201dSApple OSS Distributions 
435*fdd8201dSApple OSS Distributions 				/*
436*fdd8201dSApple OSS Distributions 				 * if this fq was freshly created and there
437*fdd8201dSApple OSS Distributions 				 * is nothing to enqueue, free it
438*fdd8201dSApple OSS Distributions 				 */
439*fdd8201dSApple OSS Distributions 				if (fq_empty(fq) && !(fq->fq_flags &
440*fdd8201dSApple OSS Distributions 				    (FQF_NEW_FLOW | FQF_OLD_FLOW))) {
441*fdd8201dSApple OSS Distributions 					fq_if_destroy_flow(fqs, fq_cl, fq, true);
442*fdd8201dSApple OSS Distributions 					fq = NULL;
443*fdd8201dSApple OSS Distributions 				}
444*fdd8201dSApple OSS Distributions 			} else {
445*fdd8201dSApple OSS Distributions 				DTRACE_IP5(different__large__flow,
446*fdd8201dSApple OSS Distributions 				    fq_if_t *, fqs, fq_if_classq_t *, fq_cl,
447*fdd8201dSApple OSS Distributions 				    fq_t *, fq, pktsched_pkt_t *, pkt,
448*fdd8201dSApple OSS Distributions 				    uint32_t, cnt);
449*fdd8201dSApple OSS Distributions 
450*fdd8201dSApple OSS Distributions 				for (i = 0; i < cnt; i++) {
451*fdd8201dSApple OSS Distributions 					fq_if_drop_packet(fqs);
452*fdd8201dSApple OSS Distributions 				}
453*fdd8201dSApple OSS Distributions 			}
454*fdd8201dSApple OSS Distributions 		}
455*fdd8201dSApple OSS Distributions 	}
456*fdd8201dSApple OSS Distributions 
457*fdd8201dSApple OSS Distributions 	if (__probable(droptype == DTYPE_NODROP)) {
458*fdd8201dSApple OSS Distributions 		uint32_t chain_len = pktsched_get_pkt_len(pkt);
459*fdd8201dSApple OSS Distributions 
460*fdd8201dSApple OSS Distributions 		/*
461*fdd8201dSApple OSS Distributions 		 * We do not compress if we are enqueuing a chain.
462*fdd8201dSApple OSS Distributions 		 * Traversing the chain to look for acks would defeat the
463*fdd8201dSApple OSS Distributions 		 * purpose of batch enqueueing.
464*fdd8201dSApple OSS Distributions 		 */
465*fdd8201dSApple OSS Distributions 		if (cnt == 1) {
466*fdd8201dSApple OSS Distributions 			ret = fq_compressor(fqs, fq, fq_cl, pkt);
467*fdd8201dSApple OSS Distributions 			if (ret != CLASSQEQ_COMPRESSED) {
468*fdd8201dSApple OSS Distributions 				ret = CLASSQEQ_SUCCESS;
469*fdd8201dSApple OSS Distributions 			} else {
470*fdd8201dSApple OSS Distributions 				fq_cl->fcl_stat.fcl_pkts_compressed++;
471*fdd8201dSApple OSS Distributions 			}
472*fdd8201dSApple OSS Distributions 		}
473*fdd8201dSApple OSS Distributions 		DTRACE_IP5(fq_enqueue, fq_if_t *, fqs, fq_if_classq_t *, fq_cl,
474*fdd8201dSApple OSS Distributions 		    fq_t *, fq, pktsched_pkt_t *, pkt, uint32_t, cnt);
475*fdd8201dSApple OSS Distributions 		fq_enqueue(fq, pkt->pktsched_pkt, pkt->pktsched_tail, cnt);
476*fdd8201dSApple OSS Distributions 
477*fdd8201dSApple OSS Distributions 		fq->fq_bytes += chain_len;
478*fdd8201dSApple OSS Distributions 		fq_cl->fcl_stat.fcl_byte_cnt += chain_len;
479*fdd8201dSApple OSS Distributions 		fq_cl->fcl_stat.fcl_pkt_cnt += cnt;
480*fdd8201dSApple OSS Distributions 
481*fdd8201dSApple OSS Distributions 		/*
482*fdd8201dSApple OSS Distributions 		 * check if this queue will qualify to be the next
483*fdd8201dSApple OSS Distributions 		 * victim queue
484*fdd8201dSApple OSS Distributions 		 */
485*fdd8201dSApple OSS Distributions 		fq_if_is_flow_heavy(fqs, fq);
486*fdd8201dSApple OSS Distributions 	} else {
487*fdd8201dSApple OSS Distributions 		DTRACE_IP3(fq_drop, fq_if_t *, fqs, int, droptype, int, ret);
488*fdd8201dSApple OSS Distributions 		return (ret != CLASSQEQ_SUCCESS) ? ret : CLASSQEQ_DROP;
489*fdd8201dSApple OSS Distributions 	}
490*fdd8201dSApple OSS Distributions 
491*fdd8201dSApple OSS Distributions 	/*
492*fdd8201dSApple OSS Distributions 	 * If the queue is not currently active, add it to the end of new
493*fdd8201dSApple OSS Distributions 	 * flows list for that service class.
494*fdd8201dSApple OSS Distributions 	 */
495*fdd8201dSApple OSS Distributions 	if ((fq->fq_flags & (FQF_NEW_FLOW | FQF_OLD_FLOW)) == 0) {
496*fdd8201dSApple OSS Distributions 		VERIFY(STAILQ_NEXT(fq, fq_actlink) == NULL);
497*fdd8201dSApple OSS Distributions 		STAILQ_INSERT_TAIL(&fq_cl->fcl_new_flows, fq, fq_actlink);
498*fdd8201dSApple OSS Distributions 		fq->fq_flags |= FQF_NEW_FLOW;
499*fdd8201dSApple OSS Distributions 
500*fdd8201dSApple OSS Distributions 		fq_cl->fcl_stat.fcl_newflows_cnt++;
501*fdd8201dSApple OSS Distributions 
502*fdd8201dSApple OSS Distributions 		fq->fq_deficit = fq_cl->fcl_quantum;
503*fdd8201dSApple OSS Distributions 	}
504*fdd8201dSApple OSS Distributions 	return ret;
505*fdd8201dSApple OSS Distributions }
506*fdd8201dSApple OSS Distributions 
507*fdd8201dSApple OSS Distributions void
fq_getq_flow_internal(fq_if_t * fqs,fq_t * fq,pktsched_pkt_t * pkt)508*fdd8201dSApple OSS Distributions fq_getq_flow_internal(fq_if_t *fqs, fq_t *fq, pktsched_pkt_t *pkt)
509*fdd8201dSApple OSS Distributions {
510*fdd8201dSApple OSS Distributions 	classq_pkt_t p = CLASSQ_PKT_INITIALIZER(p);
511*fdd8201dSApple OSS Distributions 	uint32_t plen;
512*fdd8201dSApple OSS Distributions 	fq_if_classq_t *fq_cl;
513*fdd8201dSApple OSS Distributions 	struct ifclassq *ifq = fqs->fqs_ifq;
514*fdd8201dSApple OSS Distributions 
515*fdd8201dSApple OSS Distributions 	fq_dequeue(fq, &p);
516*fdd8201dSApple OSS Distributions 	if (p.cp_ptype == QP_INVALID) {
517*fdd8201dSApple OSS Distributions 		VERIFY(p.cp_mbuf == NULL);
518*fdd8201dSApple OSS Distributions 		return;
519*fdd8201dSApple OSS Distributions 	}
520*fdd8201dSApple OSS Distributions 
521*fdd8201dSApple OSS Distributions 	pktsched_pkt_encap(pkt, &p);
522*fdd8201dSApple OSS Distributions 	plen = pktsched_get_pkt_len(pkt);
523*fdd8201dSApple OSS Distributions 
524*fdd8201dSApple OSS Distributions 	VERIFY(fq->fq_bytes >= plen);
525*fdd8201dSApple OSS Distributions 	fq->fq_bytes -= plen;
526*fdd8201dSApple OSS Distributions 
527*fdd8201dSApple OSS Distributions 	fq_cl = &fqs->fqs_classq[fq->fq_sc_index];
528*fdd8201dSApple OSS Distributions 	fq_cl->fcl_stat.fcl_byte_cnt -= plen;
529*fdd8201dSApple OSS Distributions 	fq_cl->fcl_stat.fcl_pkt_cnt--;
530*fdd8201dSApple OSS Distributions 	IFCQ_DEC_LEN(ifq);
531*fdd8201dSApple OSS Distributions 	IFCQ_DEC_BYTES(ifq, plen);
532*fdd8201dSApple OSS Distributions 
533*fdd8201dSApple OSS Distributions 	/* Reset getqtime so that we don't count idle times */
534*fdd8201dSApple OSS Distributions 	if (fq_empty(fq)) {
535*fdd8201dSApple OSS Distributions 		fq->fq_getqtime = 0;
536*fdd8201dSApple OSS Distributions 	}
537*fdd8201dSApple OSS Distributions }
538*fdd8201dSApple OSS Distributions 
539*fdd8201dSApple OSS Distributions void
fq_getq_flow(fq_if_t * fqs,fq_t * fq,pktsched_pkt_t * pkt)540*fdd8201dSApple OSS Distributions fq_getq_flow(fq_if_t *fqs, fq_t *fq, pktsched_pkt_t *pkt)
541*fdd8201dSApple OSS Distributions {
542*fdd8201dSApple OSS Distributions 	fq_if_classq_t *fq_cl;
543*fdd8201dSApple OSS Distributions 	u_int64_t now;
544*fdd8201dSApple OSS Distributions 	int64_t qdelay = 0;
545*fdd8201dSApple OSS Distributions 	struct timespec now_ts;
546*fdd8201dSApple OSS Distributions 	volatile uint32_t *pkt_flags;
547*fdd8201dSApple OSS Distributions 	uint64_t *pkt_timestamp;
548*fdd8201dSApple OSS Distributions 
549*fdd8201dSApple OSS Distributions 	fq_getq_flow_internal(fqs, fq, pkt);
550*fdd8201dSApple OSS Distributions 	if (pkt->pktsched_ptype == QP_INVALID) {
551*fdd8201dSApple OSS Distributions 		VERIFY(pkt->pktsched_pkt_mbuf == NULL);
552*fdd8201dSApple OSS Distributions 		return;
553*fdd8201dSApple OSS Distributions 	}
554*fdd8201dSApple OSS Distributions 
555*fdd8201dSApple OSS Distributions 	pktsched_get_pkt_vars(pkt, &pkt_flags, &pkt_timestamp, NULL, NULL,
556*fdd8201dSApple OSS Distributions 	    NULL, NULL);
557*fdd8201dSApple OSS Distributions 
558*fdd8201dSApple OSS Distributions 	nanouptime(&now_ts);
559*fdd8201dSApple OSS Distributions 	now = (now_ts.tv_sec * NSEC_PER_SEC) + now_ts.tv_nsec;
560*fdd8201dSApple OSS Distributions 
561*fdd8201dSApple OSS Distributions 	/* this will compute qdelay in nanoseconds */
562*fdd8201dSApple OSS Distributions 	if (now > *pkt_timestamp) {
563*fdd8201dSApple OSS Distributions 		qdelay = now - *pkt_timestamp;
564*fdd8201dSApple OSS Distributions 	}
565*fdd8201dSApple OSS Distributions 	fq_cl = &fqs->fqs_classq[fq->fq_sc_index];
566*fdd8201dSApple OSS Distributions 
567*fdd8201dSApple OSS Distributions 	if (fq->fq_min_qdelay == 0 ||
568*fdd8201dSApple OSS Distributions 	    (qdelay > 0 && (u_int64_t)qdelay < fq->fq_min_qdelay)) {
569*fdd8201dSApple OSS Distributions 		fq->fq_min_qdelay = qdelay;
570*fdd8201dSApple OSS Distributions 	}
571*fdd8201dSApple OSS Distributions 
572*fdd8201dSApple OSS Distributions 	/* Update min/max/avg qdelay for the respective class */
573*fdd8201dSApple OSS Distributions 	if (fq_cl->fcl_stat.fcl_min_qdelay == 0 ||
574*fdd8201dSApple OSS Distributions 	    (qdelay > 0 && (u_int64_t)qdelay < fq_cl->fcl_stat.fcl_min_qdelay)) {
575*fdd8201dSApple OSS Distributions 		fq_cl->fcl_stat.fcl_min_qdelay = qdelay;
576*fdd8201dSApple OSS Distributions 	}
577*fdd8201dSApple OSS Distributions 
578*fdd8201dSApple OSS Distributions 	if (fq_cl->fcl_stat.fcl_max_qdelay == 0 ||
579*fdd8201dSApple OSS Distributions 	    (qdelay > 0 && (u_int64_t)qdelay > fq_cl->fcl_stat.fcl_max_qdelay)) {
580*fdd8201dSApple OSS Distributions 		fq_cl->fcl_stat.fcl_max_qdelay = qdelay;
581*fdd8201dSApple OSS Distributions 	}
582*fdd8201dSApple OSS Distributions 
583*fdd8201dSApple OSS Distributions 	uint64_t num_dequeues = fq_cl->fcl_stat.fcl_dequeue;
584*fdd8201dSApple OSS Distributions 
585*fdd8201dSApple OSS Distributions 	if (num_dequeues == 0) {
586*fdd8201dSApple OSS Distributions 		fq_cl->fcl_stat.fcl_avg_qdelay = qdelay;
587*fdd8201dSApple OSS Distributions 	} else if (qdelay > 0) {
588*fdd8201dSApple OSS Distributions 		uint64_t res = 0;
589*fdd8201dSApple OSS Distributions 		if (os_add_overflow(num_dequeues, 1, &res)) {
590*fdd8201dSApple OSS Distributions 			/* Reset the dequeue num and dequeue bytes */
591*fdd8201dSApple OSS Distributions 			fq_cl->fcl_stat.fcl_dequeue = num_dequeues = 0;
592*fdd8201dSApple OSS Distributions 			fq_cl->fcl_stat.fcl_dequeue_bytes = 0;
593*fdd8201dSApple OSS Distributions 			fq_cl->fcl_stat.fcl_avg_qdelay = qdelay;
594*fdd8201dSApple OSS Distributions 			os_log_info(OS_LOG_DEFAULT, "%s: dequeue num overflow, "
595*fdd8201dSApple OSS Distributions 			    "flow: 0x%x, iface: %s", __func__, fq->fq_flowhash,
596*fdd8201dSApple OSS Distributions 			    if_name(fqs->fqs_ifq->ifcq_ifp));
597*fdd8201dSApple OSS Distributions 		} else {
598*fdd8201dSApple OSS Distributions 			uint64_t product = 0;
599*fdd8201dSApple OSS Distributions 			if (os_mul_overflow(fq_cl->fcl_stat.fcl_avg_qdelay,
600*fdd8201dSApple OSS Distributions 			    num_dequeues, &product) || os_add_overflow(product, qdelay, &res)) {
601*fdd8201dSApple OSS Distributions 				fq_cl->fcl_stat.fcl_avg_qdelay = qdelay;
602*fdd8201dSApple OSS Distributions 			} else {
603*fdd8201dSApple OSS Distributions 				fq_cl->fcl_stat.fcl_avg_qdelay = res /
604*fdd8201dSApple OSS Distributions 				    (num_dequeues + 1);
605*fdd8201dSApple OSS Distributions 			}
606*fdd8201dSApple OSS Distributions 		}
607*fdd8201dSApple OSS Distributions 	}
608*fdd8201dSApple OSS Distributions 
609*fdd8201dSApple OSS Distributions 	if (now >= fq->fq_updatetime) {
610*fdd8201dSApple OSS Distributions 		if (fq->fq_min_qdelay > fqs->fqs_target_qdelay) {
611*fdd8201dSApple OSS Distributions 			if (!FQ_IS_DELAYHIGH(fq)) {
612*fdd8201dSApple OSS Distributions 				FQ_SET_DELAY_HIGH(fq);
613*fdd8201dSApple OSS Distributions 				os_log_error(OS_LOG_DEFAULT,
614*fdd8201dSApple OSS Distributions 				    "%s: high delay idx: %d, %llu, flow: 0x%x, "
615*fdd8201dSApple OSS Distributions 				    "iface: %s", __func__, fq->fq_sc_index,
616*fdd8201dSApple OSS Distributions 				    fq->fq_min_qdelay, fq->fq_flowhash,
617*fdd8201dSApple OSS Distributions 				    if_name(fqs->fqs_ifq->ifcq_ifp));
618*fdd8201dSApple OSS Distributions 			}
619*fdd8201dSApple OSS Distributions 		} else {
620*fdd8201dSApple OSS Distributions 			FQ_CLEAR_DELAY_HIGH(fq);
621*fdd8201dSApple OSS Distributions 		}
622*fdd8201dSApple OSS Distributions 		/* Reset measured queue delay and update time */
623*fdd8201dSApple OSS Distributions 		fq->fq_updatetime = now + fqs->fqs_update_interval;
624*fdd8201dSApple OSS Distributions 		fq->fq_min_qdelay = 0;
625*fdd8201dSApple OSS Distributions 	}
626*fdd8201dSApple OSS Distributions 
627*fdd8201dSApple OSS Distributions 	if (fqs->fqs_large_flow != fq || !fq_if_almost_at_drop_limit(fqs)) {
628*fdd8201dSApple OSS Distributions 		FQ_CLEAR_OVERWHELMING(fq);
629*fdd8201dSApple OSS Distributions 	}
630*fdd8201dSApple OSS Distributions 	if (!FQ_IS_DELAYHIGH(fq) || fq_empty(fq)) {
631*fdd8201dSApple OSS Distributions 		FQ_CLEAR_DELAY_HIGH(fq);
632*fdd8201dSApple OSS Distributions 	}
633*fdd8201dSApple OSS Distributions 
634*fdd8201dSApple OSS Distributions 	if ((fq->fq_flags & FQF_FLOWCTL_ON) &&
635*fdd8201dSApple OSS Distributions 	    !FQ_IS_DELAYHIGH(fq) && !FQ_IS_OVERWHELMING(fq)) {
636*fdd8201dSApple OSS Distributions 		fq_if_flow_feedback(fqs, fq, fq_cl);
637*fdd8201dSApple OSS Distributions 	}
638*fdd8201dSApple OSS Distributions 
639*fdd8201dSApple OSS Distributions 	if (fq_empty(fq)) {
640*fdd8201dSApple OSS Distributions 		/* Reset getqtime so that we don't count idle times */
641*fdd8201dSApple OSS Distributions 		fq->fq_getqtime = 0;
642*fdd8201dSApple OSS Distributions 	} else {
643*fdd8201dSApple OSS Distributions 		fq->fq_getqtime = now;
644*fdd8201dSApple OSS Distributions 	}
645*fdd8201dSApple OSS Distributions 	fq_if_is_flow_heavy(fqs, fq);
646*fdd8201dSApple OSS Distributions 
647*fdd8201dSApple OSS Distributions 	*pkt_timestamp = 0;
648*fdd8201dSApple OSS Distributions 	switch (pkt->pktsched_ptype) {
649*fdd8201dSApple OSS Distributions 	case QP_MBUF:
650*fdd8201dSApple OSS Distributions 		*pkt_flags &= ~PKTF_PRIV_GUARDED;
651*fdd8201dSApple OSS Distributions 		break;
652*fdd8201dSApple OSS Distributions #if SKYWALK
653*fdd8201dSApple OSS Distributions 	case QP_PACKET:
654*fdd8201dSApple OSS Distributions 		/* sanity check */
655*fdd8201dSApple OSS Distributions 		ASSERT((*pkt_flags & ~PKT_F_COMMON_MASK) == 0);
656*fdd8201dSApple OSS Distributions 		break;
657*fdd8201dSApple OSS Distributions #endif /* SKYWALK */
658*fdd8201dSApple OSS Distributions 	default:
659*fdd8201dSApple OSS Distributions 		VERIFY(0);
660*fdd8201dSApple OSS Distributions 		/* NOTREACHED */
661*fdd8201dSApple OSS Distributions 		__builtin_unreachable();
662*fdd8201dSApple OSS Distributions 	}
663*fdd8201dSApple OSS Distributions }
664