xref: /freebsd/sys/cam/cam_iosched.c (revision a85fea31c5cb8ed8f1f5ac9ec3572866ff0ea49d)
1ba6c22ceSWarner Losh /*-
2ba6c22ceSWarner Losh  * CAM IO Scheduler Interface
3ba6c22ceSWarner Losh  *
4f24882ecSPedro F. Giffuni  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
5f24882ecSPedro F. Giffuni  *
6ba6c22ceSWarner Losh  * Copyright (c) 2015 Netflix, Inc.
7ba6c22ceSWarner Losh  *
8ba6c22ceSWarner Losh  * Redistribution and use in source and binary forms, with or without
9ba6c22ceSWarner Losh  * modification, are permitted provided that the following conditions
10ba6c22ceSWarner Losh  * are met:
11ba6c22ceSWarner Losh  * 1. Redistributions of source code must retain the above copyright
12ba6c22ceSWarner Losh  *    notice, this list of conditions, and the following disclaimer,
13ba6c22ceSWarner Losh  *    without modification, immediately at the beginning of the file.
14ba6c22ceSWarner Losh  * 2. The name of the author may not be used to endorse or promote products
15ba6c22ceSWarner Losh  *    derived from this software without specific prior written permission.
16ba6c22ceSWarner Losh  *
17ba6c22ceSWarner Losh  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18ba6c22ceSWarner Losh  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19ba6c22ceSWarner Losh  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20ba6c22ceSWarner Losh  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
21ba6c22ceSWarner Losh  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22ba6c22ceSWarner Losh  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23ba6c22ceSWarner Losh  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24ba6c22ceSWarner Losh  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25ba6c22ceSWarner Losh  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26ba6c22ceSWarner Losh  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27ba6c22ceSWarner Losh  * SUCH DAMAGE.
28ba6c22ceSWarner Losh  *
29ba6c22ceSWarner Losh  * $FreeBSD$
30ba6c22ceSWarner Losh  */
31ba6c22ceSWarner Losh 
32ba6c22ceSWarner Losh #include "opt_cam.h"
33ba6c22ceSWarner Losh #include "opt_ddb.h"
34ba6c22ceSWarner Losh 
35ba6c22ceSWarner Losh #include <sys/cdefs.h>
36ba6c22ceSWarner Losh __FBSDID("$FreeBSD$");
37ba6c22ceSWarner Losh 
38ba6c22ceSWarner Losh #include <sys/param.h>
39ba6c22ceSWarner Losh 
40ba6c22ceSWarner Losh #include <sys/systm.h>
41ba6c22ceSWarner Losh #include <sys/kernel.h>
42ba6c22ceSWarner Losh #include <sys/bio.h>
43ba6c22ceSWarner Losh #include <sys/lock.h>
44ba6c22ceSWarner Losh #include <sys/malloc.h>
45ba6c22ceSWarner Losh #include <sys/mutex.h>
46cf3ec151SWarner Losh #include <sys/sbuf.h>
47ba6c22ceSWarner Losh #include <sys/sysctl.h>
48ba6c22ceSWarner Losh 
49ba6c22ceSWarner Losh #include <cam/cam.h>
50ba6c22ceSWarner Losh #include <cam/cam_ccb.h>
51ba6c22ceSWarner Losh #include <cam/cam_periph.h>
52ba6c22ceSWarner Losh #include <cam/cam_xpt_periph.h>
53cf3ec151SWarner Losh #include <cam/cam_xpt_internal.h>
54ba6c22ceSWarner Losh #include <cam/cam_iosched.h>
55ba6c22ceSWarner Losh 
56ba6c22ceSWarner Losh #include <ddb/ddb.h>
57ba6c22ceSWarner Losh 
58ba6c22ceSWarner Losh static MALLOC_DEFINE(M_CAMSCHED, "CAM I/O Scheduler",
59ba6c22ceSWarner Losh     "CAM I/O Scheduler buffers");
60ba6c22ceSWarner Losh 
6122832069SWarner Losh static SYSCTL_NODE(_kern_cam, OID_AUTO, iosched, CTLFLAG_RD | CTLFLAG_MPSAFE, 0,
6222832069SWarner Losh     "CAM I/O Scheduler parameters");
6322832069SWarner Losh 
64ba6c22ceSWarner Losh /*
65ba6c22ceSWarner Losh  * Default I/O scheduler for FreeBSD. This implementation is just a thin-vineer
66ba6c22ceSWarner Losh  * over the bioq_* interface, with notions of separate calls for normal I/O and
67ba6c22ceSWarner Losh  * for trims.
68035ec48eSWarner Losh  *
69035ec48eSWarner Losh  * When CAM_IOSCHED_DYNAMIC is defined, the scheduler is enhanced to dynamically
70035ec48eSWarner Losh  * steer the rate of one type of traffic to help other types of traffic (eg
71035ec48eSWarner Losh  * limit writes when read latency deteriorates on SSDs).
72ba6c22ceSWarner Losh  */
73ba6c22ceSWarner Losh 
74df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
75ba6c22ceSWarner Losh 
7622832069SWarner Losh static bool do_dynamic_iosched = true;
7722832069SWarner Losh SYSCTL_BOOL(_kern_cam_iosched, OID_AUTO, dynamic, CTLFLAG_RD | CTLFLAG_TUN,
78035ec48eSWarner Losh     &do_dynamic_iosched, 1,
79035ec48eSWarner Losh     "Enable Dynamic I/O scheduler optimizations.");
80ba6c22ceSWarner Losh 
81cf3ec151SWarner Losh /*
82cf3ec151SWarner Losh  * For an EMA, with an alpha of alpha, we know
83cf3ec151SWarner Losh  * 	alpha = 2 / (N + 1)
84cf3ec151SWarner Losh  * or
85cf3ec151SWarner Losh  * 	N = 1 + (2 / alpha)
86cf3ec151SWarner Losh  * where N is the number of samples that 86% of the current
87cf3ec151SWarner Losh  * EMA is derived from.
88cf3ec151SWarner Losh  *
89cf3ec151SWarner Losh  * So we invent[*] alpha_bits:
90cf3ec151SWarner Losh  *	alpha_bits = -log_2(alpha)
91cf3ec151SWarner Losh  *	alpha = 2^-alpha_bits
92cf3ec151SWarner Losh  * So
93cf3ec151SWarner Losh  *	N = 1 + 2^(alpha_bits + 1)
94cf3ec151SWarner Losh  *
95cf3ec151SWarner Losh  * The default 9 gives a 1025 lookback for 86% of the data.
96cf3ec151SWarner Losh  * For a brief intro: https://en.wikipedia.org/wiki/Moving_average
97cf3ec151SWarner Losh  *
98cf3ec151SWarner Losh  * [*] Steal from the load average code and many other places.
9979d80af2SWarner Losh  * Note: See computation of EMA and EMVAR for acceptable ranges of alpha.
100cf3ec151SWarner Losh  */
101ba6c22ceSWarner Losh static int alpha_bits = 9;
10222832069SWarner Losh SYSCTL_INT(_kern_cam_iosched, OID_AUTO, alpha_bits, CTLFLAG_RW | CTLFLAG_TUN,
103ba6c22ceSWarner Losh     &alpha_bits, 1,
104ba6c22ceSWarner Losh     "Bits in EMA's alpha.");
105ba6c22ceSWarner Losh 
10622832069SWarner Losh /*
10722832069SWarner Losh  * Different parameters for the buckets of latency we keep track of. These are all
10822832069SWarner Losh  * published read-only since at present they are compile time constants.
10922832069SWarner Losh  *
11022832069SWarner Losh  * Bucket base is the upper bounds of the first latency bucket. It's currently 20us.
11122832069SWarner Losh  * With 20 buckets (see below), that leads to a geometric progression with a max size
11222832069SWarner Losh  * of 5.2s which is safeily larger than 1s to help diagnose extreme outliers better.
11322832069SWarner Losh  */
11422832069SWarner Losh #ifndef BUCKET_BASE
1151d92e81fSWarner Losh #define BUCKET_BASE ((SBT_1S / 50000) + 1)	/* 20us */
11622832069SWarner Losh #endif
11722832069SWarner Losh static sbintime_t bucket_base = BUCKET_BASE;
11822832069SWarner Losh SYSCTL_SBINTIME_USEC(_kern_cam_iosched, OID_AUTO, bucket_base_us, CTLFLAG_RD,
11922832069SWarner Losh     &bucket_base,
12022832069SWarner Losh     "Size of the smallest latency bucket");
12122832069SWarner Losh 
12222832069SWarner Losh /*
12322832069SWarner Losh  * Bucket ratio is the geometric progression for the bucket. For a bucket b_n
12422832069SWarner Losh  * the size of bucket b_n+1 is b_n * bucket_ratio / 100.
12522832069SWarner Losh  */
12622832069SWarner Losh static int bucket_ratio = 200;	/* Rather hard coded at the moment */
12722832069SWarner Losh SYSCTL_INT(_kern_cam_iosched, OID_AUTO, bucket_ratio, CTLFLAG_RD,
12822832069SWarner Losh     &bucket_ratio, 200,
12922832069SWarner Losh     "Latency Bucket Ratio for geometric progression.");
13022832069SWarner Losh 
13122832069SWarner Losh /*
13222832069SWarner Losh  * Number of total buckets. Starting at BUCKET_BASE, each one is a power of 2.
13322832069SWarner Losh  */
13422832069SWarner Losh #ifndef LAT_BUCKETS
13522832069SWarner Losh #define LAT_BUCKETS 20	/* < 20us < 40us ... < 2^(n-1)*20us >= 2^(n-1)*20us */
13622832069SWarner Losh #endif
13722832069SWarner Losh static int lat_buckets = LAT_BUCKETS;
13822832069SWarner Losh SYSCTL_INT(_kern_cam_iosched, OID_AUTO, buckets, CTLFLAG_RD,
13922832069SWarner Losh     &lat_buckets, LAT_BUCKETS,
14022832069SWarner Losh     "Total number of latency buckets published");
14122832069SWarner Losh 
142d592c0dbSWarner Losh /*
143d592c0dbSWarner Losh  * Read bias: how many reads do we favor before scheduling a write
144d592c0dbSWarner Losh  * when we have a choice.
145d592c0dbSWarner Losh  */
146d592c0dbSWarner Losh static int default_read_bias = 0;
147d592c0dbSWarner Losh SYSCTL_INT(_kern_cam_iosched, OID_AUTO, read_bias, CTLFLAG_RWTUN,
148d592c0dbSWarner Losh     &default_read_bias, 0,
149d592c0dbSWarner Losh     "Default read bias for new devices.");
150d592c0dbSWarner Losh 
151ba6c22ceSWarner Losh struct iop_stats;
152ba6c22ceSWarner Losh struct cam_iosched_softc;
153ba6c22ceSWarner Losh 
154ba6c22ceSWarner Losh int iosched_debug = 0;
155ba6c22ceSWarner Losh 
156ba6c22ceSWarner Losh typedef enum {
157ba6c22ceSWarner Losh 	none = 0,				/* No limits */
158ba6c22ceSWarner Losh 	queue_depth,			/* Limit how many ops we queue to SIM */
159ba6c22ceSWarner Losh 	iops,				/* Limit # of IOPS to the drive */
160ba6c22ceSWarner Losh 	bandwidth,			/* Limit bandwidth to the drive */
161ba6c22ceSWarner Losh 	limiter_max
162ba6c22ceSWarner Losh } io_limiter;
163ba6c22ceSWarner Losh 
164ba6c22ceSWarner Losh static const char *cam_iosched_limiter_names[] =
165ba6c22ceSWarner Losh     { "none", "queue_depth", "iops", "bandwidth" };
166ba6c22ceSWarner Losh 
167ba6c22ceSWarner Losh /*
168ba6c22ceSWarner Losh  * Called to initialize the bits of the iop_stats structure relevant to the
169ba6c22ceSWarner Losh  * limiter. Called just after the limiter is set.
170ba6c22ceSWarner Losh  */
171ba6c22ceSWarner Losh typedef int l_init_t(struct iop_stats *);
172ba6c22ceSWarner Losh 
173ba6c22ceSWarner Losh /*
174ba6c22ceSWarner Losh  * Called every tick.
175ba6c22ceSWarner Losh  */
176ba6c22ceSWarner Losh typedef int l_tick_t(struct iop_stats *);
177ba6c22ceSWarner Losh 
178ba6c22ceSWarner Losh /*
179ba6c22ceSWarner Losh  * Called to see if the limiter thinks this IOP can be allowed to
1800b4060b0SEd Maste  * proceed. If so, the limiter assumes that the IOP proceeded
181ba6c22ceSWarner Losh  * and makes any accounting of it that's needed.
182ba6c22ceSWarner Losh  */
183ba6c22ceSWarner Losh typedef int l_iop_t(struct iop_stats *, struct bio *);
184ba6c22ceSWarner Losh 
185ba6c22ceSWarner Losh /*
1860b4060b0SEd Maste  * Called when an I/O completes so the limiter can update its
187ba6c22ceSWarner Losh  * accounting. Pending I/Os may complete in any order (even when
188ba6c22ceSWarner Losh  * sent to the hardware at the same time), so the limiter may not
189ba6c22ceSWarner Losh  * make any assumptions other than this I/O has completed. If it
190ba6c22ceSWarner Losh  * returns 1, then xpt_schedule() needs to be called again.
191ba6c22ceSWarner Losh  */
192ba6c22ceSWarner Losh typedef int l_iodone_t(struct iop_stats *, struct bio *);
193ba6c22ceSWarner Losh 
194ba6c22ceSWarner Losh static l_iop_t cam_iosched_qd_iop;
195ba6c22ceSWarner Losh static l_iop_t cam_iosched_qd_caniop;
196ba6c22ceSWarner Losh static l_iodone_t cam_iosched_qd_iodone;
197ba6c22ceSWarner Losh 
198ba6c22ceSWarner Losh static l_init_t cam_iosched_iops_init;
199ba6c22ceSWarner Losh static l_tick_t cam_iosched_iops_tick;
200ba6c22ceSWarner Losh static l_iop_t cam_iosched_iops_caniop;
201ba6c22ceSWarner Losh static l_iop_t cam_iosched_iops_iop;
202ba6c22ceSWarner Losh 
203ba6c22ceSWarner Losh static l_init_t cam_iosched_bw_init;
204ba6c22ceSWarner Losh static l_tick_t cam_iosched_bw_tick;
205ba6c22ceSWarner Losh static l_iop_t cam_iosched_bw_caniop;
206ba6c22ceSWarner Losh static l_iop_t cam_iosched_bw_iop;
207ba6c22ceSWarner Losh 
208b20c0a07SWarner Losh struct limswitch {
209ba6c22ceSWarner Losh 	l_init_t	*l_init;
210ba6c22ceSWarner Losh 	l_tick_t	*l_tick;
211ba6c22ceSWarner Losh 	l_iop_t		*l_iop;
212ba6c22ceSWarner Losh 	l_iop_t		*l_caniop;
213ba6c22ceSWarner Losh 	l_iodone_t	*l_iodone;
214ba6c22ceSWarner Losh } limsw[] =
215ba6c22ceSWarner Losh {
216ba6c22ceSWarner Losh 	{	/* none */
217ba6c22ceSWarner Losh 		.l_init = NULL,
218ba6c22ceSWarner Losh 		.l_tick = NULL,
219ba6c22ceSWarner Losh 		.l_iop = NULL,
220ba6c22ceSWarner Losh 		.l_iodone= NULL,
221ba6c22ceSWarner Losh 	},
222ba6c22ceSWarner Losh 	{	/* queue_depth */
223ba6c22ceSWarner Losh 		.l_init = NULL,
224ba6c22ceSWarner Losh 		.l_tick = NULL,
225ba6c22ceSWarner Losh 		.l_caniop = cam_iosched_qd_caniop,
226ba6c22ceSWarner Losh 		.l_iop = cam_iosched_qd_iop,
227ba6c22ceSWarner Losh 		.l_iodone= cam_iosched_qd_iodone,
228ba6c22ceSWarner Losh 	},
229ba6c22ceSWarner Losh 	{	/* iops */
230ba6c22ceSWarner Losh 		.l_init = cam_iosched_iops_init,
231ba6c22ceSWarner Losh 		.l_tick = cam_iosched_iops_tick,
232ba6c22ceSWarner Losh 		.l_caniop = cam_iosched_iops_caniop,
233ba6c22ceSWarner Losh 		.l_iop = cam_iosched_iops_iop,
234ba6c22ceSWarner Losh 		.l_iodone= NULL,
235ba6c22ceSWarner Losh 	},
236ba6c22ceSWarner Losh 	{	/* bandwidth */
237ba6c22ceSWarner Losh 		.l_init = cam_iosched_bw_init,
238ba6c22ceSWarner Losh 		.l_tick = cam_iosched_bw_tick,
239ba6c22ceSWarner Losh 		.l_caniop = cam_iosched_bw_caniop,
240ba6c22ceSWarner Losh 		.l_iop = cam_iosched_bw_iop,
241ba6c22ceSWarner Losh 		.l_iodone= NULL,
242ba6c22ceSWarner Losh 	},
243ba6c22ceSWarner Losh };
244ba6c22ceSWarner Losh 
245b20c0a07SWarner Losh struct iop_stats {
246ba6c22ceSWarner Losh 	/*
247ba6c22ceSWarner Losh 	 * sysctl state for this subnode.
248ba6c22ceSWarner Losh 	 */
249ba6c22ceSWarner Losh 	struct sysctl_ctx_list	sysctl_ctx;
250ba6c22ceSWarner Losh 	struct sysctl_oid	*sysctl_tree;
251ba6c22ceSWarner Losh 
252ba6c22ceSWarner Losh 	/*
253ba6c22ceSWarner Losh 	 * Information about the current rate limiters, if any
254ba6c22ceSWarner Losh 	 */
255ba6c22ceSWarner Losh 	io_limiter	limiter;	/* How are I/Os being limited */
256ba6c22ceSWarner Losh 	int		min;		/* Low range of limit */
257ba6c22ceSWarner Losh 	int		max;		/* High range of limit */
258ba6c22ceSWarner Losh 	int		current;	/* Current rate limiter */
259ba6c22ceSWarner Losh 	int		l_value1;	/* per-limiter scratch value 1. */
260ba6c22ceSWarner Losh 	int		l_value2;	/* per-limiter scratch value 2. */
261ba6c22ceSWarner Losh 
262ba6c22ceSWarner Losh 	/*
263ba6c22ceSWarner Losh 	 * Debug information about counts of I/Os that have gone through the
264ba6c22ceSWarner Losh 	 * scheduler.
265ba6c22ceSWarner Losh 	 */
266ba6c22ceSWarner Losh 	int		pending;	/* I/Os pending in the hardware */
267ba6c22ceSWarner Losh 	int		queued;		/* number currently in the queue */
268ba6c22ceSWarner Losh 	int		total;		/* Total for all time -- wraps */
269ba6c22ceSWarner Losh 	int		in;		/* number queued all time -- wraps */
270ba6c22ceSWarner Losh 	int		out;		/* number completed all time -- wraps */
271c4b72d8bSWarner Losh 	int		errs;		/* Number of I/Os completed with error --  wraps */
272ba6c22ceSWarner Losh 
273ba6c22ceSWarner Losh 	/*
274ba6c22ceSWarner Losh 	 * Statistics on different bits of the process.
275ba6c22ceSWarner Losh 	 */
276cf3ec151SWarner Losh 		/* Exp Moving Average, see alpha_bits for more details */
277ba6c22ceSWarner Losh 	sbintime_t      ema;
27879d80af2SWarner Losh 	sbintime_t      emvar;
279ba6c22ceSWarner Losh 	sbintime_t      sd;		/* Last computed sd */
280ba6c22ceSWarner Losh 
281cf3ec151SWarner Losh 	uint32_t	state_flags;
282cf3ec151SWarner Losh #define IOP_RATE_LIMITED		1u
283cf3ec151SWarner Losh 
284cf3ec151SWarner Losh 	uint64_t	latencies[LAT_BUCKETS];
285cf3ec151SWarner Losh 
286ba6c22ceSWarner Losh 	struct cam_iosched_softc *softc;
287ba6c22ceSWarner Losh };
288ba6c22ceSWarner Losh 
289ba6c22ceSWarner Losh typedef enum {
290ba6c22ceSWarner Losh 	set_max = 0,			/* current = max */
291ba6c22ceSWarner Losh 	read_latency,			/* Steer read latency by throttling writes */
292ba6c22ceSWarner Losh 	cl_max				/* Keep last */
293ba6c22ceSWarner Losh } control_type;
294ba6c22ceSWarner Losh 
295ba6c22ceSWarner Losh static const char *cam_iosched_control_type_names[] =
296ba6c22ceSWarner Losh     { "set_max", "read_latency" };
297ba6c22ceSWarner Losh 
298b20c0a07SWarner Losh struct control_loop {
299ba6c22ceSWarner Losh 	/*
300ba6c22ceSWarner Losh 	 * sysctl state for this subnode.
301ba6c22ceSWarner Losh 	 */
302ba6c22ceSWarner Losh 	struct sysctl_ctx_list	sysctl_ctx;
303ba6c22ceSWarner Losh 	struct sysctl_oid	*sysctl_tree;
304ba6c22ceSWarner Losh 
305ba6c22ceSWarner Losh 	sbintime_t	next_steer;		/* Time of next steer */
306ba6c22ceSWarner Losh 	sbintime_t	steer_interval;		/* How often do we steer? */
307ba6c22ceSWarner Losh 	sbintime_t	lolat;
308ba6c22ceSWarner Losh 	sbintime_t	hilat;
309ba6c22ceSWarner Losh 	int		alpha;
310ba6c22ceSWarner Losh 	control_type	type;			/* What type of control? */
311ba6c22ceSWarner Losh 	int		last_count;		/* Last I/O count */
312ba6c22ceSWarner Losh 
313ba6c22ceSWarner Losh 	struct cam_iosched_softc *softc;
314ba6c22ceSWarner Losh };
315ba6c22ceSWarner Losh 
316ba6c22ceSWarner Losh #endif
317ba6c22ceSWarner Losh 
318b20c0a07SWarner Losh struct cam_iosched_softc {
319ba6c22ceSWarner Losh 	struct bio_queue_head bio_queue;
320ba6c22ceSWarner Losh 	struct bio_queue_head trim_queue;
321ba6c22ceSWarner Losh 				/* scheduler flags < 16, user flags >= 16 */
322ba6c22ceSWarner Losh 	uint32_t	flags;
323ba6c22ceSWarner Losh 	int		sort_io_queue;
324d900ade5SWarner Losh 	int		trim_goal;		/* # of trims to queue before sending */
325d900ade5SWarner Losh 	int		trim_ticks;		/* Max ticks to hold trims */
326d900ade5SWarner Losh 	int		last_trim_tick;		/* Last 'tick' time ld a trim */
327d900ade5SWarner Losh 	int		queued_trims;		/* Number of trims in the queue */
328df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
329ba6c22ceSWarner Losh 	int		read_bias;		/* Read bias setting */
330ba6c22ceSWarner Losh 	int		current_read_bias;	/* Current read bias state */
331ba6c22ceSWarner Losh 	int		total_ticks;
332cf3ec151SWarner Losh 	int		load;			/* EMA of 'load average' of disk / 2^16 */
333ba6c22ceSWarner Losh 
334ba6c22ceSWarner Losh 	struct bio_queue_head write_queue;
335ba6c22ceSWarner Losh 	struct iop_stats read_stats, write_stats, trim_stats;
336ba6c22ceSWarner Losh 	struct sysctl_ctx_list	sysctl_ctx;
337ba6c22ceSWarner Losh 	struct sysctl_oid	*sysctl_tree;
338ba6c22ceSWarner Losh 
339ba6c22ceSWarner Losh 	int		quanta;			/* Number of quanta per second */
340ba6c22ceSWarner Losh 	struct callout	ticker;			/* Callout for our quota system */
341ba6c22ceSWarner Losh 	struct cam_periph *periph;		/* cam periph associated with this device */
342ba6c22ceSWarner Losh 	uint32_t	this_frac;		/* Fraction of a second (1024ths) for this tick */
343ba6c22ceSWarner Losh 	sbintime_t	last_time;		/* Last time we ticked */
344ba6c22ceSWarner Losh 	struct control_loop cl;
345e5436ab5SWarner Losh 	sbintime_t	max_lat;		/* when != 0, if iop latency > max_lat, call max_lat_fcn */
346e5436ab5SWarner Losh 	cam_iosched_latfcn_t	latfcn;
347e5436ab5SWarner Losh 	void		*latarg;
348ba6c22ceSWarner Losh #endif
349ba6c22ceSWarner Losh };
350ba6c22ceSWarner Losh 
351df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
352ba6c22ceSWarner Losh /*
353ba6c22ceSWarner Losh  * helper functions to call the limsw functions.
354ba6c22ceSWarner Losh  */
355ba6c22ceSWarner Losh static int
356ba6c22ceSWarner Losh cam_iosched_limiter_init(struct iop_stats *ios)
357ba6c22ceSWarner Losh {
358ba6c22ceSWarner Losh 	int lim = ios->limiter;
359ba6c22ceSWarner Losh 
360ba6c22ceSWarner Losh 	/* maybe this should be a kassert */
361ba6c22ceSWarner Losh 	if (lim < none || lim >= limiter_max)
362ba6c22ceSWarner Losh 		return EINVAL;
363ba6c22ceSWarner Losh 
364ba6c22ceSWarner Losh 	if (limsw[lim].l_init)
365ba6c22ceSWarner Losh 		return limsw[lim].l_init(ios);
366ba6c22ceSWarner Losh 
367ba6c22ceSWarner Losh 	return 0;
368ba6c22ceSWarner Losh }
369ba6c22ceSWarner Losh 
370ba6c22ceSWarner Losh static int
371ba6c22ceSWarner Losh cam_iosched_limiter_tick(struct iop_stats *ios)
372ba6c22ceSWarner Losh {
373ba6c22ceSWarner Losh 	int lim = ios->limiter;
374ba6c22ceSWarner Losh 
375ba6c22ceSWarner Losh 	/* maybe this should be a kassert */
376ba6c22ceSWarner Losh 	if (lim < none || lim >= limiter_max)
377ba6c22ceSWarner Losh 		return EINVAL;
378ba6c22ceSWarner Losh 
379ba6c22ceSWarner Losh 	if (limsw[lim].l_tick)
380ba6c22ceSWarner Losh 		return limsw[lim].l_tick(ios);
381ba6c22ceSWarner Losh 
382ba6c22ceSWarner Losh 	return 0;
383ba6c22ceSWarner Losh }
384ba6c22ceSWarner Losh 
385ba6c22ceSWarner Losh static int
386ba6c22ceSWarner Losh cam_iosched_limiter_iop(struct iop_stats *ios, struct bio *bp)
387ba6c22ceSWarner Losh {
388ba6c22ceSWarner Losh 	int lim = ios->limiter;
389ba6c22ceSWarner Losh 
390ba6c22ceSWarner Losh 	/* maybe this should be a kassert */
391ba6c22ceSWarner Losh 	if (lim < none || lim >= limiter_max)
392ba6c22ceSWarner Losh 		return EINVAL;
393ba6c22ceSWarner Losh 
394ba6c22ceSWarner Losh 	if (limsw[lim].l_iop)
395ba6c22ceSWarner Losh 		return limsw[lim].l_iop(ios, bp);
396ba6c22ceSWarner Losh 
397ba6c22ceSWarner Losh 	return 0;
398ba6c22ceSWarner Losh }
399ba6c22ceSWarner Losh 
400ba6c22ceSWarner Losh static int
401ba6c22ceSWarner Losh cam_iosched_limiter_caniop(struct iop_stats *ios, struct bio *bp)
402ba6c22ceSWarner Losh {
403ba6c22ceSWarner Losh 	int lim = ios->limiter;
404ba6c22ceSWarner Losh 
405ba6c22ceSWarner Losh 	/* maybe this should be a kassert */
406ba6c22ceSWarner Losh 	if (lim < none || lim >= limiter_max)
407ba6c22ceSWarner Losh 		return EINVAL;
408ba6c22ceSWarner Losh 
409ba6c22ceSWarner Losh 	if (limsw[lim].l_caniop)
410ba6c22ceSWarner Losh 		return limsw[lim].l_caniop(ios, bp);
411ba6c22ceSWarner Losh 
412ba6c22ceSWarner Losh 	return 0;
413ba6c22ceSWarner Losh }
414ba6c22ceSWarner Losh 
415ba6c22ceSWarner Losh static int
416ba6c22ceSWarner Losh cam_iosched_limiter_iodone(struct iop_stats *ios, struct bio *bp)
417ba6c22ceSWarner Losh {
418ba6c22ceSWarner Losh 	int lim = ios->limiter;
419ba6c22ceSWarner Losh 
420ba6c22ceSWarner Losh 	/* maybe this should be a kassert */
421ba6c22ceSWarner Losh 	if (lim < none || lim >= limiter_max)
422ba6c22ceSWarner Losh 		return 0;
423ba6c22ceSWarner Losh 
424ba6c22ceSWarner Losh 	if (limsw[lim].l_iodone)
425ba6c22ceSWarner Losh 		return limsw[lim].l_iodone(ios, bp);
426ba6c22ceSWarner Losh 
427ba6c22ceSWarner Losh 	return 0;
428ba6c22ceSWarner Losh }
429ba6c22ceSWarner Losh 
430ba6c22ceSWarner Losh /*
431ba6c22ceSWarner Losh  * Functions to implement the different kinds of limiters
432ba6c22ceSWarner Losh  */
433ba6c22ceSWarner Losh 
434ba6c22ceSWarner Losh static int
435ba6c22ceSWarner Losh cam_iosched_qd_iop(struct iop_stats *ios, struct bio *bp)
436ba6c22ceSWarner Losh {
437ba6c22ceSWarner Losh 
438ba6c22ceSWarner Losh 	if (ios->current <= 0 || ios->pending < ios->current)
439ba6c22ceSWarner Losh 		return 0;
440ba6c22ceSWarner Losh 
441ba6c22ceSWarner Losh 	return EAGAIN;
442ba6c22ceSWarner Losh }
443ba6c22ceSWarner Losh 
444ba6c22ceSWarner Losh static int
445ba6c22ceSWarner Losh cam_iosched_qd_caniop(struct iop_stats *ios, struct bio *bp)
446ba6c22ceSWarner Losh {
447ba6c22ceSWarner Losh 
448ba6c22ceSWarner Losh 	if (ios->current <= 0 || ios->pending < ios->current)
449ba6c22ceSWarner Losh 		return 0;
450ba6c22ceSWarner Losh 
451ba6c22ceSWarner Losh 	return EAGAIN;
452ba6c22ceSWarner Losh }
453ba6c22ceSWarner Losh 
454ba6c22ceSWarner Losh static int
455ba6c22ceSWarner Losh cam_iosched_qd_iodone(struct iop_stats *ios, struct bio *bp)
456ba6c22ceSWarner Losh {
457ba6c22ceSWarner Losh 
458ba6c22ceSWarner Losh 	if (ios->current <= 0 || ios->pending != ios->current)
459ba6c22ceSWarner Losh 		return 0;
460ba6c22ceSWarner Losh 
461ba6c22ceSWarner Losh 	return 1;
462ba6c22ceSWarner Losh }
463ba6c22ceSWarner Losh 
464ba6c22ceSWarner Losh static int
465ba6c22ceSWarner Losh cam_iosched_iops_init(struct iop_stats *ios)
466ba6c22ceSWarner Losh {
467ba6c22ceSWarner Losh 
468ba6c22ceSWarner Losh 	ios->l_value1 = ios->current / ios->softc->quanta;
469ba6c22ceSWarner Losh 	if (ios->l_value1 <= 0)
470ba6c22ceSWarner Losh 		ios->l_value1 = 1;
471f777123bSWarner Losh 	ios->l_value2 = 0;
472ba6c22ceSWarner Losh 
473ba6c22ceSWarner Losh 	return 0;
474ba6c22ceSWarner Losh }
475ba6c22ceSWarner Losh 
476ba6c22ceSWarner Losh static int
477ba6c22ceSWarner Losh cam_iosched_iops_tick(struct iop_stats *ios)
478ba6c22ceSWarner Losh {
47978ed811eSWarner Losh 	int new_ios;
480ba6c22ceSWarner Losh 
481f777123bSWarner Losh 	/*
482f777123bSWarner Losh 	 * Allow at least one IO per tick until all
483f777123bSWarner Losh 	 * the IOs for this interval have been spent.
484f777123bSWarner Losh 	 */
48578ed811eSWarner Losh 	new_ios = (int)((ios->current * (uint64_t)ios->softc->this_frac) >> 16);
48678ed811eSWarner Losh 	if (new_ios < 1 && ios->l_value2 < ios->current) {
48778ed811eSWarner Losh 		new_ios = 1;
488f777123bSWarner Losh 		ios->l_value2++;
489f777123bSWarner Losh 	}
490ba6c22ceSWarner Losh 
49178ed811eSWarner Losh 	/*
49278ed811eSWarner Losh 	 * If this a new accounting interval, discard any "unspent" ios
49378ed811eSWarner Losh 	 * granted in the previous interval.  Otherwise add the new ios to
49478ed811eSWarner Losh 	 * the previously granted ones that haven't been spent yet.
49578ed811eSWarner Losh 	 */
49678ed811eSWarner Losh 	if ((ios->softc->total_ticks % ios->softc->quanta) == 0) {
49778ed811eSWarner Losh 		ios->l_value1 = new_ios;
49878ed811eSWarner Losh 		ios->l_value2 = 1;
49978ed811eSWarner Losh 	} else {
50078ed811eSWarner Losh 		ios->l_value1 += new_ios;
50178ed811eSWarner Losh 	}
50278ed811eSWarner Losh 
503ba6c22ceSWarner Losh 	return 0;
504ba6c22ceSWarner Losh }
505ba6c22ceSWarner Losh 
506ba6c22ceSWarner Losh static int
507ba6c22ceSWarner Losh cam_iosched_iops_caniop(struct iop_stats *ios, struct bio *bp)
508ba6c22ceSWarner Losh {
509ba6c22ceSWarner Losh 
510ba6c22ceSWarner Losh 	/*
511ba6c22ceSWarner Losh 	 * So if we have any more IOPs left, allow it,
5126ca2fb66SWarner Losh 	 * otherwise wait. If current iops is 0, treat that
5136ca2fb66SWarner Losh 	 * as unlimited as a failsafe.
514ba6c22ceSWarner Losh 	 */
5156ca2fb66SWarner Losh 	if (ios->current > 0 && ios->l_value1 <= 0)
516ba6c22ceSWarner Losh 		return EAGAIN;
517ba6c22ceSWarner Losh 	return 0;
518ba6c22ceSWarner Losh }
519ba6c22ceSWarner Losh 
520ba6c22ceSWarner Losh static int
521ba6c22ceSWarner Losh cam_iosched_iops_iop(struct iop_stats *ios, struct bio *bp)
522ba6c22ceSWarner Losh {
523ba6c22ceSWarner Losh 	int rv;
524ba6c22ceSWarner Losh 
525ba6c22ceSWarner Losh 	rv = cam_iosched_limiter_caniop(ios, bp);
526ba6c22ceSWarner Losh 	if (rv == 0)
527ba6c22ceSWarner Losh 		ios->l_value1--;
528ba6c22ceSWarner Losh 
529ba6c22ceSWarner Losh 	return rv;
530ba6c22ceSWarner Losh }
531ba6c22ceSWarner Losh 
532ba6c22ceSWarner Losh static int
533ba6c22ceSWarner Losh cam_iosched_bw_init(struct iop_stats *ios)
534ba6c22ceSWarner Losh {
535ba6c22ceSWarner Losh 
536ba6c22ceSWarner Losh 	/* ios->current is in kB/s, so scale to bytes */
537ba6c22ceSWarner Losh 	ios->l_value1 = ios->current * 1000 / ios->softc->quanta;
538ba6c22ceSWarner Losh 
539ba6c22ceSWarner Losh 	return 0;
540ba6c22ceSWarner Losh }
541ba6c22ceSWarner Losh 
542ba6c22ceSWarner Losh static int
543ba6c22ceSWarner Losh cam_iosched_bw_tick(struct iop_stats *ios)
544ba6c22ceSWarner Losh {
545ba6c22ceSWarner Losh 	int bw;
546ba6c22ceSWarner Losh 
547ba6c22ceSWarner Losh 	/*
548ba6c22ceSWarner Losh 	 * If we're in the hole for available quota from
549ba6c22ceSWarner Losh 	 * the last time, then add the quantum for this.
550ba6c22ceSWarner Losh 	 * If we have any left over from last quantum,
551ba6c22ceSWarner Losh 	 * then too bad, that's lost. Also, ios->current
552ba6c22ceSWarner Losh 	 * is in kB/s, so scale.
553ba6c22ceSWarner Losh 	 *
554ba6c22ceSWarner Losh 	 * We also allow up to 4 quanta of credits to
555ba6c22ceSWarner Losh 	 * accumulate to deal with burstiness. 4 is extremely
556ba6c22ceSWarner Losh 	 * arbitrary.
557ba6c22ceSWarner Losh 	 */
558ba6c22ceSWarner Losh 	bw = (int)((ios->current * 1000ull * (uint64_t)ios->softc->this_frac) >> 16);
559ba6c22ceSWarner Losh 	if (ios->l_value1 < bw * 4)
560ba6c22ceSWarner Losh 		ios->l_value1 += bw;
561ba6c22ceSWarner Losh 
562ba6c22ceSWarner Losh 	return 0;
563ba6c22ceSWarner Losh }
564ba6c22ceSWarner Losh 
565ba6c22ceSWarner Losh static int
566ba6c22ceSWarner Losh cam_iosched_bw_caniop(struct iop_stats *ios, struct bio *bp)
567ba6c22ceSWarner Losh {
568ba6c22ceSWarner Losh 	/*
569ba6c22ceSWarner Losh 	 * So if we have any more bw quota left, allow it,
5700b4060b0SEd Maste 	 * otherwise wait. Note, we'll go negative and that's
5710b4060b0SEd Maste 	 * OK. We'll just get a little less next quota.
572ba6c22ceSWarner Losh 	 *
573ba6c22ceSWarner Losh 	 * Note on going negative: that allows us to process
574ba6c22ceSWarner Losh 	 * requests in order better, since we won't allow
575ba6c22ceSWarner Losh 	 * shorter reads to get around the long one that we
576ba6c22ceSWarner Losh 	 * don't have the quota to do just yet. It also prevents
577ba6c22ceSWarner Losh 	 * starvation by being a little more permissive about
578ba6c22ceSWarner Losh 	 * what we let through this quantum (to prevent the
579ba6c22ceSWarner Losh 	 * starvation), at the cost of getting a little less
580ba6c22ceSWarner Losh 	 * next quantum.
5816ca2fb66SWarner Losh 	 *
5826ca2fb66SWarner Losh 	 * Also note that if the current limit is <= 0,
5836ca2fb66SWarner Losh 	 * we treat it as unlimited as a failsafe.
584ba6c22ceSWarner Losh 	 */
5856ca2fb66SWarner Losh 	if (ios->current > 0 && ios->l_value1 <= 0)
586ba6c22ceSWarner Losh 		return EAGAIN;
587ba6c22ceSWarner Losh 
588ba6c22ceSWarner Losh 	return 0;
589ba6c22ceSWarner Losh }
590ba6c22ceSWarner Losh 
591ba6c22ceSWarner Losh static int
592ba6c22ceSWarner Losh cam_iosched_bw_iop(struct iop_stats *ios, struct bio *bp)
593ba6c22ceSWarner Losh {
594ba6c22ceSWarner Losh 	int rv;
595ba6c22ceSWarner Losh 
596ba6c22ceSWarner Losh 	rv = cam_iosched_limiter_caniop(ios, bp);
597ba6c22ceSWarner Losh 	if (rv == 0)
598ba6c22ceSWarner Losh 		ios->l_value1 -= bp->bio_length;
599ba6c22ceSWarner Losh 
600ba6c22ceSWarner Losh 	return rv;
601ba6c22ceSWarner Losh }
602ba6c22ceSWarner Losh 
603ba6c22ceSWarner Losh static void cam_iosched_cl_maybe_steer(struct control_loop *clp);
604ba6c22ceSWarner Losh 
605ba6c22ceSWarner Losh static void
606ba6c22ceSWarner Losh cam_iosched_ticker(void *arg)
607ba6c22ceSWarner Losh {
608ba6c22ceSWarner Losh 	struct cam_iosched_softc *isc = arg;
609ba6c22ceSWarner Losh 	sbintime_t now, delta;
610cf3ec151SWarner Losh 	int pending;
611ba6c22ceSWarner Losh 
6123028dd8dSWarner Losh 	callout_reset(&isc->ticker, hz / isc->quanta, cam_iosched_ticker, isc);
613ba6c22ceSWarner Losh 
614ba6c22ceSWarner Losh 	now = sbinuptime();
615ba6c22ceSWarner Losh 	delta = now - isc->last_time;
616ba6c22ceSWarner Losh 	isc->this_frac = (uint32_t)delta >> 16;		/* Note: discards seconds -- should be 0 harmless if not */
617ba6c22ceSWarner Losh 	isc->last_time = now;
618ba6c22ceSWarner Losh 
619ba6c22ceSWarner Losh 	cam_iosched_cl_maybe_steer(&isc->cl);
620ba6c22ceSWarner Losh 
621ba6c22ceSWarner Losh 	cam_iosched_limiter_tick(&isc->read_stats);
622ba6c22ceSWarner Losh 	cam_iosched_limiter_tick(&isc->write_stats);
623ba6c22ceSWarner Losh 	cam_iosched_limiter_tick(&isc->trim_stats);
624ba6c22ceSWarner Losh 
625ba6c22ceSWarner Losh 	cam_iosched_schedule(isc, isc->periph);
626ba6c22ceSWarner Losh 
627cf3ec151SWarner Losh 	/*
628cf3ec151SWarner Losh 	 * isc->load is an EMA of the pending I/Os at each tick. The number of
629cf3ec151SWarner Losh 	 * pending I/Os is the sum of the I/Os queued to the hardware, and those
630cf3ec151SWarner Losh 	 * in the software queue that could be queued to the hardware if there
631cf3ec151SWarner Losh 	 * were slots.
632cf3ec151SWarner Losh 	 *
633cf3ec151SWarner Losh 	 * ios_stats.pending is a count of requests in the SIM right now for
634cf3ec151SWarner Losh 	 * each of these types of I/O. So the total pending count is the sum of
635cf3ec151SWarner Losh 	 * these I/Os and the sum of the queued I/Os still in the software queue
636cf3ec151SWarner Losh 	 * for those operations that aren't being rate limited at the moment.
637cf3ec151SWarner Losh 	 *
638cf3ec151SWarner Losh 	 * The reason for the rate limiting bit is because those I/Os
639cf3ec151SWarner Losh 	 * aren't part of the software queued load (since we could
640cf3ec151SWarner Losh 	 * give them to hardware, but choose not to).
641cf3ec151SWarner Losh 	 *
642cf3ec151SWarner Losh 	 * Note: due to a bug in counting pending TRIM in the device, we
643cf3ec151SWarner Losh 	 * don't include them in this count. We count each BIO_DELETE in
644cf3ec151SWarner Losh 	 * the pending count, but the periph drivers collapse them down
645cf3ec151SWarner Losh 	 * into one TRIM command. That one trim command gets the completion
646cf3ec151SWarner Losh 	 * so the counts get off.
647cf3ec151SWarner Losh 	 */
648cf3ec151SWarner Losh 	pending = isc->read_stats.pending + isc->write_stats.pending /* + isc->trim_stats.pending */;
649cf3ec151SWarner Losh 	pending += !!(isc->read_stats.state_flags & IOP_RATE_LIMITED) * isc->read_stats.queued +
650cf3ec151SWarner Losh 	    !!(isc->write_stats.state_flags & IOP_RATE_LIMITED) * isc->write_stats.queued /* +
651cf3ec151SWarner Losh 	    !!(isc->trim_stats.state_flags & IOP_RATE_LIMITED) * isc->trim_stats.queued */ ;
652cf3ec151SWarner Losh 	pending <<= 16;
653cf3ec151SWarner Losh 	pending /= isc->periph->path->device->ccbq.total_openings;
654cf3ec151SWarner Losh 
655cf3ec151SWarner Losh 	isc->load = (pending + (isc->load << 13) - isc->load) >> 13; /* see above: 13 -> 16139 / 200/s = ~81s ~1 minute */
656cf3ec151SWarner Losh 
657ba6c22ceSWarner Losh 	isc->total_ticks++;
658ba6c22ceSWarner Losh }
659ba6c22ceSWarner Losh 
660ba6c22ceSWarner Losh static void
661ba6c22ceSWarner Losh cam_iosched_cl_init(struct control_loop *clp, struct cam_iosched_softc *isc)
662ba6c22ceSWarner Losh {
663ba6c22ceSWarner Losh 
664ba6c22ceSWarner Losh 	clp->next_steer = sbinuptime();
665ba6c22ceSWarner Losh 	clp->softc = isc;
666ba6c22ceSWarner Losh 	clp->steer_interval = SBT_1S * 5;	/* Let's start out steering every 5s */
667ba6c22ceSWarner Losh 	clp->lolat = 5 * SBT_1MS;
668ba6c22ceSWarner Losh 	clp->hilat = 15 * SBT_1MS;
669ba6c22ceSWarner Losh 	clp->alpha = 20;			/* Alpha == gain. 20 = .2 */
670ba6c22ceSWarner Losh 	clp->type = set_max;
671ba6c22ceSWarner Losh }
672ba6c22ceSWarner Losh 
673ba6c22ceSWarner Losh static void
674ba6c22ceSWarner Losh cam_iosched_cl_maybe_steer(struct control_loop *clp)
675ba6c22ceSWarner Losh {
676ba6c22ceSWarner Losh 	struct cam_iosched_softc *isc;
677ba6c22ceSWarner Losh 	sbintime_t now, lat;
678ba6c22ceSWarner Losh 	int old;
679ba6c22ceSWarner Losh 
680ba6c22ceSWarner Losh 	isc = clp->softc;
681ba6c22ceSWarner Losh 	now = isc->last_time;
682ba6c22ceSWarner Losh 	if (now < clp->next_steer)
683ba6c22ceSWarner Losh 		return;
684ba6c22ceSWarner Losh 
685ba6c22ceSWarner Losh 	clp->next_steer = now + clp->steer_interval;
686ba6c22ceSWarner Losh 	switch (clp->type) {
687ba6c22ceSWarner Losh 	case set_max:
688ba6c22ceSWarner Losh 		if (isc->write_stats.current != isc->write_stats.max)
689ba6c22ceSWarner Losh 			printf("Steering write from %d kBps to %d kBps\n",
690ba6c22ceSWarner Losh 			    isc->write_stats.current, isc->write_stats.max);
691ba6c22ceSWarner Losh 		isc->read_stats.current = isc->read_stats.max;
692ba6c22ceSWarner Losh 		isc->write_stats.current = isc->write_stats.max;
693ba6c22ceSWarner Losh 		isc->trim_stats.current = isc->trim_stats.max;
694ba6c22ceSWarner Losh 		break;
695ba6c22ceSWarner Losh 	case read_latency:
696ba6c22ceSWarner Losh 		old = isc->write_stats.current;
697ba6c22ceSWarner Losh 		lat = isc->read_stats.ema;
698ba6c22ceSWarner Losh 		/*
699ba6c22ceSWarner Losh 		 * Simple PLL-like engine. Since we're steering to a range for
700ba6c22ceSWarner Losh 		 * the SP (set point) that makes things a little more
701ba6c22ceSWarner Losh 		 * complicated. In addition, we're not directly controlling our
702ba6c22ceSWarner Losh 		 * PV (process variable), the read latency, but instead are
703ba6c22ceSWarner Losh 		 * manipulating the write bandwidth limit for our MV
704ba6c22ceSWarner Losh 		 * (manipulation variable), analysis of this code gets a bit
705ba6c22ceSWarner Losh 		 * messy. Also, the MV is a very noisy control surface for read
706ba6c22ceSWarner Losh 		 * latency since it is affected by many hidden processes inside
707ba6c22ceSWarner Losh 		 * the device which change how responsive read latency will be
708ba6c22ceSWarner Losh 		 * in reaction to changes in write bandwidth. Unlike the classic
709ba6c22ceSWarner Losh 		 * boiler control PLL. this may result in over-steering while
710ba6c22ceSWarner Losh 		 * the SSD takes its time to react to the new, lower load. This
711ba6c22ceSWarner Losh 		 * is why we use a relatively low alpha of between .1 and .25 to
712ba6c22ceSWarner Losh 		 * compensate for this effect. At .1, it takes ~22 steering
713ba6c22ceSWarner Losh 		 * intervals to back off by a factor of 10. At .2 it only takes
714ba6c22ceSWarner Losh 		 * ~10. At .25 it only takes ~8. However some preliminary data
715ba6c22ceSWarner Losh 		 * from the SSD drives suggests a reasponse time in 10's of
716ba6c22ceSWarner Losh 		 * seconds before latency drops regardless of the new write
7170b4060b0SEd Maste 		 * rate. Careful observation will be required to tune this
718ba6c22ceSWarner Losh 		 * effectively.
719ba6c22ceSWarner Losh 		 *
720ba6c22ceSWarner Losh 		 * Also, when there's no read traffic, we jack up the write
721ba6c22ceSWarner Losh 		 * limit too regardless of the last read latency.  10 is
722ba6c22ceSWarner Losh 		 * somewhat arbitrary.
723ba6c22ceSWarner Losh 		 */
724ba6c22ceSWarner Losh 		if (lat < clp->lolat || isc->read_stats.total - clp->last_count < 10)
725ba6c22ceSWarner Losh 			isc->write_stats.current = isc->write_stats.current *
726ba6c22ceSWarner Losh 			    (100 + clp->alpha) / 100;	/* Scale up */
727ba6c22ceSWarner Losh 		else if (lat > clp->hilat)
728ba6c22ceSWarner Losh 			isc->write_stats.current = isc->write_stats.current *
729ba6c22ceSWarner Losh 			    (100 - clp->alpha) / 100;	/* Scale down */
730ba6c22ceSWarner Losh 		clp->last_count = isc->read_stats.total;
731ba6c22ceSWarner Losh 
732ba6c22ceSWarner Losh 		/*
733ba6c22ceSWarner Losh 		 * Even if we don't steer, per se, enforce the min/max limits as
734ba6c22ceSWarner Losh 		 * those may have changed.
735ba6c22ceSWarner Losh 		 */
736ba6c22ceSWarner Losh 		if (isc->write_stats.current < isc->write_stats.min)
737ba6c22ceSWarner Losh 			isc->write_stats.current = isc->write_stats.min;
738ba6c22ceSWarner Losh 		if (isc->write_stats.current > isc->write_stats.max)
739ba6c22ceSWarner Losh 			isc->write_stats.current = isc->write_stats.max;
7402b5c19f1SWarner Losh 		if (old != isc->write_stats.current && 	iosched_debug)
741cf3ec151SWarner Losh 			printf("Steering write from %d kBps to %d kBps due to latency of %jdus\n",
742ba6c22ceSWarner Losh 			    old, isc->write_stats.current,
7432b5c19f1SWarner Losh 			    (uintmax_t)((uint64_t)1000000 * (uint32_t)lat) >> 32);
744ba6c22ceSWarner Losh 		break;
745ba6c22ceSWarner Losh 	case cl_max:
746ba6c22ceSWarner Losh 		break;
747ba6c22ceSWarner Losh 	}
748ba6c22ceSWarner Losh }
749ba6c22ceSWarner Losh #endif
750ba6c22ceSWarner Losh 
751ece56614SWarner Losh /*
752ece56614SWarner Losh  * Trim or similar currently pending completion. Should only be set for
753ece56614SWarner Losh  * those drivers wishing only one Trim active at a time.
754ece56614SWarner Losh  */
755ece56614SWarner Losh #define CAM_IOSCHED_FLAG_TRIM_ACTIVE	(1ul << 0)
75607e5967aSWarner Losh 			/* Callout active, and needs to be torn down */
75707e5967aSWarner Losh #define CAM_IOSCHED_FLAG_CALLOUT_ACTIVE (1ul << 1)
75807e5967aSWarner Losh 
75907e5967aSWarner Losh 			/* Periph drivers set these flags to indicate work */
76007e5967aSWarner Losh #define CAM_IOSCHED_FLAG_WORK_FLAGS	((0xffffu) << 16)
76107e5967aSWarner Losh 
762df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
763ba6c22ceSWarner Losh static void
764ba6c22ceSWarner Losh cam_iosched_io_metric_update(struct cam_iosched_softc *isc,
765ba6c22ceSWarner Losh     sbintime_t sim_latency, int cmd, size_t size);
7665ede5b8cSWarner Losh #endif
767ba6c22ceSWarner Losh 
7682d87718fSWarner Losh static inline bool
769ba6c22ceSWarner Losh cam_iosched_has_flagged_work(struct cam_iosched_softc *isc)
770ba6c22ceSWarner Losh {
771ba6c22ceSWarner Losh 	return !!(isc->flags & CAM_IOSCHED_FLAG_WORK_FLAGS);
772ba6c22ceSWarner Losh }
773ba6c22ceSWarner Losh 
7742d87718fSWarner Losh static inline bool
775ba6c22ceSWarner Losh cam_iosched_has_io(struct cam_iosched_softc *isc)
776ba6c22ceSWarner Losh {
777df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
778035ec48eSWarner Losh 	if (do_dynamic_iosched) {
779ba6c22ceSWarner Losh 		struct bio *rbp = bioq_first(&isc->bio_queue);
780ba6c22ceSWarner Losh 		struct bio *wbp = bioq_first(&isc->write_queue);
7812d87718fSWarner Losh 		bool can_write = wbp != NULL &&
782ba6c22ceSWarner Losh 		    cam_iosched_limiter_caniop(&isc->write_stats, wbp) == 0;
7832d87718fSWarner Losh 		bool can_read = rbp != NULL &&
784ba6c22ceSWarner Losh 		    cam_iosched_limiter_caniop(&isc->read_stats, rbp) == 0;
785ba6c22ceSWarner Losh 		if (iosched_debug > 2) {
786ba6c22ceSWarner Losh 			printf("can write %d: pending_writes %d max_writes %d\n", can_write, isc->write_stats.pending, isc->write_stats.max);
787ba6c22ceSWarner Losh 			printf("can read %d: read_stats.pending %d max_reads %d\n", can_read, isc->read_stats.pending, isc->read_stats.max);
788ba6c22ceSWarner Losh 			printf("Queued reads %d writes %d\n", isc->read_stats.queued, isc->write_stats.queued);
789ba6c22ceSWarner Losh 		}
790ba6c22ceSWarner Losh 		return can_read || can_write;
791ba6c22ceSWarner Losh 	}
792ba6c22ceSWarner Losh #endif
793ba6c22ceSWarner Losh 	return bioq_first(&isc->bio_queue) != NULL;
794ba6c22ceSWarner Losh }
795ba6c22ceSWarner Losh 
7962d87718fSWarner Losh static inline bool
797ba6c22ceSWarner Losh cam_iosched_has_more_trim(struct cam_iosched_softc *isc)
798ba6c22ceSWarner Losh {
799c6171b44SWarner Losh 	struct bio *bp;
800c6171b44SWarner Losh 
801c6171b44SWarner Losh 	bp = bioq_first(&isc->trim_queue);
802c6171b44SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
803c6171b44SWarner Losh 	if (do_dynamic_iosched) {
804c6171b44SWarner Losh 		/*
805c6171b44SWarner Losh 		 * If we're limiting trims, then defer action on trims
806c6171b44SWarner Losh 		 * for a bit.
807c6171b44SWarner Losh 		 */
808c6171b44SWarner Losh 		if (bp == NULL || cam_iosched_limiter_caniop(&isc->trim_stats, bp) != 0)
809c6171b44SWarner Losh 			return false;
810c6171b44SWarner Losh 	}
811c6171b44SWarner Losh #endif
812d900ade5SWarner Losh 
813d900ade5SWarner Losh 	/*
814d900ade5SWarner Losh 	 * If we've set a trim_goal, then if we exceed that allow trims
815d900ade5SWarner Losh 	 * to be passed back to the driver. If we've also set a tick timeout
816d900ade5SWarner Losh 	 * allow trims back to the driver. Otherwise, don't allow trims yet.
817d900ade5SWarner Losh 	 */
818d900ade5SWarner Losh 	if (isc->trim_goal > 0) {
819d900ade5SWarner Losh 		if (isc->queued_trims >= isc->trim_goal)
820d900ade5SWarner Losh 			return true;
821d900ade5SWarner Losh 		if (isc->queued_trims > 0 &&
822d900ade5SWarner Losh 		    isc->trim_ticks > 0 &&
823d900ade5SWarner Losh 		    ticks - isc->last_trim_tick > isc->trim_ticks)
824d900ade5SWarner Losh 			return true;
825d900ade5SWarner Losh 		return false;
826d900ade5SWarner Losh 	}
827d900ade5SWarner Losh 
828ece56614SWarner Losh 	/* NB: Should perhaps have a max trim active independent of I/O limiters */
829ece56614SWarner Losh 	return !(isc->flags & CAM_IOSCHED_FLAG_TRIM_ACTIVE) && bp != NULL;
830ba6c22ceSWarner Losh }
831ba6c22ceSWarner Losh 
832ba6c22ceSWarner Losh #define cam_iosched_sort_queue(isc)	((isc)->sort_io_queue >= 0 ?	\
833ba6c22ceSWarner Losh     (isc)->sort_io_queue : cam_sort_io_queues)
834ba6c22ceSWarner Losh 
8352d87718fSWarner Losh static inline bool
836ba6c22ceSWarner Losh cam_iosched_has_work(struct cam_iosched_softc *isc)
837ba6c22ceSWarner Losh {
838df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
839ba6c22ceSWarner Losh 	if (iosched_debug > 2)
840ba6c22ceSWarner Losh 		printf("has work: %d %d %d\n", cam_iosched_has_io(isc),
841ba6c22ceSWarner Losh 		    cam_iosched_has_more_trim(isc),
842ba6c22ceSWarner Losh 		    cam_iosched_has_flagged_work(isc));
843ba6c22ceSWarner Losh #endif
844ba6c22ceSWarner Losh 
845ba6c22ceSWarner Losh 	return cam_iosched_has_io(isc) ||
846ba6c22ceSWarner Losh 		cam_iosched_has_more_trim(isc) ||
847ba6c22ceSWarner Losh 		cam_iosched_has_flagged_work(isc);
848ba6c22ceSWarner Losh }
849ba6c22ceSWarner Losh 
850df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
851ba6c22ceSWarner Losh static void
852ba6c22ceSWarner Losh cam_iosched_iop_stats_init(struct cam_iosched_softc *isc, struct iop_stats *ios)
853ba6c22ceSWarner Losh {
854ba6c22ceSWarner Losh 
855ba6c22ceSWarner Losh 	ios->limiter = none;
856ba6c22ceSWarner Losh 	ios->in = 0;
85789d26636SWarner Losh 	ios->max = ios->current = 300000;
858ba6c22ceSWarner Losh 	ios->min = 1;
859ba6c22ceSWarner Losh 	ios->out = 0;
860c4b72d8bSWarner Losh 	ios->errs = 0;
861ba6c22ceSWarner Losh 	ios->pending = 0;
862ba6c22ceSWarner Losh 	ios->queued = 0;
863ba6c22ceSWarner Losh 	ios->total = 0;
864ba6c22ceSWarner Losh 	ios->ema = 0;
86579d80af2SWarner Losh 	ios->emvar = 0;
866ba6c22ceSWarner Losh 	ios->softc = isc;
86789d26636SWarner Losh 	cam_iosched_limiter_init(ios);
868ba6c22ceSWarner Losh }
869ba6c22ceSWarner Losh 
870ba6c22ceSWarner Losh static int
871ba6c22ceSWarner Losh cam_iosched_limiter_sysctl(SYSCTL_HANDLER_ARGS)
872ba6c22ceSWarner Losh {
873ba6c22ceSWarner Losh 	char buf[16];
874ba6c22ceSWarner Losh 	struct iop_stats *ios;
875ba6c22ceSWarner Losh 	struct cam_iosched_softc *isc;
876cf3ec151SWarner Losh 	int value, i, error;
877ba6c22ceSWarner Losh 	const char *p;
878ba6c22ceSWarner Losh 
879ba6c22ceSWarner Losh 	ios = arg1;
880ba6c22ceSWarner Losh 	isc = ios->softc;
881ba6c22ceSWarner Losh 	value = ios->limiter;
882ba6c22ceSWarner Losh 	if (value < none || value >= limiter_max)
883ba6c22ceSWarner Losh 		p = "UNKNOWN";
884ba6c22ceSWarner Losh 	else
885ba6c22ceSWarner Losh 		p = cam_iosched_limiter_names[value];
886ba6c22ceSWarner Losh 
887ba6c22ceSWarner Losh 	strlcpy(buf, p, sizeof(buf));
888ba6c22ceSWarner Losh 	error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
889ba6c22ceSWarner Losh 	if (error != 0 || req->newptr == NULL)
890ba6c22ceSWarner Losh 		return error;
891ba6c22ceSWarner Losh 
892ba6c22ceSWarner Losh 	cam_periph_lock(isc->periph);
893ba6c22ceSWarner Losh 
894ba6c22ceSWarner Losh 	for (i = none; i < limiter_max; i++) {
895ba6c22ceSWarner Losh 		if (strcmp(buf, cam_iosched_limiter_names[i]) != 0)
896ba6c22ceSWarner Losh 			continue;
897ba6c22ceSWarner Losh 		ios->limiter = i;
898ba6c22ceSWarner Losh 		error = cam_iosched_limiter_init(ios);
899ba6c22ceSWarner Losh 		if (error != 0) {
900ba6c22ceSWarner Losh 			ios->limiter = value;
901ba6c22ceSWarner Losh 			cam_periph_unlock(isc->periph);
902ba6c22ceSWarner Losh 			return error;
903ba6c22ceSWarner Losh 		}
904cf3ec151SWarner Losh 		/* Note: disk load averate requires ticker to be always running */
9053028dd8dSWarner Losh 		callout_reset(&isc->ticker, hz / isc->quanta, cam_iosched_ticker, isc);
906ba6c22ceSWarner Losh 		isc->flags |= CAM_IOSCHED_FLAG_CALLOUT_ACTIVE;
907ba6c22ceSWarner Losh 
908ba6c22ceSWarner Losh 		cam_periph_unlock(isc->periph);
909ba6c22ceSWarner Losh 		return 0;
910ba6c22ceSWarner Losh 	}
911ba6c22ceSWarner Losh 
912ba6c22ceSWarner Losh 	cam_periph_unlock(isc->periph);
913ba6c22ceSWarner Losh 	return EINVAL;
914ba6c22ceSWarner Losh }
915ba6c22ceSWarner Losh 
916ba6c22ceSWarner Losh static int
917ba6c22ceSWarner Losh cam_iosched_control_type_sysctl(SYSCTL_HANDLER_ARGS)
918ba6c22ceSWarner Losh {
919ba6c22ceSWarner Losh 	char buf[16];
920ba6c22ceSWarner Losh 	struct control_loop *clp;
921ba6c22ceSWarner Losh 	struct cam_iosched_softc *isc;
922ba6c22ceSWarner Losh 	int value, i, error;
923ba6c22ceSWarner Losh 	const char *p;
924ba6c22ceSWarner Losh 
925ba6c22ceSWarner Losh 	clp = arg1;
926ba6c22ceSWarner Losh 	isc = clp->softc;
927ba6c22ceSWarner Losh 	value = clp->type;
928ba6c22ceSWarner Losh 	if (value < none || value >= cl_max)
929ba6c22ceSWarner Losh 		p = "UNKNOWN";
930ba6c22ceSWarner Losh 	else
931ba6c22ceSWarner Losh 		p = cam_iosched_control_type_names[value];
932ba6c22ceSWarner Losh 
933ba6c22ceSWarner Losh 	strlcpy(buf, p, sizeof(buf));
934ba6c22ceSWarner Losh 	error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
935ba6c22ceSWarner Losh 	if (error != 0 || req->newptr == NULL)
936ba6c22ceSWarner Losh 		return error;
937ba6c22ceSWarner Losh 
938ba6c22ceSWarner Losh 	for (i = set_max; i < cl_max; i++) {
939ba6c22ceSWarner Losh 		if (strcmp(buf, cam_iosched_control_type_names[i]) != 0)
940ba6c22ceSWarner Losh 			continue;
941ba6c22ceSWarner Losh 		cam_periph_lock(isc->periph);
942ba6c22ceSWarner Losh 		clp->type = i;
943ba6c22ceSWarner Losh 		cam_periph_unlock(isc->periph);
944ba6c22ceSWarner Losh 		return 0;
945ba6c22ceSWarner Losh 	}
946ba6c22ceSWarner Losh 
947ba6c22ceSWarner Losh 	return EINVAL;
948ba6c22ceSWarner Losh }
949ba6c22ceSWarner Losh 
950ba6c22ceSWarner Losh static int
951ba6c22ceSWarner Losh cam_iosched_sbintime_sysctl(SYSCTL_HANDLER_ARGS)
952ba6c22ceSWarner Losh {
953ba6c22ceSWarner Losh 	char buf[16];
954ba6c22ceSWarner Losh 	sbintime_t value;
955ba6c22ceSWarner Losh 	int error;
956ba6c22ceSWarner Losh 	uint64_t us;
957ba6c22ceSWarner Losh 
958ba6c22ceSWarner Losh 	value = *(sbintime_t *)arg1;
959ba6c22ceSWarner Losh 	us = (uint64_t)value / SBT_1US;
960ba6c22ceSWarner Losh 	snprintf(buf, sizeof(buf), "%ju", (intmax_t)us);
961ba6c22ceSWarner Losh 	error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
962ba6c22ceSWarner Losh 	if (error != 0 || req->newptr == NULL)
963ba6c22ceSWarner Losh 		return error;
964ba6c22ceSWarner Losh 	us = strtoul(buf, NULL, 10);
965ba6c22ceSWarner Losh 	if (us == 0)
966ba6c22ceSWarner Losh 		return EINVAL;
967ba6c22ceSWarner Losh 	*(sbintime_t *)arg1 = us * SBT_1US;
968ba6c22ceSWarner Losh 	return 0;
969ba6c22ceSWarner Losh }
970ba6c22ceSWarner Losh 
971cf3ec151SWarner Losh static int
972cf3ec151SWarner Losh cam_iosched_sysctl_latencies(SYSCTL_HANDLER_ARGS)
973cf3ec151SWarner Losh {
974cf3ec151SWarner Losh 	int i, error;
975cf3ec151SWarner Losh 	struct sbuf sb;
976cf3ec151SWarner Losh 	uint64_t *latencies;
977cf3ec151SWarner Losh 
978cf3ec151SWarner Losh 	latencies = arg1;
979cf3ec151SWarner Losh 	sbuf_new_for_sysctl(&sb, NULL, LAT_BUCKETS * 16, req);
980cf3ec151SWarner Losh 
981cf3ec151SWarner Losh 	for (i = 0; i < LAT_BUCKETS - 1; i++)
982cf3ec151SWarner Losh 		sbuf_printf(&sb, "%jd,", (intmax_t)latencies[i]);
983cf3ec151SWarner Losh 	sbuf_printf(&sb, "%jd", (intmax_t)latencies[LAT_BUCKETS - 1]);
984cf3ec151SWarner Losh 	error = sbuf_finish(&sb);
985cf3ec151SWarner Losh 	sbuf_delete(&sb);
986cf3ec151SWarner Losh 
987cf3ec151SWarner Losh 	return (error);
988cf3ec151SWarner Losh }
989cf3ec151SWarner Losh 
9902d22619aSWarner Losh static int
9912d22619aSWarner Losh cam_iosched_quanta_sysctl(SYSCTL_HANDLER_ARGS)
9922d22619aSWarner Losh {
9932d22619aSWarner Losh 	int *quanta;
9942d22619aSWarner Losh 	int error, value;
9952d22619aSWarner Losh 
9962d22619aSWarner Losh 	quanta = (unsigned *)arg1;
9972d22619aSWarner Losh 	value = *quanta;
9982d22619aSWarner Losh 
9992d22619aSWarner Losh 	error = sysctl_handle_int(oidp, (int *)&value, 0, req);
10002d22619aSWarner Losh 	if ((error != 0) || (req->newptr == NULL))
10012d22619aSWarner Losh 		return (error);
10022d22619aSWarner Losh 
10032d22619aSWarner Losh 	if (value < 1 || value > hz)
10042d22619aSWarner Losh 		return (EINVAL);
10052d22619aSWarner Losh 
10062d22619aSWarner Losh 	*quanta = value;
10072d22619aSWarner Losh 
10082d22619aSWarner Losh 	return (0);
10092d22619aSWarner Losh }
10102d22619aSWarner Losh 
1011ba6c22ceSWarner Losh static void
1012ba6c22ceSWarner Losh cam_iosched_iop_stats_sysctl_init(struct cam_iosched_softc *isc, struct iop_stats *ios, char *name)
1013ba6c22ceSWarner Losh {
1014ba6c22ceSWarner Losh 	struct sysctl_oid_list *n;
1015ba6c22ceSWarner Losh 	struct sysctl_ctx_list *ctx;
1016ba6c22ceSWarner Losh 
1017ba6c22ceSWarner Losh 	ios->sysctl_tree = SYSCTL_ADD_NODE(&isc->sysctl_ctx,
1018ba6c22ceSWarner Losh 	    SYSCTL_CHILDREN(isc->sysctl_tree), OID_AUTO, name,
10197029da5cSPawel Biernacki 	    CTLFLAG_RD | CTLFLAG_MPSAFE, 0, name);
1020ba6c22ceSWarner Losh 	n = SYSCTL_CHILDREN(ios->sysctl_tree);
1021ba6c22ceSWarner Losh 	ctx = &ios->sysctl_ctx;
1022ba6c22ceSWarner Losh 
1023ba6c22ceSWarner Losh 	SYSCTL_ADD_UQUAD(ctx, n,
1024ba6c22ceSWarner Losh 	    OID_AUTO, "ema", CTLFLAG_RD,
1025ba6c22ceSWarner Losh 	    &ios->ema,
1026ba6c22ceSWarner Losh 	    "Fast Exponentially Weighted Moving Average");
1027ba6c22ceSWarner Losh 	SYSCTL_ADD_UQUAD(ctx, n,
102879d80af2SWarner Losh 	    OID_AUTO, "emvar", CTLFLAG_RD,
102979d80af2SWarner Losh 	    &ios->emvar,
103079d80af2SWarner Losh 	    "Fast Exponentially Weighted Moving Variance");
1031ba6c22ceSWarner Losh 
1032ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1033ba6c22ceSWarner Losh 	    OID_AUTO, "pending", CTLFLAG_RD,
1034ba6c22ceSWarner Losh 	    &ios->pending, 0,
1035ba6c22ceSWarner Losh 	    "Instantaneous # of pending transactions");
1036ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1037ba6c22ceSWarner Losh 	    OID_AUTO, "count", CTLFLAG_RD,
1038ba6c22ceSWarner Losh 	    &ios->total, 0,
1039ba6c22ceSWarner Losh 	    "# of transactions submitted to hardware");
1040ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1041ba6c22ceSWarner Losh 	    OID_AUTO, "queued", CTLFLAG_RD,
1042ba6c22ceSWarner Losh 	    &ios->queued, 0,
1043ba6c22ceSWarner Losh 	    "# of transactions in the queue");
1044ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1045ba6c22ceSWarner Losh 	    OID_AUTO, "in", CTLFLAG_RD,
1046ba6c22ceSWarner Losh 	    &ios->in, 0,
1047ba6c22ceSWarner Losh 	    "# of transactions queued to driver");
1048ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1049ba6c22ceSWarner Losh 	    OID_AUTO, "out", CTLFLAG_RD,
1050ba6c22ceSWarner Losh 	    &ios->out, 0,
1051c4b72d8bSWarner Losh 	    "# of transactions completed (including with error)");
1052c4b72d8bSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1053c4b72d8bSWarner Losh 	    OID_AUTO, "errs", CTLFLAG_RD,
1054c4b72d8bSWarner Losh 	    &ios->errs, 0,
1055c4b72d8bSWarner Losh 	    "# of transactions completed with an error");
1056ba6c22ceSWarner Losh 
1057ba6c22ceSWarner Losh 	SYSCTL_ADD_PROC(ctx, n,
10587029da5cSPawel Biernacki 	    OID_AUTO, "limiter",
1059303477d3SAlexander Motin 	    CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
1060ba6c22ceSWarner Losh 	    ios, 0, cam_iosched_limiter_sysctl, "A",
1061ba6c22ceSWarner Losh 	    "Current limiting type.");
1062ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1063ba6c22ceSWarner Losh 	    OID_AUTO, "min", CTLFLAG_RW,
1064ba6c22ceSWarner Losh 	    &ios->min, 0,
1065ba6c22ceSWarner Losh 	    "min resource");
1066ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1067ba6c22ceSWarner Losh 	    OID_AUTO, "max", CTLFLAG_RW,
1068ba6c22ceSWarner Losh 	    &ios->max, 0,
1069ba6c22ceSWarner Losh 	    "max resource");
1070ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1071ba6c22ceSWarner Losh 	    OID_AUTO, "current", CTLFLAG_RW,
1072ba6c22ceSWarner Losh 	    &ios->current, 0,
1073ba6c22ceSWarner Losh 	    "current resource");
1074ba6c22ceSWarner Losh 
1075cf3ec151SWarner Losh 	SYSCTL_ADD_PROC(ctx, n,
10767029da5cSPawel Biernacki 	    OID_AUTO, "latencies",
1077303477d3SAlexander Motin 	    CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE,
1078cf3ec151SWarner Losh 	    &ios->latencies, 0,
1079cf3ec151SWarner Losh 	    cam_iosched_sysctl_latencies, "A",
1080cf3ec151SWarner Losh 	    "Array of power of 2 latency from 1ms to 1.024s");
1081ba6c22ceSWarner Losh }
1082ba6c22ceSWarner Losh 
1083ba6c22ceSWarner Losh static void
1084ba6c22ceSWarner Losh cam_iosched_iop_stats_fini(struct iop_stats *ios)
1085ba6c22ceSWarner Losh {
1086ba6c22ceSWarner Losh 	if (ios->sysctl_tree)
1087ba6c22ceSWarner Losh 		if (sysctl_ctx_free(&ios->sysctl_ctx) != 0)
1088ba6c22ceSWarner Losh 			printf("can't remove iosched sysctl stats context\n");
1089ba6c22ceSWarner Losh }
1090ba6c22ceSWarner Losh 
1091ba6c22ceSWarner Losh static void
1092ba6c22ceSWarner Losh cam_iosched_cl_sysctl_init(struct cam_iosched_softc *isc)
1093ba6c22ceSWarner Losh {
1094ba6c22ceSWarner Losh 	struct sysctl_oid_list *n;
1095ba6c22ceSWarner Losh 	struct sysctl_ctx_list *ctx;
1096ba6c22ceSWarner Losh 	struct control_loop *clp;
1097ba6c22ceSWarner Losh 
1098ba6c22ceSWarner Losh 	clp = &isc->cl;
1099ba6c22ceSWarner Losh 	clp->sysctl_tree = SYSCTL_ADD_NODE(&isc->sysctl_ctx,
1100ba6c22ceSWarner Losh 	    SYSCTL_CHILDREN(isc->sysctl_tree), OID_AUTO, "control",
11017029da5cSPawel Biernacki 	    CTLFLAG_RD | CTLFLAG_MPSAFE, 0, "Control loop info");
1102ba6c22ceSWarner Losh 	n = SYSCTL_CHILDREN(clp->sysctl_tree);
1103ba6c22ceSWarner Losh 	ctx = &clp->sysctl_ctx;
1104ba6c22ceSWarner Losh 
1105ba6c22ceSWarner Losh 	SYSCTL_ADD_PROC(ctx, n,
11067029da5cSPawel Biernacki 	    OID_AUTO, "type",
1107303477d3SAlexander Motin 	    CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
1108ba6c22ceSWarner Losh 	    clp, 0, cam_iosched_control_type_sysctl, "A",
1109ba6c22ceSWarner Losh 	    "Control loop algorithm");
1110ba6c22ceSWarner Losh 	SYSCTL_ADD_PROC(ctx, n,
11117029da5cSPawel Biernacki 	    OID_AUTO, "steer_interval",
1112303477d3SAlexander Motin 	    CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
1113ba6c22ceSWarner Losh 	    &clp->steer_interval, 0, cam_iosched_sbintime_sysctl, "A",
1114ba6c22ceSWarner Losh 	    "How often to steer (in us)");
1115ba6c22ceSWarner Losh 	SYSCTL_ADD_PROC(ctx, n,
11167029da5cSPawel Biernacki 	    OID_AUTO, "lolat",
1117303477d3SAlexander Motin 	    CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
1118ba6c22ceSWarner Losh 	    &clp->lolat, 0, cam_iosched_sbintime_sysctl, "A",
1119ba6c22ceSWarner Losh 	    "Low water mark for Latency (in us)");
1120ba6c22ceSWarner Losh 	SYSCTL_ADD_PROC(ctx, n,
11217029da5cSPawel Biernacki 	    OID_AUTO, "hilat",
1122303477d3SAlexander Motin 	    CTLTYPE_STRING | CTLFLAG_RW | CTLFLAG_MPSAFE,
1123ba6c22ceSWarner Losh 	    &clp->hilat, 0, cam_iosched_sbintime_sysctl, "A",
1124ba6c22ceSWarner Losh 	    "Hi water mark for Latency (in us)");
1125ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1126ba6c22ceSWarner Losh 	    OID_AUTO, "alpha", CTLFLAG_RW,
1127ba6c22ceSWarner Losh 	    &clp->alpha, 0,
1128ba6c22ceSWarner Losh 	    "Alpha for PLL (x100) aka gain");
1129ba6c22ceSWarner Losh }
1130ba6c22ceSWarner Losh 
1131ba6c22ceSWarner Losh static void
1132ba6c22ceSWarner Losh cam_iosched_cl_sysctl_fini(struct control_loop *clp)
1133ba6c22ceSWarner Losh {
1134ba6c22ceSWarner Losh 	if (clp->sysctl_tree)
1135ba6c22ceSWarner Losh 		if (sysctl_ctx_free(&clp->sysctl_ctx) != 0)
1136ba6c22ceSWarner Losh 			printf("can't remove iosched sysctl control loop context\n");
1137ba6c22ceSWarner Losh }
1138ba6c22ceSWarner Losh #endif
1139ba6c22ceSWarner Losh 
1140ba6c22ceSWarner Losh /*
1141ba6c22ceSWarner Losh  * Allocate the iosched structure. This also insulates callers from knowing
1142ba6c22ceSWarner Losh  * sizeof struct cam_iosched_softc.
1143ba6c22ceSWarner Losh  */
1144ba6c22ceSWarner Losh int
11450028abe6SWarner Losh cam_iosched_init(struct cam_iosched_softc **iscp, struct cam_periph *periph)
1146ba6c22ceSWarner Losh {
1147ba6c22ceSWarner Losh 
1148ba6c22ceSWarner Losh 	*iscp = malloc(sizeof(**iscp), M_CAMSCHED, M_NOWAIT | M_ZERO);
1149ba6c22ceSWarner Losh 	if (*iscp == NULL)
1150ba6c22ceSWarner Losh 		return ENOMEM;
1151df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1152ba6c22ceSWarner Losh 	if (iosched_debug)
1153ba6c22ceSWarner Losh 		printf("CAM IOSCHEDULER Allocating entry at %p\n", *iscp);
1154ba6c22ceSWarner Losh #endif
1155ba6c22ceSWarner Losh 	(*iscp)->sort_io_queue = -1;
1156ba6c22ceSWarner Losh 	bioq_init(&(*iscp)->bio_queue);
1157ba6c22ceSWarner Losh 	bioq_init(&(*iscp)->trim_queue);
1158df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1159035ec48eSWarner Losh 	if (do_dynamic_iosched) {
1160ba6c22ceSWarner Losh 		bioq_init(&(*iscp)->write_queue);
1161d592c0dbSWarner Losh 		(*iscp)->read_bias = default_read_bias;
1162b65803baSWarner Losh 		(*iscp)->current_read_bias = 0;
1163d7fa1ab0SWarner Losh 		(*iscp)->quanta = min(hz, 200);
1164ba6c22ceSWarner Losh 		cam_iosched_iop_stats_init(*iscp, &(*iscp)->read_stats);
1165ba6c22ceSWarner Losh 		cam_iosched_iop_stats_init(*iscp, &(*iscp)->write_stats);
1166ba6c22ceSWarner Losh 		cam_iosched_iop_stats_init(*iscp, &(*iscp)->trim_stats);
1167ba6c22ceSWarner Losh 		(*iscp)->trim_stats.max = 1;	/* Trims are special: one at a time for now */
1168ba6c22ceSWarner Losh 		(*iscp)->last_time = sbinuptime();
1169ba6c22ceSWarner Losh 		callout_init_mtx(&(*iscp)->ticker, cam_periph_mtx(periph), 0);
1170ba6c22ceSWarner Losh 		(*iscp)->periph = periph;
1171ba6c22ceSWarner Losh 		cam_iosched_cl_init(&(*iscp)->cl, *iscp);
11723028dd8dSWarner Losh 		callout_reset(&(*iscp)->ticker, hz / (*iscp)->quanta, cam_iosched_ticker, *iscp);
1173ba6c22ceSWarner Losh 		(*iscp)->flags |= CAM_IOSCHED_FLAG_CALLOUT_ACTIVE;
1174ba6c22ceSWarner Losh 	}
1175ba6c22ceSWarner Losh #endif
1176ba6c22ceSWarner Losh 
1177ba6c22ceSWarner Losh 	return 0;
1178ba6c22ceSWarner Losh }
1179ba6c22ceSWarner Losh 
1180ba6c22ceSWarner Losh /*
1181ba6c22ceSWarner Losh  * Reclaim all used resources. This assumes that other folks have
1182ba6c22ceSWarner Losh  * drained the requests in the hardware. Maybe an unwise assumption.
1183ba6c22ceSWarner Losh  */
1184ba6c22ceSWarner Losh void
1185ba6c22ceSWarner Losh cam_iosched_fini(struct cam_iosched_softc *isc)
1186ba6c22ceSWarner Losh {
1187ba6c22ceSWarner Losh 	if (isc) {
1188ba6c22ceSWarner Losh 		cam_iosched_flush(isc, NULL, ENXIO);
1189df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1190ba6c22ceSWarner Losh 		cam_iosched_iop_stats_fini(&isc->read_stats);
1191ba6c22ceSWarner Losh 		cam_iosched_iop_stats_fini(&isc->write_stats);
1192ba6c22ceSWarner Losh 		cam_iosched_iop_stats_fini(&isc->trim_stats);
1193ba6c22ceSWarner Losh 		cam_iosched_cl_sysctl_fini(&isc->cl);
1194ba6c22ceSWarner Losh 		if (isc->sysctl_tree)
1195ba6c22ceSWarner Losh 			if (sysctl_ctx_free(&isc->sysctl_ctx) != 0)
1196ba6c22ceSWarner Losh 				printf("can't remove iosched sysctl stats context\n");
1197ba6c22ceSWarner Losh 		if (isc->flags & CAM_IOSCHED_FLAG_CALLOUT_ACTIVE) {
1198ba6c22ceSWarner Losh 			callout_drain(&isc->ticker);
1199ba6c22ceSWarner Losh 			isc->flags &= ~ CAM_IOSCHED_FLAG_CALLOUT_ACTIVE;
1200ba6c22ceSWarner Losh 		}
1201ba6c22ceSWarner Losh #endif
1202ba6c22ceSWarner Losh 		free(isc, M_CAMSCHED);
1203ba6c22ceSWarner Losh 	}
1204ba6c22ceSWarner Losh }
1205ba6c22ceSWarner Losh 
1206ba6c22ceSWarner Losh /*
1207ba6c22ceSWarner Losh  * After we're sure we're attaching a device, go ahead and add
1208ba6c22ceSWarner Losh  * hooks for any sysctl we may wish to honor.
1209ba6c22ceSWarner Losh  */
1210ba6c22ceSWarner Losh void cam_iosched_sysctl_init(struct cam_iosched_softc *isc,
1211ba6c22ceSWarner Losh     struct sysctl_ctx_list *ctx, struct sysctl_oid *node)
1212ba6c22ceSWarner Losh {
1213ba6c22ceSWarner Losh 	struct sysctl_oid_list *n;
1214ba6c22ceSWarner Losh 
1215d900ade5SWarner Losh 	n = SYSCTL_CHILDREN(node);
1216d900ade5SWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1217ba6c22ceSWarner Losh 		OID_AUTO, "sort_io_queue", CTLFLAG_RW | CTLFLAG_MPSAFE,
1218ba6c22ceSWarner Losh 		&isc->sort_io_queue, 0,
1219ba6c22ceSWarner Losh 		"Sort IO queue to try and optimise disk access patterns");
1220d900ade5SWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1221d900ade5SWarner Losh 	    OID_AUTO, "trim_goal", CTLFLAG_RW,
1222d900ade5SWarner Losh 	    &isc->trim_goal, 0,
1223d900ade5SWarner Losh 	    "Number of trims to try to accumulate before sending to hardware");
1224d900ade5SWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1225d900ade5SWarner Losh 	    OID_AUTO, "trim_ticks", CTLFLAG_RW,
1226d900ade5SWarner Losh 	    &isc->trim_goal, 0,
1227d900ade5SWarner Losh 	    "IO Schedul qaunta to hold back trims for when accumulating");
1228ba6c22ceSWarner Losh 
1229df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1230035ec48eSWarner Losh 	if (!do_dynamic_iosched)
1231ba6c22ceSWarner Losh 		return;
1232ba6c22ceSWarner Losh 
1233ba6c22ceSWarner Losh 	isc->sysctl_tree = SYSCTL_ADD_NODE(&isc->sysctl_ctx,
1234ba6c22ceSWarner Losh 	    SYSCTL_CHILDREN(node), OID_AUTO, "iosched",
12357029da5cSPawel Biernacki 	    CTLFLAG_RD | CTLFLAG_MPSAFE, 0, "I/O scheduler statistics");
1236ba6c22ceSWarner Losh 	n = SYSCTL_CHILDREN(isc->sysctl_tree);
1237ba6c22ceSWarner Losh 	ctx = &isc->sysctl_ctx;
1238ba6c22ceSWarner Losh 
1239ba6c22ceSWarner Losh 	cam_iosched_iop_stats_sysctl_init(isc, &isc->read_stats, "read");
1240ba6c22ceSWarner Losh 	cam_iosched_iop_stats_sysctl_init(isc, &isc->write_stats, "write");
1241ba6c22ceSWarner Losh 	cam_iosched_iop_stats_sysctl_init(isc, &isc->trim_stats, "trim");
1242ba6c22ceSWarner Losh 	cam_iosched_cl_sysctl_init(isc);
1243ba6c22ceSWarner Losh 
1244ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1245ba6c22ceSWarner Losh 	    OID_AUTO, "read_bias", CTLFLAG_RW,
1246d592c0dbSWarner Losh 	    &isc->read_bias, default_read_bias,
1247ba6c22ceSWarner Losh 	    "How biased towards read should we be independent of limits");
1248ba6c22ceSWarner Losh 
12492d22619aSWarner Losh 	SYSCTL_ADD_PROC(ctx, n,
1250303477d3SAlexander Motin 	    OID_AUTO, "quanta", CTLTYPE_UINT | CTLFLAG_RW | CTLFLAG_MPSAFE,
12512d22619aSWarner Losh 	    &isc->quanta, 0, cam_iosched_quanta_sysctl, "I",
1252ba6c22ceSWarner Losh 	    "How many quanta per second do we slice the I/O up into");
1253ba6c22ceSWarner Losh 
1254ba6c22ceSWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1255ba6c22ceSWarner Losh 	    OID_AUTO, "total_ticks", CTLFLAG_RD,
1256ba6c22ceSWarner Losh 	    &isc->total_ticks, 0,
1257ba6c22ceSWarner Losh 	    "Total number of ticks we've done");
1258cf3ec151SWarner Losh 
1259cf3ec151SWarner Losh 	SYSCTL_ADD_INT(ctx, n,
1260cf3ec151SWarner Losh 	    OID_AUTO, "load", CTLFLAG_RD,
1261cf3ec151SWarner Losh 	    &isc->load, 0,
1262cf3ec151SWarner Losh 	    "scaled load average / 100");
1263e5436ab5SWarner Losh 
1264e5436ab5SWarner Losh 	SYSCTL_ADD_U64(ctx, n,
1265e5436ab5SWarner Losh 	    OID_AUTO, "latency_trigger", CTLFLAG_RW,
1266e5436ab5SWarner Losh 	    &isc->max_lat, 0,
1267e5436ab5SWarner Losh 	    "Latency treshold to trigger callbacks");
1268e5436ab5SWarner Losh #endif
1269e5436ab5SWarner Losh }
1270e5436ab5SWarner Losh 
1271e5436ab5SWarner Losh void
1272e5436ab5SWarner Losh cam_iosched_set_latfcn(struct cam_iosched_softc *isc,
1273e5436ab5SWarner Losh     cam_iosched_latfcn_t fnp, void *argp)
1274e5436ab5SWarner Losh {
1275e5436ab5SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1276e5436ab5SWarner Losh 	isc->latfcn = fnp;
1277e5436ab5SWarner Losh 	isc->latarg = argp;
1278ba6c22ceSWarner Losh #endif
1279ba6c22ceSWarner Losh }
1280ba6c22ceSWarner Losh 
1281ba6c22ceSWarner Losh /*
1282d900ade5SWarner Losh  * Client drivers can set two parameters. "goal" is the number of BIO_DELETEs
1283d900ade5SWarner Losh  * that will be queued up before iosched will "release" the trims to the client
1284d900ade5SWarner Losh  * driver to wo with what they will (usually combine as many as possible). If we
1285d900ade5SWarner Losh  * don't get this many, after trim_ticks we'll submit the I/O anyway with
1286d900ade5SWarner Losh  * whatever we have.  We do need an I/O of some kind of to clock the deferred
1287d900ade5SWarner Losh  * trims out to disk. Since we will eventually get a write for the super block
1288d900ade5SWarner Losh  * or something before we shutdown, the trims will complete. To be safe, when a
1289d900ade5SWarner Losh  * BIO_FLUSH is presented to the iosched work queue, we set the ticks time far
1290d900ade5SWarner Losh  * enough in the past so we'll present the BIO_DELETEs to the client driver.
1291d900ade5SWarner Losh  * There might be a race if no BIO_DELETESs were queued, a BIO_FLUSH comes in
1292d900ade5SWarner Losh  * and then a BIO_DELETE is sent down. No know client does this, and there's
1293d900ade5SWarner Losh  * already a race between an ordered BIO_FLUSH and any BIO_DELETEs in flight,
1294d900ade5SWarner Losh  * but no client depends on the ordering being honored.
1295d900ade5SWarner Losh  *
1296d900ade5SWarner Losh  * XXX I'm not sure what the interaction between UFS direct BIOs and the BUF
1297d900ade5SWarner Losh  * flushing on shutdown. I think there's bufs that would be dependent on the BIO
1298d900ade5SWarner Losh  * finishing to write out at least metadata, so we'll be fine. To be safe, keep
1299d900ade5SWarner Losh  * the number of ticks low (less than maybe 10s) to avoid shutdown races.
1300d900ade5SWarner Losh  */
1301d900ade5SWarner Losh 
1302d900ade5SWarner Losh void
1303d900ade5SWarner Losh cam_iosched_set_trim_goal(struct cam_iosched_softc *isc, int goal)
1304d900ade5SWarner Losh {
1305d900ade5SWarner Losh 
1306d900ade5SWarner Losh 	isc->trim_goal = goal;
1307d900ade5SWarner Losh }
1308d900ade5SWarner Losh 
1309d900ade5SWarner Losh void
1310d900ade5SWarner Losh cam_iosched_set_trim_ticks(struct cam_iosched_softc *isc, int trim_ticks)
1311d900ade5SWarner Losh {
1312d900ade5SWarner Losh 
1313d900ade5SWarner Losh 	isc->trim_ticks = trim_ticks;
1314d900ade5SWarner Losh }
1315d900ade5SWarner Losh 
1316d900ade5SWarner Losh /*
1317ba6c22ceSWarner Losh  * Flush outstanding I/O. Consumers of this library don't know all the
1318ba6c22ceSWarner Losh  * queues we may keep, so this allows all I/O to be flushed in one
1319ba6c22ceSWarner Losh  * convenient call.
1320ba6c22ceSWarner Losh  */
1321ba6c22ceSWarner Losh void
1322ba6c22ceSWarner Losh cam_iosched_flush(struct cam_iosched_softc *isc, struct devstat *stp, int err)
1323ba6c22ceSWarner Losh {
1324ba6c22ceSWarner Losh 	bioq_flush(&isc->bio_queue, stp, err);
1325ba6c22ceSWarner Losh 	bioq_flush(&isc->trim_queue, stp, err);
1326df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1327035ec48eSWarner Losh 	if (do_dynamic_iosched)
1328ba6c22ceSWarner Losh 		bioq_flush(&isc->write_queue, stp, err);
1329ba6c22ceSWarner Losh #endif
1330ba6c22ceSWarner Losh }
1331ba6c22ceSWarner Losh 
1332df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1333ba6c22ceSWarner Losh static struct bio *
13340028abe6SWarner Losh cam_iosched_get_write(struct cam_iosched_softc *isc)
1335ba6c22ceSWarner Losh {
1336ba6c22ceSWarner Losh 	struct bio *bp;
1337ba6c22ceSWarner Losh 
1338ba6c22ceSWarner Losh 	/*
1339ba6c22ceSWarner Losh 	 * We control the write rate by controlling how many requests we send
1340ba6c22ceSWarner Losh 	 * down to the drive at any one time. Fewer requests limits the
1341ba6c22ceSWarner Losh 	 * effects of both starvation when the requests take a while and write
1342ba6c22ceSWarner Losh 	 * amplification when each request is causing more than one write to
1343ba6c22ceSWarner Losh 	 * the NAND media. Limiting the queue depth like this will also limit
1344ba6c22ceSWarner Losh 	 * the write throughput and give and reads that want to compete to
1345ba6c22ceSWarner Losh 	 * compete unfairly.
1346ba6c22ceSWarner Losh 	 */
1347ba6c22ceSWarner Losh 	bp = bioq_first(&isc->write_queue);
1348ba6c22ceSWarner Losh 	if (bp == NULL) {
1349ba6c22ceSWarner Losh 		if (iosched_debug > 3)
1350ba6c22ceSWarner Losh 			printf("No writes present in write_queue\n");
1351ba6c22ceSWarner Losh 		return NULL;
1352ba6c22ceSWarner Losh 	}
1353ba6c22ceSWarner Losh 
1354ba6c22ceSWarner Losh 	/*
1355ba6c22ceSWarner Losh 	 * If pending read, prefer that based on current read bias
1356ba6c22ceSWarner Losh 	 * setting.
1357ba6c22ceSWarner Losh 	 */
1358ba6c22ceSWarner Losh 	if (bioq_first(&isc->bio_queue) && isc->current_read_bias) {
1359ba6c22ceSWarner Losh 		if (iosched_debug)
1360f2b98850SWarner Losh 			printf(
1361f2b98850SWarner Losh 			    "Reads present and current_read_bias is %d queued "
1362f2b98850SWarner Losh 			    "writes %d queued reads %d\n",
1363f2b98850SWarner Losh 			    isc->current_read_bias, isc->write_stats.queued,
1364f2b98850SWarner Losh 			    isc->read_stats.queued);
1365ba6c22ceSWarner Losh 		isc->current_read_bias--;
1366cf3ec151SWarner Losh 		/* We're not limiting writes, per se, just doing reads first */
1367ba6c22ceSWarner Losh 		return NULL;
1368ba6c22ceSWarner Losh 	}
1369ba6c22ceSWarner Losh 
1370ba6c22ceSWarner Losh 	/*
1371ba6c22ceSWarner Losh 	 * See if our current limiter allows this I/O.
1372ba6c22ceSWarner Losh 	 */
1373ba6c22ceSWarner Losh 	if (cam_iosched_limiter_iop(&isc->write_stats, bp) != 0) {
1374ba6c22ceSWarner Losh 		if (iosched_debug)
1375ba6c22ceSWarner Losh 			printf("Can't write because limiter says no.\n");
1376cf3ec151SWarner Losh 		isc->write_stats.state_flags |= IOP_RATE_LIMITED;
1377ba6c22ceSWarner Losh 		return NULL;
1378ba6c22ceSWarner Losh 	}
1379ba6c22ceSWarner Losh 
1380ba6c22ceSWarner Losh 	/*
1381ba6c22ceSWarner Losh 	 * Let's do this: We've passed all the gates and we're a go
1382ba6c22ceSWarner Losh 	 * to schedule the I/O in the SIM.
1383ba6c22ceSWarner Losh 	 */
1384ba6c22ceSWarner Losh 	isc->current_read_bias = isc->read_bias;
1385ba6c22ceSWarner Losh 	bioq_remove(&isc->write_queue, bp);
1386ba6c22ceSWarner Losh 	if (bp->bio_cmd == BIO_WRITE) {
1387ba6c22ceSWarner Losh 		isc->write_stats.queued--;
1388ba6c22ceSWarner Losh 		isc->write_stats.total++;
1389ba6c22ceSWarner Losh 		isc->write_stats.pending++;
1390ba6c22ceSWarner Losh 	}
1391ba6c22ceSWarner Losh 	if (iosched_debug > 9)
1392ba6c22ceSWarner Losh 		printf("HWQ : %p %#x\n", bp, bp->bio_cmd);
1393cf3ec151SWarner Losh 	isc->write_stats.state_flags &= ~IOP_RATE_LIMITED;
1394ba6c22ceSWarner Losh 	return bp;
1395ba6c22ceSWarner Losh }
1396ba6c22ceSWarner Losh #endif
1397ba6c22ceSWarner Losh 
1398ba6c22ceSWarner Losh /*
1399ba6c22ceSWarner Losh  * Put back a trim that you weren't able to actually schedule this time.
1400ba6c22ceSWarner Losh  */
1401ba6c22ceSWarner Losh void
1402ba6c22ceSWarner Losh cam_iosched_put_back_trim(struct cam_iosched_softc *isc, struct bio *bp)
1403ba6c22ceSWarner Losh {
1404ba6c22ceSWarner Losh 	bioq_insert_head(&isc->trim_queue, bp);
1405d900ade5SWarner Losh 	if (isc->queued_trims == 0)
1406d900ade5SWarner Losh 		isc->last_trim_tick = ticks;
1407d900ade5SWarner Losh 	isc->queued_trims++;
1408df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1409ba6c22ceSWarner Losh 	isc->trim_stats.queued++;
1410ba6c22ceSWarner Losh 	isc->trim_stats.total--;		/* since we put it back, don't double count */
1411ba6c22ceSWarner Losh 	isc->trim_stats.pending--;
1412ba6c22ceSWarner Losh #endif
1413ba6c22ceSWarner Losh }
1414ba6c22ceSWarner Losh 
1415ba6c22ceSWarner Losh /*
1416ba6c22ceSWarner Losh  * gets the next trim from the trim queue.
1417ba6c22ceSWarner Losh  *
1418ba6c22ceSWarner Losh  * Assumes we're called with the periph lock held.  It removes this
14190b4060b0SEd Maste  * trim from the queue and the device must explicitly reinsert it
1420ba6c22ceSWarner Losh  * should the need arise.
1421ba6c22ceSWarner Losh  */
1422ba6c22ceSWarner Losh struct bio *
1423ba6c22ceSWarner Losh cam_iosched_next_trim(struct cam_iosched_softc *isc)
1424ba6c22ceSWarner Losh {
1425ba6c22ceSWarner Losh 	struct bio *bp;
1426ba6c22ceSWarner Losh 
1427ba6c22ceSWarner Losh 	bp  = bioq_first(&isc->trim_queue);
1428ba6c22ceSWarner Losh 	if (bp == NULL)
1429ba6c22ceSWarner Losh 		return NULL;
1430ba6c22ceSWarner Losh 	bioq_remove(&isc->trim_queue, bp);
1431d900ade5SWarner Losh 	isc->queued_trims--;
1432d900ade5SWarner Losh 	isc->last_trim_tick = ticks;	/* Reset the tick timer when we take trims */
1433df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1434ba6c22ceSWarner Losh 	isc->trim_stats.queued--;
1435ba6c22ceSWarner Losh 	isc->trim_stats.total++;
1436ba6c22ceSWarner Losh 	isc->trim_stats.pending++;
1437ba6c22ceSWarner Losh #endif
1438ba6c22ceSWarner Losh 	return bp;
1439ba6c22ceSWarner Losh }
1440ba6c22ceSWarner Losh 
1441ba6c22ceSWarner Losh /*
14420b4060b0SEd Maste  * gets an available trim from the trim queue, if there's no trim
1443ba6c22ceSWarner Losh  * already pending. It removes this trim from the queue and the device
14440b4060b0SEd Maste  * must explicitly reinsert it should the need arise.
1445ba6c22ceSWarner Losh  *
1446ba6c22ceSWarner Losh  * Assumes we're called with the periph lock held.
1447ba6c22ceSWarner Losh  */
14480028abe6SWarner Losh struct bio *
14490028abe6SWarner Losh cam_iosched_get_trim(struct cam_iosched_softc *isc)
1450ba6c22ceSWarner Losh {
1451c6171b44SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1452c6171b44SWarner Losh 	struct bio *bp;
1453c6171b44SWarner Losh #endif
1454ba6c22ceSWarner Losh 
14550028abe6SWarner Losh 	if (!cam_iosched_has_more_trim(isc))
1456ba6c22ceSWarner Losh 		return NULL;
145762c94a05SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1458c6171b44SWarner Losh 	bp  = bioq_first(&isc->trim_queue);
1459c6171b44SWarner Losh 	if (bp == NULL)
1460c6171b44SWarner Losh 		return NULL;
1461c6171b44SWarner Losh 
146262c94a05SWarner Losh 	/*
14631759fd77SWarner Losh 	 * If pending read, prefer that based on current read bias setting. The
14641759fd77SWarner Losh 	 * read bias is shared for both writes and TRIMs, but on TRIMs the bias
14651759fd77SWarner Losh 	 * is for a combined TRIM not a single TRIM request that's come in.
146662c94a05SWarner Losh 	 */
14671759fd77SWarner Losh 	if (do_dynamic_iosched) {
146862c94a05SWarner Losh 		if (bioq_first(&isc->bio_queue) && isc->current_read_bias) {
14691759fd77SWarner Losh 			if (iosched_debug)
14701759fd77SWarner Losh 				printf("Reads present and current_read_bias is %d"
14711759fd77SWarner Losh 				    " queued trims %d queued reads %d\n",
14721759fd77SWarner Losh 				    isc->current_read_bias, isc->trim_stats.queued,
14731759fd77SWarner Losh 				    isc->read_stats.queued);
147462c94a05SWarner Losh 			isc->current_read_bias--;
147562c94a05SWarner Losh 			/* We're not limiting TRIMS, per se, just doing reads first */
147662c94a05SWarner Losh 			return NULL;
147762c94a05SWarner Losh 		}
147862c94a05SWarner Losh 		/*
147962c94a05SWarner Losh 		 * We're going to do a trim, so reset the bias.
148062c94a05SWarner Losh 		 */
148162c94a05SWarner Losh 		isc->current_read_bias = isc->read_bias;
148262c94a05SWarner Losh 	}
1483c6171b44SWarner Losh 
1484c6171b44SWarner Losh 	/*
1485c6171b44SWarner Losh 	 * See if our current limiter allows this I/O. Because we only call this
1486c6171b44SWarner Losh 	 * here, and not in next_trim, the 'bandwidth' limits for trims won't
1487c6171b44SWarner Losh 	 * work, while the iops or max queued limits will work. It's tricky
1488c6171b44SWarner Losh 	 * because we want the limits to be from the perspective of the
1489c6171b44SWarner Losh 	 * "commands sent to the device." To make iops work, we need to check
1490c6171b44SWarner Losh 	 * only here (since we want all the ops we combine to count as one). To
1491c6171b44SWarner Losh 	 * make bw limits work, we'd need to check in next_trim, but that would
1492c6171b44SWarner Losh 	 * have the effect of limiting the iops as seen from the upper layers.
1493c6171b44SWarner Losh 	 */
1494c6171b44SWarner Losh 	if (cam_iosched_limiter_iop(&isc->trim_stats, bp) != 0) {
1495c6171b44SWarner Losh 		if (iosched_debug)
1496c6171b44SWarner Losh 			printf("Can't trim because limiter says no.\n");
1497c6171b44SWarner Losh 		isc->trim_stats.state_flags |= IOP_RATE_LIMITED;
1498c6171b44SWarner Losh 		return NULL;
1499c6171b44SWarner Losh 	}
1500c6171b44SWarner Losh 	isc->current_read_bias = isc->read_bias;
1501c6171b44SWarner Losh 	isc->trim_stats.state_flags &= ~IOP_RATE_LIMITED;
1502c6171b44SWarner Losh 	/* cam_iosched_next_trim below keeps proper book */
150362c94a05SWarner Losh #endif
1504ba6c22ceSWarner Losh 	return cam_iosched_next_trim(isc);
1505ba6c22ceSWarner Losh }
1506ba6c22ceSWarner Losh 
1507cc1572ddSWarner Losh 
15081599fc90SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1509cc1572ddSWarner Losh static struct bio *
1510cc1572ddSWarner Losh bio_next(struct bio *bp)
1511cc1572ddSWarner Losh {
1512cc1572ddSWarner Losh 	bp = TAILQ_NEXT(bp, bio_queue);
1513cc1572ddSWarner Losh 	/*
1514cc1572ddSWarner Losh 	 * After the first commands, the ordered bit terminates
1515cc1572ddSWarner Losh 	 * our search because BIO_ORDERED acts like a barrier.
1516cc1572ddSWarner Losh 	 */
1517cc1572ddSWarner Losh 	if (bp == NULL || bp->bio_flags & BIO_ORDERED)
1518cc1572ddSWarner Losh 		return NULL;
1519cc1572ddSWarner Losh 	return bp;
1520cc1572ddSWarner Losh }
1521cc1572ddSWarner Losh 
1522cc1572ddSWarner Losh static bool
1523cc1572ddSWarner Losh cam_iosched_rate_limited(struct iop_stats *ios)
1524cc1572ddSWarner Losh {
1525cc1572ddSWarner Losh 	return ios->state_flags & IOP_RATE_LIMITED;
1526cc1572ddSWarner Losh }
1527cc1572ddSWarner Losh #endif
1528cc1572ddSWarner Losh 
1529ba6c22ceSWarner Losh /*
1530ba6c22ceSWarner Losh  * Determine what the next bit of work to do is for the periph. The
1531ba6c22ceSWarner Losh  * default implementation looks to see if we have trims to do, but no
1532ba6c22ceSWarner Losh  * trims outstanding. If so, we do that. Otherwise we see if we have
1533ba6c22ceSWarner Losh  * other work. If we do, then we do that. Otherwise why were we called?
1534ba6c22ceSWarner Losh  */
1535ba6c22ceSWarner Losh struct bio *
1536ba6c22ceSWarner Losh cam_iosched_next_bio(struct cam_iosched_softc *isc)
1537ba6c22ceSWarner Losh {
1538ba6c22ceSWarner Losh 	struct bio *bp;
1539ba6c22ceSWarner Losh 
1540ba6c22ceSWarner Losh 	/*
1541ba6c22ceSWarner Losh 	 * See if we have a trim that can be scheduled. We can only send one
15420028abe6SWarner Losh 	 * at a time down, so this takes that into account.
15430028abe6SWarner Losh 	 *
15440028abe6SWarner Losh 	 * XXX newer TRIM commands are queueable. Revisit this when we
15450028abe6SWarner Losh 	 * implement them.
1546ba6c22ceSWarner Losh 	 */
15470028abe6SWarner Losh 	if ((bp = cam_iosched_get_trim(isc)) != NULL)
1548ba6c22ceSWarner Losh 		return bp;
1549ba6c22ceSWarner Losh 
1550df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1551ba6c22ceSWarner Losh 	/*
1552e3d92d4cSWarner Losh 	 * See if we have any pending writes, room in the queue for them,
1553e3d92d4cSWarner Losh 	 * and no pending reads (unless we've scheduled too many).
1554e3d92d4cSWarner Losh 	 * if so, those are next.
1555ba6c22ceSWarner Losh 	 */
1556035ec48eSWarner Losh 	if (do_dynamic_iosched) {
15570028abe6SWarner Losh 		if ((bp = cam_iosched_get_write(isc)) != NULL)
1558ba6c22ceSWarner Losh 			return bp;
1559ba6c22ceSWarner Losh 	}
1560ba6c22ceSWarner Losh #endif
1561ba6c22ceSWarner Losh 	/*
1562ba6c22ceSWarner Losh 	 * next, see if there's other, normal I/O waiting. If so return that.
1563ba6c22ceSWarner Losh 	 */
1564df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1565035ec48eSWarner Losh 	if (do_dynamic_iosched) {
1566cc1572ddSWarner Losh 		for (bp = bioq_first(&isc->bio_queue); bp != NULL;
1567cc1572ddSWarner Losh 		     bp = bio_next(bp)) {
1568cc1572ddSWarner Losh 			/*
1569cc1572ddSWarner Losh 			 * For the dynamic scheduler with a read bias, bio_queue
1570cc1572ddSWarner Losh 			 * is only for reads. However, without one, all
1571cc1572ddSWarner Losh 			 * operations are queued. Enforce limits here for any
1572cc1572ddSWarner Losh 			 * operation we find here.
1573cc1572ddSWarner Losh 			 */
1574cc1572ddSWarner Losh 			if (bp->bio_cmd == BIO_READ) {
1575cc1572ddSWarner Losh 				if (cam_iosched_rate_limited(&isc->read_stats) ||
1576cf3ec151SWarner Losh 				    cam_iosched_limiter_iop(&isc->read_stats, bp) != 0) {
1577cf3ec151SWarner Losh 					isc->read_stats.state_flags |= IOP_RATE_LIMITED;
1578cc1572ddSWarner Losh 					continue;
1579cf3ec151SWarner Losh 				}
1580cf3ec151SWarner Losh 				isc->read_stats.state_flags &= ~IOP_RATE_LIMITED;
1581cc1572ddSWarner Losh 			}
1582cc1572ddSWarner Losh 			/*
1583cc1572ddSWarner Losh 			 * There can only be write requests on the queue when
1584cc1572ddSWarner Losh 			 * the read bias is 0, but we need to process them
1585cc1572ddSWarner Losh 			 * here. We do not assert for read bias == 0, however,
1586cc1572ddSWarner Losh 			 * since it is dynamic and we can have WRITE operations
1587cc1572ddSWarner Losh 			 * in the queue after we transition from 0 to non-zero.
1588cc1572ddSWarner Losh 			 */
1589cc1572ddSWarner Losh 			if (bp->bio_cmd == BIO_WRITE) {
1590cc1572ddSWarner Losh 				if (cam_iosched_rate_limited(&isc->write_stats) ||
1591cc1572ddSWarner Losh 				    cam_iosched_limiter_iop(&isc->write_stats, bp) != 0) {
1592cc1572ddSWarner Losh 					isc->write_stats.state_flags |= IOP_RATE_LIMITED;
1593cc1572ddSWarner Losh 					continue;
1594cc1572ddSWarner Losh 				}
1595cc1572ddSWarner Losh 				isc->write_stats.state_flags &= ~IOP_RATE_LIMITED;
1596cc1572ddSWarner Losh 			}
1597cc1572ddSWarner Losh 			/*
1598cc1572ddSWarner Losh 			 * here we know we have a bp that's != NULL, that's not rate limited
1599cc1572ddSWarner Losh 			 * and can be the next I/O.
1600cc1572ddSWarner Losh 			 */
1601cc1572ddSWarner Losh 			break;
1602cc1572ddSWarner Losh 		}
1603cc1572ddSWarner Losh 	} else
1604ba6c22ceSWarner Losh #endif
1605cc1572ddSWarner Losh 		bp = bioq_first(&isc->bio_queue);
1606cc1572ddSWarner Losh 
1607cc1572ddSWarner Losh 	if (bp == NULL)
1608cc1572ddSWarner Losh 		return (NULL);
1609ba6c22ceSWarner Losh 	bioq_remove(&isc->bio_queue, bp);
1610df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1611035ec48eSWarner Losh 	if (do_dynamic_iosched) {
1612ba6c22ceSWarner Losh 		if (bp->bio_cmd == BIO_READ) {
1613ba6c22ceSWarner Losh 			isc->read_stats.queued--;
1614ba6c22ceSWarner Losh 			isc->read_stats.total++;
1615ba6c22ceSWarner Losh 			isc->read_stats.pending++;
1616cc1572ddSWarner Losh 		} else if (bp->bio_cmd == BIO_WRITE) {
1617cc1572ddSWarner Losh 			isc->write_stats.queued--;
1618cc1572ddSWarner Losh 			isc->write_stats.total++;
1619cc1572ddSWarner Losh 			isc->write_stats.pending++;
1620*a85fea31SWarner Losh 		}
1621ba6c22ceSWarner Losh 	}
1622ba6c22ceSWarner Losh 	if (iosched_debug > 9)
1623ba6c22ceSWarner Losh 		printf("HWQ : %p %#x\n", bp, bp->bio_cmd);
1624ba6c22ceSWarner Losh #endif
1625ba6c22ceSWarner Losh 	return bp;
1626ba6c22ceSWarner Losh }
1627ba6c22ceSWarner Losh 
1628ba6c22ceSWarner Losh /*
1629ba6c22ceSWarner Losh  * Driver has been given some work to do by the block layer. Tell the
1630ba6c22ceSWarner Losh  * scheduler about it and have it queue the work up. The scheduler module
1631ba6c22ceSWarner Losh  * will then return the currently most useful bit of work later, possibly
1632ba6c22ceSWarner Losh  * deferring work for various reasons.
1633ba6c22ceSWarner Losh  */
1634ba6c22ceSWarner Losh void
1635ba6c22ceSWarner Losh cam_iosched_queue_work(struct cam_iosched_softc *isc, struct bio *bp)
1636ba6c22ceSWarner Losh {
1637ba6c22ceSWarner Losh 
1638ba6c22ceSWarner Losh 	/*
16390d83f8dcSWarner Losh 	 * A BIO_SPEEDUP from the uppper layers means that they have a block
16400d83f8dcSWarner Losh 	 * shortage. At the present, this is only sent when we're trying to
16410d83f8dcSWarner Losh 	 * allocate blocks, but have a shortage before giving up. bio_length is
16420d83f8dcSWarner Losh 	 * the size of their shortage. We will complete just enough BIO_DELETEs
16430d83f8dcSWarner Losh 	 * in the queue to satisfy the need. If bio_length is 0, we'll complete
16440d83f8dcSWarner Losh 	 * them all. This allows the scheduler to delay BIO_DELETEs to improve
16450d83f8dcSWarner Losh 	 * read/write performance without worrying about the upper layers. When
16460d83f8dcSWarner Losh 	 * it's possibly a problem, we respond by pretending the BIO_DELETEs
16470d83f8dcSWarner Losh 	 * just worked. We can't do anything about the BIO_DELETEs in the
16480d83f8dcSWarner Losh 	 * hardware, though. We have to wait for them to complete.
16490d83f8dcSWarner Losh 	 */
16500d83f8dcSWarner Losh 	if (bp->bio_cmd == BIO_SPEEDUP) {
16510d83f8dcSWarner Losh 		off_t len;
16520d83f8dcSWarner Losh 		struct bio *nbp;
16530d83f8dcSWarner Losh 
16540d83f8dcSWarner Losh 		len = 0;
16550d83f8dcSWarner Losh 		while (bioq_first(&isc->trim_queue) &&
16560d83f8dcSWarner Losh 		    (bp->bio_length == 0 || len < bp->bio_length)) {
16570d83f8dcSWarner Losh 			nbp = bioq_takefirst(&isc->trim_queue);
16580d83f8dcSWarner Losh 			len += nbp->bio_length;
16590d83f8dcSWarner Losh 			nbp->bio_error = 0;
16600d83f8dcSWarner Losh 			biodone(nbp);
16610d83f8dcSWarner Losh 		}
16620d83f8dcSWarner Losh 		if (bp->bio_length > 0) {
16630d83f8dcSWarner Losh 			if (bp->bio_length > len)
16640d83f8dcSWarner Losh 				bp->bio_resid = bp->bio_length - len;
16650d83f8dcSWarner Losh 			else
16660d83f8dcSWarner Losh 				bp->bio_resid = 0;
16670d83f8dcSWarner Losh 		}
16680d83f8dcSWarner Losh 		bp->bio_error = 0;
16690d83f8dcSWarner Losh 		biodone(bp);
16700d83f8dcSWarner Losh 		return;
16710d83f8dcSWarner Losh 	}
16720d83f8dcSWarner Losh 
16730d83f8dcSWarner Losh 	/*
1674d900ade5SWarner Losh 	 * If we get a BIO_FLUSH, and we're doing delayed BIO_DELETEs then we
1675d900ade5SWarner Losh 	 * set the last tick time to one less than the current ticks minus the
1676d900ade5SWarner Losh 	 * delay to force the BIO_DELETEs to be presented to the client driver.
1677d900ade5SWarner Losh 	 */
1678d900ade5SWarner Losh 	if (bp->bio_cmd == BIO_FLUSH && isc->trim_ticks > 0)
1679d900ade5SWarner Losh 		isc->last_trim_tick = ticks - isc->trim_ticks - 1;
1680d900ade5SWarner Losh 
1681d900ade5SWarner Losh 	/*
1682d900ade5SWarner Losh 	 * Put all trims on the trim queue. Otherwise put the work on the bio
1683d900ade5SWarner Losh 	 * queue.
1684ba6c22ceSWarner Losh 	 */
1685ba6c22ceSWarner Losh 	if (bp->bio_cmd == BIO_DELETE) {
168697f8aa05SWarner Losh 		bioq_insert_tail(&isc->trim_queue, bp);
1687d900ade5SWarner Losh 		if (isc->queued_trims == 0)
1688d900ade5SWarner Losh 			isc->last_trim_tick = ticks;
1689d900ade5SWarner Losh 		isc->queued_trims++;
1690df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1691ba6c22ceSWarner Losh 		isc->trim_stats.in++;
1692ba6c22ceSWarner Losh 		isc->trim_stats.queued++;
1693ba6c22ceSWarner Losh #endif
1694ba6c22ceSWarner Losh 	}
1695df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1696cc1572ddSWarner Losh 	else if (do_dynamic_iosched && isc->read_bias != 0 &&
1697cc1572ddSWarner Losh 	    (bp->bio_cmd != BIO_READ)) {
1698ba6c22ceSWarner Losh 		if (cam_iosched_sort_queue(isc))
1699ba6c22ceSWarner Losh 			bioq_disksort(&isc->write_queue, bp);
1700ba6c22ceSWarner Losh 		else
1701ba6c22ceSWarner Losh 			bioq_insert_tail(&isc->write_queue, bp);
1702ba6c22ceSWarner Losh 		if (iosched_debug > 9)
1703ba6c22ceSWarner Losh 			printf("Qw  : %p %#x\n", bp, bp->bio_cmd);
1704ba6c22ceSWarner Losh 		if (bp->bio_cmd == BIO_WRITE) {
1705ba6c22ceSWarner Losh 			isc->write_stats.in++;
1706ba6c22ceSWarner Losh 			isc->write_stats.queued++;
1707ba6c22ceSWarner Losh 		}
1708ba6c22ceSWarner Losh 	}
1709ba6c22ceSWarner Losh #endif
1710ba6c22ceSWarner Losh 	else {
1711ba6c22ceSWarner Losh 		if (cam_iosched_sort_queue(isc))
1712ba6c22ceSWarner Losh 			bioq_disksort(&isc->bio_queue, bp);
1713ba6c22ceSWarner Losh 		else
1714ba6c22ceSWarner Losh 			bioq_insert_tail(&isc->bio_queue, bp);
1715df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1716ba6c22ceSWarner Losh 		if (iosched_debug > 9)
1717ba6c22ceSWarner Losh 			printf("Qr  : %p %#x\n", bp, bp->bio_cmd);
1718ba6c22ceSWarner Losh 		if (bp->bio_cmd == BIO_READ) {
1719ba6c22ceSWarner Losh 			isc->read_stats.in++;
1720ba6c22ceSWarner Losh 			isc->read_stats.queued++;
1721ba6c22ceSWarner Losh 		} else if (bp->bio_cmd == BIO_WRITE) {
1722ba6c22ceSWarner Losh 			isc->write_stats.in++;
1723ba6c22ceSWarner Losh 			isc->write_stats.queued++;
1724ba6c22ceSWarner Losh 		}
1725ba6c22ceSWarner Losh #endif
1726ba6c22ceSWarner Losh 	}
1727ba6c22ceSWarner Losh }
1728ba6c22ceSWarner Losh 
1729ba6c22ceSWarner Losh /*
1730ba6c22ceSWarner Losh  * If we have work, get it scheduled. Called with the periph lock held.
1731ba6c22ceSWarner Losh  */
1732ba6c22ceSWarner Losh void
1733ba6c22ceSWarner Losh cam_iosched_schedule(struct cam_iosched_softc *isc, struct cam_periph *periph)
1734ba6c22ceSWarner Losh {
1735ba6c22ceSWarner Losh 
1736ba6c22ceSWarner Losh 	if (cam_iosched_has_work(isc))
1737ba6c22ceSWarner Losh 		xpt_schedule(periph, CAM_PRIORITY_NORMAL);
1738ba6c22ceSWarner Losh }
1739ba6c22ceSWarner Losh 
1740ba6c22ceSWarner Losh /*
174155c770b4SWarner Losh  * Complete a trim request. Mark that we no longer have one in flight.
1742ba6c22ceSWarner Losh  */
1743ba6c22ceSWarner Losh void
1744ba6c22ceSWarner Losh cam_iosched_trim_done(struct cam_iosched_softc *isc)
1745ba6c22ceSWarner Losh {
1746ba6c22ceSWarner Losh 
1747ece56614SWarner Losh 	isc->flags &= ~CAM_IOSCHED_FLAG_TRIM_ACTIVE;
1748ba6c22ceSWarner Losh }
1749ba6c22ceSWarner Losh 
1750ba6c22ceSWarner Losh /*
1751ba6c22ceSWarner Losh  * Complete a bio. Called before we release the ccb with xpt_release_ccb so we
1752ba6c22ceSWarner Losh  * might use notes in the ccb for statistics.
1753ba6c22ceSWarner Losh  */
1754ba6c22ceSWarner Losh int
1755ba6c22ceSWarner Losh cam_iosched_bio_complete(struct cam_iosched_softc *isc, struct bio *bp,
1756ba6c22ceSWarner Losh     union ccb *done_ccb)
1757ba6c22ceSWarner Losh {
1758ba6c22ceSWarner Losh 	int retval = 0;
1759df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1760035ec48eSWarner Losh 	if (!do_dynamic_iosched)
1761ba6c22ceSWarner Losh 		return retval;
1762ba6c22ceSWarner Losh 
1763ba6c22ceSWarner Losh 	if (iosched_debug > 10)
1764ba6c22ceSWarner Losh 		printf("done: %p %#x\n", bp, bp->bio_cmd);
1765ba6c22ceSWarner Losh 	if (bp->bio_cmd == BIO_WRITE) {
1766ba6c22ceSWarner Losh 		retval = cam_iosched_limiter_iodone(&isc->write_stats, bp);
1767157cb465SWarner Losh 		if ((bp->bio_flags & BIO_ERROR) != 0)
1768c4b72d8bSWarner Losh 			isc->write_stats.errs++;
1769ba6c22ceSWarner Losh 		isc->write_stats.out++;
1770ba6c22ceSWarner Losh 		isc->write_stats.pending--;
1771ba6c22ceSWarner Losh 	} else if (bp->bio_cmd == BIO_READ) {
1772ba6c22ceSWarner Losh 		retval = cam_iosched_limiter_iodone(&isc->read_stats, bp);
1773157cb465SWarner Losh 		if ((bp->bio_flags & BIO_ERROR) != 0)
1774c4b72d8bSWarner Losh 			isc->read_stats.errs++;
1775ba6c22ceSWarner Losh 		isc->read_stats.out++;
1776ba6c22ceSWarner Losh 		isc->read_stats.pending--;
1777ba6c22ceSWarner Losh 	} else if (bp->bio_cmd == BIO_DELETE) {
1778157cb465SWarner Losh 		if ((bp->bio_flags & BIO_ERROR) != 0)
1779c4b72d8bSWarner Losh 			isc->trim_stats.errs++;
1780ba6c22ceSWarner Losh 		isc->trim_stats.out++;
1781ba6c22ceSWarner Losh 		isc->trim_stats.pending--;
1782ba6c22ceSWarner Losh 	} else if (bp->bio_cmd != BIO_FLUSH) {
1783ba6c22ceSWarner Losh 		if (iosched_debug)
1784ba6c22ceSWarner Losh 			printf("Completing command with bio_cmd == %#x\n", bp->bio_cmd);
1785ba6c22ceSWarner Losh 	}
1786ba6c22ceSWarner Losh 
17874afa62beSWarner Losh 	if ((bp->bio_flags & BIO_ERROR) == 0 && done_ccb != NULL &&
17884afa62beSWarner Losh 	    (done_ccb->ccb_h.status & CAM_QOS_VALID) != 0) {
1789e5436ab5SWarner Losh 		sbintime_t sim_latency;
1790e5436ab5SWarner Losh 
1791e5436ab5SWarner Losh 		sim_latency = cam_iosched_sbintime_t(done_ccb->ccb_h.qos.periph_data);
1792e5436ab5SWarner Losh 
1793e5436ab5SWarner Losh 		cam_iosched_io_metric_update(isc, sim_latency,
1794ba6c22ceSWarner Losh 		    bp->bio_cmd, bp->bio_bcount);
1795e5436ab5SWarner Losh 		/*
1796e5436ab5SWarner Losh 		 * Debugging code: allow callbacks to the periph driver when latency max
1797e5436ab5SWarner Losh 		 * is exceeded. This can be useful for triggering external debugging actions.
1798e5436ab5SWarner Losh 		 */
1799e5436ab5SWarner Losh 		if (isc->latfcn && isc->max_lat != 0 && sim_latency > isc->max_lat)
1800e5436ab5SWarner Losh 			isc->latfcn(isc->latarg, sim_latency, bp);
1801e5436ab5SWarner Losh 	}
1802e5436ab5SWarner Losh 
1803ba6c22ceSWarner Losh #endif
1804ba6c22ceSWarner Losh 	return retval;
1805ba6c22ceSWarner Losh }
1806ba6c22ceSWarner Losh 
1807ba6c22ceSWarner Losh /*
1808ba6c22ceSWarner Losh  * Tell the io scheduler that you've pushed a trim down into the sim.
180955c770b4SWarner Losh  * This also tells the I/O scheduler not to push any more trims down, so
181055c770b4SWarner Losh  * some periphs do not call it if they can cope with multiple trims in flight.
1811ba6c22ceSWarner Losh  */
1812ba6c22ceSWarner Losh void
1813ba6c22ceSWarner Losh cam_iosched_submit_trim(struct cam_iosched_softc *isc)
1814ba6c22ceSWarner Losh {
1815ba6c22ceSWarner Losh 
1816ece56614SWarner Losh 	isc->flags |= CAM_IOSCHED_FLAG_TRIM_ACTIVE;
1817ba6c22ceSWarner Losh }
1818ba6c22ceSWarner Losh 
1819ba6c22ceSWarner Losh /*
1820ba6c22ceSWarner Losh  * Change the sorting policy hint for I/O transactions for this device.
1821ba6c22ceSWarner Losh  */
1822ba6c22ceSWarner Losh void
1823ba6c22ceSWarner Losh cam_iosched_set_sort_queue(struct cam_iosched_softc *isc, int val)
1824ba6c22ceSWarner Losh {
1825ba6c22ceSWarner Losh 
1826ba6c22ceSWarner Losh 	isc->sort_io_queue = val;
1827ba6c22ceSWarner Losh }
1828ba6c22ceSWarner Losh 
1829ba6c22ceSWarner Losh int
1830ba6c22ceSWarner Losh cam_iosched_has_work_flags(struct cam_iosched_softc *isc, uint32_t flags)
1831ba6c22ceSWarner Losh {
1832ba6c22ceSWarner Losh 	return isc->flags & flags;
1833ba6c22ceSWarner Losh }
1834ba6c22ceSWarner Losh 
1835ba6c22ceSWarner Losh void
1836ba6c22ceSWarner Losh cam_iosched_set_work_flags(struct cam_iosched_softc *isc, uint32_t flags)
1837ba6c22ceSWarner Losh {
1838ba6c22ceSWarner Losh 	isc->flags |= flags;
1839ba6c22ceSWarner Losh }
1840ba6c22ceSWarner Losh 
1841ba6c22ceSWarner Losh void
1842ba6c22ceSWarner Losh cam_iosched_clr_work_flags(struct cam_iosched_softc *isc, uint32_t flags)
1843ba6c22ceSWarner Losh {
1844ba6c22ceSWarner Losh 	isc->flags &= ~flags;
1845ba6c22ceSWarner Losh }
1846ba6c22ceSWarner Losh 
1847df236247SWarner Losh #ifdef CAM_IOSCHED_DYNAMIC
1848ba6c22ceSWarner Losh /*
1849ba6c22ceSWarner Losh  * After the method presented in Jack Crenshaw's 1998 article "Integer
18500b4060b0SEd Maste  * Square Roots," reprinted at
1851ba6c22ceSWarner Losh  * http://www.embedded.com/electronics-blogs/programmer-s-toolbox/4219659/Integer-Square-Roots
1852ba6c22ceSWarner Losh  * and well worth the read. Briefly, we find the power of 4 that's the
1853ba6c22ceSWarner Losh  * largest smaller than val. We then check each smaller power of 4 to
1854ba6c22ceSWarner Losh  * see if val is still bigger. The right shifts at each step divide
1855ba6c22ceSWarner Losh  * the result by 2 which after successive application winds up
1856ba6c22ceSWarner Losh  * accumulating the right answer. It could also have been accumulated
1857ba6c22ceSWarner Losh  * using a separate root counter, but this code is smaller and faster
1858ba6c22ceSWarner Losh  * than that method. This method is also integer size invariant.
18590b4060b0SEd Maste  * It returns floor(sqrt((float)val)), or the largest integer less than
1860ba6c22ceSWarner Losh  * or equal to the square root.
1861ba6c22ceSWarner Losh  */
1862ba6c22ceSWarner Losh static uint64_t
1863ba6c22ceSWarner Losh isqrt64(uint64_t val)
1864ba6c22ceSWarner Losh {
1865ba6c22ceSWarner Losh 	uint64_t res = 0;
1866ba6c22ceSWarner Losh 	uint64_t bit = 1ULL << (sizeof(uint64_t) * NBBY - 2);
1867ba6c22ceSWarner Losh 
1868ba6c22ceSWarner Losh 	/*
1869ba6c22ceSWarner Losh 	 * Find the largest power of 4 smaller than val.
1870ba6c22ceSWarner Losh 	 */
1871ba6c22ceSWarner Losh 	while (bit > val)
1872ba6c22ceSWarner Losh 		bit >>= 2;
1873ba6c22ceSWarner Losh 
1874ba6c22ceSWarner Losh 	/*
1875ba6c22ceSWarner Losh 	 * Accumulate the answer, one bit at a time (we keep moving
1876ba6c22ceSWarner Losh 	 * them over since 2 is the square root of 4 and we test
1877ba6c22ceSWarner Losh 	 * powers of 4). We accumulate where we find the bit, but
1878ba6c22ceSWarner Losh 	 * the successive shifts land the bit in the right place
1879ba6c22ceSWarner Losh 	 * by the end.
1880ba6c22ceSWarner Losh 	 */
1881ba6c22ceSWarner Losh 	while (bit != 0) {
1882ba6c22ceSWarner Losh 		if (val >= res + bit) {
1883ba6c22ceSWarner Losh 			val -= res + bit;
1884ba6c22ceSWarner Losh 			res = (res >> 1) + bit;
1885ba6c22ceSWarner Losh 		} else
1886ba6c22ceSWarner Losh 			res >>= 1;
1887ba6c22ceSWarner Losh 		bit >>= 2;
1888ba6c22ceSWarner Losh 	}
1889ba6c22ceSWarner Losh 
1890ba6c22ceSWarner Losh 	return res;
1891ba6c22ceSWarner Losh }
1892ba6c22ceSWarner Losh 
189308fc2f23SWarner Losh static sbintime_t latencies[LAT_BUCKETS - 1] = {
189422832069SWarner Losh 	BUCKET_BASE <<  0,	/* 20us */
189522832069SWarner Losh 	BUCKET_BASE <<  1,
189622832069SWarner Losh 	BUCKET_BASE <<  2,
189722832069SWarner Losh 	BUCKET_BASE <<  3,
189822832069SWarner Losh 	BUCKET_BASE <<  4,
189922832069SWarner Losh 	BUCKET_BASE <<  5,
190022832069SWarner Losh 	BUCKET_BASE <<  6,
190122832069SWarner Losh 	BUCKET_BASE <<  7,
190222832069SWarner Losh 	BUCKET_BASE <<  8,
190322832069SWarner Losh 	BUCKET_BASE <<  9,
190422832069SWarner Losh 	BUCKET_BASE << 10,
190522832069SWarner Losh 	BUCKET_BASE << 11,
190622832069SWarner Losh 	BUCKET_BASE << 12,
190722832069SWarner Losh 	BUCKET_BASE << 13,
190822832069SWarner Losh 	BUCKET_BASE << 14,
190922832069SWarner Losh 	BUCKET_BASE << 15,
191022832069SWarner Losh 	BUCKET_BASE << 16,
191122832069SWarner Losh 	BUCKET_BASE << 17,
191222832069SWarner Losh 	BUCKET_BASE << 18	/* 5,242,880us */
1913cf3ec151SWarner Losh };
1914cf3ec151SWarner Losh 
1915ba6c22ceSWarner Losh static void
1916ba6c22ceSWarner Losh cam_iosched_update(struct iop_stats *iop, sbintime_t sim_latency)
1917ba6c22ceSWarner Losh {
191879d80af2SWarner Losh 	sbintime_t y, deltasq, delta;
1919cf3ec151SWarner Losh 	int i;
1920cf3ec151SWarner Losh 
1921cf3ec151SWarner Losh 	/*
1922cf3ec151SWarner Losh 	 * Keep counts for latency. We do it by power of two buckets.
1923cf3ec151SWarner Losh 	 * This helps us spot outlier behavior obscured by averages.
1924cf3ec151SWarner Losh 	 */
1925cf3ec151SWarner Losh 	for (i = 0; i < LAT_BUCKETS - 1; i++) {
1926cf3ec151SWarner Losh 		if (sim_latency < latencies[i]) {
1927cf3ec151SWarner Losh 			iop->latencies[i]++;
1928cf3ec151SWarner Losh 			break;
1929cf3ec151SWarner Losh 		}
1930cf3ec151SWarner Losh 	}
1931cf3ec151SWarner Losh 	if (i == LAT_BUCKETS - 1)
1932c048ac62SWarner Losh 		iop->latencies[i]++; 	 /* Put all > 8192ms values into the last bucket. */
1933ba6c22ceSWarner Losh 
1934ba6c22ceSWarner Losh 	/*
19350b4060b0SEd Maste 	 * Classic exponentially decaying average with a tiny alpha
1936ba6c22ceSWarner Losh 	 * (2 ^ -alpha_bits). For more info see the NIST statistical
1937ba6c22ceSWarner Losh 	 * handbook.
1938ba6c22ceSWarner Losh 	 *
193979d80af2SWarner Losh 	 * ema_t = y_t * alpha + ema_t-1 * (1 - alpha)		[nist]
194079d80af2SWarner Losh 	 * ema_t = y_t * alpha + ema_t-1 - alpha * ema_t-1
194179d80af2SWarner Losh 	 * ema_t = alpha * y_t - alpha * ema_t-1 + ema_t-1
1942ba6c22ceSWarner Losh 	 * alpha = 1 / (1 << alpha_bits)
194379d80af2SWarner Losh 	 * sub e == ema_t-1, b == 1/alpha (== 1 << alpha_bits), d == y_t - ema_t-1
194479d80af2SWarner Losh 	 *	= y_t/b - e/b + be/b
194579d80af2SWarner Losh 	 *      = (y_t - e + be) / b
194679d80af2SWarner Losh 	 *	= (e + d) / b
1947ba6c22ceSWarner Losh 	 *
1948ba6c22ceSWarner Losh 	 * Since alpha is a power of two, we can compute this w/o any mult or
1949ba6c22ceSWarner Losh 	 * division.
195079d80af2SWarner Losh 	 *
195179d80af2SWarner Losh 	 * Variance can also be computed. Usually, it would be expressed as follows:
195279d80af2SWarner Losh 	 *	diff_t = y_t - ema_t-1
195379d80af2SWarner Losh 	 *	emvar_t = (1 - alpha) * (emavar_t-1 + diff_t^2 * alpha)
195479d80af2SWarner Losh 	 *	  = emavar_t-1 - alpha * emavar_t-1 + delta_t^2 * alpha - (delta_t * alpha)^2
195579d80af2SWarner Losh 	 * sub b == 1/alpha (== 1 << alpha_bits), e == emavar_t-1, d = delta_t^2
195679d80af2SWarner Losh 	 *	  = e - e/b + dd/b + dd/bb
195779d80af2SWarner Losh 	 *	  = (bbe - be + bdd + dd) / bb
195879d80af2SWarner Losh 	 *	  = (bbe + b(dd-e) + dd) / bb (which is expanded below bb = 1<<(2*alpha_bits))
195979d80af2SWarner Losh 	 */
196079d80af2SWarner Losh 	/*
196179d80af2SWarner Losh 	 * XXX possible numeric issues
196279d80af2SWarner Losh 	 *	o We assume right shifted integers do the right thing, since that's
196379d80af2SWarner Losh 	 *	  implementation defined. You can change the right shifts to / (1LL << alpha).
196479d80af2SWarner Losh 	 *	o alpha_bits = 9 gives ema ceiling of 23 bits of seconds for ema and 14 bits
196579d80af2SWarner Losh 	 *	  for emvar. This puts a ceiling of 13 bits on alpha since we need a
196679d80af2SWarner Losh 	 *	  few tens of seconds of representation.
196779d80af2SWarner Losh 	 *	o We mitigate alpha issues by never setting it too high.
1968ba6c22ceSWarner Losh 	 */
1969ba6c22ceSWarner Losh 	y = sim_latency;
197079d80af2SWarner Losh 	delta = (y - iop->ema);					/* d */
197179d80af2SWarner Losh 	iop->ema = ((iop->ema << alpha_bits) + delta) >> alpha_bits;
1972ba6c22ceSWarner Losh 
1973ba6c22ceSWarner Losh 	/*
197479d80af2SWarner Losh 	 * Were we to naively plow ahead at this point, we wind up with many numerical
197579d80af2SWarner Losh 	 * issues making any SD > ~3ms unreliable. So, we shift right by 12. This leaves
197679d80af2SWarner Losh 	 * us with microsecond level precision in the input, so the same in the
197779d80af2SWarner Losh 	 * output. It means we can't overflow deltasq unless delta > 4k seconds. It
197879d80af2SWarner Losh 	 * also means that emvar can be up 46 bits 40 of which are fraction, which
197979d80af2SWarner Losh 	 * gives us a way to measure up to ~8s in the SD before the computation goes
198079d80af2SWarner Losh 	 * unstable. Even the worst hard disk rarely has > 1s service time in the
198179d80af2SWarner Losh 	 * drive. It does mean we have to shift left 12 bits after taking the
198279d80af2SWarner Losh 	 * square root to compute the actual standard deviation estimate. This loss of
198379d80af2SWarner Losh 	 * precision is preferable to needing int128 types to work. The above numbers
198479d80af2SWarner Losh 	 * assume alpha=9. 10 or 11 are ok, but we start to run into issues at 12,
198579d80af2SWarner Losh 	 * so 12 or 13 is OK for EMA, EMVAR and SD will be wrong in those cases.
1986ba6c22ceSWarner Losh 	 */
198779d80af2SWarner Losh 	delta >>= 12;
198879d80af2SWarner Losh 	deltasq = delta * delta;				/* dd */
198979d80af2SWarner Losh 	iop->emvar = ((iop->emvar << (2 * alpha_bits)) +	/* bbe */
199079d80af2SWarner Losh 	    ((deltasq - iop->emvar) << alpha_bits) +		/* b(dd-e) */
199179d80af2SWarner Losh 	    deltasq)						/* dd */
199279d80af2SWarner Losh 	    >> (2 * alpha_bits);				/* div bb */
199379d80af2SWarner Losh 	iop->sd = (sbintime_t)isqrt64((uint64_t)iop->emvar) << 12;
1994ba6c22ceSWarner Losh }
1995ba6c22ceSWarner Losh 
1996ba6c22ceSWarner Losh static void
1997ba6c22ceSWarner Losh cam_iosched_io_metric_update(struct cam_iosched_softc *isc,
1998ba6c22ceSWarner Losh     sbintime_t sim_latency, int cmd, size_t size)
1999ba6c22ceSWarner Losh {
2000ba6c22ceSWarner Losh 	/* xxx Do we need to scale based on the size of the I/O ? */
2001ba6c22ceSWarner Losh 	switch (cmd) {
2002ba6c22ceSWarner Losh 	case BIO_READ:
2003ba6c22ceSWarner Losh 		cam_iosched_update(&isc->read_stats, sim_latency);
2004ba6c22ceSWarner Losh 		break;
2005ba6c22ceSWarner Losh 	case BIO_WRITE:
2006ba6c22ceSWarner Losh 		cam_iosched_update(&isc->write_stats, sim_latency);
2007ba6c22ceSWarner Losh 		break;
2008ba6c22ceSWarner Losh 	case BIO_DELETE:
2009ba6c22ceSWarner Losh 		cam_iosched_update(&isc->trim_stats, sim_latency);
2010ba6c22ceSWarner Losh 		break;
2011ba6c22ceSWarner Losh 	default:
2012ba6c22ceSWarner Losh 		break;
2013ba6c22ceSWarner Losh 	}
2014ba6c22ceSWarner Losh }
2015ba6c22ceSWarner Losh 
2016ba6c22ceSWarner Losh #ifdef DDB
2017ba6c22ceSWarner Losh static int biolen(struct bio_queue_head *bq)
2018ba6c22ceSWarner Losh {
2019ba6c22ceSWarner Losh 	int i = 0;
2020ba6c22ceSWarner Losh 	struct bio *bp;
2021ba6c22ceSWarner Losh 
2022ba6c22ceSWarner Losh 	TAILQ_FOREACH(bp, &bq->queue, bio_queue) {
2023ba6c22ceSWarner Losh 		i++;
2024ba6c22ceSWarner Losh 	}
2025ba6c22ceSWarner Losh 	return i;
2026ba6c22ceSWarner Losh }
2027ba6c22ceSWarner Losh 
2028ba6c22ceSWarner Losh /*
2029ba6c22ceSWarner Losh  * Show the internal state of the I/O scheduler.
2030ba6c22ceSWarner Losh  */
2031ba6c22ceSWarner Losh DB_SHOW_COMMAND(iosched, cam_iosched_db_show)
2032ba6c22ceSWarner Losh {
2033ba6c22ceSWarner Losh 	struct cam_iosched_softc *isc;
2034ba6c22ceSWarner Losh 
2035ba6c22ceSWarner Losh 	if (!have_addr) {
2036ba6c22ceSWarner Losh 		db_printf("Need addr\n");
2037ba6c22ceSWarner Losh 		return;
2038ba6c22ceSWarner Losh 	}
2039ba6c22ceSWarner Losh 	isc = (struct cam_iosched_softc *)addr;
2040ba6c22ceSWarner Losh 	db_printf("pending_reads:     %d\n", isc->read_stats.pending);
2041ba6c22ceSWarner Losh 	db_printf("min_reads:         %d\n", isc->read_stats.min);
2042ba6c22ceSWarner Losh 	db_printf("max_reads:         %d\n", isc->read_stats.max);
2043ba6c22ceSWarner Losh 	db_printf("reads:             %d\n", isc->read_stats.total);
2044ba6c22ceSWarner Losh 	db_printf("in_reads:          %d\n", isc->read_stats.in);
2045ba6c22ceSWarner Losh 	db_printf("out_reads:         %d\n", isc->read_stats.out);
2046ba6c22ceSWarner Losh 	db_printf("queued_reads:      %d\n", isc->read_stats.queued);
20473aba1d47SWarner Losh 	db_printf("Read Q len         %d\n", biolen(&isc->bio_queue));
2048ba6c22ceSWarner Losh 	db_printf("pending_writes:    %d\n", isc->write_stats.pending);
2049ba6c22ceSWarner Losh 	db_printf("min_writes:        %d\n", isc->write_stats.min);
2050ba6c22ceSWarner Losh 	db_printf("max_writes:        %d\n", isc->write_stats.max);
2051ba6c22ceSWarner Losh 	db_printf("writes:            %d\n", isc->write_stats.total);
2052ba6c22ceSWarner Losh 	db_printf("in_writes:         %d\n", isc->write_stats.in);
2053ba6c22ceSWarner Losh 	db_printf("out_writes:        %d\n", isc->write_stats.out);
2054ba6c22ceSWarner Losh 	db_printf("queued_writes:     %d\n", isc->write_stats.queued);
20553aba1d47SWarner Losh 	db_printf("Write Q len        %d\n", biolen(&isc->write_queue));
2056ba6c22ceSWarner Losh 	db_printf("pending_trims:     %d\n", isc->trim_stats.pending);
2057ba6c22ceSWarner Losh 	db_printf("min_trims:         %d\n", isc->trim_stats.min);
2058ba6c22ceSWarner Losh 	db_printf("max_trims:         %d\n", isc->trim_stats.max);
2059ba6c22ceSWarner Losh 	db_printf("trims:             %d\n", isc->trim_stats.total);
2060ba6c22ceSWarner Losh 	db_printf("in_trims:          %d\n", isc->trim_stats.in);
2061ba6c22ceSWarner Losh 	db_printf("out_trims:         %d\n", isc->trim_stats.out);
2062ba6c22ceSWarner Losh 	db_printf("queued_trims:      %d\n", isc->trim_stats.queued);
20633aba1d47SWarner Losh 	db_printf("Trim Q len         %d\n", biolen(&isc->trim_queue));
2064ba6c22ceSWarner Losh 	db_printf("read_bias:         %d\n", isc->read_bias);
2065ba6c22ceSWarner Losh 	db_printf("current_read_bias: %d\n", isc->current_read_bias);
2066ece56614SWarner Losh 	db_printf("Trim active?       %s\n",
2067ece56614SWarner Losh 	    (isc->flags & CAM_IOSCHED_FLAG_TRIM_ACTIVE) ? "yes" : "no");
2068ba6c22ceSWarner Losh }
2069ba6c22ceSWarner Losh #endif
2070ba6c22ceSWarner Losh #endif
2071