xref: /OK3568_Linux_fs/kernel/block/blk-iocost.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /* SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun  *
3*4882a593Smuzhiyun  * IO cost model based controller.
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2019 Tejun Heo <tj@kernel.org>
6*4882a593Smuzhiyun  * Copyright (C) 2019 Andy Newell <newella@fb.com>
7*4882a593Smuzhiyun  * Copyright (C) 2019 Facebook
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * One challenge of controlling IO resources is the lack of trivially
10*4882a593Smuzhiyun  * observable cost metric.  This is distinguished from CPU and memory where
11*4882a593Smuzhiyun  * wallclock time and the number of bytes can serve as accurate enough
12*4882a593Smuzhiyun  * approximations.
13*4882a593Smuzhiyun  *
14*4882a593Smuzhiyun  * Bandwidth and iops are the most commonly used metrics for IO devices but
15*4882a593Smuzhiyun  * depending on the type and specifics of the device, different IO patterns
16*4882a593Smuzhiyun  * easily lead to multiple orders of magnitude variations rendering them
17*4882a593Smuzhiyun  * useless for the purpose of IO capacity distribution.  While on-device
18*4882a593Smuzhiyun  * time, with a lot of clutches, could serve as a useful approximation for
19*4882a593Smuzhiyun  * non-queued rotational devices, this is no longer viable with modern
20*4882a593Smuzhiyun  * devices, even the rotational ones.
21*4882a593Smuzhiyun  *
22*4882a593Smuzhiyun  * While there is no cost metric we can trivially observe, it isn't a
23*4882a593Smuzhiyun  * complete mystery.  For example, on a rotational device, seek cost
24*4882a593Smuzhiyun  * dominates while a contiguous transfer contributes a smaller amount
25*4882a593Smuzhiyun  * proportional to the size.  If we can characterize at least the relative
26*4882a593Smuzhiyun  * costs of these different types of IOs, it should be possible to
27*4882a593Smuzhiyun  * implement a reasonable work-conserving proportional IO resource
28*4882a593Smuzhiyun  * distribution.
29*4882a593Smuzhiyun  *
30*4882a593Smuzhiyun  * 1. IO Cost Model
31*4882a593Smuzhiyun  *
32*4882a593Smuzhiyun  * IO cost model estimates the cost of an IO given its basic parameters and
33*4882a593Smuzhiyun  * history (e.g. the end sector of the last IO).  The cost is measured in
34*4882a593Smuzhiyun  * device time.  If a given IO is estimated to cost 10ms, the device should
35*4882a593Smuzhiyun  * be able to process ~100 of those IOs in a second.
36*4882a593Smuzhiyun  *
37*4882a593Smuzhiyun  * Currently, there's only one builtin cost model - linear.  Each IO is
38*4882a593Smuzhiyun  * classified as sequential or random and given a base cost accordingly.
39*4882a593Smuzhiyun  * On top of that, a size cost proportional to the length of the IO is
40*4882a593Smuzhiyun  * added.  While simple, this model captures the operational
41*4882a593Smuzhiyun  * characteristics of a wide varienty of devices well enough.  Default
42*4882a593Smuzhiyun  * paramters for several different classes of devices are provided and the
43*4882a593Smuzhiyun  * parameters can be configured from userspace via
44*4882a593Smuzhiyun  * /sys/fs/cgroup/io.cost.model.
45*4882a593Smuzhiyun  *
46*4882a593Smuzhiyun  * If needed, tools/cgroup/iocost_coef_gen.py can be used to generate
47*4882a593Smuzhiyun  * device-specific coefficients.
48*4882a593Smuzhiyun  *
49*4882a593Smuzhiyun  * 2. Control Strategy
50*4882a593Smuzhiyun  *
51*4882a593Smuzhiyun  * The device virtual time (vtime) is used as the primary control metric.
52*4882a593Smuzhiyun  * The control strategy is composed of the following three parts.
53*4882a593Smuzhiyun  *
54*4882a593Smuzhiyun  * 2-1. Vtime Distribution
55*4882a593Smuzhiyun  *
56*4882a593Smuzhiyun  * When a cgroup becomes active in terms of IOs, its hierarchical share is
57*4882a593Smuzhiyun  * calculated.  Please consider the following hierarchy where the numbers
58*4882a593Smuzhiyun  * inside parentheses denote the configured weights.
59*4882a593Smuzhiyun  *
60*4882a593Smuzhiyun  *           root
61*4882a593Smuzhiyun  *         /       \
62*4882a593Smuzhiyun  *      A (w:100)  B (w:300)
63*4882a593Smuzhiyun  *      /       \
64*4882a593Smuzhiyun  *  A0 (w:100)  A1 (w:100)
65*4882a593Smuzhiyun  *
66*4882a593Smuzhiyun  * If B is idle and only A0 and A1 are actively issuing IOs, as the two are
67*4882a593Smuzhiyun  * of equal weight, each gets 50% share.  If then B starts issuing IOs, B
68*4882a593Smuzhiyun  * gets 300/(100+300) or 75% share, and A0 and A1 equally splits the rest,
69*4882a593Smuzhiyun  * 12.5% each.  The distribution mechanism only cares about these flattened
70*4882a593Smuzhiyun  * shares.  They're called hweights (hierarchical weights) and always add
71*4882a593Smuzhiyun  * upto 1 (WEIGHT_ONE).
72*4882a593Smuzhiyun  *
73*4882a593Smuzhiyun  * A given cgroup's vtime runs slower in inverse proportion to its hweight.
74*4882a593Smuzhiyun  * For example, with 12.5% weight, A0's time runs 8 times slower (100/12.5)
75*4882a593Smuzhiyun  * against the device vtime - an IO which takes 10ms on the underlying
76*4882a593Smuzhiyun  * device is considered to take 80ms on A0.
77*4882a593Smuzhiyun  *
78*4882a593Smuzhiyun  * This constitutes the basis of IO capacity distribution.  Each cgroup's
79*4882a593Smuzhiyun  * vtime is running at a rate determined by its hweight.  A cgroup tracks
80*4882a593Smuzhiyun  * the vtime consumed by past IOs and can issue a new IO iff doing so
81*4882a593Smuzhiyun  * wouldn't outrun the current device vtime.  Otherwise, the IO is
82*4882a593Smuzhiyun  * suspended until the vtime has progressed enough to cover it.
83*4882a593Smuzhiyun  *
84*4882a593Smuzhiyun  * 2-2. Vrate Adjustment
85*4882a593Smuzhiyun  *
86*4882a593Smuzhiyun  * It's unrealistic to expect the cost model to be perfect.  There are too
87*4882a593Smuzhiyun  * many devices and even on the same device the overall performance
88*4882a593Smuzhiyun  * fluctuates depending on numerous factors such as IO mixture and device
89*4882a593Smuzhiyun  * internal garbage collection.  The controller needs to adapt dynamically.
90*4882a593Smuzhiyun  *
91*4882a593Smuzhiyun  * This is achieved by adjusting the overall IO rate according to how busy
92*4882a593Smuzhiyun  * the device is.  If the device becomes overloaded, we're sending down too
93*4882a593Smuzhiyun  * many IOs and should generally slow down.  If there are waiting issuers
94*4882a593Smuzhiyun  * but the device isn't saturated, we're issuing too few and should
95*4882a593Smuzhiyun  * generally speed up.
96*4882a593Smuzhiyun  *
97*4882a593Smuzhiyun  * To slow down, we lower the vrate - the rate at which the device vtime
98*4882a593Smuzhiyun  * passes compared to the wall clock.  For example, if the vtime is running
99*4882a593Smuzhiyun  * at the vrate of 75%, all cgroups added up would only be able to issue
100*4882a593Smuzhiyun  * 750ms worth of IOs per second, and vice-versa for speeding up.
101*4882a593Smuzhiyun  *
102*4882a593Smuzhiyun  * Device business is determined using two criteria - rq wait and
103*4882a593Smuzhiyun  * completion latencies.
104*4882a593Smuzhiyun  *
105*4882a593Smuzhiyun  * When a device gets saturated, the on-device and then the request queues
106*4882a593Smuzhiyun  * fill up and a bio which is ready to be issued has to wait for a request
107*4882a593Smuzhiyun  * to become available.  When this delay becomes noticeable, it's a clear
108*4882a593Smuzhiyun  * indication that the device is saturated and we lower the vrate.  This
109*4882a593Smuzhiyun  * saturation signal is fairly conservative as it only triggers when both
110*4882a593Smuzhiyun  * hardware and software queues are filled up, and is used as the default
111*4882a593Smuzhiyun  * busy signal.
112*4882a593Smuzhiyun  *
113*4882a593Smuzhiyun  * As devices can have deep queues and be unfair in how the queued commands
114*4882a593Smuzhiyun  * are executed, soley depending on rq wait may not result in satisfactory
115*4882a593Smuzhiyun  * control quality.  For a better control quality, completion latency QoS
116*4882a593Smuzhiyun  * parameters can be configured so that the device is considered saturated
117*4882a593Smuzhiyun  * if N'th percentile completion latency rises above the set point.
118*4882a593Smuzhiyun  *
119*4882a593Smuzhiyun  * The completion latency requirements are a function of both the
120*4882a593Smuzhiyun  * underlying device characteristics and the desired IO latency quality of
121*4882a593Smuzhiyun  * service.  There is an inherent trade-off - the tighter the latency QoS,
122*4882a593Smuzhiyun  * the higher the bandwidth lossage.  Latency QoS is disabled by default
123*4882a593Smuzhiyun  * and can be set through /sys/fs/cgroup/io.cost.qos.
124*4882a593Smuzhiyun  *
125*4882a593Smuzhiyun  * 2-3. Work Conservation
126*4882a593Smuzhiyun  *
127*4882a593Smuzhiyun  * Imagine two cgroups A and B with equal weights.  A is issuing a small IO
128*4882a593Smuzhiyun  * periodically while B is sending out enough parallel IOs to saturate the
129*4882a593Smuzhiyun  * device on its own.  Let's say A's usage amounts to 100ms worth of IO
130*4882a593Smuzhiyun  * cost per second, i.e., 10% of the device capacity.  The naive
131*4882a593Smuzhiyun  * distribution of half and half would lead to 60% utilization of the
132*4882a593Smuzhiyun  * device, a significant reduction in the total amount of work done
133*4882a593Smuzhiyun  * compared to free-for-all competition.  This is too high a cost to pay
134*4882a593Smuzhiyun  * for IO control.
135*4882a593Smuzhiyun  *
136*4882a593Smuzhiyun  * To conserve the total amount of work done, we keep track of how much
137*4882a593Smuzhiyun  * each active cgroup is actually using and yield part of its weight if
138*4882a593Smuzhiyun  * there are other cgroups which can make use of it.  In the above case,
139*4882a593Smuzhiyun  * A's weight will be lowered so that it hovers above the actual usage and
140*4882a593Smuzhiyun  * B would be able to use the rest.
141*4882a593Smuzhiyun  *
142*4882a593Smuzhiyun  * As we don't want to penalize a cgroup for donating its weight, the
143*4882a593Smuzhiyun  * surplus weight adjustment factors in a margin and has an immediate
144*4882a593Smuzhiyun  * snapback mechanism in case the cgroup needs more IO vtime for itself.
145*4882a593Smuzhiyun  *
146*4882a593Smuzhiyun  * Note that adjusting down surplus weights has the same effects as
147*4882a593Smuzhiyun  * accelerating vtime for other cgroups and work conservation can also be
148*4882a593Smuzhiyun  * implemented by adjusting vrate dynamically.  However, squaring who can
149*4882a593Smuzhiyun  * donate and should take back how much requires hweight propagations
150*4882a593Smuzhiyun  * anyway making it easier to implement and understand as a separate
151*4882a593Smuzhiyun  * mechanism.
152*4882a593Smuzhiyun  *
153*4882a593Smuzhiyun  * 3. Monitoring
154*4882a593Smuzhiyun  *
155*4882a593Smuzhiyun  * Instead of debugfs or other clumsy monitoring mechanisms, this
156*4882a593Smuzhiyun  * controller uses a drgn based monitoring script -
157*4882a593Smuzhiyun  * tools/cgroup/iocost_monitor.py.  For details on drgn, please see
158*4882a593Smuzhiyun  * https://github.com/osandov/drgn.  The ouput looks like the following.
159*4882a593Smuzhiyun  *
160*4882a593Smuzhiyun  *  sdb RUN   per=300ms cur_per=234.218:v203.695 busy= +1 vrate= 62.12%
161*4882a593Smuzhiyun  *                 active      weight      hweight% inflt% dbt  delay usages%
162*4882a593Smuzhiyun  *  test/a              *    50/   50  33.33/ 33.33  27.65   2  0*041 033:033:033
163*4882a593Smuzhiyun  *  test/b              *   100/  100  66.67/ 66.67  17.56   0  0*000 066:079:077
164*4882a593Smuzhiyun  *
165*4882a593Smuzhiyun  * - per	: Timer period
166*4882a593Smuzhiyun  * - cur_per	: Internal wall and device vtime clock
167*4882a593Smuzhiyun  * - vrate	: Device virtual time rate against wall clock
168*4882a593Smuzhiyun  * - weight	: Surplus-adjusted and configured weights
169*4882a593Smuzhiyun  * - hweight	: Surplus-adjusted and configured hierarchical weights
170*4882a593Smuzhiyun  * - inflt	: The percentage of in-flight IO cost at the end of last period
171*4882a593Smuzhiyun  * - del_ms	: Deferred issuer delay induction level and duration
172*4882a593Smuzhiyun  * - usages	: Usage history
173*4882a593Smuzhiyun  */
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun #include <linux/kernel.h>
176*4882a593Smuzhiyun #include <linux/module.h>
177*4882a593Smuzhiyun #include <linux/timer.h>
178*4882a593Smuzhiyun #include <linux/time64.h>
179*4882a593Smuzhiyun #include <linux/parser.h>
180*4882a593Smuzhiyun #include <linux/sched/signal.h>
181*4882a593Smuzhiyun #include <linux/blk-cgroup.h>
182*4882a593Smuzhiyun #include <asm/local.h>
183*4882a593Smuzhiyun #include <asm/local64.h>
184*4882a593Smuzhiyun #include "blk-rq-qos.h"
185*4882a593Smuzhiyun #include "blk-stat.h"
186*4882a593Smuzhiyun #include "blk-wbt.h"
187*4882a593Smuzhiyun 
188*4882a593Smuzhiyun #ifdef CONFIG_TRACEPOINTS
189*4882a593Smuzhiyun 
190*4882a593Smuzhiyun /* copied from TRACE_CGROUP_PATH, see cgroup-internal.h */
191*4882a593Smuzhiyun #define TRACE_IOCG_PATH_LEN 1024
192*4882a593Smuzhiyun static DEFINE_SPINLOCK(trace_iocg_path_lock);
193*4882a593Smuzhiyun static char trace_iocg_path[TRACE_IOCG_PATH_LEN];
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun #define TRACE_IOCG_PATH(type, iocg, ...)					\
196*4882a593Smuzhiyun 	do {									\
197*4882a593Smuzhiyun 		unsigned long flags;						\
198*4882a593Smuzhiyun 		if (trace_iocost_##type##_enabled()) {				\
199*4882a593Smuzhiyun 			spin_lock_irqsave(&trace_iocg_path_lock, flags);	\
200*4882a593Smuzhiyun 			cgroup_path(iocg_to_blkg(iocg)->blkcg->css.cgroup,	\
201*4882a593Smuzhiyun 				    trace_iocg_path, TRACE_IOCG_PATH_LEN);	\
202*4882a593Smuzhiyun 			trace_iocost_##type(iocg, trace_iocg_path,		\
203*4882a593Smuzhiyun 					      ##__VA_ARGS__);			\
204*4882a593Smuzhiyun 			spin_unlock_irqrestore(&trace_iocg_path_lock, flags);	\
205*4882a593Smuzhiyun 		}								\
206*4882a593Smuzhiyun 	} while (0)
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun #else	/* CONFIG_TRACE_POINTS */
209*4882a593Smuzhiyun #define TRACE_IOCG_PATH(type, iocg, ...)	do { } while (0)
210*4882a593Smuzhiyun #endif	/* CONFIG_TRACE_POINTS */
211*4882a593Smuzhiyun 
212*4882a593Smuzhiyun enum {
213*4882a593Smuzhiyun 	MILLION			= 1000000,
214*4882a593Smuzhiyun 
215*4882a593Smuzhiyun 	/* timer period is calculated from latency requirements, bound it */
216*4882a593Smuzhiyun 	MIN_PERIOD		= USEC_PER_MSEC,
217*4882a593Smuzhiyun 	MAX_PERIOD		= USEC_PER_SEC,
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 	/*
220*4882a593Smuzhiyun 	 * iocg->vtime is targeted at 50% behind the device vtime, which
221*4882a593Smuzhiyun 	 * serves as its IO credit buffer.  Surplus weight adjustment is
222*4882a593Smuzhiyun 	 * immediately canceled if the vtime margin runs below 10%.
223*4882a593Smuzhiyun 	 */
224*4882a593Smuzhiyun 	MARGIN_MIN_PCT		= 10,
225*4882a593Smuzhiyun 	MARGIN_LOW_PCT		= 20,
226*4882a593Smuzhiyun 	MARGIN_TARGET_PCT	= 50,
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	INUSE_ADJ_STEP_PCT	= 25,
229*4882a593Smuzhiyun 
230*4882a593Smuzhiyun 	/* Have some play in timer operations */
231*4882a593Smuzhiyun 	TIMER_SLACK_PCT		= 1,
232*4882a593Smuzhiyun 
233*4882a593Smuzhiyun 	/* 1/64k is granular enough and can easily be handled w/ u32 */
234*4882a593Smuzhiyun 	WEIGHT_ONE		= 1 << 16,
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 	/*
237*4882a593Smuzhiyun 	 * As vtime is used to calculate the cost of each IO, it needs to
238*4882a593Smuzhiyun 	 * be fairly high precision.  For example, it should be able to
239*4882a593Smuzhiyun 	 * represent the cost of a single page worth of discard with
240*4882a593Smuzhiyun 	 * suffificient accuracy.  At the same time, it should be able to
241*4882a593Smuzhiyun 	 * represent reasonably long enough durations to be useful and
242*4882a593Smuzhiyun 	 * convenient during operation.
243*4882a593Smuzhiyun 	 *
244*4882a593Smuzhiyun 	 * 1s worth of vtime is 2^37.  This gives us both sub-nanosecond
245*4882a593Smuzhiyun 	 * granularity and days of wrap-around time even at extreme vrates.
246*4882a593Smuzhiyun 	 */
247*4882a593Smuzhiyun 	VTIME_PER_SEC_SHIFT	= 37,
248*4882a593Smuzhiyun 	VTIME_PER_SEC		= 1LLU << VTIME_PER_SEC_SHIFT,
249*4882a593Smuzhiyun 	VTIME_PER_USEC		= VTIME_PER_SEC / USEC_PER_SEC,
250*4882a593Smuzhiyun 	VTIME_PER_NSEC		= VTIME_PER_SEC / NSEC_PER_SEC,
251*4882a593Smuzhiyun 
252*4882a593Smuzhiyun 	/* bound vrate adjustments within two orders of magnitude */
253*4882a593Smuzhiyun 	VRATE_MIN_PPM		= 10000,	/* 1% */
254*4882a593Smuzhiyun 	VRATE_MAX_PPM		= 100000000,	/* 10000% */
255*4882a593Smuzhiyun 
256*4882a593Smuzhiyun 	VRATE_MIN		= VTIME_PER_USEC * VRATE_MIN_PPM / MILLION,
257*4882a593Smuzhiyun 	VRATE_CLAMP_ADJ_PCT	= 4,
258*4882a593Smuzhiyun 
259*4882a593Smuzhiyun 	/* if IOs end up waiting for requests, issue less */
260*4882a593Smuzhiyun 	RQ_WAIT_BUSY_PCT	= 5,
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 	/* unbusy hysterisis */
263*4882a593Smuzhiyun 	UNBUSY_THR_PCT		= 75,
264*4882a593Smuzhiyun 
265*4882a593Smuzhiyun 	/*
266*4882a593Smuzhiyun 	 * The effect of delay is indirect and non-linear and a huge amount of
267*4882a593Smuzhiyun 	 * future debt can accumulate abruptly while unthrottled. Linearly scale
268*4882a593Smuzhiyun 	 * up delay as debt is going up and then let it decay exponentially.
269*4882a593Smuzhiyun 	 * This gives us quick ramp ups while delay is accumulating and long
270*4882a593Smuzhiyun 	 * tails which can help reducing the frequency of debt explosions on
271*4882a593Smuzhiyun 	 * unthrottle. The parameters are experimentally determined.
272*4882a593Smuzhiyun 	 *
273*4882a593Smuzhiyun 	 * The delay mechanism provides adequate protection and behavior in many
274*4882a593Smuzhiyun 	 * cases. However, this is far from ideal and falls shorts on both
275*4882a593Smuzhiyun 	 * fronts. The debtors are often throttled too harshly costing a
276*4882a593Smuzhiyun 	 * significant level of fairness and possibly total work while the
277*4882a593Smuzhiyun 	 * protection against their impacts on the system can be choppy and
278*4882a593Smuzhiyun 	 * unreliable.
279*4882a593Smuzhiyun 	 *
280*4882a593Smuzhiyun 	 * The shortcoming primarily stems from the fact that, unlike for page
281*4882a593Smuzhiyun 	 * cache, the kernel doesn't have well-defined back-pressure propagation
282*4882a593Smuzhiyun 	 * mechanism and policies for anonymous memory. Fully addressing this
283*4882a593Smuzhiyun 	 * issue will likely require substantial improvements in the area.
284*4882a593Smuzhiyun 	 */
285*4882a593Smuzhiyun 	MIN_DELAY_THR_PCT	= 500,
286*4882a593Smuzhiyun 	MAX_DELAY_THR_PCT	= 25000,
287*4882a593Smuzhiyun 	MIN_DELAY		= 250,
288*4882a593Smuzhiyun 	MAX_DELAY		= 250 * USEC_PER_MSEC,
289*4882a593Smuzhiyun 
290*4882a593Smuzhiyun 	/* halve debts if avg usage over 100ms is under 50% */
291*4882a593Smuzhiyun 	DFGV_USAGE_PCT		= 50,
292*4882a593Smuzhiyun 	DFGV_PERIOD		= 100 * USEC_PER_MSEC,
293*4882a593Smuzhiyun 
294*4882a593Smuzhiyun 	/* don't let cmds which take a very long time pin lagging for too long */
295*4882a593Smuzhiyun 	MAX_LAGGING_PERIODS	= 10,
296*4882a593Smuzhiyun 
297*4882a593Smuzhiyun 	/* switch iff the conditions are met for longer than this */
298*4882a593Smuzhiyun 	AUTOP_CYCLE_NSEC	= 10LLU * NSEC_PER_SEC,
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 	/*
301*4882a593Smuzhiyun 	 * Count IO size in 4k pages.  The 12bit shift helps keeping
302*4882a593Smuzhiyun 	 * size-proportional components of cost calculation in closer
303*4882a593Smuzhiyun 	 * numbers of digits to per-IO cost components.
304*4882a593Smuzhiyun 	 */
305*4882a593Smuzhiyun 	IOC_PAGE_SHIFT		= 12,
306*4882a593Smuzhiyun 	IOC_PAGE_SIZE		= 1 << IOC_PAGE_SHIFT,
307*4882a593Smuzhiyun 	IOC_SECT_TO_PAGE_SHIFT	= IOC_PAGE_SHIFT - SECTOR_SHIFT,
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	/* if apart further than 16M, consider randio for linear model */
310*4882a593Smuzhiyun 	LCOEF_RANDIO_PAGES	= 4096,
311*4882a593Smuzhiyun };
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun enum ioc_running {
314*4882a593Smuzhiyun 	IOC_IDLE,
315*4882a593Smuzhiyun 	IOC_RUNNING,
316*4882a593Smuzhiyun 	IOC_STOP,
317*4882a593Smuzhiyun };
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun /* io.cost.qos controls including per-dev enable of the whole controller */
320*4882a593Smuzhiyun enum {
321*4882a593Smuzhiyun 	QOS_ENABLE,
322*4882a593Smuzhiyun 	QOS_CTRL,
323*4882a593Smuzhiyun 	NR_QOS_CTRL_PARAMS,
324*4882a593Smuzhiyun };
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun /* io.cost.qos params */
327*4882a593Smuzhiyun enum {
328*4882a593Smuzhiyun 	QOS_RPPM,
329*4882a593Smuzhiyun 	QOS_RLAT,
330*4882a593Smuzhiyun 	QOS_WPPM,
331*4882a593Smuzhiyun 	QOS_WLAT,
332*4882a593Smuzhiyun 	QOS_MIN,
333*4882a593Smuzhiyun 	QOS_MAX,
334*4882a593Smuzhiyun 	NR_QOS_PARAMS,
335*4882a593Smuzhiyun };
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun /* io.cost.model controls */
338*4882a593Smuzhiyun enum {
339*4882a593Smuzhiyun 	COST_CTRL,
340*4882a593Smuzhiyun 	COST_MODEL,
341*4882a593Smuzhiyun 	NR_COST_CTRL_PARAMS,
342*4882a593Smuzhiyun };
343*4882a593Smuzhiyun 
344*4882a593Smuzhiyun /* builtin linear cost model coefficients */
345*4882a593Smuzhiyun enum {
346*4882a593Smuzhiyun 	I_LCOEF_RBPS,
347*4882a593Smuzhiyun 	I_LCOEF_RSEQIOPS,
348*4882a593Smuzhiyun 	I_LCOEF_RRANDIOPS,
349*4882a593Smuzhiyun 	I_LCOEF_WBPS,
350*4882a593Smuzhiyun 	I_LCOEF_WSEQIOPS,
351*4882a593Smuzhiyun 	I_LCOEF_WRANDIOPS,
352*4882a593Smuzhiyun 	NR_I_LCOEFS,
353*4882a593Smuzhiyun };
354*4882a593Smuzhiyun 
355*4882a593Smuzhiyun enum {
356*4882a593Smuzhiyun 	LCOEF_RPAGE,
357*4882a593Smuzhiyun 	LCOEF_RSEQIO,
358*4882a593Smuzhiyun 	LCOEF_RRANDIO,
359*4882a593Smuzhiyun 	LCOEF_WPAGE,
360*4882a593Smuzhiyun 	LCOEF_WSEQIO,
361*4882a593Smuzhiyun 	LCOEF_WRANDIO,
362*4882a593Smuzhiyun 	NR_LCOEFS,
363*4882a593Smuzhiyun };
364*4882a593Smuzhiyun 
365*4882a593Smuzhiyun enum {
366*4882a593Smuzhiyun 	AUTOP_INVALID,
367*4882a593Smuzhiyun 	AUTOP_HDD,
368*4882a593Smuzhiyun 	AUTOP_SSD_QD1,
369*4882a593Smuzhiyun 	AUTOP_SSD_DFL,
370*4882a593Smuzhiyun 	AUTOP_SSD_FAST,
371*4882a593Smuzhiyun };
372*4882a593Smuzhiyun 
373*4882a593Smuzhiyun struct ioc_gq;
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun struct ioc_params {
376*4882a593Smuzhiyun 	u32				qos[NR_QOS_PARAMS];
377*4882a593Smuzhiyun 	u64				i_lcoefs[NR_I_LCOEFS];
378*4882a593Smuzhiyun 	u64				lcoefs[NR_LCOEFS];
379*4882a593Smuzhiyun 	u32				too_fast_vrate_pct;
380*4882a593Smuzhiyun 	u32				too_slow_vrate_pct;
381*4882a593Smuzhiyun };
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun struct ioc_margins {
384*4882a593Smuzhiyun 	s64				min;
385*4882a593Smuzhiyun 	s64				low;
386*4882a593Smuzhiyun 	s64				target;
387*4882a593Smuzhiyun };
388*4882a593Smuzhiyun 
389*4882a593Smuzhiyun struct ioc_missed {
390*4882a593Smuzhiyun 	local_t				nr_met;
391*4882a593Smuzhiyun 	local_t				nr_missed;
392*4882a593Smuzhiyun 	u32				last_met;
393*4882a593Smuzhiyun 	u32				last_missed;
394*4882a593Smuzhiyun };
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun struct ioc_pcpu_stat {
397*4882a593Smuzhiyun 	struct ioc_missed		missed[2];
398*4882a593Smuzhiyun 
399*4882a593Smuzhiyun 	local64_t			rq_wait_ns;
400*4882a593Smuzhiyun 	u64				last_rq_wait_ns;
401*4882a593Smuzhiyun };
402*4882a593Smuzhiyun 
403*4882a593Smuzhiyun /* per device */
404*4882a593Smuzhiyun struct ioc {
405*4882a593Smuzhiyun 	struct rq_qos			rqos;
406*4882a593Smuzhiyun 
407*4882a593Smuzhiyun 	bool				enabled;
408*4882a593Smuzhiyun 
409*4882a593Smuzhiyun 	struct ioc_params		params;
410*4882a593Smuzhiyun 	struct ioc_margins		margins;
411*4882a593Smuzhiyun 	u32				period_us;
412*4882a593Smuzhiyun 	u32				timer_slack_ns;
413*4882a593Smuzhiyun 	u64				vrate_min;
414*4882a593Smuzhiyun 	u64				vrate_max;
415*4882a593Smuzhiyun 
416*4882a593Smuzhiyun 	spinlock_t			lock;
417*4882a593Smuzhiyun 	struct timer_list		timer;
418*4882a593Smuzhiyun 	struct list_head		active_iocgs;	/* active cgroups */
419*4882a593Smuzhiyun 	struct ioc_pcpu_stat __percpu	*pcpu_stat;
420*4882a593Smuzhiyun 
421*4882a593Smuzhiyun 	enum ioc_running		running;
422*4882a593Smuzhiyun 	atomic64_t			vtime_rate;
423*4882a593Smuzhiyun 	u64				vtime_base_rate;
424*4882a593Smuzhiyun 	s64				vtime_err;
425*4882a593Smuzhiyun 
426*4882a593Smuzhiyun 	seqcount_spinlock_t		period_seqcount;
427*4882a593Smuzhiyun 	u64				period_at;	/* wallclock starttime */
428*4882a593Smuzhiyun 	u64				period_at_vtime; /* vtime starttime */
429*4882a593Smuzhiyun 
430*4882a593Smuzhiyun 	atomic64_t			cur_period;	/* inc'd each period */
431*4882a593Smuzhiyun 	int				busy_level;	/* saturation history */
432*4882a593Smuzhiyun 
433*4882a593Smuzhiyun 	bool				weights_updated;
434*4882a593Smuzhiyun 	atomic_t			hweight_gen;	/* for lazy hweights */
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 	/* debt forgivness */
437*4882a593Smuzhiyun 	u64				dfgv_period_at;
438*4882a593Smuzhiyun 	u64				dfgv_period_rem;
439*4882a593Smuzhiyun 	u64				dfgv_usage_us_sum;
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun 	u64				autop_too_fast_at;
442*4882a593Smuzhiyun 	u64				autop_too_slow_at;
443*4882a593Smuzhiyun 	int				autop_idx;
444*4882a593Smuzhiyun 	bool				user_qos_params:1;
445*4882a593Smuzhiyun 	bool				user_cost_model:1;
446*4882a593Smuzhiyun };
447*4882a593Smuzhiyun 
448*4882a593Smuzhiyun struct iocg_pcpu_stat {
449*4882a593Smuzhiyun 	local64_t			abs_vusage;
450*4882a593Smuzhiyun };
451*4882a593Smuzhiyun 
452*4882a593Smuzhiyun struct iocg_stat {
453*4882a593Smuzhiyun 	u64				usage_us;
454*4882a593Smuzhiyun 	u64				wait_us;
455*4882a593Smuzhiyun 	u64				indebt_us;
456*4882a593Smuzhiyun 	u64				indelay_us;
457*4882a593Smuzhiyun };
458*4882a593Smuzhiyun 
459*4882a593Smuzhiyun /* per device-cgroup pair */
460*4882a593Smuzhiyun struct ioc_gq {
461*4882a593Smuzhiyun 	struct blkg_policy_data		pd;
462*4882a593Smuzhiyun 	struct ioc			*ioc;
463*4882a593Smuzhiyun 
464*4882a593Smuzhiyun 	/*
465*4882a593Smuzhiyun 	 * A iocg can get its weight from two sources - an explicit
466*4882a593Smuzhiyun 	 * per-device-cgroup configuration or the default weight of the
467*4882a593Smuzhiyun 	 * cgroup.  `cfg_weight` is the explicit per-device-cgroup
468*4882a593Smuzhiyun 	 * configuration.  `weight` is the effective considering both
469*4882a593Smuzhiyun 	 * sources.
470*4882a593Smuzhiyun 	 *
471*4882a593Smuzhiyun 	 * When an idle cgroup becomes active its `active` goes from 0 to
472*4882a593Smuzhiyun 	 * `weight`.  `inuse` is the surplus adjusted active weight.
473*4882a593Smuzhiyun 	 * `active` and `inuse` are used to calculate `hweight_active` and
474*4882a593Smuzhiyun 	 * `hweight_inuse`.
475*4882a593Smuzhiyun 	 *
476*4882a593Smuzhiyun 	 * `last_inuse` remembers `inuse` while an iocg is idle to persist
477*4882a593Smuzhiyun 	 * surplus adjustments.
478*4882a593Smuzhiyun 	 *
479*4882a593Smuzhiyun 	 * `inuse` may be adjusted dynamically during period. `saved_*` are used
480*4882a593Smuzhiyun 	 * to determine and track adjustments.
481*4882a593Smuzhiyun 	 */
482*4882a593Smuzhiyun 	u32				cfg_weight;
483*4882a593Smuzhiyun 	u32				weight;
484*4882a593Smuzhiyun 	u32				active;
485*4882a593Smuzhiyun 	u32				inuse;
486*4882a593Smuzhiyun 
487*4882a593Smuzhiyun 	u32				last_inuse;
488*4882a593Smuzhiyun 	s64				saved_margin;
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun 	sector_t			cursor;		/* to detect randio */
491*4882a593Smuzhiyun 
492*4882a593Smuzhiyun 	/*
493*4882a593Smuzhiyun 	 * `vtime` is this iocg's vtime cursor which progresses as IOs are
494*4882a593Smuzhiyun 	 * issued.  If lagging behind device vtime, the delta represents
495*4882a593Smuzhiyun 	 * the currently available IO budget.  If runnning ahead, the
496*4882a593Smuzhiyun 	 * overage.
497*4882a593Smuzhiyun 	 *
498*4882a593Smuzhiyun 	 * `vtime_done` is the same but progressed on completion rather
499*4882a593Smuzhiyun 	 * than issue.  The delta behind `vtime` represents the cost of
500*4882a593Smuzhiyun 	 * currently in-flight IOs.
501*4882a593Smuzhiyun 	 */
502*4882a593Smuzhiyun 	atomic64_t			vtime;
503*4882a593Smuzhiyun 	atomic64_t			done_vtime;
504*4882a593Smuzhiyun 	u64				abs_vdebt;
505*4882a593Smuzhiyun 
506*4882a593Smuzhiyun 	/* current delay in effect and when it started */
507*4882a593Smuzhiyun 	u64				delay;
508*4882a593Smuzhiyun 	u64				delay_at;
509*4882a593Smuzhiyun 
510*4882a593Smuzhiyun 	/*
511*4882a593Smuzhiyun 	 * The period this iocg was last active in.  Used for deactivation
512*4882a593Smuzhiyun 	 * and invalidating `vtime`.
513*4882a593Smuzhiyun 	 */
514*4882a593Smuzhiyun 	atomic64_t			active_period;
515*4882a593Smuzhiyun 	struct list_head		active_list;
516*4882a593Smuzhiyun 
517*4882a593Smuzhiyun 	/* see __propagate_weights() and current_hweight() for details */
518*4882a593Smuzhiyun 	u64				child_active_sum;
519*4882a593Smuzhiyun 	u64				child_inuse_sum;
520*4882a593Smuzhiyun 	u64				child_adjusted_sum;
521*4882a593Smuzhiyun 	int				hweight_gen;
522*4882a593Smuzhiyun 	u32				hweight_active;
523*4882a593Smuzhiyun 	u32				hweight_inuse;
524*4882a593Smuzhiyun 	u32				hweight_donating;
525*4882a593Smuzhiyun 	u32				hweight_after_donation;
526*4882a593Smuzhiyun 
527*4882a593Smuzhiyun 	struct list_head		walk_list;
528*4882a593Smuzhiyun 	struct list_head		surplus_list;
529*4882a593Smuzhiyun 
530*4882a593Smuzhiyun 	struct wait_queue_head		waitq;
531*4882a593Smuzhiyun 	struct hrtimer			waitq_timer;
532*4882a593Smuzhiyun 
533*4882a593Smuzhiyun 	/* timestamp at the latest activation */
534*4882a593Smuzhiyun 	u64				activated_at;
535*4882a593Smuzhiyun 
536*4882a593Smuzhiyun 	/* statistics */
537*4882a593Smuzhiyun 	struct iocg_pcpu_stat __percpu	*pcpu_stat;
538*4882a593Smuzhiyun 	struct iocg_stat		local_stat;
539*4882a593Smuzhiyun 	struct iocg_stat		desc_stat;
540*4882a593Smuzhiyun 	struct iocg_stat		last_stat;
541*4882a593Smuzhiyun 	u64				last_stat_abs_vusage;
542*4882a593Smuzhiyun 	u64				usage_delta_us;
543*4882a593Smuzhiyun 	u64				wait_since;
544*4882a593Smuzhiyun 	u64				indebt_since;
545*4882a593Smuzhiyun 	u64				indelay_since;
546*4882a593Smuzhiyun 
547*4882a593Smuzhiyun 	/* this iocg's depth in the hierarchy and ancestors including self */
548*4882a593Smuzhiyun 	int				level;
549*4882a593Smuzhiyun 	struct ioc_gq			*ancestors[];
550*4882a593Smuzhiyun };
551*4882a593Smuzhiyun 
552*4882a593Smuzhiyun /* per cgroup */
553*4882a593Smuzhiyun struct ioc_cgrp {
554*4882a593Smuzhiyun 	struct blkcg_policy_data	cpd;
555*4882a593Smuzhiyun 	unsigned int			dfl_weight;
556*4882a593Smuzhiyun };
557*4882a593Smuzhiyun 
558*4882a593Smuzhiyun struct ioc_now {
559*4882a593Smuzhiyun 	u64				now_ns;
560*4882a593Smuzhiyun 	u64				now;
561*4882a593Smuzhiyun 	u64				vnow;
562*4882a593Smuzhiyun 	u64				vrate;
563*4882a593Smuzhiyun };
564*4882a593Smuzhiyun 
565*4882a593Smuzhiyun struct iocg_wait {
566*4882a593Smuzhiyun 	struct wait_queue_entry		wait;
567*4882a593Smuzhiyun 	struct bio			*bio;
568*4882a593Smuzhiyun 	u64				abs_cost;
569*4882a593Smuzhiyun 	bool				committed;
570*4882a593Smuzhiyun };
571*4882a593Smuzhiyun 
572*4882a593Smuzhiyun struct iocg_wake_ctx {
573*4882a593Smuzhiyun 	struct ioc_gq			*iocg;
574*4882a593Smuzhiyun 	u32				hw_inuse;
575*4882a593Smuzhiyun 	s64				vbudget;
576*4882a593Smuzhiyun };
577*4882a593Smuzhiyun 
578*4882a593Smuzhiyun static const struct ioc_params autop[] = {
579*4882a593Smuzhiyun 	[AUTOP_HDD] = {
580*4882a593Smuzhiyun 		.qos				= {
581*4882a593Smuzhiyun 			[QOS_RLAT]		=        250000, /* 250ms */
582*4882a593Smuzhiyun 			[QOS_WLAT]		=        250000,
583*4882a593Smuzhiyun 			[QOS_MIN]		= VRATE_MIN_PPM,
584*4882a593Smuzhiyun 			[QOS_MAX]		= VRATE_MAX_PPM,
585*4882a593Smuzhiyun 		},
586*4882a593Smuzhiyun 		.i_lcoefs			= {
587*4882a593Smuzhiyun 			[I_LCOEF_RBPS]		=     174019176,
588*4882a593Smuzhiyun 			[I_LCOEF_RSEQIOPS]	=         41708,
589*4882a593Smuzhiyun 			[I_LCOEF_RRANDIOPS]	=           370,
590*4882a593Smuzhiyun 			[I_LCOEF_WBPS]		=     178075866,
591*4882a593Smuzhiyun 			[I_LCOEF_WSEQIOPS]	=         42705,
592*4882a593Smuzhiyun 			[I_LCOEF_WRANDIOPS]	=           378,
593*4882a593Smuzhiyun 		},
594*4882a593Smuzhiyun 	},
595*4882a593Smuzhiyun 	[AUTOP_SSD_QD1] = {
596*4882a593Smuzhiyun 		.qos				= {
597*4882a593Smuzhiyun 			[QOS_RLAT]		=         25000, /* 25ms */
598*4882a593Smuzhiyun 			[QOS_WLAT]		=         25000,
599*4882a593Smuzhiyun 			[QOS_MIN]		= VRATE_MIN_PPM,
600*4882a593Smuzhiyun 			[QOS_MAX]		= VRATE_MAX_PPM,
601*4882a593Smuzhiyun 		},
602*4882a593Smuzhiyun 		.i_lcoefs			= {
603*4882a593Smuzhiyun 			[I_LCOEF_RBPS]		=     245855193,
604*4882a593Smuzhiyun 			[I_LCOEF_RSEQIOPS]	=         61575,
605*4882a593Smuzhiyun 			[I_LCOEF_RRANDIOPS]	=          6946,
606*4882a593Smuzhiyun 			[I_LCOEF_WBPS]		=     141365009,
607*4882a593Smuzhiyun 			[I_LCOEF_WSEQIOPS]	=         33716,
608*4882a593Smuzhiyun 			[I_LCOEF_WRANDIOPS]	=         26796,
609*4882a593Smuzhiyun 		},
610*4882a593Smuzhiyun 	},
611*4882a593Smuzhiyun 	[AUTOP_SSD_DFL] = {
612*4882a593Smuzhiyun 		.qos				= {
613*4882a593Smuzhiyun 			[QOS_RLAT]		=         25000, /* 25ms */
614*4882a593Smuzhiyun 			[QOS_WLAT]		=         25000,
615*4882a593Smuzhiyun 			[QOS_MIN]		= VRATE_MIN_PPM,
616*4882a593Smuzhiyun 			[QOS_MAX]		= VRATE_MAX_PPM,
617*4882a593Smuzhiyun 		},
618*4882a593Smuzhiyun 		.i_lcoefs			= {
619*4882a593Smuzhiyun 			[I_LCOEF_RBPS]		=     488636629,
620*4882a593Smuzhiyun 			[I_LCOEF_RSEQIOPS]	=          8932,
621*4882a593Smuzhiyun 			[I_LCOEF_RRANDIOPS]	=          8518,
622*4882a593Smuzhiyun 			[I_LCOEF_WBPS]		=     427891549,
623*4882a593Smuzhiyun 			[I_LCOEF_WSEQIOPS]	=         28755,
624*4882a593Smuzhiyun 			[I_LCOEF_WRANDIOPS]	=         21940,
625*4882a593Smuzhiyun 		},
626*4882a593Smuzhiyun 		.too_fast_vrate_pct		=           500,
627*4882a593Smuzhiyun 	},
628*4882a593Smuzhiyun 	[AUTOP_SSD_FAST] = {
629*4882a593Smuzhiyun 		.qos				= {
630*4882a593Smuzhiyun 			[QOS_RLAT]		=          5000, /* 5ms */
631*4882a593Smuzhiyun 			[QOS_WLAT]		=          5000,
632*4882a593Smuzhiyun 			[QOS_MIN]		= VRATE_MIN_PPM,
633*4882a593Smuzhiyun 			[QOS_MAX]		= VRATE_MAX_PPM,
634*4882a593Smuzhiyun 		},
635*4882a593Smuzhiyun 		.i_lcoefs			= {
636*4882a593Smuzhiyun 			[I_LCOEF_RBPS]		=    3102524156LLU,
637*4882a593Smuzhiyun 			[I_LCOEF_RSEQIOPS]	=        724816,
638*4882a593Smuzhiyun 			[I_LCOEF_RRANDIOPS]	=        778122,
639*4882a593Smuzhiyun 			[I_LCOEF_WBPS]		=    1742780862LLU,
640*4882a593Smuzhiyun 			[I_LCOEF_WSEQIOPS]	=        425702,
641*4882a593Smuzhiyun 			[I_LCOEF_WRANDIOPS]	=	 443193,
642*4882a593Smuzhiyun 		},
643*4882a593Smuzhiyun 		.too_slow_vrate_pct		=            10,
644*4882a593Smuzhiyun 	},
645*4882a593Smuzhiyun };
646*4882a593Smuzhiyun 
647*4882a593Smuzhiyun /*
648*4882a593Smuzhiyun  * vrate adjust percentages indexed by ioc->busy_level.  We adjust up on
649*4882a593Smuzhiyun  * vtime credit shortage and down on device saturation.
650*4882a593Smuzhiyun  */
651*4882a593Smuzhiyun static u32 vrate_adj_pct[] =
652*4882a593Smuzhiyun 	{ 0, 0, 0, 0,
653*4882a593Smuzhiyun 	  1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
654*4882a593Smuzhiyun 	  2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
655*4882a593Smuzhiyun 	  4, 4, 4, 4, 4, 4, 4, 4, 8, 8, 8, 8, 8, 8, 8, 8, 16 };
656*4882a593Smuzhiyun 
657*4882a593Smuzhiyun static struct blkcg_policy blkcg_policy_iocost;
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun /* accessors and helpers */
rqos_to_ioc(struct rq_qos * rqos)660*4882a593Smuzhiyun static struct ioc *rqos_to_ioc(struct rq_qos *rqos)
661*4882a593Smuzhiyun {
662*4882a593Smuzhiyun 	return container_of(rqos, struct ioc, rqos);
663*4882a593Smuzhiyun }
664*4882a593Smuzhiyun 
q_to_ioc(struct request_queue * q)665*4882a593Smuzhiyun static struct ioc *q_to_ioc(struct request_queue *q)
666*4882a593Smuzhiyun {
667*4882a593Smuzhiyun 	return rqos_to_ioc(rq_qos_id(q, RQ_QOS_COST));
668*4882a593Smuzhiyun }
669*4882a593Smuzhiyun 
q_name(struct request_queue * q)670*4882a593Smuzhiyun static const char *q_name(struct request_queue *q)
671*4882a593Smuzhiyun {
672*4882a593Smuzhiyun 	if (blk_queue_registered(q))
673*4882a593Smuzhiyun 		return kobject_name(q->kobj.parent);
674*4882a593Smuzhiyun 	else
675*4882a593Smuzhiyun 		return "<unknown>";
676*4882a593Smuzhiyun }
677*4882a593Smuzhiyun 
ioc_name(struct ioc * ioc)678*4882a593Smuzhiyun static const char __maybe_unused *ioc_name(struct ioc *ioc)
679*4882a593Smuzhiyun {
680*4882a593Smuzhiyun 	return q_name(ioc->rqos.q);
681*4882a593Smuzhiyun }
682*4882a593Smuzhiyun 
pd_to_iocg(struct blkg_policy_data * pd)683*4882a593Smuzhiyun static struct ioc_gq *pd_to_iocg(struct blkg_policy_data *pd)
684*4882a593Smuzhiyun {
685*4882a593Smuzhiyun 	return pd ? container_of(pd, struct ioc_gq, pd) : NULL;
686*4882a593Smuzhiyun }
687*4882a593Smuzhiyun 
blkg_to_iocg(struct blkcg_gq * blkg)688*4882a593Smuzhiyun static struct ioc_gq *blkg_to_iocg(struct blkcg_gq *blkg)
689*4882a593Smuzhiyun {
690*4882a593Smuzhiyun 	return pd_to_iocg(blkg_to_pd(blkg, &blkcg_policy_iocost));
691*4882a593Smuzhiyun }
692*4882a593Smuzhiyun 
iocg_to_blkg(struct ioc_gq * iocg)693*4882a593Smuzhiyun static struct blkcg_gq *iocg_to_blkg(struct ioc_gq *iocg)
694*4882a593Smuzhiyun {
695*4882a593Smuzhiyun 	return pd_to_blkg(&iocg->pd);
696*4882a593Smuzhiyun }
697*4882a593Smuzhiyun 
blkcg_to_iocc(struct blkcg * blkcg)698*4882a593Smuzhiyun static struct ioc_cgrp *blkcg_to_iocc(struct blkcg *blkcg)
699*4882a593Smuzhiyun {
700*4882a593Smuzhiyun 	return container_of(blkcg_to_cpd(blkcg, &blkcg_policy_iocost),
701*4882a593Smuzhiyun 			    struct ioc_cgrp, cpd);
702*4882a593Smuzhiyun }
703*4882a593Smuzhiyun 
704*4882a593Smuzhiyun /*
705*4882a593Smuzhiyun  * Scale @abs_cost to the inverse of @hw_inuse.  The lower the hierarchical
706*4882a593Smuzhiyun  * weight, the more expensive each IO.  Must round up.
707*4882a593Smuzhiyun  */
abs_cost_to_cost(u64 abs_cost,u32 hw_inuse)708*4882a593Smuzhiyun static u64 abs_cost_to_cost(u64 abs_cost, u32 hw_inuse)
709*4882a593Smuzhiyun {
710*4882a593Smuzhiyun 	return DIV64_U64_ROUND_UP(abs_cost * WEIGHT_ONE, hw_inuse);
711*4882a593Smuzhiyun }
712*4882a593Smuzhiyun 
713*4882a593Smuzhiyun /*
714*4882a593Smuzhiyun  * The inverse of abs_cost_to_cost().  Must round up.
715*4882a593Smuzhiyun  */
cost_to_abs_cost(u64 cost,u32 hw_inuse)716*4882a593Smuzhiyun static u64 cost_to_abs_cost(u64 cost, u32 hw_inuse)
717*4882a593Smuzhiyun {
718*4882a593Smuzhiyun 	return DIV64_U64_ROUND_UP(cost * hw_inuse, WEIGHT_ONE);
719*4882a593Smuzhiyun }
720*4882a593Smuzhiyun 
iocg_commit_bio(struct ioc_gq * iocg,struct bio * bio,u64 abs_cost,u64 cost)721*4882a593Smuzhiyun static void iocg_commit_bio(struct ioc_gq *iocg, struct bio *bio,
722*4882a593Smuzhiyun 			    u64 abs_cost, u64 cost)
723*4882a593Smuzhiyun {
724*4882a593Smuzhiyun 	struct iocg_pcpu_stat *gcs;
725*4882a593Smuzhiyun 
726*4882a593Smuzhiyun 	bio->bi_iocost_cost = cost;
727*4882a593Smuzhiyun 	atomic64_add(cost, &iocg->vtime);
728*4882a593Smuzhiyun 
729*4882a593Smuzhiyun 	gcs = get_cpu_ptr(iocg->pcpu_stat);
730*4882a593Smuzhiyun 	local64_add(abs_cost, &gcs->abs_vusage);
731*4882a593Smuzhiyun 	put_cpu_ptr(gcs);
732*4882a593Smuzhiyun }
733*4882a593Smuzhiyun 
iocg_lock(struct ioc_gq * iocg,bool lock_ioc,unsigned long * flags)734*4882a593Smuzhiyun static void iocg_lock(struct ioc_gq *iocg, bool lock_ioc, unsigned long *flags)
735*4882a593Smuzhiyun {
736*4882a593Smuzhiyun 	if (lock_ioc) {
737*4882a593Smuzhiyun 		spin_lock_irqsave(&iocg->ioc->lock, *flags);
738*4882a593Smuzhiyun 		spin_lock(&iocg->waitq.lock);
739*4882a593Smuzhiyun 	} else {
740*4882a593Smuzhiyun 		spin_lock_irqsave(&iocg->waitq.lock, *flags);
741*4882a593Smuzhiyun 	}
742*4882a593Smuzhiyun }
743*4882a593Smuzhiyun 
iocg_unlock(struct ioc_gq * iocg,bool unlock_ioc,unsigned long * flags)744*4882a593Smuzhiyun static void iocg_unlock(struct ioc_gq *iocg, bool unlock_ioc, unsigned long *flags)
745*4882a593Smuzhiyun {
746*4882a593Smuzhiyun 	if (unlock_ioc) {
747*4882a593Smuzhiyun 		spin_unlock(&iocg->waitq.lock);
748*4882a593Smuzhiyun 		spin_unlock_irqrestore(&iocg->ioc->lock, *flags);
749*4882a593Smuzhiyun 	} else {
750*4882a593Smuzhiyun 		spin_unlock_irqrestore(&iocg->waitq.lock, *flags);
751*4882a593Smuzhiyun 	}
752*4882a593Smuzhiyun }
753*4882a593Smuzhiyun 
754*4882a593Smuzhiyun #define CREATE_TRACE_POINTS
755*4882a593Smuzhiyun #include <trace/events/iocost.h>
756*4882a593Smuzhiyun 
ioc_refresh_margins(struct ioc * ioc)757*4882a593Smuzhiyun static void ioc_refresh_margins(struct ioc *ioc)
758*4882a593Smuzhiyun {
759*4882a593Smuzhiyun 	struct ioc_margins *margins = &ioc->margins;
760*4882a593Smuzhiyun 	u32 period_us = ioc->period_us;
761*4882a593Smuzhiyun 	u64 vrate = ioc->vtime_base_rate;
762*4882a593Smuzhiyun 
763*4882a593Smuzhiyun 	margins->min = (period_us * MARGIN_MIN_PCT / 100) * vrate;
764*4882a593Smuzhiyun 	margins->low = (period_us * MARGIN_LOW_PCT / 100) * vrate;
765*4882a593Smuzhiyun 	margins->target = (period_us * MARGIN_TARGET_PCT / 100) * vrate;
766*4882a593Smuzhiyun }
767*4882a593Smuzhiyun 
768*4882a593Smuzhiyun /* latency Qos params changed, update period_us and all the dependent params */
ioc_refresh_period_us(struct ioc * ioc)769*4882a593Smuzhiyun static void ioc_refresh_period_us(struct ioc *ioc)
770*4882a593Smuzhiyun {
771*4882a593Smuzhiyun 	u32 ppm, lat, multi, period_us;
772*4882a593Smuzhiyun 
773*4882a593Smuzhiyun 	lockdep_assert_held(&ioc->lock);
774*4882a593Smuzhiyun 
775*4882a593Smuzhiyun 	/* pick the higher latency target */
776*4882a593Smuzhiyun 	if (ioc->params.qos[QOS_RLAT] >= ioc->params.qos[QOS_WLAT]) {
777*4882a593Smuzhiyun 		ppm = ioc->params.qos[QOS_RPPM];
778*4882a593Smuzhiyun 		lat = ioc->params.qos[QOS_RLAT];
779*4882a593Smuzhiyun 	} else {
780*4882a593Smuzhiyun 		ppm = ioc->params.qos[QOS_WPPM];
781*4882a593Smuzhiyun 		lat = ioc->params.qos[QOS_WLAT];
782*4882a593Smuzhiyun 	}
783*4882a593Smuzhiyun 
784*4882a593Smuzhiyun 	/*
785*4882a593Smuzhiyun 	 * We want the period to be long enough to contain a healthy number
786*4882a593Smuzhiyun 	 * of IOs while short enough for granular control.  Define it as a
787*4882a593Smuzhiyun 	 * multiple of the latency target.  Ideally, the multiplier should
788*4882a593Smuzhiyun 	 * be scaled according to the percentile so that it would nominally
789*4882a593Smuzhiyun 	 * contain a certain number of requests.  Let's be simpler and
790*4882a593Smuzhiyun 	 * scale it linearly so that it's 2x >= pct(90) and 10x at pct(50).
791*4882a593Smuzhiyun 	 */
792*4882a593Smuzhiyun 	if (ppm)
793*4882a593Smuzhiyun 		multi = max_t(u32, (MILLION - ppm) / 50000, 2);
794*4882a593Smuzhiyun 	else
795*4882a593Smuzhiyun 		multi = 2;
796*4882a593Smuzhiyun 	period_us = multi * lat;
797*4882a593Smuzhiyun 	period_us = clamp_t(u32, period_us, MIN_PERIOD, MAX_PERIOD);
798*4882a593Smuzhiyun 
799*4882a593Smuzhiyun 	/* calculate dependent params */
800*4882a593Smuzhiyun 	ioc->period_us = period_us;
801*4882a593Smuzhiyun 	ioc->timer_slack_ns = div64_u64(
802*4882a593Smuzhiyun 		(u64)period_us * NSEC_PER_USEC * TIMER_SLACK_PCT,
803*4882a593Smuzhiyun 		100);
804*4882a593Smuzhiyun 	ioc_refresh_margins(ioc);
805*4882a593Smuzhiyun }
806*4882a593Smuzhiyun 
ioc_autop_idx(struct ioc * ioc)807*4882a593Smuzhiyun static int ioc_autop_idx(struct ioc *ioc)
808*4882a593Smuzhiyun {
809*4882a593Smuzhiyun 	int idx = ioc->autop_idx;
810*4882a593Smuzhiyun 	const struct ioc_params *p = &autop[idx];
811*4882a593Smuzhiyun 	u32 vrate_pct;
812*4882a593Smuzhiyun 	u64 now_ns;
813*4882a593Smuzhiyun 
814*4882a593Smuzhiyun 	/* rotational? */
815*4882a593Smuzhiyun 	if (!blk_queue_nonrot(ioc->rqos.q))
816*4882a593Smuzhiyun 		return AUTOP_HDD;
817*4882a593Smuzhiyun 
818*4882a593Smuzhiyun 	/* handle SATA SSDs w/ broken NCQ */
819*4882a593Smuzhiyun 	if (blk_queue_depth(ioc->rqos.q) == 1)
820*4882a593Smuzhiyun 		return AUTOP_SSD_QD1;
821*4882a593Smuzhiyun 
822*4882a593Smuzhiyun 	/* use one of the normal ssd sets */
823*4882a593Smuzhiyun 	if (idx < AUTOP_SSD_DFL)
824*4882a593Smuzhiyun 		return AUTOP_SSD_DFL;
825*4882a593Smuzhiyun 
826*4882a593Smuzhiyun 	/* if user is overriding anything, maintain what was there */
827*4882a593Smuzhiyun 	if (ioc->user_qos_params || ioc->user_cost_model)
828*4882a593Smuzhiyun 		return idx;
829*4882a593Smuzhiyun 
830*4882a593Smuzhiyun 	/* step up/down based on the vrate */
831*4882a593Smuzhiyun 	vrate_pct = div64_u64(ioc->vtime_base_rate * 100, VTIME_PER_USEC);
832*4882a593Smuzhiyun 	now_ns = ktime_get_ns();
833*4882a593Smuzhiyun 
834*4882a593Smuzhiyun 	if (p->too_fast_vrate_pct && p->too_fast_vrate_pct <= vrate_pct) {
835*4882a593Smuzhiyun 		if (!ioc->autop_too_fast_at)
836*4882a593Smuzhiyun 			ioc->autop_too_fast_at = now_ns;
837*4882a593Smuzhiyun 		if (now_ns - ioc->autop_too_fast_at >= AUTOP_CYCLE_NSEC)
838*4882a593Smuzhiyun 			return idx + 1;
839*4882a593Smuzhiyun 	} else {
840*4882a593Smuzhiyun 		ioc->autop_too_fast_at = 0;
841*4882a593Smuzhiyun 	}
842*4882a593Smuzhiyun 
843*4882a593Smuzhiyun 	if (p->too_slow_vrate_pct && p->too_slow_vrate_pct >= vrate_pct) {
844*4882a593Smuzhiyun 		if (!ioc->autop_too_slow_at)
845*4882a593Smuzhiyun 			ioc->autop_too_slow_at = now_ns;
846*4882a593Smuzhiyun 		if (now_ns - ioc->autop_too_slow_at >= AUTOP_CYCLE_NSEC)
847*4882a593Smuzhiyun 			return idx - 1;
848*4882a593Smuzhiyun 	} else {
849*4882a593Smuzhiyun 		ioc->autop_too_slow_at = 0;
850*4882a593Smuzhiyun 	}
851*4882a593Smuzhiyun 
852*4882a593Smuzhiyun 	return idx;
853*4882a593Smuzhiyun }
854*4882a593Smuzhiyun 
855*4882a593Smuzhiyun /*
856*4882a593Smuzhiyun  * Take the followings as input
857*4882a593Smuzhiyun  *
858*4882a593Smuzhiyun  *  @bps	maximum sequential throughput
859*4882a593Smuzhiyun  *  @seqiops	maximum sequential 4k iops
860*4882a593Smuzhiyun  *  @randiops	maximum random 4k iops
861*4882a593Smuzhiyun  *
862*4882a593Smuzhiyun  * and calculate the linear model cost coefficients.
863*4882a593Smuzhiyun  *
864*4882a593Smuzhiyun  *  *@page	per-page cost		1s / (@bps / 4096)
865*4882a593Smuzhiyun  *  *@seqio	base cost of a seq IO	max((1s / @seqiops) - *@page, 0)
866*4882a593Smuzhiyun  *  @randiops	base cost of a rand IO	max((1s / @randiops) - *@page, 0)
867*4882a593Smuzhiyun  */
calc_lcoefs(u64 bps,u64 seqiops,u64 randiops,u64 * page,u64 * seqio,u64 * randio)868*4882a593Smuzhiyun static void calc_lcoefs(u64 bps, u64 seqiops, u64 randiops,
869*4882a593Smuzhiyun 			u64 *page, u64 *seqio, u64 *randio)
870*4882a593Smuzhiyun {
871*4882a593Smuzhiyun 	u64 v;
872*4882a593Smuzhiyun 
873*4882a593Smuzhiyun 	*page = *seqio = *randio = 0;
874*4882a593Smuzhiyun 
875*4882a593Smuzhiyun 	if (bps)
876*4882a593Smuzhiyun 		*page = DIV64_U64_ROUND_UP(VTIME_PER_SEC,
877*4882a593Smuzhiyun 					   DIV_ROUND_UP_ULL(bps, IOC_PAGE_SIZE));
878*4882a593Smuzhiyun 
879*4882a593Smuzhiyun 	if (seqiops) {
880*4882a593Smuzhiyun 		v = DIV64_U64_ROUND_UP(VTIME_PER_SEC, seqiops);
881*4882a593Smuzhiyun 		if (v > *page)
882*4882a593Smuzhiyun 			*seqio = v - *page;
883*4882a593Smuzhiyun 	}
884*4882a593Smuzhiyun 
885*4882a593Smuzhiyun 	if (randiops) {
886*4882a593Smuzhiyun 		v = DIV64_U64_ROUND_UP(VTIME_PER_SEC, randiops);
887*4882a593Smuzhiyun 		if (v > *page)
888*4882a593Smuzhiyun 			*randio = v - *page;
889*4882a593Smuzhiyun 	}
890*4882a593Smuzhiyun }
891*4882a593Smuzhiyun 
ioc_refresh_lcoefs(struct ioc * ioc)892*4882a593Smuzhiyun static void ioc_refresh_lcoefs(struct ioc *ioc)
893*4882a593Smuzhiyun {
894*4882a593Smuzhiyun 	u64 *u = ioc->params.i_lcoefs;
895*4882a593Smuzhiyun 	u64 *c = ioc->params.lcoefs;
896*4882a593Smuzhiyun 
897*4882a593Smuzhiyun 	calc_lcoefs(u[I_LCOEF_RBPS], u[I_LCOEF_RSEQIOPS], u[I_LCOEF_RRANDIOPS],
898*4882a593Smuzhiyun 		    &c[LCOEF_RPAGE], &c[LCOEF_RSEQIO], &c[LCOEF_RRANDIO]);
899*4882a593Smuzhiyun 	calc_lcoefs(u[I_LCOEF_WBPS], u[I_LCOEF_WSEQIOPS], u[I_LCOEF_WRANDIOPS],
900*4882a593Smuzhiyun 		    &c[LCOEF_WPAGE], &c[LCOEF_WSEQIO], &c[LCOEF_WRANDIO]);
901*4882a593Smuzhiyun }
902*4882a593Smuzhiyun 
ioc_refresh_params(struct ioc * ioc,bool force)903*4882a593Smuzhiyun static bool ioc_refresh_params(struct ioc *ioc, bool force)
904*4882a593Smuzhiyun {
905*4882a593Smuzhiyun 	const struct ioc_params *p;
906*4882a593Smuzhiyun 	int idx;
907*4882a593Smuzhiyun 
908*4882a593Smuzhiyun 	lockdep_assert_held(&ioc->lock);
909*4882a593Smuzhiyun 
910*4882a593Smuzhiyun 	idx = ioc_autop_idx(ioc);
911*4882a593Smuzhiyun 	p = &autop[idx];
912*4882a593Smuzhiyun 
913*4882a593Smuzhiyun 	if (idx == ioc->autop_idx && !force)
914*4882a593Smuzhiyun 		return false;
915*4882a593Smuzhiyun 
916*4882a593Smuzhiyun 	if (idx != ioc->autop_idx)
917*4882a593Smuzhiyun 		atomic64_set(&ioc->vtime_rate, VTIME_PER_USEC);
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 	ioc->autop_idx = idx;
920*4882a593Smuzhiyun 	ioc->autop_too_fast_at = 0;
921*4882a593Smuzhiyun 	ioc->autop_too_slow_at = 0;
922*4882a593Smuzhiyun 
923*4882a593Smuzhiyun 	if (!ioc->user_qos_params)
924*4882a593Smuzhiyun 		memcpy(ioc->params.qos, p->qos, sizeof(p->qos));
925*4882a593Smuzhiyun 	if (!ioc->user_cost_model)
926*4882a593Smuzhiyun 		memcpy(ioc->params.i_lcoefs, p->i_lcoefs, sizeof(p->i_lcoefs));
927*4882a593Smuzhiyun 
928*4882a593Smuzhiyun 	ioc_refresh_period_us(ioc);
929*4882a593Smuzhiyun 	ioc_refresh_lcoefs(ioc);
930*4882a593Smuzhiyun 
931*4882a593Smuzhiyun 	ioc->vrate_min = DIV64_U64_ROUND_UP((u64)ioc->params.qos[QOS_MIN] *
932*4882a593Smuzhiyun 					    VTIME_PER_USEC, MILLION);
933*4882a593Smuzhiyun 	ioc->vrate_max = div64_u64((u64)ioc->params.qos[QOS_MAX] *
934*4882a593Smuzhiyun 				   VTIME_PER_USEC, MILLION);
935*4882a593Smuzhiyun 
936*4882a593Smuzhiyun 	return true;
937*4882a593Smuzhiyun }
938*4882a593Smuzhiyun 
939*4882a593Smuzhiyun /*
940*4882a593Smuzhiyun  * When an iocg accumulates too much vtime or gets deactivated, we throw away
941*4882a593Smuzhiyun  * some vtime, which lowers the overall device utilization. As the exact amount
942*4882a593Smuzhiyun  * which is being thrown away is known, we can compensate by accelerating the
943*4882a593Smuzhiyun  * vrate accordingly so that the extra vtime generated in the current period
944*4882a593Smuzhiyun  * matches what got lost.
945*4882a593Smuzhiyun  */
ioc_refresh_vrate(struct ioc * ioc,struct ioc_now * now)946*4882a593Smuzhiyun static void ioc_refresh_vrate(struct ioc *ioc, struct ioc_now *now)
947*4882a593Smuzhiyun {
948*4882a593Smuzhiyun 	s64 pleft = ioc->period_at + ioc->period_us - now->now;
949*4882a593Smuzhiyun 	s64 vperiod = ioc->period_us * ioc->vtime_base_rate;
950*4882a593Smuzhiyun 	s64 vcomp, vcomp_min, vcomp_max;
951*4882a593Smuzhiyun 
952*4882a593Smuzhiyun 	lockdep_assert_held(&ioc->lock);
953*4882a593Smuzhiyun 
954*4882a593Smuzhiyun 	/* we need some time left in this period */
955*4882a593Smuzhiyun 	if (pleft <= 0)
956*4882a593Smuzhiyun 		goto done;
957*4882a593Smuzhiyun 
958*4882a593Smuzhiyun 	/*
959*4882a593Smuzhiyun 	 * Calculate how much vrate should be adjusted to offset the error.
960*4882a593Smuzhiyun 	 * Limit the amount of adjustment and deduct the adjusted amount from
961*4882a593Smuzhiyun 	 * the error.
962*4882a593Smuzhiyun 	 */
963*4882a593Smuzhiyun 	vcomp = -div64_s64(ioc->vtime_err, pleft);
964*4882a593Smuzhiyun 	vcomp_min = -(ioc->vtime_base_rate >> 1);
965*4882a593Smuzhiyun 	vcomp_max = ioc->vtime_base_rate;
966*4882a593Smuzhiyun 	vcomp = clamp(vcomp, vcomp_min, vcomp_max);
967*4882a593Smuzhiyun 
968*4882a593Smuzhiyun 	ioc->vtime_err += vcomp * pleft;
969*4882a593Smuzhiyun 
970*4882a593Smuzhiyun 	atomic64_set(&ioc->vtime_rate, ioc->vtime_base_rate + vcomp);
971*4882a593Smuzhiyun done:
972*4882a593Smuzhiyun 	/* bound how much error can accumulate */
973*4882a593Smuzhiyun 	ioc->vtime_err = clamp(ioc->vtime_err, -vperiod, vperiod);
974*4882a593Smuzhiyun }
975*4882a593Smuzhiyun 
976*4882a593Smuzhiyun /* take a snapshot of the current [v]time and vrate */
ioc_now(struct ioc * ioc,struct ioc_now * now)977*4882a593Smuzhiyun static void ioc_now(struct ioc *ioc, struct ioc_now *now)
978*4882a593Smuzhiyun {
979*4882a593Smuzhiyun 	unsigned seq;
980*4882a593Smuzhiyun 
981*4882a593Smuzhiyun 	now->now_ns = ktime_get();
982*4882a593Smuzhiyun 	now->now = ktime_to_us(now->now_ns);
983*4882a593Smuzhiyun 	now->vrate = atomic64_read(&ioc->vtime_rate);
984*4882a593Smuzhiyun 
985*4882a593Smuzhiyun 	/*
986*4882a593Smuzhiyun 	 * The current vtime is
987*4882a593Smuzhiyun 	 *
988*4882a593Smuzhiyun 	 *   vtime at period start + (wallclock time since the start) * vrate
989*4882a593Smuzhiyun 	 *
990*4882a593Smuzhiyun 	 * As a consistent snapshot of `period_at_vtime` and `period_at` is
991*4882a593Smuzhiyun 	 * needed, they're seqcount protected.
992*4882a593Smuzhiyun 	 */
993*4882a593Smuzhiyun 	do {
994*4882a593Smuzhiyun 		seq = read_seqcount_begin(&ioc->period_seqcount);
995*4882a593Smuzhiyun 		now->vnow = ioc->period_at_vtime +
996*4882a593Smuzhiyun 			(now->now - ioc->period_at) * now->vrate;
997*4882a593Smuzhiyun 	} while (read_seqcount_retry(&ioc->period_seqcount, seq));
998*4882a593Smuzhiyun }
999*4882a593Smuzhiyun 
ioc_start_period(struct ioc * ioc,struct ioc_now * now)1000*4882a593Smuzhiyun static void ioc_start_period(struct ioc *ioc, struct ioc_now *now)
1001*4882a593Smuzhiyun {
1002*4882a593Smuzhiyun 	WARN_ON_ONCE(ioc->running != IOC_RUNNING);
1003*4882a593Smuzhiyun 
1004*4882a593Smuzhiyun 	write_seqcount_begin(&ioc->period_seqcount);
1005*4882a593Smuzhiyun 	ioc->period_at = now->now;
1006*4882a593Smuzhiyun 	ioc->period_at_vtime = now->vnow;
1007*4882a593Smuzhiyun 	write_seqcount_end(&ioc->period_seqcount);
1008*4882a593Smuzhiyun 
1009*4882a593Smuzhiyun 	ioc->timer.expires = jiffies + usecs_to_jiffies(ioc->period_us);
1010*4882a593Smuzhiyun 	add_timer(&ioc->timer);
1011*4882a593Smuzhiyun }
1012*4882a593Smuzhiyun 
1013*4882a593Smuzhiyun /*
1014*4882a593Smuzhiyun  * Update @iocg's `active` and `inuse` to @active and @inuse, update level
1015*4882a593Smuzhiyun  * weight sums and propagate upwards accordingly. If @save, the current margin
1016*4882a593Smuzhiyun  * is saved to be used as reference for later inuse in-period adjustments.
1017*4882a593Smuzhiyun  */
__propagate_weights(struct ioc_gq * iocg,u32 active,u32 inuse,bool save,struct ioc_now * now)1018*4882a593Smuzhiyun static void __propagate_weights(struct ioc_gq *iocg, u32 active, u32 inuse,
1019*4882a593Smuzhiyun 				bool save, struct ioc_now *now)
1020*4882a593Smuzhiyun {
1021*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
1022*4882a593Smuzhiyun 	int lvl;
1023*4882a593Smuzhiyun 
1024*4882a593Smuzhiyun 	lockdep_assert_held(&ioc->lock);
1025*4882a593Smuzhiyun 
1026*4882a593Smuzhiyun 	/*
1027*4882a593Smuzhiyun 	 * For an active leaf node, its inuse shouldn't be zero or exceed
1028*4882a593Smuzhiyun 	 * @active. An active internal node's inuse is solely determined by the
1029*4882a593Smuzhiyun 	 * inuse to active ratio of its children regardless of @inuse.
1030*4882a593Smuzhiyun 	 */
1031*4882a593Smuzhiyun 	if (list_empty(&iocg->active_list) && iocg->child_active_sum) {
1032*4882a593Smuzhiyun 		inuse = DIV64_U64_ROUND_UP(active * iocg->child_inuse_sum,
1033*4882a593Smuzhiyun 					   iocg->child_active_sum);
1034*4882a593Smuzhiyun 	} else {
1035*4882a593Smuzhiyun 		inuse = clamp_t(u32, inuse, 1, active);
1036*4882a593Smuzhiyun 	}
1037*4882a593Smuzhiyun 
1038*4882a593Smuzhiyun 	iocg->last_inuse = iocg->inuse;
1039*4882a593Smuzhiyun 	if (save)
1040*4882a593Smuzhiyun 		iocg->saved_margin = now->vnow - atomic64_read(&iocg->vtime);
1041*4882a593Smuzhiyun 
1042*4882a593Smuzhiyun 	if (active == iocg->active && inuse == iocg->inuse)
1043*4882a593Smuzhiyun 		return;
1044*4882a593Smuzhiyun 
1045*4882a593Smuzhiyun 	for (lvl = iocg->level - 1; lvl >= 0; lvl--) {
1046*4882a593Smuzhiyun 		struct ioc_gq *parent = iocg->ancestors[lvl];
1047*4882a593Smuzhiyun 		struct ioc_gq *child = iocg->ancestors[lvl + 1];
1048*4882a593Smuzhiyun 		u32 parent_active = 0, parent_inuse = 0;
1049*4882a593Smuzhiyun 
1050*4882a593Smuzhiyun 		/* update the level sums */
1051*4882a593Smuzhiyun 		parent->child_active_sum += (s32)(active - child->active);
1052*4882a593Smuzhiyun 		parent->child_inuse_sum += (s32)(inuse - child->inuse);
1053*4882a593Smuzhiyun 		/* apply the updates */
1054*4882a593Smuzhiyun 		child->active = active;
1055*4882a593Smuzhiyun 		child->inuse = inuse;
1056*4882a593Smuzhiyun 
1057*4882a593Smuzhiyun 		/*
1058*4882a593Smuzhiyun 		 * The delta between inuse and active sums indicates that
1059*4882a593Smuzhiyun 		 * that much of weight is being given away.  Parent's inuse
1060*4882a593Smuzhiyun 		 * and active should reflect the ratio.
1061*4882a593Smuzhiyun 		 */
1062*4882a593Smuzhiyun 		if (parent->child_active_sum) {
1063*4882a593Smuzhiyun 			parent_active = parent->weight;
1064*4882a593Smuzhiyun 			parent_inuse = DIV64_U64_ROUND_UP(
1065*4882a593Smuzhiyun 				parent_active * parent->child_inuse_sum,
1066*4882a593Smuzhiyun 				parent->child_active_sum);
1067*4882a593Smuzhiyun 		}
1068*4882a593Smuzhiyun 
1069*4882a593Smuzhiyun 		/* do we need to keep walking up? */
1070*4882a593Smuzhiyun 		if (parent_active == parent->active &&
1071*4882a593Smuzhiyun 		    parent_inuse == parent->inuse)
1072*4882a593Smuzhiyun 			break;
1073*4882a593Smuzhiyun 
1074*4882a593Smuzhiyun 		active = parent_active;
1075*4882a593Smuzhiyun 		inuse = parent_inuse;
1076*4882a593Smuzhiyun 	}
1077*4882a593Smuzhiyun 
1078*4882a593Smuzhiyun 	ioc->weights_updated = true;
1079*4882a593Smuzhiyun }
1080*4882a593Smuzhiyun 
commit_weights(struct ioc * ioc)1081*4882a593Smuzhiyun static void commit_weights(struct ioc *ioc)
1082*4882a593Smuzhiyun {
1083*4882a593Smuzhiyun 	lockdep_assert_held(&ioc->lock);
1084*4882a593Smuzhiyun 
1085*4882a593Smuzhiyun 	if (ioc->weights_updated) {
1086*4882a593Smuzhiyun 		/* paired with rmb in current_hweight(), see there */
1087*4882a593Smuzhiyun 		smp_wmb();
1088*4882a593Smuzhiyun 		atomic_inc(&ioc->hweight_gen);
1089*4882a593Smuzhiyun 		ioc->weights_updated = false;
1090*4882a593Smuzhiyun 	}
1091*4882a593Smuzhiyun }
1092*4882a593Smuzhiyun 
propagate_weights(struct ioc_gq * iocg,u32 active,u32 inuse,bool save,struct ioc_now * now)1093*4882a593Smuzhiyun static void propagate_weights(struct ioc_gq *iocg, u32 active, u32 inuse,
1094*4882a593Smuzhiyun 			      bool save, struct ioc_now *now)
1095*4882a593Smuzhiyun {
1096*4882a593Smuzhiyun 	__propagate_weights(iocg, active, inuse, save, now);
1097*4882a593Smuzhiyun 	commit_weights(iocg->ioc);
1098*4882a593Smuzhiyun }
1099*4882a593Smuzhiyun 
current_hweight(struct ioc_gq * iocg,u32 * hw_activep,u32 * hw_inusep)1100*4882a593Smuzhiyun static void current_hweight(struct ioc_gq *iocg, u32 *hw_activep, u32 *hw_inusep)
1101*4882a593Smuzhiyun {
1102*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
1103*4882a593Smuzhiyun 	int lvl;
1104*4882a593Smuzhiyun 	u32 hwa, hwi;
1105*4882a593Smuzhiyun 	int ioc_gen;
1106*4882a593Smuzhiyun 
1107*4882a593Smuzhiyun 	/* hot path - if uptodate, use cached */
1108*4882a593Smuzhiyun 	ioc_gen = atomic_read(&ioc->hweight_gen);
1109*4882a593Smuzhiyun 	if (ioc_gen == iocg->hweight_gen)
1110*4882a593Smuzhiyun 		goto out;
1111*4882a593Smuzhiyun 
1112*4882a593Smuzhiyun 	/*
1113*4882a593Smuzhiyun 	 * Paired with wmb in commit_weights(). If we saw the updated
1114*4882a593Smuzhiyun 	 * hweight_gen, all the weight updates from __propagate_weights() are
1115*4882a593Smuzhiyun 	 * visible too.
1116*4882a593Smuzhiyun 	 *
1117*4882a593Smuzhiyun 	 * We can race with weight updates during calculation and get it
1118*4882a593Smuzhiyun 	 * wrong.  However, hweight_gen would have changed and a future
1119*4882a593Smuzhiyun 	 * reader will recalculate and we're guaranteed to discard the
1120*4882a593Smuzhiyun 	 * wrong result soon.
1121*4882a593Smuzhiyun 	 */
1122*4882a593Smuzhiyun 	smp_rmb();
1123*4882a593Smuzhiyun 
1124*4882a593Smuzhiyun 	hwa = hwi = WEIGHT_ONE;
1125*4882a593Smuzhiyun 	for (lvl = 0; lvl <= iocg->level - 1; lvl++) {
1126*4882a593Smuzhiyun 		struct ioc_gq *parent = iocg->ancestors[lvl];
1127*4882a593Smuzhiyun 		struct ioc_gq *child = iocg->ancestors[lvl + 1];
1128*4882a593Smuzhiyun 		u64 active_sum = READ_ONCE(parent->child_active_sum);
1129*4882a593Smuzhiyun 		u64 inuse_sum = READ_ONCE(parent->child_inuse_sum);
1130*4882a593Smuzhiyun 		u32 active = READ_ONCE(child->active);
1131*4882a593Smuzhiyun 		u32 inuse = READ_ONCE(child->inuse);
1132*4882a593Smuzhiyun 
1133*4882a593Smuzhiyun 		/* we can race with deactivations and either may read as zero */
1134*4882a593Smuzhiyun 		if (!active_sum || !inuse_sum)
1135*4882a593Smuzhiyun 			continue;
1136*4882a593Smuzhiyun 
1137*4882a593Smuzhiyun 		active_sum = max_t(u64, active, active_sum);
1138*4882a593Smuzhiyun 		hwa = div64_u64((u64)hwa * active, active_sum);
1139*4882a593Smuzhiyun 
1140*4882a593Smuzhiyun 		inuse_sum = max_t(u64, inuse, inuse_sum);
1141*4882a593Smuzhiyun 		hwi = div64_u64((u64)hwi * inuse, inuse_sum);
1142*4882a593Smuzhiyun 	}
1143*4882a593Smuzhiyun 
1144*4882a593Smuzhiyun 	iocg->hweight_active = max_t(u32, hwa, 1);
1145*4882a593Smuzhiyun 	iocg->hweight_inuse = max_t(u32, hwi, 1);
1146*4882a593Smuzhiyun 	iocg->hweight_gen = ioc_gen;
1147*4882a593Smuzhiyun out:
1148*4882a593Smuzhiyun 	if (hw_activep)
1149*4882a593Smuzhiyun 		*hw_activep = iocg->hweight_active;
1150*4882a593Smuzhiyun 	if (hw_inusep)
1151*4882a593Smuzhiyun 		*hw_inusep = iocg->hweight_inuse;
1152*4882a593Smuzhiyun }
1153*4882a593Smuzhiyun 
1154*4882a593Smuzhiyun /*
1155*4882a593Smuzhiyun  * Calculate the hweight_inuse @iocg would get with max @inuse assuming all the
1156*4882a593Smuzhiyun  * other weights stay unchanged.
1157*4882a593Smuzhiyun  */
current_hweight_max(struct ioc_gq * iocg)1158*4882a593Smuzhiyun static u32 current_hweight_max(struct ioc_gq *iocg)
1159*4882a593Smuzhiyun {
1160*4882a593Smuzhiyun 	u32 hwm = WEIGHT_ONE;
1161*4882a593Smuzhiyun 	u32 inuse = iocg->active;
1162*4882a593Smuzhiyun 	u64 child_inuse_sum;
1163*4882a593Smuzhiyun 	int lvl;
1164*4882a593Smuzhiyun 
1165*4882a593Smuzhiyun 	lockdep_assert_held(&iocg->ioc->lock);
1166*4882a593Smuzhiyun 
1167*4882a593Smuzhiyun 	for (lvl = iocg->level - 1; lvl >= 0; lvl--) {
1168*4882a593Smuzhiyun 		struct ioc_gq *parent = iocg->ancestors[lvl];
1169*4882a593Smuzhiyun 		struct ioc_gq *child = iocg->ancestors[lvl + 1];
1170*4882a593Smuzhiyun 
1171*4882a593Smuzhiyun 		child_inuse_sum = parent->child_inuse_sum + inuse - child->inuse;
1172*4882a593Smuzhiyun 		hwm = div64_u64((u64)hwm * inuse, child_inuse_sum);
1173*4882a593Smuzhiyun 		inuse = DIV64_U64_ROUND_UP(parent->active * child_inuse_sum,
1174*4882a593Smuzhiyun 					   parent->child_active_sum);
1175*4882a593Smuzhiyun 	}
1176*4882a593Smuzhiyun 
1177*4882a593Smuzhiyun 	return max_t(u32, hwm, 1);
1178*4882a593Smuzhiyun }
1179*4882a593Smuzhiyun 
weight_updated(struct ioc_gq * iocg,struct ioc_now * now)1180*4882a593Smuzhiyun static void weight_updated(struct ioc_gq *iocg, struct ioc_now *now)
1181*4882a593Smuzhiyun {
1182*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
1183*4882a593Smuzhiyun 	struct blkcg_gq *blkg = iocg_to_blkg(iocg);
1184*4882a593Smuzhiyun 	struct ioc_cgrp *iocc = blkcg_to_iocc(blkg->blkcg);
1185*4882a593Smuzhiyun 	u32 weight;
1186*4882a593Smuzhiyun 
1187*4882a593Smuzhiyun 	lockdep_assert_held(&ioc->lock);
1188*4882a593Smuzhiyun 
1189*4882a593Smuzhiyun 	weight = iocg->cfg_weight ?: iocc->dfl_weight;
1190*4882a593Smuzhiyun 	if (weight != iocg->weight && iocg->active)
1191*4882a593Smuzhiyun 		propagate_weights(iocg, weight, iocg->inuse, true, now);
1192*4882a593Smuzhiyun 	iocg->weight = weight;
1193*4882a593Smuzhiyun }
1194*4882a593Smuzhiyun 
iocg_activate(struct ioc_gq * iocg,struct ioc_now * now)1195*4882a593Smuzhiyun static bool iocg_activate(struct ioc_gq *iocg, struct ioc_now *now)
1196*4882a593Smuzhiyun {
1197*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
1198*4882a593Smuzhiyun 	u64 last_period, cur_period;
1199*4882a593Smuzhiyun 	u64 vtime, vtarget;
1200*4882a593Smuzhiyun 	int i;
1201*4882a593Smuzhiyun 
1202*4882a593Smuzhiyun 	/*
1203*4882a593Smuzhiyun 	 * If seem to be already active, just update the stamp to tell the
1204*4882a593Smuzhiyun 	 * timer that we're still active.  We don't mind occassional races.
1205*4882a593Smuzhiyun 	 */
1206*4882a593Smuzhiyun 	if (!list_empty(&iocg->active_list)) {
1207*4882a593Smuzhiyun 		ioc_now(ioc, now);
1208*4882a593Smuzhiyun 		cur_period = atomic64_read(&ioc->cur_period);
1209*4882a593Smuzhiyun 		if (atomic64_read(&iocg->active_period) != cur_period)
1210*4882a593Smuzhiyun 			atomic64_set(&iocg->active_period, cur_period);
1211*4882a593Smuzhiyun 		return true;
1212*4882a593Smuzhiyun 	}
1213*4882a593Smuzhiyun 
1214*4882a593Smuzhiyun 	/* racy check on internal node IOs, treat as root level IOs */
1215*4882a593Smuzhiyun 	if (iocg->child_active_sum)
1216*4882a593Smuzhiyun 		return false;
1217*4882a593Smuzhiyun 
1218*4882a593Smuzhiyun 	spin_lock_irq(&ioc->lock);
1219*4882a593Smuzhiyun 
1220*4882a593Smuzhiyun 	ioc_now(ioc, now);
1221*4882a593Smuzhiyun 
1222*4882a593Smuzhiyun 	/* update period */
1223*4882a593Smuzhiyun 	cur_period = atomic64_read(&ioc->cur_period);
1224*4882a593Smuzhiyun 	last_period = atomic64_read(&iocg->active_period);
1225*4882a593Smuzhiyun 	atomic64_set(&iocg->active_period, cur_period);
1226*4882a593Smuzhiyun 
1227*4882a593Smuzhiyun 	/* already activated or breaking leaf-only constraint? */
1228*4882a593Smuzhiyun 	if (!list_empty(&iocg->active_list))
1229*4882a593Smuzhiyun 		goto succeed_unlock;
1230*4882a593Smuzhiyun 	for (i = iocg->level - 1; i > 0; i--)
1231*4882a593Smuzhiyun 		if (!list_empty(&iocg->ancestors[i]->active_list))
1232*4882a593Smuzhiyun 			goto fail_unlock;
1233*4882a593Smuzhiyun 
1234*4882a593Smuzhiyun 	if (iocg->child_active_sum)
1235*4882a593Smuzhiyun 		goto fail_unlock;
1236*4882a593Smuzhiyun 
1237*4882a593Smuzhiyun 	/*
1238*4882a593Smuzhiyun 	 * Always start with the target budget. On deactivation, we throw away
1239*4882a593Smuzhiyun 	 * anything above it.
1240*4882a593Smuzhiyun 	 */
1241*4882a593Smuzhiyun 	vtarget = now->vnow - ioc->margins.target;
1242*4882a593Smuzhiyun 	vtime = atomic64_read(&iocg->vtime);
1243*4882a593Smuzhiyun 
1244*4882a593Smuzhiyun 	atomic64_add(vtarget - vtime, &iocg->vtime);
1245*4882a593Smuzhiyun 	atomic64_add(vtarget - vtime, &iocg->done_vtime);
1246*4882a593Smuzhiyun 	vtime = vtarget;
1247*4882a593Smuzhiyun 
1248*4882a593Smuzhiyun 	/*
1249*4882a593Smuzhiyun 	 * Activate, propagate weight and start period timer if not
1250*4882a593Smuzhiyun 	 * running.  Reset hweight_gen to avoid accidental match from
1251*4882a593Smuzhiyun 	 * wrapping.
1252*4882a593Smuzhiyun 	 */
1253*4882a593Smuzhiyun 	iocg->hweight_gen = atomic_read(&ioc->hweight_gen) - 1;
1254*4882a593Smuzhiyun 	list_add(&iocg->active_list, &ioc->active_iocgs);
1255*4882a593Smuzhiyun 
1256*4882a593Smuzhiyun 	propagate_weights(iocg, iocg->weight,
1257*4882a593Smuzhiyun 			  iocg->last_inuse ?: iocg->weight, true, now);
1258*4882a593Smuzhiyun 
1259*4882a593Smuzhiyun 	TRACE_IOCG_PATH(iocg_activate, iocg, now,
1260*4882a593Smuzhiyun 			last_period, cur_period, vtime);
1261*4882a593Smuzhiyun 
1262*4882a593Smuzhiyun 	iocg->activated_at = now->now;
1263*4882a593Smuzhiyun 
1264*4882a593Smuzhiyun 	if (ioc->running == IOC_IDLE) {
1265*4882a593Smuzhiyun 		ioc->running = IOC_RUNNING;
1266*4882a593Smuzhiyun 		ioc->dfgv_period_at = now->now;
1267*4882a593Smuzhiyun 		ioc->dfgv_period_rem = 0;
1268*4882a593Smuzhiyun 		ioc_start_period(ioc, now);
1269*4882a593Smuzhiyun 	}
1270*4882a593Smuzhiyun 
1271*4882a593Smuzhiyun succeed_unlock:
1272*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
1273*4882a593Smuzhiyun 	return true;
1274*4882a593Smuzhiyun 
1275*4882a593Smuzhiyun fail_unlock:
1276*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
1277*4882a593Smuzhiyun 	return false;
1278*4882a593Smuzhiyun }
1279*4882a593Smuzhiyun 
iocg_kick_delay(struct ioc_gq * iocg,struct ioc_now * now)1280*4882a593Smuzhiyun static bool iocg_kick_delay(struct ioc_gq *iocg, struct ioc_now *now)
1281*4882a593Smuzhiyun {
1282*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
1283*4882a593Smuzhiyun 	struct blkcg_gq *blkg = iocg_to_blkg(iocg);
1284*4882a593Smuzhiyun 	u64 tdelta, delay, new_delay;
1285*4882a593Smuzhiyun 	s64 vover, vover_pct;
1286*4882a593Smuzhiyun 	u32 hwa;
1287*4882a593Smuzhiyun 
1288*4882a593Smuzhiyun 	lockdep_assert_held(&iocg->waitq.lock);
1289*4882a593Smuzhiyun 
1290*4882a593Smuzhiyun 	/* calculate the current delay in effect - 1/2 every second */
1291*4882a593Smuzhiyun 	tdelta = now->now - iocg->delay_at;
1292*4882a593Smuzhiyun 	if (iocg->delay)
1293*4882a593Smuzhiyun 		delay = iocg->delay >> div64_u64(tdelta, USEC_PER_SEC);
1294*4882a593Smuzhiyun 	else
1295*4882a593Smuzhiyun 		delay = 0;
1296*4882a593Smuzhiyun 
1297*4882a593Smuzhiyun 	/* calculate the new delay from the debt amount */
1298*4882a593Smuzhiyun 	current_hweight(iocg, &hwa, NULL);
1299*4882a593Smuzhiyun 	vover = atomic64_read(&iocg->vtime) +
1300*4882a593Smuzhiyun 		abs_cost_to_cost(iocg->abs_vdebt, hwa) - now->vnow;
1301*4882a593Smuzhiyun 	vover_pct = div64_s64(100 * vover,
1302*4882a593Smuzhiyun 			      ioc->period_us * ioc->vtime_base_rate);
1303*4882a593Smuzhiyun 
1304*4882a593Smuzhiyun 	if (vover_pct <= MIN_DELAY_THR_PCT)
1305*4882a593Smuzhiyun 		new_delay = 0;
1306*4882a593Smuzhiyun 	else if (vover_pct >= MAX_DELAY_THR_PCT)
1307*4882a593Smuzhiyun 		new_delay = MAX_DELAY;
1308*4882a593Smuzhiyun 	else
1309*4882a593Smuzhiyun 		new_delay = MIN_DELAY +
1310*4882a593Smuzhiyun 			div_u64((MAX_DELAY - MIN_DELAY) *
1311*4882a593Smuzhiyun 				(vover_pct - MIN_DELAY_THR_PCT),
1312*4882a593Smuzhiyun 				MAX_DELAY_THR_PCT - MIN_DELAY_THR_PCT);
1313*4882a593Smuzhiyun 
1314*4882a593Smuzhiyun 	/* pick the higher one and apply */
1315*4882a593Smuzhiyun 	if (new_delay > delay) {
1316*4882a593Smuzhiyun 		iocg->delay = new_delay;
1317*4882a593Smuzhiyun 		iocg->delay_at = now->now;
1318*4882a593Smuzhiyun 		delay = new_delay;
1319*4882a593Smuzhiyun 	}
1320*4882a593Smuzhiyun 
1321*4882a593Smuzhiyun 	if (delay >= MIN_DELAY) {
1322*4882a593Smuzhiyun 		if (!iocg->indelay_since)
1323*4882a593Smuzhiyun 			iocg->indelay_since = now->now;
1324*4882a593Smuzhiyun 		blkcg_set_delay(blkg, delay * NSEC_PER_USEC);
1325*4882a593Smuzhiyun 		return true;
1326*4882a593Smuzhiyun 	} else {
1327*4882a593Smuzhiyun 		if (iocg->indelay_since) {
1328*4882a593Smuzhiyun 			iocg->local_stat.indelay_us += now->now - iocg->indelay_since;
1329*4882a593Smuzhiyun 			iocg->indelay_since = 0;
1330*4882a593Smuzhiyun 		}
1331*4882a593Smuzhiyun 		iocg->delay = 0;
1332*4882a593Smuzhiyun 		blkcg_clear_delay(blkg);
1333*4882a593Smuzhiyun 		return false;
1334*4882a593Smuzhiyun 	}
1335*4882a593Smuzhiyun }
1336*4882a593Smuzhiyun 
iocg_incur_debt(struct ioc_gq * iocg,u64 abs_cost,struct ioc_now * now)1337*4882a593Smuzhiyun static void iocg_incur_debt(struct ioc_gq *iocg, u64 abs_cost,
1338*4882a593Smuzhiyun 			    struct ioc_now *now)
1339*4882a593Smuzhiyun {
1340*4882a593Smuzhiyun 	struct iocg_pcpu_stat *gcs;
1341*4882a593Smuzhiyun 
1342*4882a593Smuzhiyun 	lockdep_assert_held(&iocg->ioc->lock);
1343*4882a593Smuzhiyun 	lockdep_assert_held(&iocg->waitq.lock);
1344*4882a593Smuzhiyun 	WARN_ON_ONCE(list_empty(&iocg->active_list));
1345*4882a593Smuzhiyun 
1346*4882a593Smuzhiyun 	/*
1347*4882a593Smuzhiyun 	 * Once in debt, debt handling owns inuse. @iocg stays at the minimum
1348*4882a593Smuzhiyun 	 * inuse donating all of it share to others until its debt is paid off.
1349*4882a593Smuzhiyun 	 */
1350*4882a593Smuzhiyun 	if (!iocg->abs_vdebt && abs_cost) {
1351*4882a593Smuzhiyun 		iocg->indebt_since = now->now;
1352*4882a593Smuzhiyun 		propagate_weights(iocg, iocg->active, 0, false, now);
1353*4882a593Smuzhiyun 	}
1354*4882a593Smuzhiyun 
1355*4882a593Smuzhiyun 	iocg->abs_vdebt += abs_cost;
1356*4882a593Smuzhiyun 
1357*4882a593Smuzhiyun 	gcs = get_cpu_ptr(iocg->pcpu_stat);
1358*4882a593Smuzhiyun 	local64_add(abs_cost, &gcs->abs_vusage);
1359*4882a593Smuzhiyun 	put_cpu_ptr(gcs);
1360*4882a593Smuzhiyun }
1361*4882a593Smuzhiyun 
iocg_pay_debt(struct ioc_gq * iocg,u64 abs_vpay,struct ioc_now * now)1362*4882a593Smuzhiyun static void iocg_pay_debt(struct ioc_gq *iocg, u64 abs_vpay,
1363*4882a593Smuzhiyun 			  struct ioc_now *now)
1364*4882a593Smuzhiyun {
1365*4882a593Smuzhiyun 	lockdep_assert_held(&iocg->ioc->lock);
1366*4882a593Smuzhiyun 	lockdep_assert_held(&iocg->waitq.lock);
1367*4882a593Smuzhiyun 
1368*4882a593Smuzhiyun 	/* make sure that nobody messed with @iocg */
1369*4882a593Smuzhiyun 	WARN_ON_ONCE(list_empty(&iocg->active_list));
1370*4882a593Smuzhiyun 	WARN_ON_ONCE(iocg->inuse > 1);
1371*4882a593Smuzhiyun 
1372*4882a593Smuzhiyun 	iocg->abs_vdebt -= min(abs_vpay, iocg->abs_vdebt);
1373*4882a593Smuzhiyun 
1374*4882a593Smuzhiyun 	/* if debt is paid in full, restore inuse */
1375*4882a593Smuzhiyun 	if (!iocg->abs_vdebt) {
1376*4882a593Smuzhiyun 		iocg->local_stat.indebt_us += now->now - iocg->indebt_since;
1377*4882a593Smuzhiyun 		iocg->indebt_since = 0;
1378*4882a593Smuzhiyun 
1379*4882a593Smuzhiyun 		propagate_weights(iocg, iocg->active, iocg->last_inuse,
1380*4882a593Smuzhiyun 				  false, now);
1381*4882a593Smuzhiyun 	}
1382*4882a593Smuzhiyun }
1383*4882a593Smuzhiyun 
iocg_wake_fn(struct wait_queue_entry * wq_entry,unsigned mode,int flags,void * key)1384*4882a593Smuzhiyun static int iocg_wake_fn(struct wait_queue_entry *wq_entry, unsigned mode,
1385*4882a593Smuzhiyun 			int flags, void *key)
1386*4882a593Smuzhiyun {
1387*4882a593Smuzhiyun 	struct iocg_wait *wait = container_of(wq_entry, struct iocg_wait, wait);
1388*4882a593Smuzhiyun 	struct iocg_wake_ctx *ctx = (struct iocg_wake_ctx *)key;
1389*4882a593Smuzhiyun 	u64 cost = abs_cost_to_cost(wait->abs_cost, ctx->hw_inuse);
1390*4882a593Smuzhiyun 
1391*4882a593Smuzhiyun 	ctx->vbudget -= cost;
1392*4882a593Smuzhiyun 
1393*4882a593Smuzhiyun 	if (ctx->vbudget < 0)
1394*4882a593Smuzhiyun 		return -1;
1395*4882a593Smuzhiyun 
1396*4882a593Smuzhiyun 	iocg_commit_bio(ctx->iocg, wait->bio, wait->abs_cost, cost);
1397*4882a593Smuzhiyun 	wait->committed = true;
1398*4882a593Smuzhiyun 
1399*4882a593Smuzhiyun 	/*
1400*4882a593Smuzhiyun 	 * autoremove_wake_function() removes the wait entry only when it
1401*4882a593Smuzhiyun 	 * actually changed the task state. We want the wait always removed.
1402*4882a593Smuzhiyun 	 * Remove explicitly and use default_wake_function(). Note that the
1403*4882a593Smuzhiyun 	 * order of operations is important as finish_wait() tests whether
1404*4882a593Smuzhiyun 	 * @wq_entry is removed without grabbing the lock.
1405*4882a593Smuzhiyun 	 */
1406*4882a593Smuzhiyun 	default_wake_function(wq_entry, mode, flags, key);
1407*4882a593Smuzhiyun 	list_del_init_careful(&wq_entry->entry);
1408*4882a593Smuzhiyun 	return 0;
1409*4882a593Smuzhiyun }
1410*4882a593Smuzhiyun 
1411*4882a593Smuzhiyun /*
1412*4882a593Smuzhiyun  * Calculate the accumulated budget, pay debt if @pay_debt and wake up waiters
1413*4882a593Smuzhiyun  * accordingly. When @pay_debt is %true, the caller must be holding ioc->lock in
1414*4882a593Smuzhiyun  * addition to iocg->waitq.lock.
1415*4882a593Smuzhiyun  */
iocg_kick_waitq(struct ioc_gq * iocg,bool pay_debt,struct ioc_now * now)1416*4882a593Smuzhiyun static void iocg_kick_waitq(struct ioc_gq *iocg, bool pay_debt,
1417*4882a593Smuzhiyun 			    struct ioc_now *now)
1418*4882a593Smuzhiyun {
1419*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
1420*4882a593Smuzhiyun 	struct iocg_wake_ctx ctx = { .iocg = iocg };
1421*4882a593Smuzhiyun 	u64 vshortage, expires, oexpires;
1422*4882a593Smuzhiyun 	s64 vbudget;
1423*4882a593Smuzhiyun 	u32 hwa;
1424*4882a593Smuzhiyun 
1425*4882a593Smuzhiyun 	lockdep_assert_held(&iocg->waitq.lock);
1426*4882a593Smuzhiyun 
1427*4882a593Smuzhiyun 	current_hweight(iocg, &hwa, NULL);
1428*4882a593Smuzhiyun 	vbudget = now->vnow - atomic64_read(&iocg->vtime);
1429*4882a593Smuzhiyun 
1430*4882a593Smuzhiyun 	/* pay off debt */
1431*4882a593Smuzhiyun 	if (pay_debt && iocg->abs_vdebt && vbudget > 0) {
1432*4882a593Smuzhiyun 		u64 abs_vbudget = cost_to_abs_cost(vbudget, hwa);
1433*4882a593Smuzhiyun 		u64 abs_vpay = min_t(u64, abs_vbudget, iocg->abs_vdebt);
1434*4882a593Smuzhiyun 		u64 vpay = abs_cost_to_cost(abs_vpay, hwa);
1435*4882a593Smuzhiyun 
1436*4882a593Smuzhiyun 		lockdep_assert_held(&ioc->lock);
1437*4882a593Smuzhiyun 
1438*4882a593Smuzhiyun 		atomic64_add(vpay, &iocg->vtime);
1439*4882a593Smuzhiyun 		atomic64_add(vpay, &iocg->done_vtime);
1440*4882a593Smuzhiyun 		iocg_pay_debt(iocg, abs_vpay, now);
1441*4882a593Smuzhiyun 		vbudget -= vpay;
1442*4882a593Smuzhiyun 	}
1443*4882a593Smuzhiyun 
1444*4882a593Smuzhiyun 	if (iocg->abs_vdebt || iocg->delay)
1445*4882a593Smuzhiyun 		iocg_kick_delay(iocg, now);
1446*4882a593Smuzhiyun 
1447*4882a593Smuzhiyun 	/*
1448*4882a593Smuzhiyun 	 * Debt can still be outstanding if we haven't paid all yet or the
1449*4882a593Smuzhiyun 	 * caller raced and called without @pay_debt. Shouldn't wake up waiters
1450*4882a593Smuzhiyun 	 * under debt. Make sure @vbudget reflects the outstanding amount and is
1451*4882a593Smuzhiyun 	 * not positive.
1452*4882a593Smuzhiyun 	 */
1453*4882a593Smuzhiyun 	if (iocg->abs_vdebt) {
1454*4882a593Smuzhiyun 		s64 vdebt = abs_cost_to_cost(iocg->abs_vdebt, hwa);
1455*4882a593Smuzhiyun 		vbudget = min_t(s64, 0, vbudget - vdebt);
1456*4882a593Smuzhiyun 	}
1457*4882a593Smuzhiyun 
1458*4882a593Smuzhiyun 	/*
1459*4882a593Smuzhiyun 	 * Wake up the ones which are due and see how much vtime we'll need for
1460*4882a593Smuzhiyun 	 * the next one. As paying off debt restores hw_inuse, it must be read
1461*4882a593Smuzhiyun 	 * after the above debt payment.
1462*4882a593Smuzhiyun 	 */
1463*4882a593Smuzhiyun 	ctx.vbudget = vbudget;
1464*4882a593Smuzhiyun 	current_hweight(iocg, NULL, &ctx.hw_inuse);
1465*4882a593Smuzhiyun 
1466*4882a593Smuzhiyun 	__wake_up_locked_key(&iocg->waitq, TASK_NORMAL, &ctx);
1467*4882a593Smuzhiyun 
1468*4882a593Smuzhiyun 	if (!waitqueue_active(&iocg->waitq)) {
1469*4882a593Smuzhiyun 		if (iocg->wait_since) {
1470*4882a593Smuzhiyun 			iocg->local_stat.wait_us += now->now - iocg->wait_since;
1471*4882a593Smuzhiyun 			iocg->wait_since = 0;
1472*4882a593Smuzhiyun 		}
1473*4882a593Smuzhiyun 		return;
1474*4882a593Smuzhiyun 	}
1475*4882a593Smuzhiyun 
1476*4882a593Smuzhiyun 	if (!iocg->wait_since)
1477*4882a593Smuzhiyun 		iocg->wait_since = now->now;
1478*4882a593Smuzhiyun 
1479*4882a593Smuzhiyun 	if (WARN_ON_ONCE(ctx.vbudget >= 0))
1480*4882a593Smuzhiyun 		return;
1481*4882a593Smuzhiyun 
1482*4882a593Smuzhiyun 	/* determine next wakeup, add a timer margin to guarantee chunking */
1483*4882a593Smuzhiyun 	vshortage = -ctx.vbudget;
1484*4882a593Smuzhiyun 	expires = now->now_ns +
1485*4882a593Smuzhiyun 		DIV64_U64_ROUND_UP(vshortage, ioc->vtime_base_rate) *
1486*4882a593Smuzhiyun 		NSEC_PER_USEC;
1487*4882a593Smuzhiyun 	expires += ioc->timer_slack_ns;
1488*4882a593Smuzhiyun 
1489*4882a593Smuzhiyun 	/* if already active and close enough, don't bother */
1490*4882a593Smuzhiyun 	oexpires = ktime_to_ns(hrtimer_get_softexpires(&iocg->waitq_timer));
1491*4882a593Smuzhiyun 	if (hrtimer_is_queued(&iocg->waitq_timer) &&
1492*4882a593Smuzhiyun 	    abs(oexpires - expires) <= ioc->timer_slack_ns)
1493*4882a593Smuzhiyun 		return;
1494*4882a593Smuzhiyun 
1495*4882a593Smuzhiyun 	hrtimer_start_range_ns(&iocg->waitq_timer, ns_to_ktime(expires),
1496*4882a593Smuzhiyun 			       ioc->timer_slack_ns, HRTIMER_MODE_ABS);
1497*4882a593Smuzhiyun }
1498*4882a593Smuzhiyun 
iocg_waitq_timer_fn(struct hrtimer * timer)1499*4882a593Smuzhiyun static enum hrtimer_restart iocg_waitq_timer_fn(struct hrtimer *timer)
1500*4882a593Smuzhiyun {
1501*4882a593Smuzhiyun 	struct ioc_gq *iocg = container_of(timer, struct ioc_gq, waitq_timer);
1502*4882a593Smuzhiyun 	bool pay_debt = READ_ONCE(iocg->abs_vdebt);
1503*4882a593Smuzhiyun 	struct ioc_now now;
1504*4882a593Smuzhiyun 	unsigned long flags;
1505*4882a593Smuzhiyun 
1506*4882a593Smuzhiyun 	ioc_now(iocg->ioc, &now);
1507*4882a593Smuzhiyun 
1508*4882a593Smuzhiyun 	iocg_lock(iocg, pay_debt, &flags);
1509*4882a593Smuzhiyun 	iocg_kick_waitq(iocg, pay_debt, &now);
1510*4882a593Smuzhiyun 	iocg_unlock(iocg, pay_debt, &flags);
1511*4882a593Smuzhiyun 
1512*4882a593Smuzhiyun 	return HRTIMER_NORESTART;
1513*4882a593Smuzhiyun }
1514*4882a593Smuzhiyun 
ioc_lat_stat(struct ioc * ioc,u32 * missed_ppm_ar,u32 * rq_wait_pct_p)1515*4882a593Smuzhiyun static void ioc_lat_stat(struct ioc *ioc, u32 *missed_ppm_ar, u32 *rq_wait_pct_p)
1516*4882a593Smuzhiyun {
1517*4882a593Smuzhiyun 	u32 nr_met[2] = { };
1518*4882a593Smuzhiyun 	u32 nr_missed[2] = { };
1519*4882a593Smuzhiyun 	u64 rq_wait_ns = 0;
1520*4882a593Smuzhiyun 	int cpu, rw;
1521*4882a593Smuzhiyun 
1522*4882a593Smuzhiyun 	for_each_online_cpu(cpu) {
1523*4882a593Smuzhiyun 		struct ioc_pcpu_stat *stat = per_cpu_ptr(ioc->pcpu_stat, cpu);
1524*4882a593Smuzhiyun 		u64 this_rq_wait_ns;
1525*4882a593Smuzhiyun 
1526*4882a593Smuzhiyun 		for (rw = READ; rw <= WRITE; rw++) {
1527*4882a593Smuzhiyun 			u32 this_met = local_read(&stat->missed[rw].nr_met);
1528*4882a593Smuzhiyun 			u32 this_missed = local_read(&stat->missed[rw].nr_missed);
1529*4882a593Smuzhiyun 
1530*4882a593Smuzhiyun 			nr_met[rw] += this_met - stat->missed[rw].last_met;
1531*4882a593Smuzhiyun 			nr_missed[rw] += this_missed - stat->missed[rw].last_missed;
1532*4882a593Smuzhiyun 			stat->missed[rw].last_met = this_met;
1533*4882a593Smuzhiyun 			stat->missed[rw].last_missed = this_missed;
1534*4882a593Smuzhiyun 		}
1535*4882a593Smuzhiyun 
1536*4882a593Smuzhiyun 		this_rq_wait_ns = local64_read(&stat->rq_wait_ns);
1537*4882a593Smuzhiyun 		rq_wait_ns += this_rq_wait_ns - stat->last_rq_wait_ns;
1538*4882a593Smuzhiyun 		stat->last_rq_wait_ns = this_rq_wait_ns;
1539*4882a593Smuzhiyun 	}
1540*4882a593Smuzhiyun 
1541*4882a593Smuzhiyun 	for (rw = READ; rw <= WRITE; rw++) {
1542*4882a593Smuzhiyun 		if (nr_met[rw] + nr_missed[rw])
1543*4882a593Smuzhiyun 			missed_ppm_ar[rw] =
1544*4882a593Smuzhiyun 				DIV64_U64_ROUND_UP((u64)nr_missed[rw] * MILLION,
1545*4882a593Smuzhiyun 						   nr_met[rw] + nr_missed[rw]);
1546*4882a593Smuzhiyun 		else
1547*4882a593Smuzhiyun 			missed_ppm_ar[rw] = 0;
1548*4882a593Smuzhiyun 	}
1549*4882a593Smuzhiyun 
1550*4882a593Smuzhiyun 	*rq_wait_pct_p = div64_u64(rq_wait_ns * 100,
1551*4882a593Smuzhiyun 				   ioc->period_us * NSEC_PER_USEC);
1552*4882a593Smuzhiyun }
1553*4882a593Smuzhiyun 
1554*4882a593Smuzhiyun /* was iocg idle this period? */
iocg_is_idle(struct ioc_gq * iocg)1555*4882a593Smuzhiyun static bool iocg_is_idle(struct ioc_gq *iocg)
1556*4882a593Smuzhiyun {
1557*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
1558*4882a593Smuzhiyun 
1559*4882a593Smuzhiyun 	/* did something get issued this period? */
1560*4882a593Smuzhiyun 	if (atomic64_read(&iocg->active_period) ==
1561*4882a593Smuzhiyun 	    atomic64_read(&ioc->cur_period))
1562*4882a593Smuzhiyun 		return false;
1563*4882a593Smuzhiyun 
1564*4882a593Smuzhiyun 	/* is something in flight? */
1565*4882a593Smuzhiyun 	if (atomic64_read(&iocg->done_vtime) != atomic64_read(&iocg->vtime))
1566*4882a593Smuzhiyun 		return false;
1567*4882a593Smuzhiyun 
1568*4882a593Smuzhiyun 	return true;
1569*4882a593Smuzhiyun }
1570*4882a593Smuzhiyun 
1571*4882a593Smuzhiyun /*
1572*4882a593Smuzhiyun  * Call this function on the target leaf @iocg's to build pre-order traversal
1573*4882a593Smuzhiyun  * list of all the ancestors in @inner_walk. The inner nodes are linked through
1574*4882a593Smuzhiyun  * ->walk_list and the caller is responsible for dissolving the list after use.
1575*4882a593Smuzhiyun  */
iocg_build_inner_walk(struct ioc_gq * iocg,struct list_head * inner_walk)1576*4882a593Smuzhiyun static void iocg_build_inner_walk(struct ioc_gq *iocg,
1577*4882a593Smuzhiyun 				  struct list_head *inner_walk)
1578*4882a593Smuzhiyun {
1579*4882a593Smuzhiyun 	int lvl;
1580*4882a593Smuzhiyun 
1581*4882a593Smuzhiyun 	WARN_ON_ONCE(!list_empty(&iocg->walk_list));
1582*4882a593Smuzhiyun 
1583*4882a593Smuzhiyun 	/* find the first ancestor which hasn't been visited yet */
1584*4882a593Smuzhiyun 	for (lvl = iocg->level - 1; lvl >= 0; lvl--) {
1585*4882a593Smuzhiyun 		if (!list_empty(&iocg->ancestors[lvl]->walk_list))
1586*4882a593Smuzhiyun 			break;
1587*4882a593Smuzhiyun 	}
1588*4882a593Smuzhiyun 
1589*4882a593Smuzhiyun 	/* walk down and visit the inner nodes to get pre-order traversal */
1590*4882a593Smuzhiyun 	while (++lvl <= iocg->level - 1) {
1591*4882a593Smuzhiyun 		struct ioc_gq *inner = iocg->ancestors[lvl];
1592*4882a593Smuzhiyun 
1593*4882a593Smuzhiyun 		/* record traversal order */
1594*4882a593Smuzhiyun 		list_add_tail(&inner->walk_list, inner_walk);
1595*4882a593Smuzhiyun 	}
1596*4882a593Smuzhiyun }
1597*4882a593Smuzhiyun 
1598*4882a593Smuzhiyun /* collect per-cpu counters and propagate the deltas to the parent */
iocg_flush_stat_one(struct ioc_gq * iocg,struct ioc_now * now)1599*4882a593Smuzhiyun static void iocg_flush_stat_one(struct ioc_gq *iocg, struct ioc_now *now)
1600*4882a593Smuzhiyun {
1601*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
1602*4882a593Smuzhiyun 	struct iocg_stat new_stat;
1603*4882a593Smuzhiyun 	u64 abs_vusage = 0;
1604*4882a593Smuzhiyun 	u64 vusage_delta;
1605*4882a593Smuzhiyun 	int cpu;
1606*4882a593Smuzhiyun 
1607*4882a593Smuzhiyun 	lockdep_assert_held(&iocg->ioc->lock);
1608*4882a593Smuzhiyun 
1609*4882a593Smuzhiyun 	/* collect per-cpu counters */
1610*4882a593Smuzhiyun 	for_each_possible_cpu(cpu) {
1611*4882a593Smuzhiyun 		abs_vusage += local64_read(
1612*4882a593Smuzhiyun 				per_cpu_ptr(&iocg->pcpu_stat->abs_vusage, cpu));
1613*4882a593Smuzhiyun 	}
1614*4882a593Smuzhiyun 	vusage_delta = abs_vusage - iocg->last_stat_abs_vusage;
1615*4882a593Smuzhiyun 	iocg->last_stat_abs_vusage = abs_vusage;
1616*4882a593Smuzhiyun 
1617*4882a593Smuzhiyun 	iocg->usage_delta_us = div64_u64(vusage_delta, ioc->vtime_base_rate);
1618*4882a593Smuzhiyun 	iocg->local_stat.usage_us += iocg->usage_delta_us;
1619*4882a593Smuzhiyun 
1620*4882a593Smuzhiyun 	/* propagate upwards */
1621*4882a593Smuzhiyun 	new_stat.usage_us =
1622*4882a593Smuzhiyun 		iocg->local_stat.usage_us + iocg->desc_stat.usage_us;
1623*4882a593Smuzhiyun 	new_stat.wait_us =
1624*4882a593Smuzhiyun 		iocg->local_stat.wait_us + iocg->desc_stat.wait_us;
1625*4882a593Smuzhiyun 	new_stat.indebt_us =
1626*4882a593Smuzhiyun 		iocg->local_stat.indebt_us + iocg->desc_stat.indebt_us;
1627*4882a593Smuzhiyun 	new_stat.indelay_us =
1628*4882a593Smuzhiyun 		iocg->local_stat.indelay_us + iocg->desc_stat.indelay_us;
1629*4882a593Smuzhiyun 
1630*4882a593Smuzhiyun 	/* propagate the deltas to the parent */
1631*4882a593Smuzhiyun 	if (iocg->level > 0) {
1632*4882a593Smuzhiyun 		struct iocg_stat *parent_stat =
1633*4882a593Smuzhiyun 			&iocg->ancestors[iocg->level - 1]->desc_stat;
1634*4882a593Smuzhiyun 
1635*4882a593Smuzhiyun 		parent_stat->usage_us +=
1636*4882a593Smuzhiyun 			new_stat.usage_us - iocg->last_stat.usage_us;
1637*4882a593Smuzhiyun 		parent_stat->wait_us +=
1638*4882a593Smuzhiyun 			new_stat.wait_us - iocg->last_stat.wait_us;
1639*4882a593Smuzhiyun 		parent_stat->indebt_us +=
1640*4882a593Smuzhiyun 			new_stat.indebt_us - iocg->last_stat.indebt_us;
1641*4882a593Smuzhiyun 		parent_stat->indelay_us +=
1642*4882a593Smuzhiyun 			new_stat.indelay_us - iocg->last_stat.indelay_us;
1643*4882a593Smuzhiyun 	}
1644*4882a593Smuzhiyun 
1645*4882a593Smuzhiyun 	iocg->last_stat = new_stat;
1646*4882a593Smuzhiyun }
1647*4882a593Smuzhiyun 
1648*4882a593Smuzhiyun /* get stat counters ready for reading on all active iocgs */
iocg_flush_stat(struct list_head * target_iocgs,struct ioc_now * now)1649*4882a593Smuzhiyun static void iocg_flush_stat(struct list_head *target_iocgs, struct ioc_now *now)
1650*4882a593Smuzhiyun {
1651*4882a593Smuzhiyun 	LIST_HEAD(inner_walk);
1652*4882a593Smuzhiyun 	struct ioc_gq *iocg, *tiocg;
1653*4882a593Smuzhiyun 
1654*4882a593Smuzhiyun 	/* flush leaves and build inner node walk list */
1655*4882a593Smuzhiyun 	list_for_each_entry(iocg, target_iocgs, active_list) {
1656*4882a593Smuzhiyun 		iocg_flush_stat_one(iocg, now);
1657*4882a593Smuzhiyun 		iocg_build_inner_walk(iocg, &inner_walk);
1658*4882a593Smuzhiyun 	}
1659*4882a593Smuzhiyun 
1660*4882a593Smuzhiyun 	/* keep flushing upwards by walking the inner list backwards */
1661*4882a593Smuzhiyun 	list_for_each_entry_safe_reverse(iocg, tiocg, &inner_walk, walk_list) {
1662*4882a593Smuzhiyun 		iocg_flush_stat_one(iocg, now);
1663*4882a593Smuzhiyun 		list_del_init(&iocg->walk_list);
1664*4882a593Smuzhiyun 	}
1665*4882a593Smuzhiyun }
1666*4882a593Smuzhiyun 
1667*4882a593Smuzhiyun /*
1668*4882a593Smuzhiyun  * Determine what @iocg's hweight_inuse should be after donating unused
1669*4882a593Smuzhiyun  * capacity. @hwm is the upper bound and used to signal no donation. This
1670*4882a593Smuzhiyun  * function also throws away @iocg's excess budget.
1671*4882a593Smuzhiyun  */
hweight_after_donation(struct ioc_gq * iocg,u32 old_hwi,u32 hwm,u32 usage,struct ioc_now * now)1672*4882a593Smuzhiyun static u32 hweight_after_donation(struct ioc_gq *iocg, u32 old_hwi, u32 hwm,
1673*4882a593Smuzhiyun 				  u32 usage, struct ioc_now *now)
1674*4882a593Smuzhiyun {
1675*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
1676*4882a593Smuzhiyun 	u64 vtime = atomic64_read(&iocg->vtime);
1677*4882a593Smuzhiyun 	s64 excess, delta, target, new_hwi;
1678*4882a593Smuzhiyun 
1679*4882a593Smuzhiyun 	/* debt handling owns inuse for debtors */
1680*4882a593Smuzhiyun 	if (iocg->abs_vdebt)
1681*4882a593Smuzhiyun 		return 1;
1682*4882a593Smuzhiyun 
1683*4882a593Smuzhiyun 	/* see whether minimum margin requirement is met */
1684*4882a593Smuzhiyun 	if (waitqueue_active(&iocg->waitq) ||
1685*4882a593Smuzhiyun 	    time_after64(vtime, now->vnow - ioc->margins.min))
1686*4882a593Smuzhiyun 		return hwm;
1687*4882a593Smuzhiyun 
1688*4882a593Smuzhiyun 	/* throw away excess above target */
1689*4882a593Smuzhiyun 	excess = now->vnow - vtime - ioc->margins.target;
1690*4882a593Smuzhiyun 	if (excess > 0) {
1691*4882a593Smuzhiyun 		atomic64_add(excess, &iocg->vtime);
1692*4882a593Smuzhiyun 		atomic64_add(excess, &iocg->done_vtime);
1693*4882a593Smuzhiyun 		vtime += excess;
1694*4882a593Smuzhiyun 		ioc->vtime_err -= div64_u64(excess * old_hwi, WEIGHT_ONE);
1695*4882a593Smuzhiyun 	}
1696*4882a593Smuzhiyun 
1697*4882a593Smuzhiyun 	/*
1698*4882a593Smuzhiyun 	 * Let's say the distance between iocg's and device's vtimes as a
1699*4882a593Smuzhiyun 	 * fraction of period duration is delta. Assuming that the iocg will
1700*4882a593Smuzhiyun 	 * consume the usage determined above, we want to determine new_hwi so
1701*4882a593Smuzhiyun 	 * that delta equals MARGIN_TARGET at the end of the next period.
1702*4882a593Smuzhiyun 	 *
1703*4882a593Smuzhiyun 	 * We need to execute usage worth of IOs while spending the sum of the
1704*4882a593Smuzhiyun 	 * new budget (1 - MARGIN_TARGET) and the leftover from the last period
1705*4882a593Smuzhiyun 	 * (delta):
1706*4882a593Smuzhiyun 	 *
1707*4882a593Smuzhiyun 	 *   usage = (1 - MARGIN_TARGET + delta) * new_hwi
1708*4882a593Smuzhiyun 	 *
1709*4882a593Smuzhiyun 	 * Therefore, the new_hwi is:
1710*4882a593Smuzhiyun 	 *
1711*4882a593Smuzhiyun 	 *   new_hwi = usage / (1 - MARGIN_TARGET + delta)
1712*4882a593Smuzhiyun 	 */
1713*4882a593Smuzhiyun 	delta = div64_s64(WEIGHT_ONE * (now->vnow - vtime),
1714*4882a593Smuzhiyun 			  now->vnow - ioc->period_at_vtime);
1715*4882a593Smuzhiyun 	target = WEIGHT_ONE * MARGIN_TARGET_PCT / 100;
1716*4882a593Smuzhiyun 	new_hwi = div64_s64(WEIGHT_ONE * usage, WEIGHT_ONE - target + delta);
1717*4882a593Smuzhiyun 
1718*4882a593Smuzhiyun 	return clamp_t(s64, new_hwi, 1, hwm);
1719*4882a593Smuzhiyun }
1720*4882a593Smuzhiyun 
1721*4882a593Smuzhiyun /*
1722*4882a593Smuzhiyun  * For work-conservation, an iocg which isn't using all of its share should
1723*4882a593Smuzhiyun  * donate the leftover to other iocgs. There are two ways to achieve this - 1.
1724*4882a593Smuzhiyun  * bumping up vrate accordingly 2. lowering the donating iocg's inuse weight.
1725*4882a593Smuzhiyun  *
1726*4882a593Smuzhiyun  * #1 is mathematically simpler but has the drawback of requiring synchronous
1727*4882a593Smuzhiyun  * global hweight_inuse updates when idle iocg's get activated or inuse weights
1728*4882a593Smuzhiyun  * change due to donation snapbacks as it has the possibility of grossly
1729*4882a593Smuzhiyun  * overshooting what's allowed by the model and vrate.
1730*4882a593Smuzhiyun  *
1731*4882a593Smuzhiyun  * #2 is inherently safe with local operations. The donating iocg can easily
1732*4882a593Smuzhiyun  * snap back to higher weights when needed without worrying about impacts on
1733*4882a593Smuzhiyun  * other nodes as the impacts will be inherently correct. This also makes idle
1734*4882a593Smuzhiyun  * iocg activations safe. The only effect activations have is decreasing
1735*4882a593Smuzhiyun  * hweight_inuse of others, the right solution to which is for those iocgs to
1736*4882a593Smuzhiyun  * snap back to higher weights.
1737*4882a593Smuzhiyun  *
1738*4882a593Smuzhiyun  * So, we go with #2. The challenge is calculating how each donating iocg's
1739*4882a593Smuzhiyun  * inuse should be adjusted to achieve the target donation amounts. This is done
1740*4882a593Smuzhiyun  * using Andy's method described in the following pdf.
1741*4882a593Smuzhiyun  *
1742*4882a593Smuzhiyun  *   https://drive.google.com/file/d/1PsJwxPFtjUnwOY1QJ5AeICCcsL7BM3bo
1743*4882a593Smuzhiyun  *
1744*4882a593Smuzhiyun  * Given the weights and target after-donation hweight_inuse values, Andy's
1745*4882a593Smuzhiyun  * method determines how the proportional distribution should look like at each
1746*4882a593Smuzhiyun  * sibling level to maintain the relative relationship between all non-donating
1747*4882a593Smuzhiyun  * pairs. To roughly summarize, it divides the tree into donating and
1748*4882a593Smuzhiyun  * non-donating parts, calculates global donation rate which is used to
1749*4882a593Smuzhiyun  * determine the target hweight_inuse for each node, and then derives per-level
1750*4882a593Smuzhiyun  * proportions.
1751*4882a593Smuzhiyun  *
1752*4882a593Smuzhiyun  * The following pdf shows that global distribution calculated this way can be
1753*4882a593Smuzhiyun  * achieved by scaling inuse weights of donating leaves and propagating the
1754*4882a593Smuzhiyun  * adjustments upwards proportionally.
1755*4882a593Smuzhiyun  *
1756*4882a593Smuzhiyun  *   https://drive.google.com/file/d/1vONz1-fzVO7oY5DXXsLjSxEtYYQbOvsE
1757*4882a593Smuzhiyun  *
1758*4882a593Smuzhiyun  * Combining the above two, we can determine how each leaf iocg's inuse should
1759*4882a593Smuzhiyun  * be adjusted to achieve the target donation.
1760*4882a593Smuzhiyun  *
1761*4882a593Smuzhiyun  *   https://drive.google.com/file/d/1WcrltBOSPN0qXVdBgnKm4mdp9FhuEFQN
1762*4882a593Smuzhiyun  *
1763*4882a593Smuzhiyun  * The inline comments use symbols from the last pdf.
1764*4882a593Smuzhiyun  *
1765*4882a593Smuzhiyun  *   b is the sum of the absolute budgets in the subtree. 1 for the root node.
1766*4882a593Smuzhiyun  *   f is the sum of the absolute budgets of non-donating nodes in the subtree.
1767*4882a593Smuzhiyun  *   t is the sum of the absolute budgets of donating nodes in the subtree.
1768*4882a593Smuzhiyun  *   w is the weight of the node. w = w_f + w_t
1769*4882a593Smuzhiyun  *   w_f is the non-donating portion of w. w_f = w * f / b
1770*4882a593Smuzhiyun  *   w_b is the donating portion of w. w_t = w * t / b
1771*4882a593Smuzhiyun  *   s is the sum of all sibling weights. s = Sum(w) for siblings
1772*4882a593Smuzhiyun  *   s_f and s_t are the non-donating and donating portions of s.
1773*4882a593Smuzhiyun  *
1774*4882a593Smuzhiyun  * Subscript p denotes the parent's counterpart and ' the adjusted value - e.g.
1775*4882a593Smuzhiyun  * w_pt is the donating portion of the parent's weight and w'_pt the same value
1776*4882a593Smuzhiyun  * after adjustments. Subscript r denotes the root node's values.
1777*4882a593Smuzhiyun  */
transfer_surpluses(struct list_head * surpluses,struct ioc_now * now)1778*4882a593Smuzhiyun static void transfer_surpluses(struct list_head *surpluses, struct ioc_now *now)
1779*4882a593Smuzhiyun {
1780*4882a593Smuzhiyun 	LIST_HEAD(over_hwa);
1781*4882a593Smuzhiyun 	LIST_HEAD(inner_walk);
1782*4882a593Smuzhiyun 	struct ioc_gq *iocg, *tiocg, *root_iocg;
1783*4882a593Smuzhiyun 	u32 after_sum, over_sum, over_target, gamma;
1784*4882a593Smuzhiyun 
1785*4882a593Smuzhiyun 	/*
1786*4882a593Smuzhiyun 	 * It's pretty unlikely but possible for the total sum of
1787*4882a593Smuzhiyun 	 * hweight_after_donation's to be higher than WEIGHT_ONE, which will
1788*4882a593Smuzhiyun 	 * confuse the following calculations. If such condition is detected,
1789*4882a593Smuzhiyun 	 * scale down everyone over its full share equally to keep the sum below
1790*4882a593Smuzhiyun 	 * WEIGHT_ONE.
1791*4882a593Smuzhiyun 	 */
1792*4882a593Smuzhiyun 	after_sum = 0;
1793*4882a593Smuzhiyun 	over_sum = 0;
1794*4882a593Smuzhiyun 	list_for_each_entry(iocg, surpluses, surplus_list) {
1795*4882a593Smuzhiyun 		u32 hwa;
1796*4882a593Smuzhiyun 
1797*4882a593Smuzhiyun 		current_hweight(iocg, &hwa, NULL);
1798*4882a593Smuzhiyun 		after_sum += iocg->hweight_after_donation;
1799*4882a593Smuzhiyun 
1800*4882a593Smuzhiyun 		if (iocg->hweight_after_donation > hwa) {
1801*4882a593Smuzhiyun 			over_sum += iocg->hweight_after_donation;
1802*4882a593Smuzhiyun 			list_add(&iocg->walk_list, &over_hwa);
1803*4882a593Smuzhiyun 		}
1804*4882a593Smuzhiyun 	}
1805*4882a593Smuzhiyun 
1806*4882a593Smuzhiyun 	if (after_sum >= WEIGHT_ONE) {
1807*4882a593Smuzhiyun 		/*
1808*4882a593Smuzhiyun 		 * The delta should be deducted from the over_sum, calculate
1809*4882a593Smuzhiyun 		 * target over_sum value.
1810*4882a593Smuzhiyun 		 */
1811*4882a593Smuzhiyun 		u32 over_delta = after_sum - (WEIGHT_ONE - 1);
1812*4882a593Smuzhiyun 		WARN_ON_ONCE(over_sum <= over_delta);
1813*4882a593Smuzhiyun 		over_target = over_sum - over_delta;
1814*4882a593Smuzhiyun 	} else {
1815*4882a593Smuzhiyun 		over_target = 0;
1816*4882a593Smuzhiyun 	}
1817*4882a593Smuzhiyun 
1818*4882a593Smuzhiyun 	list_for_each_entry_safe(iocg, tiocg, &over_hwa, walk_list) {
1819*4882a593Smuzhiyun 		if (over_target)
1820*4882a593Smuzhiyun 			iocg->hweight_after_donation =
1821*4882a593Smuzhiyun 				div_u64((u64)iocg->hweight_after_donation *
1822*4882a593Smuzhiyun 					over_target, over_sum);
1823*4882a593Smuzhiyun 		list_del_init(&iocg->walk_list);
1824*4882a593Smuzhiyun 	}
1825*4882a593Smuzhiyun 
1826*4882a593Smuzhiyun 	/*
1827*4882a593Smuzhiyun 	 * Build pre-order inner node walk list and prepare for donation
1828*4882a593Smuzhiyun 	 * adjustment calculations.
1829*4882a593Smuzhiyun 	 */
1830*4882a593Smuzhiyun 	list_for_each_entry(iocg, surpluses, surplus_list) {
1831*4882a593Smuzhiyun 		iocg_build_inner_walk(iocg, &inner_walk);
1832*4882a593Smuzhiyun 	}
1833*4882a593Smuzhiyun 
1834*4882a593Smuzhiyun 	root_iocg = list_first_entry(&inner_walk, struct ioc_gq, walk_list);
1835*4882a593Smuzhiyun 	WARN_ON_ONCE(root_iocg->level > 0);
1836*4882a593Smuzhiyun 
1837*4882a593Smuzhiyun 	list_for_each_entry(iocg, &inner_walk, walk_list) {
1838*4882a593Smuzhiyun 		iocg->child_adjusted_sum = 0;
1839*4882a593Smuzhiyun 		iocg->hweight_donating = 0;
1840*4882a593Smuzhiyun 		iocg->hweight_after_donation = 0;
1841*4882a593Smuzhiyun 	}
1842*4882a593Smuzhiyun 
1843*4882a593Smuzhiyun 	/*
1844*4882a593Smuzhiyun 	 * Propagate the donating budget (b_t) and after donation budget (b'_t)
1845*4882a593Smuzhiyun 	 * up the hierarchy.
1846*4882a593Smuzhiyun 	 */
1847*4882a593Smuzhiyun 	list_for_each_entry(iocg, surpluses, surplus_list) {
1848*4882a593Smuzhiyun 		struct ioc_gq *parent = iocg->ancestors[iocg->level - 1];
1849*4882a593Smuzhiyun 
1850*4882a593Smuzhiyun 		parent->hweight_donating += iocg->hweight_donating;
1851*4882a593Smuzhiyun 		parent->hweight_after_donation += iocg->hweight_after_donation;
1852*4882a593Smuzhiyun 	}
1853*4882a593Smuzhiyun 
1854*4882a593Smuzhiyun 	list_for_each_entry_reverse(iocg, &inner_walk, walk_list) {
1855*4882a593Smuzhiyun 		if (iocg->level > 0) {
1856*4882a593Smuzhiyun 			struct ioc_gq *parent = iocg->ancestors[iocg->level - 1];
1857*4882a593Smuzhiyun 
1858*4882a593Smuzhiyun 			parent->hweight_donating += iocg->hweight_donating;
1859*4882a593Smuzhiyun 			parent->hweight_after_donation += iocg->hweight_after_donation;
1860*4882a593Smuzhiyun 		}
1861*4882a593Smuzhiyun 	}
1862*4882a593Smuzhiyun 
1863*4882a593Smuzhiyun 	/*
1864*4882a593Smuzhiyun 	 * Calculate inner hwa's (b) and make sure the donation values are
1865*4882a593Smuzhiyun 	 * within the accepted ranges as we're doing low res calculations with
1866*4882a593Smuzhiyun 	 * roundups.
1867*4882a593Smuzhiyun 	 */
1868*4882a593Smuzhiyun 	list_for_each_entry(iocg, &inner_walk, walk_list) {
1869*4882a593Smuzhiyun 		if (iocg->level) {
1870*4882a593Smuzhiyun 			struct ioc_gq *parent = iocg->ancestors[iocg->level - 1];
1871*4882a593Smuzhiyun 
1872*4882a593Smuzhiyun 			iocg->hweight_active = DIV64_U64_ROUND_UP(
1873*4882a593Smuzhiyun 				(u64)parent->hweight_active * iocg->active,
1874*4882a593Smuzhiyun 				parent->child_active_sum);
1875*4882a593Smuzhiyun 
1876*4882a593Smuzhiyun 		}
1877*4882a593Smuzhiyun 
1878*4882a593Smuzhiyun 		iocg->hweight_donating = min(iocg->hweight_donating,
1879*4882a593Smuzhiyun 					     iocg->hweight_active);
1880*4882a593Smuzhiyun 		iocg->hweight_after_donation = min(iocg->hweight_after_donation,
1881*4882a593Smuzhiyun 						   iocg->hweight_donating - 1);
1882*4882a593Smuzhiyun 		if (WARN_ON_ONCE(iocg->hweight_active <= 1 ||
1883*4882a593Smuzhiyun 				 iocg->hweight_donating <= 1 ||
1884*4882a593Smuzhiyun 				 iocg->hweight_after_donation == 0)) {
1885*4882a593Smuzhiyun 			pr_warn("iocg: invalid donation weights in ");
1886*4882a593Smuzhiyun 			pr_cont_cgroup_path(iocg_to_blkg(iocg)->blkcg->css.cgroup);
1887*4882a593Smuzhiyun 			pr_cont(": active=%u donating=%u after=%u\n",
1888*4882a593Smuzhiyun 				iocg->hweight_active, iocg->hweight_donating,
1889*4882a593Smuzhiyun 				iocg->hweight_after_donation);
1890*4882a593Smuzhiyun 		}
1891*4882a593Smuzhiyun 	}
1892*4882a593Smuzhiyun 
1893*4882a593Smuzhiyun 	/*
1894*4882a593Smuzhiyun 	 * Calculate the global donation rate (gamma) - the rate to adjust
1895*4882a593Smuzhiyun 	 * non-donating budgets by.
1896*4882a593Smuzhiyun 	 *
1897*4882a593Smuzhiyun 	 * No need to use 64bit multiplication here as the first operand is
1898*4882a593Smuzhiyun 	 * guaranteed to be smaller than WEIGHT_ONE (1<<16).
1899*4882a593Smuzhiyun 	 *
1900*4882a593Smuzhiyun 	 * We know that there are beneficiary nodes and the sum of the donating
1901*4882a593Smuzhiyun 	 * hweights can't be whole; however, due to the round-ups during hweight
1902*4882a593Smuzhiyun 	 * calculations, root_iocg->hweight_donating might still end up equal to
1903*4882a593Smuzhiyun 	 * or greater than whole. Limit the range when calculating the divider.
1904*4882a593Smuzhiyun 	 *
1905*4882a593Smuzhiyun 	 * gamma = (1 - t_r') / (1 - t_r)
1906*4882a593Smuzhiyun 	 */
1907*4882a593Smuzhiyun 	gamma = DIV_ROUND_UP(
1908*4882a593Smuzhiyun 		(WEIGHT_ONE - root_iocg->hweight_after_donation) * WEIGHT_ONE,
1909*4882a593Smuzhiyun 		WEIGHT_ONE - min_t(u32, root_iocg->hweight_donating, WEIGHT_ONE - 1));
1910*4882a593Smuzhiyun 
1911*4882a593Smuzhiyun 	/*
1912*4882a593Smuzhiyun 	 * Calculate adjusted hwi, child_adjusted_sum and inuse for the inner
1913*4882a593Smuzhiyun 	 * nodes.
1914*4882a593Smuzhiyun 	 */
1915*4882a593Smuzhiyun 	list_for_each_entry(iocg, &inner_walk, walk_list) {
1916*4882a593Smuzhiyun 		struct ioc_gq *parent;
1917*4882a593Smuzhiyun 		u32 inuse, wpt, wptp;
1918*4882a593Smuzhiyun 		u64 st, sf;
1919*4882a593Smuzhiyun 
1920*4882a593Smuzhiyun 		if (iocg->level == 0) {
1921*4882a593Smuzhiyun 			/* adjusted weight sum for 1st level: s' = s * b_pf / b'_pf */
1922*4882a593Smuzhiyun 			iocg->child_adjusted_sum = DIV64_U64_ROUND_UP(
1923*4882a593Smuzhiyun 				iocg->child_active_sum * (WEIGHT_ONE - iocg->hweight_donating),
1924*4882a593Smuzhiyun 				WEIGHT_ONE - iocg->hweight_after_donation);
1925*4882a593Smuzhiyun 			continue;
1926*4882a593Smuzhiyun 		}
1927*4882a593Smuzhiyun 
1928*4882a593Smuzhiyun 		parent = iocg->ancestors[iocg->level - 1];
1929*4882a593Smuzhiyun 
1930*4882a593Smuzhiyun 		/* b' = gamma * b_f + b_t' */
1931*4882a593Smuzhiyun 		iocg->hweight_inuse = DIV64_U64_ROUND_UP(
1932*4882a593Smuzhiyun 			(u64)gamma * (iocg->hweight_active - iocg->hweight_donating),
1933*4882a593Smuzhiyun 			WEIGHT_ONE) + iocg->hweight_after_donation;
1934*4882a593Smuzhiyun 
1935*4882a593Smuzhiyun 		/* w' = s' * b' / b'_p */
1936*4882a593Smuzhiyun 		inuse = DIV64_U64_ROUND_UP(
1937*4882a593Smuzhiyun 			(u64)parent->child_adjusted_sum * iocg->hweight_inuse,
1938*4882a593Smuzhiyun 			parent->hweight_inuse);
1939*4882a593Smuzhiyun 
1940*4882a593Smuzhiyun 		/* adjusted weight sum for children: s' = s_f + s_t * w'_pt / w_pt */
1941*4882a593Smuzhiyun 		st = DIV64_U64_ROUND_UP(
1942*4882a593Smuzhiyun 			iocg->child_active_sum * iocg->hweight_donating,
1943*4882a593Smuzhiyun 			iocg->hweight_active);
1944*4882a593Smuzhiyun 		sf = iocg->child_active_sum - st;
1945*4882a593Smuzhiyun 		wpt = DIV64_U64_ROUND_UP(
1946*4882a593Smuzhiyun 			(u64)iocg->active * iocg->hweight_donating,
1947*4882a593Smuzhiyun 			iocg->hweight_active);
1948*4882a593Smuzhiyun 		wptp = DIV64_U64_ROUND_UP(
1949*4882a593Smuzhiyun 			(u64)inuse * iocg->hweight_after_donation,
1950*4882a593Smuzhiyun 			iocg->hweight_inuse);
1951*4882a593Smuzhiyun 
1952*4882a593Smuzhiyun 		iocg->child_adjusted_sum = sf + DIV64_U64_ROUND_UP(st * wptp, wpt);
1953*4882a593Smuzhiyun 	}
1954*4882a593Smuzhiyun 
1955*4882a593Smuzhiyun 	/*
1956*4882a593Smuzhiyun 	 * All inner nodes now have ->hweight_inuse and ->child_adjusted_sum and
1957*4882a593Smuzhiyun 	 * we can finally determine leaf adjustments.
1958*4882a593Smuzhiyun 	 */
1959*4882a593Smuzhiyun 	list_for_each_entry(iocg, surpluses, surplus_list) {
1960*4882a593Smuzhiyun 		struct ioc_gq *parent = iocg->ancestors[iocg->level - 1];
1961*4882a593Smuzhiyun 		u32 inuse;
1962*4882a593Smuzhiyun 
1963*4882a593Smuzhiyun 		/*
1964*4882a593Smuzhiyun 		 * In-debt iocgs participated in the donation calculation with
1965*4882a593Smuzhiyun 		 * the minimum target hweight_inuse. Configuring inuse
1966*4882a593Smuzhiyun 		 * accordingly would work fine but debt handling expects
1967*4882a593Smuzhiyun 		 * @iocg->inuse stay at the minimum and we don't wanna
1968*4882a593Smuzhiyun 		 * interfere.
1969*4882a593Smuzhiyun 		 */
1970*4882a593Smuzhiyun 		if (iocg->abs_vdebt) {
1971*4882a593Smuzhiyun 			WARN_ON_ONCE(iocg->inuse > 1);
1972*4882a593Smuzhiyun 			continue;
1973*4882a593Smuzhiyun 		}
1974*4882a593Smuzhiyun 
1975*4882a593Smuzhiyun 		/* w' = s' * b' / b'_p, note that b' == b'_t for donating leaves */
1976*4882a593Smuzhiyun 		inuse = DIV64_U64_ROUND_UP(
1977*4882a593Smuzhiyun 			parent->child_adjusted_sum * iocg->hweight_after_donation,
1978*4882a593Smuzhiyun 			parent->hweight_inuse);
1979*4882a593Smuzhiyun 
1980*4882a593Smuzhiyun 		TRACE_IOCG_PATH(inuse_transfer, iocg, now,
1981*4882a593Smuzhiyun 				iocg->inuse, inuse,
1982*4882a593Smuzhiyun 				iocg->hweight_inuse,
1983*4882a593Smuzhiyun 				iocg->hweight_after_donation);
1984*4882a593Smuzhiyun 
1985*4882a593Smuzhiyun 		__propagate_weights(iocg, iocg->active, inuse, true, now);
1986*4882a593Smuzhiyun 	}
1987*4882a593Smuzhiyun 
1988*4882a593Smuzhiyun 	/* walk list should be dissolved after use */
1989*4882a593Smuzhiyun 	list_for_each_entry_safe(iocg, tiocg, &inner_walk, walk_list)
1990*4882a593Smuzhiyun 		list_del_init(&iocg->walk_list);
1991*4882a593Smuzhiyun }
1992*4882a593Smuzhiyun 
1993*4882a593Smuzhiyun /*
1994*4882a593Smuzhiyun  * A low weight iocg can amass a large amount of debt, for example, when
1995*4882a593Smuzhiyun  * anonymous memory gets reclaimed aggressively. If the system has a lot of
1996*4882a593Smuzhiyun  * memory paired with a slow IO device, the debt can span multiple seconds or
1997*4882a593Smuzhiyun  * more. If there are no other subsequent IO issuers, the in-debt iocg may end
1998*4882a593Smuzhiyun  * up blocked paying its debt while the IO device is idle.
1999*4882a593Smuzhiyun  *
2000*4882a593Smuzhiyun  * The following protects against such cases. If the device has been
2001*4882a593Smuzhiyun  * sufficiently idle for a while, the debts are halved and delays are
2002*4882a593Smuzhiyun  * recalculated.
2003*4882a593Smuzhiyun  */
ioc_forgive_debts(struct ioc * ioc,u64 usage_us_sum,int nr_debtors,struct ioc_now * now)2004*4882a593Smuzhiyun static void ioc_forgive_debts(struct ioc *ioc, u64 usage_us_sum, int nr_debtors,
2005*4882a593Smuzhiyun 			      struct ioc_now *now)
2006*4882a593Smuzhiyun {
2007*4882a593Smuzhiyun 	struct ioc_gq *iocg;
2008*4882a593Smuzhiyun 	u64 dur, usage_pct, nr_cycles;
2009*4882a593Smuzhiyun 
2010*4882a593Smuzhiyun 	/* if no debtor, reset the cycle */
2011*4882a593Smuzhiyun 	if (!nr_debtors) {
2012*4882a593Smuzhiyun 		ioc->dfgv_period_at = now->now;
2013*4882a593Smuzhiyun 		ioc->dfgv_period_rem = 0;
2014*4882a593Smuzhiyun 		ioc->dfgv_usage_us_sum = 0;
2015*4882a593Smuzhiyun 		return;
2016*4882a593Smuzhiyun 	}
2017*4882a593Smuzhiyun 
2018*4882a593Smuzhiyun 	/*
2019*4882a593Smuzhiyun 	 * Debtors can pass through a lot of writes choking the device and we
2020*4882a593Smuzhiyun 	 * don't want to be forgiving debts while the device is struggling from
2021*4882a593Smuzhiyun 	 * write bursts. If we're missing latency targets, consider the device
2022*4882a593Smuzhiyun 	 * fully utilized.
2023*4882a593Smuzhiyun 	 */
2024*4882a593Smuzhiyun 	if (ioc->busy_level > 0)
2025*4882a593Smuzhiyun 		usage_us_sum = max_t(u64, usage_us_sum, ioc->period_us);
2026*4882a593Smuzhiyun 
2027*4882a593Smuzhiyun 	ioc->dfgv_usage_us_sum += usage_us_sum;
2028*4882a593Smuzhiyun 	if (time_before64(now->now, ioc->dfgv_period_at + DFGV_PERIOD))
2029*4882a593Smuzhiyun 		return;
2030*4882a593Smuzhiyun 
2031*4882a593Smuzhiyun 	/*
2032*4882a593Smuzhiyun 	 * At least DFGV_PERIOD has passed since the last period. Calculate the
2033*4882a593Smuzhiyun 	 * average usage and reset the period counters.
2034*4882a593Smuzhiyun 	 */
2035*4882a593Smuzhiyun 	dur = now->now - ioc->dfgv_period_at;
2036*4882a593Smuzhiyun 	usage_pct = div64_u64(100 * ioc->dfgv_usage_us_sum, dur);
2037*4882a593Smuzhiyun 
2038*4882a593Smuzhiyun 	ioc->dfgv_period_at = now->now;
2039*4882a593Smuzhiyun 	ioc->dfgv_usage_us_sum = 0;
2040*4882a593Smuzhiyun 
2041*4882a593Smuzhiyun 	/* if was too busy, reset everything */
2042*4882a593Smuzhiyun 	if (usage_pct > DFGV_USAGE_PCT) {
2043*4882a593Smuzhiyun 		ioc->dfgv_period_rem = 0;
2044*4882a593Smuzhiyun 		return;
2045*4882a593Smuzhiyun 	}
2046*4882a593Smuzhiyun 
2047*4882a593Smuzhiyun 	/*
2048*4882a593Smuzhiyun 	 * Usage is lower than threshold. Let's forgive some debts. Debt
2049*4882a593Smuzhiyun 	 * forgiveness runs off of the usual ioc timer but its period usually
2050*4882a593Smuzhiyun 	 * doesn't match ioc's. Compensate the difference by performing the
2051*4882a593Smuzhiyun 	 * reduction as many times as would fit in the duration since the last
2052*4882a593Smuzhiyun 	 * run and carrying over the left-over duration in @ioc->dfgv_period_rem
2053*4882a593Smuzhiyun 	 * - if ioc period is 75% of DFGV_PERIOD, one out of three consecutive
2054*4882a593Smuzhiyun 	 * reductions is doubled.
2055*4882a593Smuzhiyun 	 */
2056*4882a593Smuzhiyun 	nr_cycles = dur + ioc->dfgv_period_rem;
2057*4882a593Smuzhiyun 	ioc->dfgv_period_rem = do_div(nr_cycles, DFGV_PERIOD);
2058*4882a593Smuzhiyun 
2059*4882a593Smuzhiyun 	list_for_each_entry(iocg, &ioc->active_iocgs, active_list) {
2060*4882a593Smuzhiyun 		u64 __maybe_unused old_debt, __maybe_unused old_delay;
2061*4882a593Smuzhiyun 
2062*4882a593Smuzhiyun 		if (!iocg->abs_vdebt && !iocg->delay)
2063*4882a593Smuzhiyun 			continue;
2064*4882a593Smuzhiyun 
2065*4882a593Smuzhiyun 		spin_lock(&iocg->waitq.lock);
2066*4882a593Smuzhiyun 
2067*4882a593Smuzhiyun 		old_debt = iocg->abs_vdebt;
2068*4882a593Smuzhiyun 		old_delay = iocg->delay;
2069*4882a593Smuzhiyun 
2070*4882a593Smuzhiyun 		if (iocg->abs_vdebt)
2071*4882a593Smuzhiyun 			iocg->abs_vdebt = iocg->abs_vdebt >> nr_cycles ?: 1;
2072*4882a593Smuzhiyun 		if (iocg->delay)
2073*4882a593Smuzhiyun 			iocg->delay = iocg->delay >> nr_cycles ?: 1;
2074*4882a593Smuzhiyun 
2075*4882a593Smuzhiyun 		iocg_kick_waitq(iocg, true, now);
2076*4882a593Smuzhiyun 
2077*4882a593Smuzhiyun 		TRACE_IOCG_PATH(iocg_forgive_debt, iocg, now, usage_pct,
2078*4882a593Smuzhiyun 				old_debt, iocg->abs_vdebt,
2079*4882a593Smuzhiyun 				old_delay, iocg->delay);
2080*4882a593Smuzhiyun 
2081*4882a593Smuzhiyun 		spin_unlock(&iocg->waitq.lock);
2082*4882a593Smuzhiyun 	}
2083*4882a593Smuzhiyun }
2084*4882a593Smuzhiyun 
ioc_timer_fn(struct timer_list * timer)2085*4882a593Smuzhiyun static void ioc_timer_fn(struct timer_list *timer)
2086*4882a593Smuzhiyun {
2087*4882a593Smuzhiyun 	struct ioc *ioc = container_of(timer, struct ioc, timer);
2088*4882a593Smuzhiyun 	struct ioc_gq *iocg, *tiocg;
2089*4882a593Smuzhiyun 	struct ioc_now now;
2090*4882a593Smuzhiyun 	LIST_HEAD(surpluses);
2091*4882a593Smuzhiyun 	int nr_debtors = 0, nr_shortages = 0, nr_lagging = 0;
2092*4882a593Smuzhiyun 	u64 usage_us_sum = 0;
2093*4882a593Smuzhiyun 	u32 ppm_rthr = MILLION - ioc->params.qos[QOS_RPPM];
2094*4882a593Smuzhiyun 	u32 ppm_wthr = MILLION - ioc->params.qos[QOS_WPPM];
2095*4882a593Smuzhiyun 	u32 missed_ppm[2], rq_wait_pct;
2096*4882a593Smuzhiyun 	u64 period_vtime;
2097*4882a593Smuzhiyun 	int prev_busy_level;
2098*4882a593Smuzhiyun 
2099*4882a593Smuzhiyun 	/* how were the latencies during the period? */
2100*4882a593Smuzhiyun 	ioc_lat_stat(ioc, missed_ppm, &rq_wait_pct);
2101*4882a593Smuzhiyun 
2102*4882a593Smuzhiyun 	/* take care of active iocgs */
2103*4882a593Smuzhiyun 	spin_lock_irq(&ioc->lock);
2104*4882a593Smuzhiyun 
2105*4882a593Smuzhiyun 	ioc_now(ioc, &now);
2106*4882a593Smuzhiyun 
2107*4882a593Smuzhiyun 	period_vtime = now.vnow - ioc->period_at_vtime;
2108*4882a593Smuzhiyun 	if (WARN_ON_ONCE(!period_vtime)) {
2109*4882a593Smuzhiyun 		spin_unlock_irq(&ioc->lock);
2110*4882a593Smuzhiyun 		return;
2111*4882a593Smuzhiyun 	}
2112*4882a593Smuzhiyun 
2113*4882a593Smuzhiyun 	/*
2114*4882a593Smuzhiyun 	 * Waiters determine the sleep durations based on the vrate they
2115*4882a593Smuzhiyun 	 * saw at the time of sleep.  If vrate has increased, some waiters
2116*4882a593Smuzhiyun 	 * could be sleeping for too long.  Wake up tardy waiters which
2117*4882a593Smuzhiyun 	 * should have woken up in the last period and expire idle iocgs.
2118*4882a593Smuzhiyun 	 */
2119*4882a593Smuzhiyun 	list_for_each_entry_safe(iocg, tiocg, &ioc->active_iocgs, active_list) {
2120*4882a593Smuzhiyun 		if (!waitqueue_active(&iocg->waitq) && !iocg->abs_vdebt &&
2121*4882a593Smuzhiyun 		    !iocg->delay && !iocg_is_idle(iocg))
2122*4882a593Smuzhiyun 			continue;
2123*4882a593Smuzhiyun 
2124*4882a593Smuzhiyun 		spin_lock(&iocg->waitq.lock);
2125*4882a593Smuzhiyun 
2126*4882a593Smuzhiyun 		/* flush wait and indebt stat deltas */
2127*4882a593Smuzhiyun 		if (iocg->wait_since) {
2128*4882a593Smuzhiyun 			iocg->local_stat.wait_us += now.now - iocg->wait_since;
2129*4882a593Smuzhiyun 			iocg->wait_since = now.now;
2130*4882a593Smuzhiyun 		}
2131*4882a593Smuzhiyun 		if (iocg->indebt_since) {
2132*4882a593Smuzhiyun 			iocg->local_stat.indebt_us +=
2133*4882a593Smuzhiyun 				now.now - iocg->indebt_since;
2134*4882a593Smuzhiyun 			iocg->indebt_since = now.now;
2135*4882a593Smuzhiyun 		}
2136*4882a593Smuzhiyun 		if (iocg->indelay_since) {
2137*4882a593Smuzhiyun 			iocg->local_stat.indelay_us +=
2138*4882a593Smuzhiyun 				now.now - iocg->indelay_since;
2139*4882a593Smuzhiyun 			iocg->indelay_since = now.now;
2140*4882a593Smuzhiyun 		}
2141*4882a593Smuzhiyun 
2142*4882a593Smuzhiyun 		if (waitqueue_active(&iocg->waitq) || iocg->abs_vdebt ||
2143*4882a593Smuzhiyun 		    iocg->delay) {
2144*4882a593Smuzhiyun 			/* might be oversleeping vtime / hweight changes, kick */
2145*4882a593Smuzhiyun 			iocg_kick_waitq(iocg, true, &now);
2146*4882a593Smuzhiyun 			if (iocg->abs_vdebt || iocg->delay)
2147*4882a593Smuzhiyun 				nr_debtors++;
2148*4882a593Smuzhiyun 		} else if (iocg_is_idle(iocg)) {
2149*4882a593Smuzhiyun 			/* no waiter and idle, deactivate */
2150*4882a593Smuzhiyun 			u64 vtime = atomic64_read(&iocg->vtime);
2151*4882a593Smuzhiyun 			s64 excess;
2152*4882a593Smuzhiyun 
2153*4882a593Smuzhiyun 			/*
2154*4882a593Smuzhiyun 			 * @iocg has been inactive for a full duration and will
2155*4882a593Smuzhiyun 			 * have a high budget. Account anything above target as
2156*4882a593Smuzhiyun 			 * error and throw away. On reactivation, it'll start
2157*4882a593Smuzhiyun 			 * with the target budget.
2158*4882a593Smuzhiyun 			 */
2159*4882a593Smuzhiyun 			excess = now.vnow - vtime - ioc->margins.target;
2160*4882a593Smuzhiyun 			if (excess > 0) {
2161*4882a593Smuzhiyun 				u32 old_hwi;
2162*4882a593Smuzhiyun 
2163*4882a593Smuzhiyun 				current_hweight(iocg, NULL, &old_hwi);
2164*4882a593Smuzhiyun 				ioc->vtime_err -= div64_u64(excess * old_hwi,
2165*4882a593Smuzhiyun 							    WEIGHT_ONE);
2166*4882a593Smuzhiyun 			}
2167*4882a593Smuzhiyun 
2168*4882a593Smuzhiyun 			__propagate_weights(iocg, 0, 0, false, &now);
2169*4882a593Smuzhiyun 			list_del_init(&iocg->active_list);
2170*4882a593Smuzhiyun 		}
2171*4882a593Smuzhiyun 
2172*4882a593Smuzhiyun 		spin_unlock(&iocg->waitq.lock);
2173*4882a593Smuzhiyun 	}
2174*4882a593Smuzhiyun 	commit_weights(ioc);
2175*4882a593Smuzhiyun 
2176*4882a593Smuzhiyun 	/*
2177*4882a593Smuzhiyun 	 * Wait and indebt stat are flushed above and the donation calculation
2178*4882a593Smuzhiyun 	 * below needs updated usage stat. Let's bring stat up-to-date.
2179*4882a593Smuzhiyun 	 */
2180*4882a593Smuzhiyun 	iocg_flush_stat(&ioc->active_iocgs, &now);
2181*4882a593Smuzhiyun 
2182*4882a593Smuzhiyun 	/* calc usage and see whether some weights need to be moved around */
2183*4882a593Smuzhiyun 	list_for_each_entry(iocg, &ioc->active_iocgs, active_list) {
2184*4882a593Smuzhiyun 		u64 vdone, vtime, usage_us, usage_dur;
2185*4882a593Smuzhiyun 		u32 usage, hw_active, hw_inuse;
2186*4882a593Smuzhiyun 
2187*4882a593Smuzhiyun 		/*
2188*4882a593Smuzhiyun 		 * Collect unused and wind vtime closer to vnow to prevent
2189*4882a593Smuzhiyun 		 * iocgs from accumulating a large amount of budget.
2190*4882a593Smuzhiyun 		 */
2191*4882a593Smuzhiyun 		vdone = atomic64_read(&iocg->done_vtime);
2192*4882a593Smuzhiyun 		vtime = atomic64_read(&iocg->vtime);
2193*4882a593Smuzhiyun 		current_hweight(iocg, &hw_active, &hw_inuse);
2194*4882a593Smuzhiyun 
2195*4882a593Smuzhiyun 		/*
2196*4882a593Smuzhiyun 		 * Latency QoS detection doesn't account for IOs which are
2197*4882a593Smuzhiyun 		 * in-flight for longer than a period.  Detect them by
2198*4882a593Smuzhiyun 		 * comparing vdone against period start.  If lagging behind
2199*4882a593Smuzhiyun 		 * IOs from past periods, don't increase vrate.
2200*4882a593Smuzhiyun 		 */
2201*4882a593Smuzhiyun 		if ((ppm_rthr != MILLION || ppm_wthr != MILLION) &&
2202*4882a593Smuzhiyun 		    !atomic_read(&iocg_to_blkg(iocg)->use_delay) &&
2203*4882a593Smuzhiyun 		    time_after64(vtime, vdone) &&
2204*4882a593Smuzhiyun 		    time_after64(vtime, now.vnow -
2205*4882a593Smuzhiyun 				 MAX_LAGGING_PERIODS * period_vtime) &&
2206*4882a593Smuzhiyun 		    time_before64(vdone, now.vnow - period_vtime))
2207*4882a593Smuzhiyun 			nr_lagging++;
2208*4882a593Smuzhiyun 
2209*4882a593Smuzhiyun 		/*
2210*4882a593Smuzhiyun 		 * Determine absolute usage factoring in in-flight IOs to avoid
2211*4882a593Smuzhiyun 		 * high-latency completions appearing as idle.
2212*4882a593Smuzhiyun 		 */
2213*4882a593Smuzhiyun 		usage_us = iocg->usage_delta_us;
2214*4882a593Smuzhiyun 		usage_us_sum += usage_us;
2215*4882a593Smuzhiyun 
2216*4882a593Smuzhiyun 		if (vdone != vtime) {
2217*4882a593Smuzhiyun 			u64 inflight_us = DIV64_U64_ROUND_UP(
2218*4882a593Smuzhiyun 				cost_to_abs_cost(vtime - vdone, hw_inuse),
2219*4882a593Smuzhiyun 				ioc->vtime_base_rate);
2220*4882a593Smuzhiyun 			usage_us = max(usage_us, inflight_us);
2221*4882a593Smuzhiyun 		}
2222*4882a593Smuzhiyun 
2223*4882a593Smuzhiyun 		/* convert to hweight based usage ratio */
2224*4882a593Smuzhiyun 		if (time_after64(iocg->activated_at, ioc->period_at))
2225*4882a593Smuzhiyun 			usage_dur = max_t(u64, now.now - iocg->activated_at, 1);
2226*4882a593Smuzhiyun 		else
2227*4882a593Smuzhiyun 			usage_dur = max_t(u64, now.now - ioc->period_at, 1);
2228*4882a593Smuzhiyun 
2229*4882a593Smuzhiyun 		usage = clamp_t(u32,
2230*4882a593Smuzhiyun 				DIV64_U64_ROUND_UP(usage_us * WEIGHT_ONE,
2231*4882a593Smuzhiyun 						   usage_dur),
2232*4882a593Smuzhiyun 				1, WEIGHT_ONE);
2233*4882a593Smuzhiyun 
2234*4882a593Smuzhiyun 		/* see whether there's surplus vtime */
2235*4882a593Smuzhiyun 		WARN_ON_ONCE(!list_empty(&iocg->surplus_list));
2236*4882a593Smuzhiyun 		if (hw_inuse < hw_active ||
2237*4882a593Smuzhiyun 		    (!waitqueue_active(&iocg->waitq) &&
2238*4882a593Smuzhiyun 		     time_before64(vtime, now.vnow - ioc->margins.low))) {
2239*4882a593Smuzhiyun 			u32 hwa, old_hwi, hwm, new_hwi;
2240*4882a593Smuzhiyun 
2241*4882a593Smuzhiyun 			/*
2242*4882a593Smuzhiyun 			 * Already donating or accumulated enough to start.
2243*4882a593Smuzhiyun 			 * Determine the donation amount.
2244*4882a593Smuzhiyun 			 */
2245*4882a593Smuzhiyun 			current_hweight(iocg, &hwa, &old_hwi);
2246*4882a593Smuzhiyun 			hwm = current_hweight_max(iocg);
2247*4882a593Smuzhiyun 			new_hwi = hweight_after_donation(iocg, old_hwi, hwm,
2248*4882a593Smuzhiyun 							 usage, &now);
2249*4882a593Smuzhiyun 			/*
2250*4882a593Smuzhiyun 			 * Donation calculation assumes hweight_after_donation
2251*4882a593Smuzhiyun 			 * to be positive, a condition that a donor w/ hwa < 2
2252*4882a593Smuzhiyun 			 * can't meet. Don't bother with donation if hwa is
2253*4882a593Smuzhiyun 			 * below 2. It's not gonna make a meaningful difference
2254*4882a593Smuzhiyun 			 * anyway.
2255*4882a593Smuzhiyun 			 */
2256*4882a593Smuzhiyun 			if (new_hwi < hwm && hwa >= 2) {
2257*4882a593Smuzhiyun 				iocg->hweight_donating = hwa;
2258*4882a593Smuzhiyun 				iocg->hweight_after_donation = new_hwi;
2259*4882a593Smuzhiyun 				list_add(&iocg->surplus_list, &surpluses);
2260*4882a593Smuzhiyun 			} else if (!iocg->abs_vdebt) {
2261*4882a593Smuzhiyun 				/*
2262*4882a593Smuzhiyun 				 * @iocg doesn't have enough to donate. Reset
2263*4882a593Smuzhiyun 				 * its inuse to active.
2264*4882a593Smuzhiyun 				 *
2265*4882a593Smuzhiyun 				 * Don't reset debtors as their inuse's are
2266*4882a593Smuzhiyun 				 * owned by debt handling. This shouldn't affect
2267*4882a593Smuzhiyun 				 * donation calculuation in any meaningful way
2268*4882a593Smuzhiyun 				 * as @iocg doesn't have a meaningful amount of
2269*4882a593Smuzhiyun 				 * share anyway.
2270*4882a593Smuzhiyun 				 */
2271*4882a593Smuzhiyun 				TRACE_IOCG_PATH(inuse_shortage, iocg, &now,
2272*4882a593Smuzhiyun 						iocg->inuse, iocg->active,
2273*4882a593Smuzhiyun 						iocg->hweight_inuse, new_hwi);
2274*4882a593Smuzhiyun 
2275*4882a593Smuzhiyun 				__propagate_weights(iocg, iocg->active,
2276*4882a593Smuzhiyun 						    iocg->active, true, &now);
2277*4882a593Smuzhiyun 				nr_shortages++;
2278*4882a593Smuzhiyun 			}
2279*4882a593Smuzhiyun 		} else {
2280*4882a593Smuzhiyun 			/* genuinely short on vtime */
2281*4882a593Smuzhiyun 			nr_shortages++;
2282*4882a593Smuzhiyun 		}
2283*4882a593Smuzhiyun 	}
2284*4882a593Smuzhiyun 
2285*4882a593Smuzhiyun 	if (!list_empty(&surpluses) && nr_shortages)
2286*4882a593Smuzhiyun 		transfer_surpluses(&surpluses, &now);
2287*4882a593Smuzhiyun 
2288*4882a593Smuzhiyun 	commit_weights(ioc);
2289*4882a593Smuzhiyun 
2290*4882a593Smuzhiyun 	/* surplus list should be dissolved after use */
2291*4882a593Smuzhiyun 	list_for_each_entry_safe(iocg, tiocg, &surpluses, surplus_list)
2292*4882a593Smuzhiyun 		list_del_init(&iocg->surplus_list);
2293*4882a593Smuzhiyun 
2294*4882a593Smuzhiyun 	/*
2295*4882a593Smuzhiyun 	 * If q is getting clogged or we're missing too much, we're issuing
2296*4882a593Smuzhiyun 	 * too much IO and should lower vtime rate.  If we're not missing
2297*4882a593Smuzhiyun 	 * and experiencing shortages but not surpluses, we're too stingy
2298*4882a593Smuzhiyun 	 * and should increase vtime rate.
2299*4882a593Smuzhiyun 	 */
2300*4882a593Smuzhiyun 	prev_busy_level = ioc->busy_level;
2301*4882a593Smuzhiyun 	if (rq_wait_pct > RQ_WAIT_BUSY_PCT ||
2302*4882a593Smuzhiyun 	    missed_ppm[READ] > ppm_rthr ||
2303*4882a593Smuzhiyun 	    missed_ppm[WRITE] > ppm_wthr) {
2304*4882a593Smuzhiyun 		/* clearly missing QoS targets, slow down vrate */
2305*4882a593Smuzhiyun 		ioc->busy_level = max(ioc->busy_level, 0);
2306*4882a593Smuzhiyun 		ioc->busy_level++;
2307*4882a593Smuzhiyun 	} else if (rq_wait_pct <= RQ_WAIT_BUSY_PCT * UNBUSY_THR_PCT / 100 &&
2308*4882a593Smuzhiyun 		   missed_ppm[READ] <= ppm_rthr * UNBUSY_THR_PCT / 100 &&
2309*4882a593Smuzhiyun 		   missed_ppm[WRITE] <= ppm_wthr * UNBUSY_THR_PCT / 100) {
2310*4882a593Smuzhiyun 		/* QoS targets are being met with >25% margin */
2311*4882a593Smuzhiyun 		if (nr_shortages) {
2312*4882a593Smuzhiyun 			/*
2313*4882a593Smuzhiyun 			 * We're throttling while the device has spare
2314*4882a593Smuzhiyun 			 * capacity.  If vrate was being slowed down, stop.
2315*4882a593Smuzhiyun 			 */
2316*4882a593Smuzhiyun 			ioc->busy_level = min(ioc->busy_level, 0);
2317*4882a593Smuzhiyun 
2318*4882a593Smuzhiyun 			/*
2319*4882a593Smuzhiyun 			 * If there are IOs spanning multiple periods, wait
2320*4882a593Smuzhiyun 			 * them out before pushing the device harder.
2321*4882a593Smuzhiyun 			 */
2322*4882a593Smuzhiyun 			if (!nr_lagging)
2323*4882a593Smuzhiyun 				ioc->busy_level--;
2324*4882a593Smuzhiyun 		} else {
2325*4882a593Smuzhiyun 			/*
2326*4882a593Smuzhiyun 			 * Nobody is being throttled and the users aren't
2327*4882a593Smuzhiyun 			 * issuing enough IOs to saturate the device.  We
2328*4882a593Smuzhiyun 			 * simply don't know how close the device is to
2329*4882a593Smuzhiyun 			 * saturation.  Coast.
2330*4882a593Smuzhiyun 			 */
2331*4882a593Smuzhiyun 			ioc->busy_level = 0;
2332*4882a593Smuzhiyun 		}
2333*4882a593Smuzhiyun 	} else {
2334*4882a593Smuzhiyun 		/* inside the hysterisis margin, we're good */
2335*4882a593Smuzhiyun 		ioc->busy_level = 0;
2336*4882a593Smuzhiyun 	}
2337*4882a593Smuzhiyun 
2338*4882a593Smuzhiyun 	ioc->busy_level = clamp(ioc->busy_level, -1000, 1000);
2339*4882a593Smuzhiyun 
2340*4882a593Smuzhiyun 	if (ioc->busy_level > 0 || (ioc->busy_level < 0 && !nr_lagging)) {
2341*4882a593Smuzhiyun 		u64 vrate = ioc->vtime_base_rate;
2342*4882a593Smuzhiyun 		u64 vrate_min = ioc->vrate_min, vrate_max = ioc->vrate_max;
2343*4882a593Smuzhiyun 
2344*4882a593Smuzhiyun 		/* rq_wait signal is always reliable, ignore user vrate_min */
2345*4882a593Smuzhiyun 		if (rq_wait_pct > RQ_WAIT_BUSY_PCT)
2346*4882a593Smuzhiyun 			vrate_min = VRATE_MIN;
2347*4882a593Smuzhiyun 
2348*4882a593Smuzhiyun 		/*
2349*4882a593Smuzhiyun 		 * If vrate is out of bounds, apply clamp gradually as the
2350*4882a593Smuzhiyun 		 * bounds can change abruptly.  Otherwise, apply busy_level
2351*4882a593Smuzhiyun 		 * based adjustment.
2352*4882a593Smuzhiyun 		 */
2353*4882a593Smuzhiyun 		if (vrate < vrate_min) {
2354*4882a593Smuzhiyun 			vrate = div64_u64(vrate * (100 + VRATE_CLAMP_ADJ_PCT),
2355*4882a593Smuzhiyun 					  100);
2356*4882a593Smuzhiyun 			vrate = min(vrate, vrate_min);
2357*4882a593Smuzhiyun 		} else if (vrate > vrate_max) {
2358*4882a593Smuzhiyun 			vrate = div64_u64(vrate * (100 - VRATE_CLAMP_ADJ_PCT),
2359*4882a593Smuzhiyun 					  100);
2360*4882a593Smuzhiyun 			vrate = max(vrate, vrate_max);
2361*4882a593Smuzhiyun 		} else {
2362*4882a593Smuzhiyun 			int idx = min_t(int, abs(ioc->busy_level),
2363*4882a593Smuzhiyun 					ARRAY_SIZE(vrate_adj_pct) - 1);
2364*4882a593Smuzhiyun 			u32 adj_pct = vrate_adj_pct[idx];
2365*4882a593Smuzhiyun 
2366*4882a593Smuzhiyun 			if (ioc->busy_level > 0)
2367*4882a593Smuzhiyun 				adj_pct = 100 - adj_pct;
2368*4882a593Smuzhiyun 			else
2369*4882a593Smuzhiyun 				adj_pct = 100 + adj_pct;
2370*4882a593Smuzhiyun 
2371*4882a593Smuzhiyun 			vrate = clamp(DIV64_U64_ROUND_UP(vrate * adj_pct, 100),
2372*4882a593Smuzhiyun 				      vrate_min, vrate_max);
2373*4882a593Smuzhiyun 		}
2374*4882a593Smuzhiyun 
2375*4882a593Smuzhiyun 		trace_iocost_ioc_vrate_adj(ioc, vrate, missed_ppm, rq_wait_pct,
2376*4882a593Smuzhiyun 					   nr_lagging, nr_shortages);
2377*4882a593Smuzhiyun 
2378*4882a593Smuzhiyun 		ioc->vtime_base_rate = vrate;
2379*4882a593Smuzhiyun 		ioc_refresh_margins(ioc);
2380*4882a593Smuzhiyun 	} else if (ioc->busy_level != prev_busy_level || nr_lagging) {
2381*4882a593Smuzhiyun 		trace_iocost_ioc_vrate_adj(ioc, atomic64_read(&ioc->vtime_rate),
2382*4882a593Smuzhiyun 					   missed_ppm, rq_wait_pct, nr_lagging,
2383*4882a593Smuzhiyun 					   nr_shortages);
2384*4882a593Smuzhiyun 	}
2385*4882a593Smuzhiyun 
2386*4882a593Smuzhiyun 	ioc_refresh_params(ioc, false);
2387*4882a593Smuzhiyun 
2388*4882a593Smuzhiyun 	ioc_forgive_debts(ioc, usage_us_sum, nr_debtors, &now);
2389*4882a593Smuzhiyun 
2390*4882a593Smuzhiyun 	/*
2391*4882a593Smuzhiyun 	 * This period is done.  Move onto the next one.  If nothing's
2392*4882a593Smuzhiyun 	 * going on with the device, stop the timer.
2393*4882a593Smuzhiyun 	 */
2394*4882a593Smuzhiyun 	atomic64_inc(&ioc->cur_period);
2395*4882a593Smuzhiyun 
2396*4882a593Smuzhiyun 	if (ioc->running != IOC_STOP) {
2397*4882a593Smuzhiyun 		if (!list_empty(&ioc->active_iocgs)) {
2398*4882a593Smuzhiyun 			ioc_start_period(ioc, &now);
2399*4882a593Smuzhiyun 		} else {
2400*4882a593Smuzhiyun 			ioc->busy_level = 0;
2401*4882a593Smuzhiyun 			ioc->vtime_err = 0;
2402*4882a593Smuzhiyun 			ioc->running = IOC_IDLE;
2403*4882a593Smuzhiyun 		}
2404*4882a593Smuzhiyun 
2405*4882a593Smuzhiyun 		ioc_refresh_vrate(ioc, &now);
2406*4882a593Smuzhiyun 	}
2407*4882a593Smuzhiyun 
2408*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
2409*4882a593Smuzhiyun }
2410*4882a593Smuzhiyun 
adjust_inuse_and_calc_cost(struct ioc_gq * iocg,u64 vtime,u64 abs_cost,struct ioc_now * now)2411*4882a593Smuzhiyun static u64 adjust_inuse_and_calc_cost(struct ioc_gq *iocg, u64 vtime,
2412*4882a593Smuzhiyun 				      u64 abs_cost, struct ioc_now *now)
2413*4882a593Smuzhiyun {
2414*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
2415*4882a593Smuzhiyun 	struct ioc_margins *margins = &ioc->margins;
2416*4882a593Smuzhiyun 	u32 __maybe_unused old_inuse = iocg->inuse, __maybe_unused old_hwi;
2417*4882a593Smuzhiyun 	u32 hwi, adj_step;
2418*4882a593Smuzhiyun 	s64 margin;
2419*4882a593Smuzhiyun 	u64 cost, new_inuse;
2420*4882a593Smuzhiyun 
2421*4882a593Smuzhiyun 	current_hweight(iocg, NULL, &hwi);
2422*4882a593Smuzhiyun 	old_hwi = hwi;
2423*4882a593Smuzhiyun 	cost = abs_cost_to_cost(abs_cost, hwi);
2424*4882a593Smuzhiyun 	margin = now->vnow - vtime - cost;
2425*4882a593Smuzhiyun 
2426*4882a593Smuzhiyun 	/* debt handling owns inuse for debtors */
2427*4882a593Smuzhiyun 	if (iocg->abs_vdebt)
2428*4882a593Smuzhiyun 		return cost;
2429*4882a593Smuzhiyun 
2430*4882a593Smuzhiyun 	/*
2431*4882a593Smuzhiyun 	 * We only increase inuse during period and do so iff the margin has
2432*4882a593Smuzhiyun 	 * deteriorated since the previous adjustment.
2433*4882a593Smuzhiyun 	 */
2434*4882a593Smuzhiyun 	if (margin >= iocg->saved_margin || margin >= margins->low ||
2435*4882a593Smuzhiyun 	    iocg->inuse == iocg->active)
2436*4882a593Smuzhiyun 		return cost;
2437*4882a593Smuzhiyun 
2438*4882a593Smuzhiyun 	spin_lock_irq(&ioc->lock);
2439*4882a593Smuzhiyun 
2440*4882a593Smuzhiyun 	/* we own inuse only when @iocg is in the normal active state */
2441*4882a593Smuzhiyun 	if (iocg->abs_vdebt || list_empty(&iocg->active_list)) {
2442*4882a593Smuzhiyun 		spin_unlock_irq(&ioc->lock);
2443*4882a593Smuzhiyun 		return cost;
2444*4882a593Smuzhiyun 	}
2445*4882a593Smuzhiyun 
2446*4882a593Smuzhiyun 	/*
2447*4882a593Smuzhiyun 	 * Bump up inuse till @abs_cost fits in the existing budget.
2448*4882a593Smuzhiyun 	 * adj_step must be determined after acquiring ioc->lock - we might
2449*4882a593Smuzhiyun 	 * have raced and lost to another thread for activation and could
2450*4882a593Smuzhiyun 	 * be reading 0 iocg->active before ioc->lock which will lead to
2451*4882a593Smuzhiyun 	 * infinite loop.
2452*4882a593Smuzhiyun 	 */
2453*4882a593Smuzhiyun 	new_inuse = iocg->inuse;
2454*4882a593Smuzhiyun 	adj_step = DIV_ROUND_UP(iocg->active * INUSE_ADJ_STEP_PCT, 100);
2455*4882a593Smuzhiyun 	do {
2456*4882a593Smuzhiyun 		new_inuse = new_inuse + adj_step;
2457*4882a593Smuzhiyun 		propagate_weights(iocg, iocg->active, new_inuse, true, now);
2458*4882a593Smuzhiyun 		current_hweight(iocg, NULL, &hwi);
2459*4882a593Smuzhiyun 		cost = abs_cost_to_cost(abs_cost, hwi);
2460*4882a593Smuzhiyun 	} while (time_after64(vtime + cost, now->vnow) &&
2461*4882a593Smuzhiyun 		 iocg->inuse != iocg->active);
2462*4882a593Smuzhiyun 
2463*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
2464*4882a593Smuzhiyun 
2465*4882a593Smuzhiyun 	TRACE_IOCG_PATH(inuse_adjust, iocg, now,
2466*4882a593Smuzhiyun 			old_inuse, iocg->inuse, old_hwi, hwi);
2467*4882a593Smuzhiyun 
2468*4882a593Smuzhiyun 	return cost;
2469*4882a593Smuzhiyun }
2470*4882a593Smuzhiyun 
calc_vtime_cost_builtin(struct bio * bio,struct ioc_gq * iocg,bool is_merge,u64 * costp)2471*4882a593Smuzhiyun static void calc_vtime_cost_builtin(struct bio *bio, struct ioc_gq *iocg,
2472*4882a593Smuzhiyun 				    bool is_merge, u64 *costp)
2473*4882a593Smuzhiyun {
2474*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
2475*4882a593Smuzhiyun 	u64 coef_seqio, coef_randio, coef_page;
2476*4882a593Smuzhiyun 	u64 pages = max_t(u64, bio_sectors(bio) >> IOC_SECT_TO_PAGE_SHIFT, 1);
2477*4882a593Smuzhiyun 	u64 seek_pages = 0;
2478*4882a593Smuzhiyun 	u64 cost = 0;
2479*4882a593Smuzhiyun 
2480*4882a593Smuzhiyun 	switch (bio_op(bio)) {
2481*4882a593Smuzhiyun 	case REQ_OP_READ:
2482*4882a593Smuzhiyun 		coef_seqio	= ioc->params.lcoefs[LCOEF_RSEQIO];
2483*4882a593Smuzhiyun 		coef_randio	= ioc->params.lcoefs[LCOEF_RRANDIO];
2484*4882a593Smuzhiyun 		coef_page	= ioc->params.lcoefs[LCOEF_RPAGE];
2485*4882a593Smuzhiyun 		break;
2486*4882a593Smuzhiyun 	case REQ_OP_WRITE:
2487*4882a593Smuzhiyun 		coef_seqio	= ioc->params.lcoefs[LCOEF_WSEQIO];
2488*4882a593Smuzhiyun 		coef_randio	= ioc->params.lcoefs[LCOEF_WRANDIO];
2489*4882a593Smuzhiyun 		coef_page	= ioc->params.lcoefs[LCOEF_WPAGE];
2490*4882a593Smuzhiyun 		break;
2491*4882a593Smuzhiyun 	default:
2492*4882a593Smuzhiyun 		goto out;
2493*4882a593Smuzhiyun 	}
2494*4882a593Smuzhiyun 
2495*4882a593Smuzhiyun 	if (iocg->cursor) {
2496*4882a593Smuzhiyun 		seek_pages = abs(bio->bi_iter.bi_sector - iocg->cursor);
2497*4882a593Smuzhiyun 		seek_pages >>= IOC_SECT_TO_PAGE_SHIFT;
2498*4882a593Smuzhiyun 	}
2499*4882a593Smuzhiyun 
2500*4882a593Smuzhiyun 	if (!is_merge) {
2501*4882a593Smuzhiyun 		if (seek_pages > LCOEF_RANDIO_PAGES) {
2502*4882a593Smuzhiyun 			cost += coef_randio;
2503*4882a593Smuzhiyun 		} else {
2504*4882a593Smuzhiyun 			cost += coef_seqio;
2505*4882a593Smuzhiyun 		}
2506*4882a593Smuzhiyun 	}
2507*4882a593Smuzhiyun 	cost += pages * coef_page;
2508*4882a593Smuzhiyun out:
2509*4882a593Smuzhiyun 	*costp = cost;
2510*4882a593Smuzhiyun }
2511*4882a593Smuzhiyun 
calc_vtime_cost(struct bio * bio,struct ioc_gq * iocg,bool is_merge)2512*4882a593Smuzhiyun static u64 calc_vtime_cost(struct bio *bio, struct ioc_gq *iocg, bool is_merge)
2513*4882a593Smuzhiyun {
2514*4882a593Smuzhiyun 	u64 cost;
2515*4882a593Smuzhiyun 
2516*4882a593Smuzhiyun 	calc_vtime_cost_builtin(bio, iocg, is_merge, &cost);
2517*4882a593Smuzhiyun 	return cost;
2518*4882a593Smuzhiyun }
2519*4882a593Smuzhiyun 
calc_size_vtime_cost_builtin(struct request * rq,struct ioc * ioc,u64 * costp)2520*4882a593Smuzhiyun static void calc_size_vtime_cost_builtin(struct request *rq, struct ioc *ioc,
2521*4882a593Smuzhiyun 					 u64 *costp)
2522*4882a593Smuzhiyun {
2523*4882a593Smuzhiyun 	unsigned int pages = blk_rq_stats_sectors(rq) >> IOC_SECT_TO_PAGE_SHIFT;
2524*4882a593Smuzhiyun 
2525*4882a593Smuzhiyun 	switch (req_op(rq)) {
2526*4882a593Smuzhiyun 	case REQ_OP_READ:
2527*4882a593Smuzhiyun 		*costp = pages * ioc->params.lcoefs[LCOEF_RPAGE];
2528*4882a593Smuzhiyun 		break;
2529*4882a593Smuzhiyun 	case REQ_OP_WRITE:
2530*4882a593Smuzhiyun 		*costp = pages * ioc->params.lcoefs[LCOEF_WPAGE];
2531*4882a593Smuzhiyun 		break;
2532*4882a593Smuzhiyun 	default:
2533*4882a593Smuzhiyun 		*costp = 0;
2534*4882a593Smuzhiyun 	}
2535*4882a593Smuzhiyun }
2536*4882a593Smuzhiyun 
calc_size_vtime_cost(struct request * rq,struct ioc * ioc)2537*4882a593Smuzhiyun static u64 calc_size_vtime_cost(struct request *rq, struct ioc *ioc)
2538*4882a593Smuzhiyun {
2539*4882a593Smuzhiyun 	u64 cost;
2540*4882a593Smuzhiyun 
2541*4882a593Smuzhiyun 	calc_size_vtime_cost_builtin(rq, ioc, &cost);
2542*4882a593Smuzhiyun 	return cost;
2543*4882a593Smuzhiyun }
2544*4882a593Smuzhiyun 
ioc_rqos_throttle(struct rq_qos * rqos,struct bio * bio)2545*4882a593Smuzhiyun static void ioc_rqos_throttle(struct rq_qos *rqos, struct bio *bio)
2546*4882a593Smuzhiyun {
2547*4882a593Smuzhiyun 	struct blkcg_gq *blkg = bio->bi_blkg;
2548*4882a593Smuzhiyun 	struct ioc *ioc = rqos_to_ioc(rqos);
2549*4882a593Smuzhiyun 	struct ioc_gq *iocg = blkg_to_iocg(blkg);
2550*4882a593Smuzhiyun 	struct ioc_now now;
2551*4882a593Smuzhiyun 	struct iocg_wait wait;
2552*4882a593Smuzhiyun 	u64 abs_cost, cost, vtime;
2553*4882a593Smuzhiyun 	bool use_debt, ioc_locked;
2554*4882a593Smuzhiyun 	unsigned long flags;
2555*4882a593Smuzhiyun 
2556*4882a593Smuzhiyun 	/* bypass IOs if disabled, still initializing, or for root cgroup */
2557*4882a593Smuzhiyun 	if (!ioc->enabled || !iocg || !iocg->level)
2558*4882a593Smuzhiyun 		return;
2559*4882a593Smuzhiyun 
2560*4882a593Smuzhiyun 	/* calculate the absolute vtime cost */
2561*4882a593Smuzhiyun 	abs_cost = calc_vtime_cost(bio, iocg, false);
2562*4882a593Smuzhiyun 	if (!abs_cost)
2563*4882a593Smuzhiyun 		return;
2564*4882a593Smuzhiyun 
2565*4882a593Smuzhiyun 	if (!iocg_activate(iocg, &now))
2566*4882a593Smuzhiyun 		return;
2567*4882a593Smuzhiyun 
2568*4882a593Smuzhiyun 	iocg->cursor = bio_end_sector(bio);
2569*4882a593Smuzhiyun 	vtime = atomic64_read(&iocg->vtime);
2570*4882a593Smuzhiyun 	cost = adjust_inuse_and_calc_cost(iocg, vtime, abs_cost, &now);
2571*4882a593Smuzhiyun 
2572*4882a593Smuzhiyun 	/*
2573*4882a593Smuzhiyun 	 * If no one's waiting and within budget, issue right away.  The
2574*4882a593Smuzhiyun 	 * tests are racy but the races aren't systemic - we only miss once
2575*4882a593Smuzhiyun 	 * in a while which is fine.
2576*4882a593Smuzhiyun 	 */
2577*4882a593Smuzhiyun 	if (!waitqueue_active(&iocg->waitq) && !iocg->abs_vdebt &&
2578*4882a593Smuzhiyun 	    time_before_eq64(vtime + cost, now.vnow)) {
2579*4882a593Smuzhiyun 		iocg_commit_bio(iocg, bio, abs_cost, cost);
2580*4882a593Smuzhiyun 		return;
2581*4882a593Smuzhiyun 	}
2582*4882a593Smuzhiyun 
2583*4882a593Smuzhiyun 	/*
2584*4882a593Smuzhiyun 	 * We're over budget. This can be handled in two ways. IOs which may
2585*4882a593Smuzhiyun 	 * cause priority inversions are punted to @ioc->aux_iocg and charged as
2586*4882a593Smuzhiyun 	 * debt. Otherwise, the issuer is blocked on @iocg->waitq. Debt handling
2587*4882a593Smuzhiyun 	 * requires @ioc->lock, waitq handling @iocg->waitq.lock. Determine
2588*4882a593Smuzhiyun 	 * whether debt handling is needed and acquire locks accordingly.
2589*4882a593Smuzhiyun 	 */
2590*4882a593Smuzhiyun 	use_debt = bio_issue_as_root_blkg(bio) || fatal_signal_pending(current);
2591*4882a593Smuzhiyun 	ioc_locked = use_debt || READ_ONCE(iocg->abs_vdebt);
2592*4882a593Smuzhiyun retry_lock:
2593*4882a593Smuzhiyun 	iocg_lock(iocg, ioc_locked, &flags);
2594*4882a593Smuzhiyun 
2595*4882a593Smuzhiyun 	/*
2596*4882a593Smuzhiyun 	 * @iocg must stay activated for debt and waitq handling. Deactivation
2597*4882a593Smuzhiyun 	 * is synchronized against both ioc->lock and waitq.lock and we won't
2598*4882a593Smuzhiyun 	 * get deactivated as long as we're waiting or has debt, so we're good
2599*4882a593Smuzhiyun 	 * if we're activated here. In the unlikely cases that we aren't, just
2600*4882a593Smuzhiyun 	 * issue the IO.
2601*4882a593Smuzhiyun 	 */
2602*4882a593Smuzhiyun 	if (unlikely(list_empty(&iocg->active_list))) {
2603*4882a593Smuzhiyun 		iocg_unlock(iocg, ioc_locked, &flags);
2604*4882a593Smuzhiyun 		iocg_commit_bio(iocg, bio, abs_cost, cost);
2605*4882a593Smuzhiyun 		return;
2606*4882a593Smuzhiyun 	}
2607*4882a593Smuzhiyun 
2608*4882a593Smuzhiyun 	/*
2609*4882a593Smuzhiyun 	 * We're over budget. If @bio has to be issued regardless, remember
2610*4882a593Smuzhiyun 	 * the abs_cost instead of advancing vtime. iocg_kick_waitq() will pay
2611*4882a593Smuzhiyun 	 * off the debt before waking more IOs.
2612*4882a593Smuzhiyun 	 *
2613*4882a593Smuzhiyun 	 * This way, the debt is continuously paid off each period with the
2614*4882a593Smuzhiyun 	 * actual budget available to the cgroup. If we just wound vtime, we
2615*4882a593Smuzhiyun 	 * would incorrectly use the current hw_inuse for the entire amount
2616*4882a593Smuzhiyun 	 * which, for example, can lead to the cgroup staying blocked for a
2617*4882a593Smuzhiyun 	 * long time even with substantially raised hw_inuse.
2618*4882a593Smuzhiyun 	 *
2619*4882a593Smuzhiyun 	 * An iocg with vdebt should stay online so that the timer can keep
2620*4882a593Smuzhiyun 	 * deducting its vdebt and [de]activate use_delay mechanism
2621*4882a593Smuzhiyun 	 * accordingly. We don't want to race against the timer trying to
2622*4882a593Smuzhiyun 	 * clear them and leave @iocg inactive w/ dangling use_delay heavily
2623*4882a593Smuzhiyun 	 * penalizing the cgroup and its descendants.
2624*4882a593Smuzhiyun 	 */
2625*4882a593Smuzhiyun 	if (use_debt) {
2626*4882a593Smuzhiyun 		iocg_incur_debt(iocg, abs_cost, &now);
2627*4882a593Smuzhiyun 		if (iocg_kick_delay(iocg, &now))
2628*4882a593Smuzhiyun 			blkcg_schedule_throttle(rqos->q,
2629*4882a593Smuzhiyun 					(bio->bi_opf & REQ_SWAP) == REQ_SWAP);
2630*4882a593Smuzhiyun 		iocg_unlock(iocg, ioc_locked, &flags);
2631*4882a593Smuzhiyun 		return;
2632*4882a593Smuzhiyun 	}
2633*4882a593Smuzhiyun 
2634*4882a593Smuzhiyun 	/* guarantee that iocgs w/ waiters have maximum inuse */
2635*4882a593Smuzhiyun 	if (!iocg->abs_vdebt && iocg->inuse != iocg->active) {
2636*4882a593Smuzhiyun 		if (!ioc_locked) {
2637*4882a593Smuzhiyun 			iocg_unlock(iocg, false, &flags);
2638*4882a593Smuzhiyun 			ioc_locked = true;
2639*4882a593Smuzhiyun 			goto retry_lock;
2640*4882a593Smuzhiyun 		}
2641*4882a593Smuzhiyun 		propagate_weights(iocg, iocg->active, iocg->active, true,
2642*4882a593Smuzhiyun 				  &now);
2643*4882a593Smuzhiyun 	}
2644*4882a593Smuzhiyun 
2645*4882a593Smuzhiyun 	/*
2646*4882a593Smuzhiyun 	 * Append self to the waitq and schedule the wakeup timer if we're
2647*4882a593Smuzhiyun 	 * the first waiter.  The timer duration is calculated based on the
2648*4882a593Smuzhiyun 	 * current vrate.  vtime and hweight changes can make it too short
2649*4882a593Smuzhiyun 	 * or too long.  Each wait entry records the absolute cost it's
2650*4882a593Smuzhiyun 	 * waiting for to allow re-evaluation using a custom wait entry.
2651*4882a593Smuzhiyun 	 *
2652*4882a593Smuzhiyun 	 * If too short, the timer simply reschedules itself.  If too long,
2653*4882a593Smuzhiyun 	 * the period timer will notice and trigger wakeups.
2654*4882a593Smuzhiyun 	 *
2655*4882a593Smuzhiyun 	 * All waiters are on iocg->waitq and the wait states are
2656*4882a593Smuzhiyun 	 * synchronized using waitq.lock.
2657*4882a593Smuzhiyun 	 */
2658*4882a593Smuzhiyun 	init_waitqueue_func_entry(&wait.wait, iocg_wake_fn);
2659*4882a593Smuzhiyun 	wait.wait.private = current;
2660*4882a593Smuzhiyun 	wait.bio = bio;
2661*4882a593Smuzhiyun 	wait.abs_cost = abs_cost;
2662*4882a593Smuzhiyun 	wait.committed = false;	/* will be set true by waker */
2663*4882a593Smuzhiyun 
2664*4882a593Smuzhiyun 	__add_wait_queue_entry_tail(&iocg->waitq, &wait.wait);
2665*4882a593Smuzhiyun 	iocg_kick_waitq(iocg, ioc_locked, &now);
2666*4882a593Smuzhiyun 
2667*4882a593Smuzhiyun 	iocg_unlock(iocg, ioc_locked, &flags);
2668*4882a593Smuzhiyun 
2669*4882a593Smuzhiyun 	while (true) {
2670*4882a593Smuzhiyun 		set_current_state(TASK_UNINTERRUPTIBLE);
2671*4882a593Smuzhiyun 		if (wait.committed)
2672*4882a593Smuzhiyun 			break;
2673*4882a593Smuzhiyun 		io_schedule();
2674*4882a593Smuzhiyun 	}
2675*4882a593Smuzhiyun 
2676*4882a593Smuzhiyun 	/* waker already committed us, proceed */
2677*4882a593Smuzhiyun 	finish_wait(&iocg->waitq, &wait.wait);
2678*4882a593Smuzhiyun }
2679*4882a593Smuzhiyun 
ioc_rqos_merge(struct rq_qos * rqos,struct request * rq,struct bio * bio)2680*4882a593Smuzhiyun static void ioc_rqos_merge(struct rq_qos *rqos, struct request *rq,
2681*4882a593Smuzhiyun 			   struct bio *bio)
2682*4882a593Smuzhiyun {
2683*4882a593Smuzhiyun 	struct ioc_gq *iocg = blkg_to_iocg(bio->bi_blkg);
2684*4882a593Smuzhiyun 	struct ioc *ioc = rqos_to_ioc(rqos);
2685*4882a593Smuzhiyun 	sector_t bio_end = bio_end_sector(bio);
2686*4882a593Smuzhiyun 	struct ioc_now now;
2687*4882a593Smuzhiyun 	u64 vtime, abs_cost, cost;
2688*4882a593Smuzhiyun 	unsigned long flags;
2689*4882a593Smuzhiyun 
2690*4882a593Smuzhiyun 	/* bypass if disabled, still initializing, or for root cgroup */
2691*4882a593Smuzhiyun 	if (!ioc->enabled || !iocg || !iocg->level)
2692*4882a593Smuzhiyun 		return;
2693*4882a593Smuzhiyun 
2694*4882a593Smuzhiyun 	abs_cost = calc_vtime_cost(bio, iocg, true);
2695*4882a593Smuzhiyun 	if (!abs_cost)
2696*4882a593Smuzhiyun 		return;
2697*4882a593Smuzhiyun 
2698*4882a593Smuzhiyun 	ioc_now(ioc, &now);
2699*4882a593Smuzhiyun 
2700*4882a593Smuzhiyun 	vtime = atomic64_read(&iocg->vtime);
2701*4882a593Smuzhiyun 	cost = adjust_inuse_and_calc_cost(iocg, vtime, abs_cost, &now);
2702*4882a593Smuzhiyun 
2703*4882a593Smuzhiyun 	/* update cursor if backmerging into the request at the cursor */
2704*4882a593Smuzhiyun 	if (blk_rq_pos(rq) < bio_end &&
2705*4882a593Smuzhiyun 	    blk_rq_pos(rq) + blk_rq_sectors(rq) == iocg->cursor)
2706*4882a593Smuzhiyun 		iocg->cursor = bio_end;
2707*4882a593Smuzhiyun 
2708*4882a593Smuzhiyun 	/*
2709*4882a593Smuzhiyun 	 * Charge if there's enough vtime budget and the existing request has
2710*4882a593Smuzhiyun 	 * cost assigned.
2711*4882a593Smuzhiyun 	 */
2712*4882a593Smuzhiyun 	if (rq->bio && rq->bio->bi_iocost_cost &&
2713*4882a593Smuzhiyun 	    time_before_eq64(atomic64_read(&iocg->vtime) + cost, now.vnow)) {
2714*4882a593Smuzhiyun 		iocg_commit_bio(iocg, bio, abs_cost, cost);
2715*4882a593Smuzhiyun 		return;
2716*4882a593Smuzhiyun 	}
2717*4882a593Smuzhiyun 
2718*4882a593Smuzhiyun 	/*
2719*4882a593Smuzhiyun 	 * Otherwise, account it as debt if @iocg is online, which it should
2720*4882a593Smuzhiyun 	 * be for the vast majority of cases. See debt handling in
2721*4882a593Smuzhiyun 	 * ioc_rqos_throttle() for details.
2722*4882a593Smuzhiyun 	 */
2723*4882a593Smuzhiyun 	spin_lock_irqsave(&ioc->lock, flags);
2724*4882a593Smuzhiyun 	spin_lock(&iocg->waitq.lock);
2725*4882a593Smuzhiyun 
2726*4882a593Smuzhiyun 	if (likely(!list_empty(&iocg->active_list))) {
2727*4882a593Smuzhiyun 		iocg_incur_debt(iocg, abs_cost, &now);
2728*4882a593Smuzhiyun 		if (iocg_kick_delay(iocg, &now))
2729*4882a593Smuzhiyun 			blkcg_schedule_throttle(rqos->q,
2730*4882a593Smuzhiyun 					(bio->bi_opf & REQ_SWAP) == REQ_SWAP);
2731*4882a593Smuzhiyun 	} else {
2732*4882a593Smuzhiyun 		iocg_commit_bio(iocg, bio, abs_cost, cost);
2733*4882a593Smuzhiyun 	}
2734*4882a593Smuzhiyun 
2735*4882a593Smuzhiyun 	spin_unlock(&iocg->waitq.lock);
2736*4882a593Smuzhiyun 	spin_unlock_irqrestore(&ioc->lock, flags);
2737*4882a593Smuzhiyun }
2738*4882a593Smuzhiyun 
ioc_rqos_done_bio(struct rq_qos * rqos,struct bio * bio)2739*4882a593Smuzhiyun static void ioc_rqos_done_bio(struct rq_qos *rqos, struct bio *bio)
2740*4882a593Smuzhiyun {
2741*4882a593Smuzhiyun 	struct ioc_gq *iocg = blkg_to_iocg(bio->bi_blkg);
2742*4882a593Smuzhiyun 
2743*4882a593Smuzhiyun 	if (iocg && bio->bi_iocost_cost)
2744*4882a593Smuzhiyun 		atomic64_add(bio->bi_iocost_cost, &iocg->done_vtime);
2745*4882a593Smuzhiyun }
2746*4882a593Smuzhiyun 
ioc_rqos_done(struct rq_qos * rqos,struct request * rq)2747*4882a593Smuzhiyun static void ioc_rqos_done(struct rq_qos *rqos, struct request *rq)
2748*4882a593Smuzhiyun {
2749*4882a593Smuzhiyun 	struct ioc *ioc = rqos_to_ioc(rqos);
2750*4882a593Smuzhiyun 	struct ioc_pcpu_stat *ccs;
2751*4882a593Smuzhiyun 	u64 on_q_ns, rq_wait_ns, size_nsec;
2752*4882a593Smuzhiyun 	int pidx, rw;
2753*4882a593Smuzhiyun 
2754*4882a593Smuzhiyun 	if (!ioc->enabled || !rq->alloc_time_ns || !rq->start_time_ns)
2755*4882a593Smuzhiyun 		return;
2756*4882a593Smuzhiyun 
2757*4882a593Smuzhiyun 	switch (req_op(rq) & REQ_OP_MASK) {
2758*4882a593Smuzhiyun 	case REQ_OP_READ:
2759*4882a593Smuzhiyun 		pidx = QOS_RLAT;
2760*4882a593Smuzhiyun 		rw = READ;
2761*4882a593Smuzhiyun 		break;
2762*4882a593Smuzhiyun 	case REQ_OP_WRITE:
2763*4882a593Smuzhiyun 		pidx = QOS_WLAT;
2764*4882a593Smuzhiyun 		rw = WRITE;
2765*4882a593Smuzhiyun 		break;
2766*4882a593Smuzhiyun 	default:
2767*4882a593Smuzhiyun 		return;
2768*4882a593Smuzhiyun 	}
2769*4882a593Smuzhiyun 
2770*4882a593Smuzhiyun 	on_q_ns = ktime_get_ns() - rq->alloc_time_ns;
2771*4882a593Smuzhiyun 	rq_wait_ns = rq->start_time_ns - rq->alloc_time_ns;
2772*4882a593Smuzhiyun 	size_nsec = div64_u64(calc_size_vtime_cost(rq, ioc), VTIME_PER_NSEC);
2773*4882a593Smuzhiyun 
2774*4882a593Smuzhiyun 	ccs = get_cpu_ptr(ioc->pcpu_stat);
2775*4882a593Smuzhiyun 
2776*4882a593Smuzhiyun 	if (on_q_ns <= size_nsec ||
2777*4882a593Smuzhiyun 	    on_q_ns - size_nsec <= ioc->params.qos[pidx] * NSEC_PER_USEC)
2778*4882a593Smuzhiyun 		local_inc(&ccs->missed[rw].nr_met);
2779*4882a593Smuzhiyun 	else
2780*4882a593Smuzhiyun 		local_inc(&ccs->missed[rw].nr_missed);
2781*4882a593Smuzhiyun 
2782*4882a593Smuzhiyun 	local64_add(rq_wait_ns, &ccs->rq_wait_ns);
2783*4882a593Smuzhiyun 
2784*4882a593Smuzhiyun 	put_cpu_ptr(ccs);
2785*4882a593Smuzhiyun }
2786*4882a593Smuzhiyun 
ioc_rqos_queue_depth_changed(struct rq_qos * rqos)2787*4882a593Smuzhiyun static void ioc_rqos_queue_depth_changed(struct rq_qos *rqos)
2788*4882a593Smuzhiyun {
2789*4882a593Smuzhiyun 	struct ioc *ioc = rqos_to_ioc(rqos);
2790*4882a593Smuzhiyun 
2791*4882a593Smuzhiyun 	spin_lock_irq(&ioc->lock);
2792*4882a593Smuzhiyun 	ioc_refresh_params(ioc, false);
2793*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
2794*4882a593Smuzhiyun }
2795*4882a593Smuzhiyun 
ioc_rqos_exit(struct rq_qos * rqos)2796*4882a593Smuzhiyun static void ioc_rqos_exit(struct rq_qos *rqos)
2797*4882a593Smuzhiyun {
2798*4882a593Smuzhiyun 	struct ioc *ioc = rqos_to_ioc(rqos);
2799*4882a593Smuzhiyun 
2800*4882a593Smuzhiyun 	blkcg_deactivate_policy(rqos->q, &blkcg_policy_iocost);
2801*4882a593Smuzhiyun 
2802*4882a593Smuzhiyun 	spin_lock_irq(&ioc->lock);
2803*4882a593Smuzhiyun 	ioc->running = IOC_STOP;
2804*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
2805*4882a593Smuzhiyun 
2806*4882a593Smuzhiyun 	del_timer_sync(&ioc->timer);
2807*4882a593Smuzhiyun 	free_percpu(ioc->pcpu_stat);
2808*4882a593Smuzhiyun 	kfree(ioc);
2809*4882a593Smuzhiyun }
2810*4882a593Smuzhiyun 
2811*4882a593Smuzhiyun static struct rq_qos_ops ioc_rqos_ops = {
2812*4882a593Smuzhiyun 	.throttle = ioc_rqos_throttle,
2813*4882a593Smuzhiyun 	.merge = ioc_rqos_merge,
2814*4882a593Smuzhiyun 	.done_bio = ioc_rqos_done_bio,
2815*4882a593Smuzhiyun 	.done = ioc_rqos_done,
2816*4882a593Smuzhiyun 	.queue_depth_changed = ioc_rqos_queue_depth_changed,
2817*4882a593Smuzhiyun 	.exit = ioc_rqos_exit,
2818*4882a593Smuzhiyun };
2819*4882a593Smuzhiyun 
blk_iocost_init(struct request_queue * q)2820*4882a593Smuzhiyun static int blk_iocost_init(struct request_queue *q)
2821*4882a593Smuzhiyun {
2822*4882a593Smuzhiyun 	struct ioc *ioc;
2823*4882a593Smuzhiyun 	struct rq_qos *rqos;
2824*4882a593Smuzhiyun 	int i, cpu, ret;
2825*4882a593Smuzhiyun 
2826*4882a593Smuzhiyun 	ioc = kzalloc(sizeof(*ioc), GFP_KERNEL);
2827*4882a593Smuzhiyun 	if (!ioc)
2828*4882a593Smuzhiyun 		return -ENOMEM;
2829*4882a593Smuzhiyun 
2830*4882a593Smuzhiyun 	ioc->pcpu_stat = alloc_percpu(struct ioc_pcpu_stat);
2831*4882a593Smuzhiyun 	if (!ioc->pcpu_stat) {
2832*4882a593Smuzhiyun 		kfree(ioc);
2833*4882a593Smuzhiyun 		return -ENOMEM;
2834*4882a593Smuzhiyun 	}
2835*4882a593Smuzhiyun 
2836*4882a593Smuzhiyun 	for_each_possible_cpu(cpu) {
2837*4882a593Smuzhiyun 		struct ioc_pcpu_stat *ccs = per_cpu_ptr(ioc->pcpu_stat, cpu);
2838*4882a593Smuzhiyun 
2839*4882a593Smuzhiyun 		for (i = 0; i < ARRAY_SIZE(ccs->missed); i++) {
2840*4882a593Smuzhiyun 			local_set(&ccs->missed[i].nr_met, 0);
2841*4882a593Smuzhiyun 			local_set(&ccs->missed[i].nr_missed, 0);
2842*4882a593Smuzhiyun 		}
2843*4882a593Smuzhiyun 		local64_set(&ccs->rq_wait_ns, 0);
2844*4882a593Smuzhiyun 	}
2845*4882a593Smuzhiyun 
2846*4882a593Smuzhiyun 	rqos = &ioc->rqos;
2847*4882a593Smuzhiyun 	rqos->id = RQ_QOS_COST;
2848*4882a593Smuzhiyun 	rqos->ops = &ioc_rqos_ops;
2849*4882a593Smuzhiyun 	rqos->q = q;
2850*4882a593Smuzhiyun 
2851*4882a593Smuzhiyun 	spin_lock_init(&ioc->lock);
2852*4882a593Smuzhiyun 	timer_setup(&ioc->timer, ioc_timer_fn, 0);
2853*4882a593Smuzhiyun 	INIT_LIST_HEAD(&ioc->active_iocgs);
2854*4882a593Smuzhiyun 
2855*4882a593Smuzhiyun 	ioc->running = IOC_IDLE;
2856*4882a593Smuzhiyun 	ioc->vtime_base_rate = VTIME_PER_USEC;
2857*4882a593Smuzhiyun 	atomic64_set(&ioc->vtime_rate, VTIME_PER_USEC);
2858*4882a593Smuzhiyun 	seqcount_spinlock_init(&ioc->period_seqcount, &ioc->lock);
2859*4882a593Smuzhiyun 	ioc->period_at = ktime_to_us(ktime_get());
2860*4882a593Smuzhiyun 	atomic64_set(&ioc->cur_period, 0);
2861*4882a593Smuzhiyun 	atomic_set(&ioc->hweight_gen, 0);
2862*4882a593Smuzhiyun 
2863*4882a593Smuzhiyun 	spin_lock_irq(&ioc->lock);
2864*4882a593Smuzhiyun 	ioc->autop_idx = AUTOP_INVALID;
2865*4882a593Smuzhiyun 	ioc_refresh_params(ioc, true);
2866*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
2867*4882a593Smuzhiyun 
2868*4882a593Smuzhiyun 	/*
2869*4882a593Smuzhiyun 	 * rqos must be added before activation to allow iocg_pd_init() to
2870*4882a593Smuzhiyun 	 * lookup the ioc from q. This means that the rqos methods may get
2871*4882a593Smuzhiyun 	 * called before policy activation completion, can't assume that the
2872*4882a593Smuzhiyun 	 * target bio has an iocg associated and need to test for NULL iocg.
2873*4882a593Smuzhiyun 	 */
2874*4882a593Smuzhiyun 	rq_qos_add(q, rqos);
2875*4882a593Smuzhiyun 	ret = blkcg_activate_policy(q, &blkcg_policy_iocost);
2876*4882a593Smuzhiyun 	if (ret) {
2877*4882a593Smuzhiyun 		rq_qos_del(q, rqos);
2878*4882a593Smuzhiyun 		free_percpu(ioc->pcpu_stat);
2879*4882a593Smuzhiyun 		kfree(ioc);
2880*4882a593Smuzhiyun 		return ret;
2881*4882a593Smuzhiyun 	}
2882*4882a593Smuzhiyun 	return 0;
2883*4882a593Smuzhiyun }
2884*4882a593Smuzhiyun 
ioc_cpd_alloc(gfp_t gfp)2885*4882a593Smuzhiyun static struct blkcg_policy_data *ioc_cpd_alloc(gfp_t gfp)
2886*4882a593Smuzhiyun {
2887*4882a593Smuzhiyun 	struct ioc_cgrp *iocc;
2888*4882a593Smuzhiyun 
2889*4882a593Smuzhiyun 	iocc = kzalloc(sizeof(struct ioc_cgrp), gfp);
2890*4882a593Smuzhiyun 	if (!iocc)
2891*4882a593Smuzhiyun 		return NULL;
2892*4882a593Smuzhiyun 
2893*4882a593Smuzhiyun 	iocc->dfl_weight = CGROUP_WEIGHT_DFL * WEIGHT_ONE;
2894*4882a593Smuzhiyun 	return &iocc->cpd;
2895*4882a593Smuzhiyun }
2896*4882a593Smuzhiyun 
ioc_cpd_free(struct blkcg_policy_data * cpd)2897*4882a593Smuzhiyun static void ioc_cpd_free(struct blkcg_policy_data *cpd)
2898*4882a593Smuzhiyun {
2899*4882a593Smuzhiyun 	kfree(container_of(cpd, struct ioc_cgrp, cpd));
2900*4882a593Smuzhiyun }
2901*4882a593Smuzhiyun 
ioc_pd_alloc(gfp_t gfp,struct request_queue * q,struct blkcg * blkcg)2902*4882a593Smuzhiyun static struct blkg_policy_data *ioc_pd_alloc(gfp_t gfp, struct request_queue *q,
2903*4882a593Smuzhiyun 					     struct blkcg *blkcg)
2904*4882a593Smuzhiyun {
2905*4882a593Smuzhiyun 	int levels = blkcg->css.cgroup->level + 1;
2906*4882a593Smuzhiyun 	struct ioc_gq *iocg;
2907*4882a593Smuzhiyun 
2908*4882a593Smuzhiyun 	iocg = kzalloc_node(struct_size(iocg, ancestors, levels), gfp, q->node);
2909*4882a593Smuzhiyun 	if (!iocg)
2910*4882a593Smuzhiyun 		return NULL;
2911*4882a593Smuzhiyun 
2912*4882a593Smuzhiyun 	iocg->pcpu_stat = alloc_percpu_gfp(struct iocg_pcpu_stat, gfp);
2913*4882a593Smuzhiyun 	if (!iocg->pcpu_stat) {
2914*4882a593Smuzhiyun 		kfree(iocg);
2915*4882a593Smuzhiyun 		return NULL;
2916*4882a593Smuzhiyun 	}
2917*4882a593Smuzhiyun 
2918*4882a593Smuzhiyun 	return &iocg->pd;
2919*4882a593Smuzhiyun }
2920*4882a593Smuzhiyun 
ioc_pd_init(struct blkg_policy_data * pd)2921*4882a593Smuzhiyun static void ioc_pd_init(struct blkg_policy_data *pd)
2922*4882a593Smuzhiyun {
2923*4882a593Smuzhiyun 	struct ioc_gq *iocg = pd_to_iocg(pd);
2924*4882a593Smuzhiyun 	struct blkcg_gq *blkg = pd_to_blkg(&iocg->pd);
2925*4882a593Smuzhiyun 	struct ioc *ioc = q_to_ioc(blkg->q);
2926*4882a593Smuzhiyun 	struct ioc_now now;
2927*4882a593Smuzhiyun 	struct blkcg_gq *tblkg;
2928*4882a593Smuzhiyun 	unsigned long flags;
2929*4882a593Smuzhiyun 
2930*4882a593Smuzhiyun 	ioc_now(ioc, &now);
2931*4882a593Smuzhiyun 
2932*4882a593Smuzhiyun 	iocg->ioc = ioc;
2933*4882a593Smuzhiyun 	atomic64_set(&iocg->vtime, now.vnow);
2934*4882a593Smuzhiyun 	atomic64_set(&iocg->done_vtime, now.vnow);
2935*4882a593Smuzhiyun 	atomic64_set(&iocg->active_period, atomic64_read(&ioc->cur_period));
2936*4882a593Smuzhiyun 	INIT_LIST_HEAD(&iocg->active_list);
2937*4882a593Smuzhiyun 	INIT_LIST_HEAD(&iocg->walk_list);
2938*4882a593Smuzhiyun 	INIT_LIST_HEAD(&iocg->surplus_list);
2939*4882a593Smuzhiyun 	iocg->hweight_active = WEIGHT_ONE;
2940*4882a593Smuzhiyun 	iocg->hweight_inuse = WEIGHT_ONE;
2941*4882a593Smuzhiyun 
2942*4882a593Smuzhiyun 	init_waitqueue_head(&iocg->waitq);
2943*4882a593Smuzhiyun 	hrtimer_init(&iocg->waitq_timer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
2944*4882a593Smuzhiyun 	iocg->waitq_timer.function = iocg_waitq_timer_fn;
2945*4882a593Smuzhiyun 
2946*4882a593Smuzhiyun 	iocg->level = blkg->blkcg->css.cgroup->level;
2947*4882a593Smuzhiyun 
2948*4882a593Smuzhiyun 	for (tblkg = blkg; tblkg; tblkg = tblkg->parent) {
2949*4882a593Smuzhiyun 		struct ioc_gq *tiocg = blkg_to_iocg(tblkg);
2950*4882a593Smuzhiyun 		iocg->ancestors[tiocg->level] = tiocg;
2951*4882a593Smuzhiyun 	}
2952*4882a593Smuzhiyun 
2953*4882a593Smuzhiyun 	spin_lock_irqsave(&ioc->lock, flags);
2954*4882a593Smuzhiyun 	weight_updated(iocg, &now);
2955*4882a593Smuzhiyun 	spin_unlock_irqrestore(&ioc->lock, flags);
2956*4882a593Smuzhiyun }
2957*4882a593Smuzhiyun 
ioc_pd_free(struct blkg_policy_data * pd)2958*4882a593Smuzhiyun static void ioc_pd_free(struct blkg_policy_data *pd)
2959*4882a593Smuzhiyun {
2960*4882a593Smuzhiyun 	struct ioc_gq *iocg = pd_to_iocg(pd);
2961*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
2962*4882a593Smuzhiyun 	unsigned long flags;
2963*4882a593Smuzhiyun 
2964*4882a593Smuzhiyun 	if (ioc) {
2965*4882a593Smuzhiyun 		spin_lock_irqsave(&ioc->lock, flags);
2966*4882a593Smuzhiyun 
2967*4882a593Smuzhiyun 		if (!list_empty(&iocg->active_list)) {
2968*4882a593Smuzhiyun 			struct ioc_now now;
2969*4882a593Smuzhiyun 
2970*4882a593Smuzhiyun 			ioc_now(ioc, &now);
2971*4882a593Smuzhiyun 			propagate_weights(iocg, 0, 0, false, &now);
2972*4882a593Smuzhiyun 			list_del_init(&iocg->active_list);
2973*4882a593Smuzhiyun 		}
2974*4882a593Smuzhiyun 
2975*4882a593Smuzhiyun 		WARN_ON_ONCE(!list_empty(&iocg->walk_list));
2976*4882a593Smuzhiyun 		WARN_ON_ONCE(!list_empty(&iocg->surplus_list));
2977*4882a593Smuzhiyun 
2978*4882a593Smuzhiyun 		spin_unlock_irqrestore(&ioc->lock, flags);
2979*4882a593Smuzhiyun 
2980*4882a593Smuzhiyun 		hrtimer_cancel(&iocg->waitq_timer);
2981*4882a593Smuzhiyun 	}
2982*4882a593Smuzhiyun 	free_percpu(iocg->pcpu_stat);
2983*4882a593Smuzhiyun 	kfree(iocg);
2984*4882a593Smuzhiyun }
2985*4882a593Smuzhiyun 
ioc_pd_stat(struct blkg_policy_data * pd,char * buf,size_t size)2986*4882a593Smuzhiyun static size_t ioc_pd_stat(struct blkg_policy_data *pd, char *buf, size_t size)
2987*4882a593Smuzhiyun {
2988*4882a593Smuzhiyun 	struct ioc_gq *iocg = pd_to_iocg(pd);
2989*4882a593Smuzhiyun 	struct ioc *ioc = iocg->ioc;
2990*4882a593Smuzhiyun 	size_t pos = 0;
2991*4882a593Smuzhiyun 
2992*4882a593Smuzhiyun 	if (!ioc->enabled)
2993*4882a593Smuzhiyun 		return 0;
2994*4882a593Smuzhiyun 
2995*4882a593Smuzhiyun 	if (iocg->level == 0) {
2996*4882a593Smuzhiyun 		unsigned vp10k = DIV64_U64_ROUND_CLOSEST(
2997*4882a593Smuzhiyun 			ioc->vtime_base_rate * 10000,
2998*4882a593Smuzhiyun 			VTIME_PER_USEC);
2999*4882a593Smuzhiyun 		pos += scnprintf(buf + pos, size - pos, " cost.vrate=%u.%02u",
3000*4882a593Smuzhiyun 				  vp10k / 100, vp10k % 100);
3001*4882a593Smuzhiyun 	}
3002*4882a593Smuzhiyun 
3003*4882a593Smuzhiyun 	pos += scnprintf(buf + pos, size - pos, " cost.usage=%llu",
3004*4882a593Smuzhiyun 			 iocg->last_stat.usage_us);
3005*4882a593Smuzhiyun 
3006*4882a593Smuzhiyun 	if (blkcg_debug_stats)
3007*4882a593Smuzhiyun 		pos += scnprintf(buf + pos, size - pos,
3008*4882a593Smuzhiyun 				 " cost.wait=%llu cost.indebt=%llu cost.indelay=%llu",
3009*4882a593Smuzhiyun 				 iocg->last_stat.wait_us,
3010*4882a593Smuzhiyun 				 iocg->last_stat.indebt_us,
3011*4882a593Smuzhiyun 				 iocg->last_stat.indelay_us);
3012*4882a593Smuzhiyun 
3013*4882a593Smuzhiyun 	return pos;
3014*4882a593Smuzhiyun }
3015*4882a593Smuzhiyun 
ioc_weight_prfill(struct seq_file * sf,struct blkg_policy_data * pd,int off)3016*4882a593Smuzhiyun static u64 ioc_weight_prfill(struct seq_file *sf, struct blkg_policy_data *pd,
3017*4882a593Smuzhiyun 			     int off)
3018*4882a593Smuzhiyun {
3019*4882a593Smuzhiyun 	const char *dname = blkg_dev_name(pd->blkg);
3020*4882a593Smuzhiyun 	struct ioc_gq *iocg = pd_to_iocg(pd);
3021*4882a593Smuzhiyun 
3022*4882a593Smuzhiyun 	if (dname && iocg->cfg_weight)
3023*4882a593Smuzhiyun 		seq_printf(sf, "%s %u\n", dname, iocg->cfg_weight / WEIGHT_ONE);
3024*4882a593Smuzhiyun 	return 0;
3025*4882a593Smuzhiyun }
3026*4882a593Smuzhiyun 
3027*4882a593Smuzhiyun 
ioc_weight_show(struct seq_file * sf,void * v)3028*4882a593Smuzhiyun static int ioc_weight_show(struct seq_file *sf, void *v)
3029*4882a593Smuzhiyun {
3030*4882a593Smuzhiyun 	struct blkcg *blkcg = css_to_blkcg(seq_css(sf));
3031*4882a593Smuzhiyun 	struct ioc_cgrp *iocc = blkcg_to_iocc(blkcg);
3032*4882a593Smuzhiyun 
3033*4882a593Smuzhiyun 	seq_printf(sf, "default %u\n", iocc->dfl_weight / WEIGHT_ONE);
3034*4882a593Smuzhiyun 	blkcg_print_blkgs(sf, blkcg, ioc_weight_prfill,
3035*4882a593Smuzhiyun 			  &blkcg_policy_iocost, seq_cft(sf)->private, false);
3036*4882a593Smuzhiyun 	return 0;
3037*4882a593Smuzhiyun }
3038*4882a593Smuzhiyun 
ioc_weight_write(struct kernfs_open_file * of,char * buf,size_t nbytes,loff_t off)3039*4882a593Smuzhiyun static ssize_t ioc_weight_write(struct kernfs_open_file *of, char *buf,
3040*4882a593Smuzhiyun 				size_t nbytes, loff_t off)
3041*4882a593Smuzhiyun {
3042*4882a593Smuzhiyun 	struct blkcg *blkcg = css_to_blkcg(of_css(of));
3043*4882a593Smuzhiyun 	struct ioc_cgrp *iocc = blkcg_to_iocc(blkcg);
3044*4882a593Smuzhiyun 	struct blkg_conf_ctx ctx;
3045*4882a593Smuzhiyun 	struct ioc_now now;
3046*4882a593Smuzhiyun 	struct ioc_gq *iocg;
3047*4882a593Smuzhiyun 	u32 v;
3048*4882a593Smuzhiyun 	int ret;
3049*4882a593Smuzhiyun 
3050*4882a593Smuzhiyun 	if (!strchr(buf, ':')) {
3051*4882a593Smuzhiyun 		struct blkcg_gq *blkg;
3052*4882a593Smuzhiyun 
3053*4882a593Smuzhiyun 		if (!sscanf(buf, "default %u", &v) && !sscanf(buf, "%u", &v))
3054*4882a593Smuzhiyun 			return -EINVAL;
3055*4882a593Smuzhiyun 
3056*4882a593Smuzhiyun 		if (v < CGROUP_WEIGHT_MIN || v > CGROUP_WEIGHT_MAX)
3057*4882a593Smuzhiyun 			return -EINVAL;
3058*4882a593Smuzhiyun 
3059*4882a593Smuzhiyun 		spin_lock_irq(&blkcg->lock);
3060*4882a593Smuzhiyun 		iocc->dfl_weight = v * WEIGHT_ONE;
3061*4882a593Smuzhiyun 		hlist_for_each_entry(blkg, &blkcg->blkg_list, blkcg_node) {
3062*4882a593Smuzhiyun 			struct ioc_gq *iocg = blkg_to_iocg(blkg);
3063*4882a593Smuzhiyun 
3064*4882a593Smuzhiyun 			if (iocg) {
3065*4882a593Smuzhiyun 				spin_lock(&iocg->ioc->lock);
3066*4882a593Smuzhiyun 				ioc_now(iocg->ioc, &now);
3067*4882a593Smuzhiyun 				weight_updated(iocg, &now);
3068*4882a593Smuzhiyun 				spin_unlock(&iocg->ioc->lock);
3069*4882a593Smuzhiyun 			}
3070*4882a593Smuzhiyun 		}
3071*4882a593Smuzhiyun 		spin_unlock_irq(&blkcg->lock);
3072*4882a593Smuzhiyun 
3073*4882a593Smuzhiyun 		return nbytes;
3074*4882a593Smuzhiyun 	}
3075*4882a593Smuzhiyun 
3076*4882a593Smuzhiyun 	ret = blkg_conf_prep(blkcg, &blkcg_policy_iocost, buf, &ctx);
3077*4882a593Smuzhiyun 	if (ret)
3078*4882a593Smuzhiyun 		return ret;
3079*4882a593Smuzhiyun 
3080*4882a593Smuzhiyun 	iocg = blkg_to_iocg(ctx.blkg);
3081*4882a593Smuzhiyun 
3082*4882a593Smuzhiyun 	if (!strncmp(ctx.body, "default", 7)) {
3083*4882a593Smuzhiyun 		v = 0;
3084*4882a593Smuzhiyun 	} else {
3085*4882a593Smuzhiyun 		if (!sscanf(ctx.body, "%u", &v))
3086*4882a593Smuzhiyun 			goto einval;
3087*4882a593Smuzhiyun 		if (v < CGROUP_WEIGHT_MIN || v > CGROUP_WEIGHT_MAX)
3088*4882a593Smuzhiyun 			goto einval;
3089*4882a593Smuzhiyun 	}
3090*4882a593Smuzhiyun 
3091*4882a593Smuzhiyun 	spin_lock(&iocg->ioc->lock);
3092*4882a593Smuzhiyun 	iocg->cfg_weight = v * WEIGHT_ONE;
3093*4882a593Smuzhiyun 	ioc_now(iocg->ioc, &now);
3094*4882a593Smuzhiyun 	weight_updated(iocg, &now);
3095*4882a593Smuzhiyun 	spin_unlock(&iocg->ioc->lock);
3096*4882a593Smuzhiyun 
3097*4882a593Smuzhiyun 	blkg_conf_finish(&ctx);
3098*4882a593Smuzhiyun 	return nbytes;
3099*4882a593Smuzhiyun 
3100*4882a593Smuzhiyun einval:
3101*4882a593Smuzhiyun 	blkg_conf_finish(&ctx);
3102*4882a593Smuzhiyun 	return -EINVAL;
3103*4882a593Smuzhiyun }
3104*4882a593Smuzhiyun 
ioc_qos_prfill(struct seq_file * sf,struct blkg_policy_data * pd,int off)3105*4882a593Smuzhiyun static u64 ioc_qos_prfill(struct seq_file *sf, struct blkg_policy_data *pd,
3106*4882a593Smuzhiyun 			  int off)
3107*4882a593Smuzhiyun {
3108*4882a593Smuzhiyun 	const char *dname = blkg_dev_name(pd->blkg);
3109*4882a593Smuzhiyun 	struct ioc *ioc = pd_to_iocg(pd)->ioc;
3110*4882a593Smuzhiyun 
3111*4882a593Smuzhiyun 	if (!dname)
3112*4882a593Smuzhiyun 		return 0;
3113*4882a593Smuzhiyun 
3114*4882a593Smuzhiyun 	seq_printf(sf, "%s enable=%d ctrl=%s rpct=%u.%02u rlat=%u wpct=%u.%02u wlat=%u min=%u.%02u max=%u.%02u\n",
3115*4882a593Smuzhiyun 		   dname, ioc->enabled, ioc->user_qos_params ? "user" : "auto",
3116*4882a593Smuzhiyun 		   ioc->params.qos[QOS_RPPM] / 10000,
3117*4882a593Smuzhiyun 		   ioc->params.qos[QOS_RPPM] % 10000 / 100,
3118*4882a593Smuzhiyun 		   ioc->params.qos[QOS_RLAT],
3119*4882a593Smuzhiyun 		   ioc->params.qos[QOS_WPPM] / 10000,
3120*4882a593Smuzhiyun 		   ioc->params.qos[QOS_WPPM] % 10000 / 100,
3121*4882a593Smuzhiyun 		   ioc->params.qos[QOS_WLAT],
3122*4882a593Smuzhiyun 		   ioc->params.qos[QOS_MIN] / 10000,
3123*4882a593Smuzhiyun 		   ioc->params.qos[QOS_MIN] % 10000 / 100,
3124*4882a593Smuzhiyun 		   ioc->params.qos[QOS_MAX] / 10000,
3125*4882a593Smuzhiyun 		   ioc->params.qos[QOS_MAX] % 10000 / 100);
3126*4882a593Smuzhiyun 	return 0;
3127*4882a593Smuzhiyun }
3128*4882a593Smuzhiyun 
ioc_qos_show(struct seq_file * sf,void * v)3129*4882a593Smuzhiyun static int ioc_qos_show(struct seq_file *sf, void *v)
3130*4882a593Smuzhiyun {
3131*4882a593Smuzhiyun 	struct blkcg *blkcg = css_to_blkcg(seq_css(sf));
3132*4882a593Smuzhiyun 
3133*4882a593Smuzhiyun 	blkcg_print_blkgs(sf, blkcg, ioc_qos_prfill,
3134*4882a593Smuzhiyun 			  &blkcg_policy_iocost, seq_cft(sf)->private, false);
3135*4882a593Smuzhiyun 	return 0;
3136*4882a593Smuzhiyun }
3137*4882a593Smuzhiyun 
3138*4882a593Smuzhiyun static const match_table_t qos_ctrl_tokens = {
3139*4882a593Smuzhiyun 	{ QOS_ENABLE,		"enable=%u"	},
3140*4882a593Smuzhiyun 	{ QOS_CTRL,		"ctrl=%s"	},
3141*4882a593Smuzhiyun 	{ NR_QOS_CTRL_PARAMS,	NULL		},
3142*4882a593Smuzhiyun };
3143*4882a593Smuzhiyun 
3144*4882a593Smuzhiyun static const match_table_t qos_tokens = {
3145*4882a593Smuzhiyun 	{ QOS_RPPM,		"rpct=%s"	},
3146*4882a593Smuzhiyun 	{ QOS_RLAT,		"rlat=%u"	},
3147*4882a593Smuzhiyun 	{ QOS_WPPM,		"wpct=%s"	},
3148*4882a593Smuzhiyun 	{ QOS_WLAT,		"wlat=%u"	},
3149*4882a593Smuzhiyun 	{ QOS_MIN,		"min=%s"	},
3150*4882a593Smuzhiyun 	{ QOS_MAX,		"max=%s"	},
3151*4882a593Smuzhiyun 	{ NR_QOS_PARAMS,	NULL		},
3152*4882a593Smuzhiyun };
3153*4882a593Smuzhiyun 
ioc_qos_write(struct kernfs_open_file * of,char * input,size_t nbytes,loff_t off)3154*4882a593Smuzhiyun static ssize_t ioc_qos_write(struct kernfs_open_file *of, char *input,
3155*4882a593Smuzhiyun 			     size_t nbytes, loff_t off)
3156*4882a593Smuzhiyun {
3157*4882a593Smuzhiyun 	struct gendisk *disk;
3158*4882a593Smuzhiyun 	struct ioc *ioc;
3159*4882a593Smuzhiyun 	u32 qos[NR_QOS_PARAMS];
3160*4882a593Smuzhiyun 	bool enable, user;
3161*4882a593Smuzhiyun 	char *p;
3162*4882a593Smuzhiyun 	int ret;
3163*4882a593Smuzhiyun 
3164*4882a593Smuzhiyun 	disk = blkcg_conf_get_disk(&input);
3165*4882a593Smuzhiyun 	if (IS_ERR(disk))
3166*4882a593Smuzhiyun 		return PTR_ERR(disk);
3167*4882a593Smuzhiyun 
3168*4882a593Smuzhiyun 	ioc = q_to_ioc(disk->queue);
3169*4882a593Smuzhiyun 	if (!ioc) {
3170*4882a593Smuzhiyun 		ret = blk_iocost_init(disk->queue);
3171*4882a593Smuzhiyun 		if (ret)
3172*4882a593Smuzhiyun 			goto err;
3173*4882a593Smuzhiyun 		ioc = q_to_ioc(disk->queue);
3174*4882a593Smuzhiyun 	}
3175*4882a593Smuzhiyun 
3176*4882a593Smuzhiyun 	spin_lock_irq(&ioc->lock);
3177*4882a593Smuzhiyun 	memcpy(qos, ioc->params.qos, sizeof(qos));
3178*4882a593Smuzhiyun 	enable = ioc->enabled;
3179*4882a593Smuzhiyun 	user = ioc->user_qos_params;
3180*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
3181*4882a593Smuzhiyun 
3182*4882a593Smuzhiyun 	while ((p = strsep(&input, " \t\n"))) {
3183*4882a593Smuzhiyun 		substring_t args[MAX_OPT_ARGS];
3184*4882a593Smuzhiyun 		char buf[32];
3185*4882a593Smuzhiyun 		int tok;
3186*4882a593Smuzhiyun 		s64 v;
3187*4882a593Smuzhiyun 
3188*4882a593Smuzhiyun 		if (!*p)
3189*4882a593Smuzhiyun 			continue;
3190*4882a593Smuzhiyun 
3191*4882a593Smuzhiyun 		switch (match_token(p, qos_ctrl_tokens, args)) {
3192*4882a593Smuzhiyun 		case QOS_ENABLE:
3193*4882a593Smuzhiyun 			match_u64(&args[0], &v);
3194*4882a593Smuzhiyun 			enable = v;
3195*4882a593Smuzhiyun 			continue;
3196*4882a593Smuzhiyun 		case QOS_CTRL:
3197*4882a593Smuzhiyun 			match_strlcpy(buf, &args[0], sizeof(buf));
3198*4882a593Smuzhiyun 			if (!strcmp(buf, "auto"))
3199*4882a593Smuzhiyun 				user = false;
3200*4882a593Smuzhiyun 			else if (!strcmp(buf, "user"))
3201*4882a593Smuzhiyun 				user = true;
3202*4882a593Smuzhiyun 			else
3203*4882a593Smuzhiyun 				goto einval;
3204*4882a593Smuzhiyun 			continue;
3205*4882a593Smuzhiyun 		}
3206*4882a593Smuzhiyun 
3207*4882a593Smuzhiyun 		tok = match_token(p, qos_tokens, args);
3208*4882a593Smuzhiyun 		switch (tok) {
3209*4882a593Smuzhiyun 		case QOS_RPPM:
3210*4882a593Smuzhiyun 		case QOS_WPPM:
3211*4882a593Smuzhiyun 			if (match_strlcpy(buf, &args[0], sizeof(buf)) >=
3212*4882a593Smuzhiyun 			    sizeof(buf))
3213*4882a593Smuzhiyun 				goto einval;
3214*4882a593Smuzhiyun 			if (cgroup_parse_float(buf, 2, &v))
3215*4882a593Smuzhiyun 				goto einval;
3216*4882a593Smuzhiyun 			if (v < 0 || v > 10000)
3217*4882a593Smuzhiyun 				goto einval;
3218*4882a593Smuzhiyun 			qos[tok] = v * 100;
3219*4882a593Smuzhiyun 			break;
3220*4882a593Smuzhiyun 		case QOS_RLAT:
3221*4882a593Smuzhiyun 		case QOS_WLAT:
3222*4882a593Smuzhiyun 			if (match_u64(&args[0], &v))
3223*4882a593Smuzhiyun 				goto einval;
3224*4882a593Smuzhiyun 			qos[tok] = v;
3225*4882a593Smuzhiyun 			break;
3226*4882a593Smuzhiyun 		case QOS_MIN:
3227*4882a593Smuzhiyun 		case QOS_MAX:
3228*4882a593Smuzhiyun 			if (match_strlcpy(buf, &args[0], sizeof(buf)) >=
3229*4882a593Smuzhiyun 			    sizeof(buf))
3230*4882a593Smuzhiyun 				goto einval;
3231*4882a593Smuzhiyun 			if (cgroup_parse_float(buf, 2, &v))
3232*4882a593Smuzhiyun 				goto einval;
3233*4882a593Smuzhiyun 			if (v < 0)
3234*4882a593Smuzhiyun 				goto einval;
3235*4882a593Smuzhiyun 			qos[tok] = clamp_t(s64, v * 100,
3236*4882a593Smuzhiyun 					   VRATE_MIN_PPM, VRATE_MAX_PPM);
3237*4882a593Smuzhiyun 			break;
3238*4882a593Smuzhiyun 		default:
3239*4882a593Smuzhiyun 			goto einval;
3240*4882a593Smuzhiyun 		}
3241*4882a593Smuzhiyun 		user = true;
3242*4882a593Smuzhiyun 	}
3243*4882a593Smuzhiyun 
3244*4882a593Smuzhiyun 	if (qos[QOS_MIN] > qos[QOS_MAX])
3245*4882a593Smuzhiyun 		goto einval;
3246*4882a593Smuzhiyun 
3247*4882a593Smuzhiyun 	spin_lock_irq(&ioc->lock);
3248*4882a593Smuzhiyun 
3249*4882a593Smuzhiyun 	if (enable) {
3250*4882a593Smuzhiyun 		blk_stat_enable_accounting(ioc->rqos.q);
3251*4882a593Smuzhiyun 		blk_queue_flag_set(QUEUE_FLAG_RQ_ALLOC_TIME, ioc->rqos.q);
3252*4882a593Smuzhiyun 		ioc->enabled = true;
3253*4882a593Smuzhiyun 	} else {
3254*4882a593Smuzhiyun 		blk_queue_flag_clear(QUEUE_FLAG_RQ_ALLOC_TIME, ioc->rqos.q);
3255*4882a593Smuzhiyun 		ioc->enabled = false;
3256*4882a593Smuzhiyun 	}
3257*4882a593Smuzhiyun 
3258*4882a593Smuzhiyun 	if (user) {
3259*4882a593Smuzhiyun 		memcpy(ioc->params.qos, qos, sizeof(qos));
3260*4882a593Smuzhiyun 		ioc->user_qos_params = true;
3261*4882a593Smuzhiyun 	} else {
3262*4882a593Smuzhiyun 		ioc->user_qos_params = false;
3263*4882a593Smuzhiyun 	}
3264*4882a593Smuzhiyun 
3265*4882a593Smuzhiyun 	ioc_refresh_params(ioc, true);
3266*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
3267*4882a593Smuzhiyun 
3268*4882a593Smuzhiyun 	put_disk_and_module(disk);
3269*4882a593Smuzhiyun 	return nbytes;
3270*4882a593Smuzhiyun einval:
3271*4882a593Smuzhiyun 	ret = -EINVAL;
3272*4882a593Smuzhiyun err:
3273*4882a593Smuzhiyun 	put_disk_and_module(disk);
3274*4882a593Smuzhiyun 	return ret;
3275*4882a593Smuzhiyun }
3276*4882a593Smuzhiyun 
ioc_cost_model_prfill(struct seq_file * sf,struct blkg_policy_data * pd,int off)3277*4882a593Smuzhiyun static u64 ioc_cost_model_prfill(struct seq_file *sf,
3278*4882a593Smuzhiyun 				 struct blkg_policy_data *pd, int off)
3279*4882a593Smuzhiyun {
3280*4882a593Smuzhiyun 	const char *dname = blkg_dev_name(pd->blkg);
3281*4882a593Smuzhiyun 	struct ioc *ioc = pd_to_iocg(pd)->ioc;
3282*4882a593Smuzhiyun 	u64 *u = ioc->params.i_lcoefs;
3283*4882a593Smuzhiyun 
3284*4882a593Smuzhiyun 	if (!dname)
3285*4882a593Smuzhiyun 		return 0;
3286*4882a593Smuzhiyun 
3287*4882a593Smuzhiyun 	seq_printf(sf, "%s ctrl=%s model=linear "
3288*4882a593Smuzhiyun 		   "rbps=%llu rseqiops=%llu rrandiops=%llu "
3289*4882a593Smuzhiyun 		   "wbps=%llu wseqiops=%llu wrandiops=%llu\n",
3290*4882a593Smuzhiyun 		   dname, ioc->user_cost_model ? "user" : "auto",
3291*4882a593Smuzhiyun 		   u[I_LCOEF_RBPS], u[I_LCOEF_RSEQIOPS], u[I_LCOEF_RRANDIOPS],
3292*4882a593Smuzhiyun 		   u[I_LCOEF_WBPS], u[I_LCOEF_WSEQIOPS], u[I_LCOEF_WRANDIOPS]);
3293*4882a593Smuzhiyun 	return 0;
3294*4882a593Smuzhiyun }
3295*4882a593Smuzhiyun 
ioc_cost_model_show(struct seq_file * sf,void * v)3296*4882a593Smuzhiyun static int ioc_cost_model_show(struct seq_file *sf, void *v)
3297*4882a593Smuzhiyun {
3298*4882a593Smuzhiyun 	struct blkcg *blkcg = css_to_blkcg(seq_css(sf));
3299*4882a593Smuzhiyun 
3300*4882a593Smuzhiyun 	blkcg_print_blkgs(sf, blkcg, ioc_cost_model_prfill,
3301*4882a593Smuzhiyun 			  &blkcg_policy_iocost, seq_cft(sf)->private, false);
3302*4882a593Smuzhiyun 	return 0;
3303*4882a593Smuzhiyun }
3304*4882a593Smuzhiyun 
3305*4882a593Smuzhiyun static const match_table_t cost_ctrl_tokens = {
3306*4882a593Smuzhiyun 	{ COST_CTRL,		"ctrl=%s"	},
3307*4882a593Smuzhiyun 	{ COST_MODEL,		"model=%s"	},
3308*4882a593Smuzhiyun 	{ NR_COST_CTRL_PARAMS,	NULL		},
3309*4882a593Smuzhiyun };
3310*4882a593Smuzhiyun 
3311*4882a593Smuzhiyun static const match_table_t i_lcoef_tokens = {
3312*4882a593Smuzhiyun 	{ I_LCOEF_RBPS,		"rbps=%u"	},
3313*4882a593Smuzhiyun 	{ I_LCOEF_RSEQIOPS,	"rseqiops=%u"	},
3314*4882a593Smuzhiyun 	{ I_LCOEF_RRANDIOPS,	"rrandiops=%u"	},
3315*4882a593Smuzhiyun 	{ I_LCOEF_WBPS,		"wbps=%u"	},
3316*4882a593Smuzhiyun 	{ I_LCOEF_WSEQIOPS,	"wseqiops=%u"	},
3317*4882a593Smuzhiyun 	{ I_LCOEF_WRANDIOPS,	"wrandiops=%u"	},
3318*4882a593Smuzhiyun 	{ NR_I_LCOEFS,		NULL		},
3319*4882a593Smuzhiyun };
3320*4882a593Smuzhiyun 
ioc_cost_model_write(struct kernfs_open_file * of,char * input,size_t nbytes,loff_t off)3321*4882a593Smuzhiyun static ssize_t ioc_cost_model_write(struct kernfs_open_file *of, char *input,
3322*4882a593Smuzhiyun 				    size_t nbytes, loff_t off)
3323*4882a593Smuzhiyun {
3324*4882a593Smuzhiyun 	struct gendisk *disk;
3325*4882a593Smuzhiyun 	struct ioc *ioc;
3326*4882a593Smuzhiyun 	u64 u[NR_I_LCOEFS];
3327*4882a593Smuzhiyun 	bool user;
3328*4882a593Smuzhiyun 	char *p;
3329*4882a593Smuzhiyun 	int ret;
3330*4882a593Smuzhiyun 
3331*4882a593Smuzhiyun 	disk = blkcg_conf_get_disk(&input);
3332*4882a593Smuzhiyun 	if (IS_ERR(disk))
3333*4882a593Smuzhiyun 		return PTR_ERR(disk);
3334*4882a593Smuzhiyun 
3335*4882a593Smuzhiyun 	ioc = q_to_ioc(disk->queue);
3336*4882a593Smuzhiyun 	if (!ioc) {
3337*4882a593Smuzhiyun 		ret = blk_iocost_init(disk->queue);
3338*4882a593Smuzhiyun 		if (ret)
3339*4882a593Smuzhiyun 			goto err;
3340*4882a593Smuzhiyun 		ioc = q_to_ioc(disk->queue);
3341*4882a593Smuzhiyun 	}
3342*4882a593Smuzhiyun 
3343*4882a593Smuzhiyun 	spin_lock_irq(&ioc->lock);
3344*4882a593Smuzhiyun 	memcpy(u, ioc->params.i_lcoefs, sizeof(u));
3345*4882a593Smuzhiyun 	user = ioc->user_cost_model;
3346*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
3347*4882a593Smuzhiyun 
3348*4882a593Smuzhiyun 	while ((p = strsep(&input, " \t\n"))) {
3349*4882a593Smuzhiyun 		substring_t args[MAX_OPT_ARGS];
3350*4882a593Smuzhiyun 		char buf[32];
3351*4882a593Smuzhiyun 		int tok;
3352*4882a593Smuzhiyun 		u64 v;
3353*4882a593Smuzhiyun 
3354*4882a593Smuzhiyun 		if (!*p)
3355*4882a593Smuzhiyun 			continue;
3356*4882a593Smuzhiyun 
3357*4882a593Smuzhiyun 		switch (match_token(p, cost_ctrl_tokens, args)) {
3358*4882a593Smuzhiyun 		case COST_CTRL:
3359*4882a593Smuzhiyun 			match_strlcpy(buf, &args[0], sizeof(buf));
3360*4882a593Smuzhiyun 			if (!strcmp(buf, "auto"))
3361*4882a593Smuzhiyun 				user = false;
3362*4882a593Smuzhiyun 			else if (!strcmp(buf, "user"))
3363*4882a593Smuzhiyun 				user = true;
3364*4882a593Smuzhiyun 			else
3365*4882a593Smuzhiyun 				goto einval;
3366*4882a593Smuzhiyun 			continue;
3367*4882a593Smuzhiyun 		case COST_MODEL:
3368*4882a593Smuzhiyun 			match_strlcpy(buf, &args[0], sizeof(buf));
3369*4882a593Smuzhiyun 			if (strcmp(buf, "linear"))
3370*4882a593Smuzhiyun 				goto einval;
3371*4882a593Smuzhiyun 			continue;
3372*4882a593Smuzhiyun 		}
3373*4882a593Smuzhiyun 
3374*4882a593Smuzhiyun 		tok = match_token(p, i_lcoef_tokens, args);
3375*4882a593Smuzhiyun 		if (tok == NR_I_LCOEFS)
3376*4882a593Smuzhiyun 			goto einval;
3377*4882a593Smuzhiyun 		if (match_u64(&args[0], &v))
3378*4882a593Smuzhiyun 			goto einval;
3379*4882a593Smuzhiyun 		u[tok] = v;
3380*4882a593Smuzhiyun 		user = true;
3381*4882a593Smuzhiyun 	}
3382*4882a593Smuzhiyun 
3383*4882a593Smuzhiyun 	spin_lock_irq(&ioc->lock);
3384*4882a593Smuzhiyun 	if (user) {
3385*4882a593Smuzhiyun 		memcpy(ioc->params.i_lcoefs, u, sizeof(u));
3386*4882a593Smuzhiyun 		ioc->user_cost_model = true;
3387*4882a593Smuzhiyun 	} else {
3388*4882a593Smuzhiyun 		ioc->user_cost_model = false;
3389*4882a593Smuzhiyun 	}
3390*4882a593Smuzhiyun 	ioc_refresh_params(ioc, true);
3391*4882a593Smuzhiyun 	spin_unlock_irq(&ioc->lock);
3392*4882a593Smuzhiyun 
3393*4882a593Smuzhiyun 	put_disk_and_module(disk);
3394*4882a593Smuzhiyun 	return nbytes;
3395*4882a593Smuzhiyun 
3396*4882a593Smuzhiyun einval:
3397*4882a593Smuzhiyun 	ret = -EINVAL;
3398*4882a593Smuzhiyun err:
3399*4882a593Smuzhiyun 	put_disk_and_module(disk);
3400*4882a593Smuzhiyun 	return ret;
3401*4882a593Smuzhiyun }
3402*4882a593Smuzhiyun 
3403*4882a593Smuzhiyun static struct cftype ioc_files[] = {
3404*4882a593Smuzhiyun 	{
3405*4882a593Smuzhiyun 		.name = "weight",
3406*4882a593Smuzhiyun 		.flags = CFTYPE_NOT_ON_ROOT,
3407*4882a593Smuzhiyun 		.seq_show = ioc_weight_show,
3408*4882a593Smuzhiyun 		.write = ioc_weight_write,
3409*4882a593Smuzhiyun 	},
3410*4882a593Smuzhiyun 	{
3411*4882a593Smuzhiyun 		.name = "cost.qos",
3412*4882a593Smuzhiyun 		.flags = CFTYPE_ONLY_ON_ROOT,
3413*4882a593Smuzhiyun 		.seq_show = ioc_qos_show,
3414*4882a593Smuzhiyun 		.write = ioc_qos_write,
3415*4882a593Smuzhiyun 	},
3416*4882a593Smuzhiyun 	{
3417*4882a593Smuzhiyun 		.name = "cost.model",
3418*4882a593Smuzhiyun 		.flags = CFTYPE_ONLY_ON_ROOT,
3419*4882a593Smuzhiyun 		.seq_show = ioc_cost_model_show,
3420*4882a593Smuzhiyun 		.write = ioc_cost_model_write,
3421*4882a593Smuzhiyun 	},
3422*4882a593Smuzhiyun 	{}
3423*4882a593Smuzhiyun };
3424*4882a593Smuzhiyun 
3425*4882a593Smuzhiyun static struct blkcg_policy blkcg_policy_iocost = {
3426*4882a593Smuzhiyun 	.dfl_cftypes	= ioc_files,
3427*4882a593Smuzhiyun 	.cpd_alloc_fn	= ioc_cpd_alloc,
3428*4882a593Smuzhiyun 	.cpd_free_fn	= ioc_cpd_free,
3429*4882a593Smuzhiyun 	.pd_alloc_fn	= ioc_pd_alloc,
3430*4882a593Smuzhiyun 	.pd_init_fn	= ioc_pd_init,
3431*4882a593Smuzhiyun 	.pd_free_fn	= ioc_pd_free,
3432*4882a593Smuzhiyun 	.pd_stat_fn	= ioc_pd_stat,
3433*4882a593Smuzhiyun };
3434*4882a593Smuzhiyun 
ioc_init(void)3435*4882a593Smuzhiyun static int __init ioc_init(void)
3436*4882a593Smuzhiyun {
3437*4882a593Smuzhiyun 	return blkcg_policy_register(&blkcg_policy_iocost);
3438*4882a593Smuzhiyun }
3439*4882a593Smuzhiyun 
ioc_exit(void)3440*4882a593Smuzhiyun static void __exit ioc_exit(void)
3441*4882a593Smuzhiyun {
3442*4882a593Smuzhiyun 	blkcg_policy_unregister(&blkcg_policy_iocost);
3443*4882a593Smuzhiyun }
3444*4882a593Smuzhiyun 
3445*4882a593Smuzhiyun module_init(ioc_init);
3446*4882a593Smuzhiyun module_exit(ioc_exit);
3447