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