blob: 266fc4f6b046f29cc6c1f45d476232880fc0ecfe [file] [log] [blame]
Jens Axboe75bb4622014-05-28 10:15:41 -06001/*
2 * Block multiqueue core code
3 *
4 * Copyright (C) 2013-2014 Jens Axboe
5 * Copyright (C) 2013-2014 Christoph Hellwig
6 */
Jens Axboe320ae512013-10-24 09:20:05 +01007#include <linux/kernel.h>
8#include <linux/module.h>
9#include <linux/backing-dev.h>
10#include <linux/bio.h>
11#include <linux/blkdev.h>
Catalin Marinasf75782e2015-09-14 18:16:02 +010012#include <linux/kmemleak.h>
Jens Axboe320ae512013-10-24 09:20:05 +010013#include <linux/mm.h>
14#include <linux/init.h>
15#include <linux/slab.h>
16#include <linux/workqueue.h>
17#include <linux/smp.h>
18#include <linux/llist.h>
19#include <linux/list_sort.h>
20#include <linux/cpu.h>
21#include <linux/cache.h>
22#include <linux/sched/sysctl.h>
Ingo Molnar105ab3d2017-02-01 16:36:40 +010023#include <linux/sched/topology.h>
Ingo Molnar174cd4b2017-02-02 19:15:33 +010024#include <linux/sched/signal.h>
Jens Axboe320ae512013-10-24 09:20:05 +010025#include <linux/delay.h>
Jens Axboeaedcd722014-09-17 08:27:03 -060026#include <linux/crash_dump.h>
Jens Axboe88c7b2b2016-08-25 08:07:30 -060027#include <linux/prefetch.h>
Jens Axboe320ae512013-10-24 09:20:05 +010028
29#include <trace/events/block.h>
30
31#include <linux/blk-mq.h>
32#include "blk.h"
33#include "blk-mq.h"
Omar Sandoval9c1051a2017-05-04 08:17:21 -060034#include "blk-mq-debugfs.h"
Jens Axboe320ae512013-10-24 09:20:05 +010035#include "blk-mq-tag.h"
Jens Axboecf43e6b2016-11-07 21:32:37 -070036#include "blk-stat.h"
Jens Axboe87760e52016-11-09 12:38:14 -070037#include "blk-wbt.h"
Jens Axboebd166ef2017-01-17 06:03:22 -070038#include "blk-mq-sched.h"
Jens Axboe320ae512013-10-24 09:20:05 +010039
Christoph Hellwigea435e12017-11-02 21:29:54 +030040static bool blk_mq_poll(struct request_queue *q, blk_qc_t cookie);
Omar Sandoval34dbad52017-03-21 08:56:08 -070041static void blk_mq_poll_stats_start(struct request_queue *q);
42static void blk_mq_poll_stats_fn(struct blk_stat_callback *cb);
43
Stephen Bates720b8cc2017-04-07 06:24:03 -060044static int blk_mq_poll_stats_bkt(const struct request *rq)
45{
46 int ddir, bytes, bucket;
47
Jens Axboe99c749a2017-04-21 07:55:42 -060048 ddir = rq_data_dir(rq);
Stephen Bates720b8cc2017-04-07 06:24:03 -060049 bytes = blk_rq_bytes(rq);
50
51 bucket = ddir + 2*(ilog2(bytes) - 9);
52
53 if (bucket < 0)
54 return -1;
55 else if (bucket >= BLK_MQ_POLL_STATS_BKTS)
56 return ddir + BLK_MQ_POLL_STATS_BKTS - 2;
57
58 return bucket;
59}
60
Jens Axboe320ae512013-10-24 09:20:05 +010061/*
62 * Check if any of the ctx's have pending work in this hardware queue
63 */
Jens Axboe79f720a2017-11-10 09:13:21 -070064static bool blk_mq_hctx_has_pending(struct blk_mq_hw_ctx *hctx)
Jens Axboe320ae512013-10-24 09:20:05 +010065{
Jens Axboe79f720a2017-11-10 09:13:21 -070066 return !list_empty_careful(&hctx->dispatch) ||
67 sbitmap_any_bit_set(&hctx->ctx_map) ||
Jens Axboebd166ef2017-01-17 06:03:22 -070068 blk_mq_sched_has_work(hctx);
Jens Axboe320ae512013-10-24 09:20:05 +010069}
70
71/*
72 * Mark this ctx as having pending work in this hardware queue
73 */
74static void blk_mq_hctx_mark_pending(struct blk_mq_hw_ctx *hctx,
75 struct blk_mq_ctx *ctx)
76{
Omar Sandoval88459642016-09-17 08:38:44 -060077 if (!sbitmap_test_bit(&hctx->ctx_map, ctx->index_hw))
78 sbitmap_set_bit(&hctx->ctx_map, ctx->index_hw);
Jens Axboe1429d7c2014-05-19 09:23:55 -060079}
80
81static void blk_mq_hctx_clear_pending(struct blk_mq_hw_ctx *hctx,
82 struct blk_mq_ctx *ctx)
83{
Omar Sandoval88459642016-09-17 08:38:44 -060084 sbitmap_clear_bit(&hctx->ctx_map, ctx->index_hw);
Jens Axboe320ae512013-10-24 09:20:05 +010085}
86
Jens Axboef299b7c2017-08-08 17:51:45 -060087struct mq_inflight {
88 struct hd_struct *part;
89 unsigned int *inflight;
90};
91
92static void blk_mq_check_inflight(struct blk_mq_hw_ctx *hctx,
93 struct request *rq, void *priv,
94 bool reserved)
95{
96 struct mq_inflight *mi = priv;
97
Tejun Heo67818d22018-01-09 08:29:49 -080098 if (blk_mq_rq_state(rq) == MQ_RQ_IN_FLIGHT) {
Jens Axboef299b7c2017-08-08 17:51:45 -060099 /*
Jens Axboeb8d62b32017-08-08 17:53:33 -0600100 * index[0] counts the specific partition that was asked
101 * for. index[1] counts the ones that are active on the
102 * whole device, so increment that if mi->part is indeed
103 * a partition, and not a whole device.
Jens Axboef299b7c2017-08-08 17:51:45 -0600104 */
Jens Axboeb8d62b32017-08-08 17:53:33 -0600105 if (rq->part == mi->part)
Jens Axboef299b7c2017-08-08 17:51:45 -0600106 mi->inflight[0]++;
Jens Axboeb8d62b32017-08-08 17:53:33 -0600107 if (mi->part->partno)
108 mi->inflight[1]++;
Jens Axboef299b7c2017-08-08 17:51:45 -0600109 }
110}
111
112void blk_mq_in_flight(struct request_queue *q, struct hd_struct *part,
113 unsigned int inflight[2])
114{
115 struct mq_inflight mi = { .part = part, .inflight = inflight, };
116
Jens Axboeb8d62b32017-08-08 17:53:33 -0600117 inflight[0] = inflight[1] = 0;
Jens Axboef299b7c2017-08-08 17:51:45 -0600118 blk_mq_queue_tag_busy_iter(q, blk_mq_check_inflight, &mi);
119}
120
Ming Lei1671d522017-03-27 20:06:57 +0800121void blk_freeze_queue_start(struct request_queue *q)
Ming Lei43a5e4e2013-12-26 21:31:35 +0800122{
Christoph Hellwig4ecd4fe2015-05-07 09:38:13 +0200123 int freeze_depth;
Tejun Heocddd5d12014-08-16 08:02:24 -0400124
Christoph Hellwig4ecd4fe2015-05-07 09:38:13 +0200125 freeze_depth = atomic_inc_return(&q->mq_freeze_depth);
126 if (freeze_depth == 1) {
Dan Williams3ef28e82015-10-21 13:20:12 -0400127 percpu_ref_kill(&q->q_usage_counter);
Ming Lei055f6e12017-11-09 10:49:53 -0800128 if (q->mq_ops)
129 blk_mq_run_hw_queues(q, false);
Tejun Heocddd5d12014-08-16 08:02:24 -0400130 }
Tejun Heof3af0202014-11-04 13:52:27 -0500131}
Ming Lei1671d522017-03-27 20:06:57 +0800132EXPORT_SYMBOL_GPL(blk_freeze_queue_start);
Tejun Heof3af0202014-11-04 13:52:27 -0500133
Keith Busch6bae3632017-03-01 14:22:10 -0500134void blk_mq_freeze_queue_wait(struct request_queue *q)
Tejun Heof3af0202014-11-04 13:52:27 -0500135{
Dan Williams3ef28e82015-10-21 13:20:12 -0400136 wait_event(q->mq_freeze_wq, percpu_ref_is_zero(&q->q_usage_counter));
Ming Lei43a5e4e2013-12-26 21:31:35 +0800137}
Keith Busch6bae3632017-03-01 14:22:10 -0500138EXPORT_SYMBOL_GPL(blk_mq_freeze_queue_wait);
Ming Lei43a5e4e2013-12-26 21:31:35 +0800139
Keith Buschf91328c2017-03-01 14:22:11 -0500140int blk_mq_freeze_queue_wait_timeout(struct request_queue *q,
141 unsigned long timeout)
142{
143 return wait_event_timeout(q->mq_freeze_wq,
144 percpu_ref_is_zero(&q->q_usage_counter),
145 timeout);
146}
147EXPORT_SYMBOL_GPL(blk_mq_freeze_queue_wait_timeout);
Jens Axboe320ae512013-10-24 09:20:05 +0100148
Tejun Heof3af0202014-11-04 13:52:27 -0500149/*
150 * Guarantee no request is in use, so we can change any data structure of
151 * the queue afterward.
152 */
Dan Williams3ef28e82015-10-21 13:20:12 -0400153void blk_freeze_queue(struct request_queue *q)
Tejun Heof3af0202014-11-04 13:52:27 -0500154{
Dan Williams3ef28e82015-10-21 13:20:12 -0400155 /*
156 * In the !blk_mq case we are only calling this to kill the
157 * q_usage_counter, otherwise this increases the freeze depth
158 * and waits for it to return to zero. For this reason there is
159 * no blk_unfreeze_queue(), and blk_freeze_queue() is not
160 * exported to drivers as the only user for unfreeze is blk_mq.
161 */
Ming Lei1671d522017-03-27 20:06:57 +0800162 blk_freeze_queue_start(q);
Tejun Heof3af0202014-11-04 13:52:27 -0500163 blk_mq_freeze_queue_wait(q);
164}
Dan Williams3ef28e82015-10-21 13:20:12 -0400165
166void blk_mq_freeze_queue(struct request_queue *q)
167{
168 /*
169 * ...just an alias to keep freeze and unfreeze actions balanced
170 * in the blk_mq_* namespace
171 */
172 blk_freeze_queue(q);
173}
Jens Axboec761d962015-01-02 15:05:12 -0700174EXPORT_SYMBOL_GPL(blk_mq_freeze_queue);
Tejun Heof3af0202014-11-04 13:52:27 -0500175
Keith Buschb4c6a022014-12-19 17:54:14 -0700176void blk_mq_unfreeze_queue(struct request_queue *q)
Jens Axboe320ae512013-10-24 09:20:05 +0100177{
Christoph Hellwig4ecd4fe2015-05-07 09:38:13 +0200178 int freeze_depth;
Jens Axboe320ae512013-10-24 09:20:05 +0100179
Christoph Hellwig4ecd4fe2015-05-07 09:38:13 +0200180 freeze_depth = atomic_dec_return(&q->mq_freeze_depth);
181 WARN_ON_ONCE(freeze_depth < 0);
182 if (!freeze_depth) {
Dan Williams3ef28e82015-10-21 13:20:12 -0400183 percpu_ref_reinit(&q->q_usage_counter);
Jens Axboe320ae512013-10-24 09:20:05 +0100184 wake_up_all(&q->mq_freeze_wq);
Tejun Heoadd703f2014-07-01 10:34:38 -0600185 }
Jens Axboe320ae512013-10-24 09:20:05 +0100186}
Keith Buschb4c6a022014-12-19 17:54:14 -0700187EXPORT_SYMBOL_GPL(blk_mq_unfreeze_queue);
Jens Axboe320ae512013-10-24 09:20:05 +0100188
Bart Van Assche852ec802017-06-21 10:55:47 -0700189/*
190 * FIXME: replace the scsi_internal_device_*block_nowait() calls in the
191 * mpt3sas driver such that this function can be removed.
192 */
193void blk_mq_quiesce_queue_nowait(struct request_queue *q)
194{
195 unsigned long flags;
196
197 spin_lock_irqsave(q->queue_lock, flags);
198 queue_flag_set(QUEUE_FLAG_QUIESCED, q);
199 spin_unlock_irqrestore(q->queue_lock, flags);
200}
201EXPORT_SYMBOL_GPL(blk_mq_quiesce_queue_nowait);
202
Bart Van Assche6a83e742016-11-02 10:09:51 -0600203/**
Ming Lei69e07c42017-06-06 23:22:07 +0800204 * blk_mq_quiesce_queue() - wait until all ongoing dispatches have finished
Bart Van Assche6a83e742016-11-02 10:09:51 -0600205 * @q: request queue.
206 *
207 * Note: this function does not prevent that the struct request end_io()
Ming Lei69e07c42017-06-06 23:22:07 +0800208 * callback function is invoked. Once this function is returned, we make
209 * sure no dispatch can happen until the queue is unquiesced via
210 * blk_mq_unquiesce_queue().
Bart Van Assche6a83e742016-11-02 10:09:51 -0600211 */
212void blk_mq_quiesce_queue(struct request_queue *q)
213{
214 struct blk_mq_hw_ctx *hctx;
215 unsigned int i;
216 bool rcu = false;
217
Ming Lei1d9e9bc2017-06-06 23:22:08 +0800218 blk_mq_quiesce_queue_nowait(q);
Ming Leif4560ff2017-06-18 14:24:27 -0600219
Bart Van Assche6a83e742016-11-02 10:09:51 -0600220 queue_for_each_hw_ctx(q, hctx, i) {
221 if (hctx->flags & BLK_MQ_F_BLOCKING)
Tejun Heo05707b62018-01-09 08:29:53 -0800222 synchronize_srcu(hctx->srcu);
Bart Van Assche6a83e742016-11-02 10:09:51 -0600223 else
224 rcu = true;
225 }
226 if (rcu)
227 synchronize_rcu();
228}
229EXPORT_SYMBOL_GPL(blk_mq_quiesce_queue);
230
Ming Leie4e73912017-06-06 23:22:03 +0800231/*
232 * blk_mq_unquiesce_queue() - counterpart of blk_mq_quiesce_queue()
233 * @q: request queue.
234 *
235 * This function recovers queue into the state before quiescing
236 * which is done by blk_mq_quiesce_queue.
237 */
238void blk_mq_unquiesce_queue(struct request_queue *q)
239{
Bart Van Assche852ec802017-06-21 10:55:47 -0700240 unsigned long flags;
241
242 spin_lock_irqsave(q->queue_lock, flags);
Ming Leif4560ff2017-06-18 14:24:27 -0600243 queue_flag_clear(QUEUE_FLAG_QUIESCED, q);
Bart Van Assche852ec802017-06-21 10:55:47 -0700244 spin_unlock_irqrestore(q->queue_lock, flags);
Ming Leif4560ff2017-06-18 14:24:27 -0600245
Ming Lei1d9e9bc2017-06-06 23:22:08 +0800246 /* dispatch requests which are inserted during quiescing */
247 blk_mq_run_hw_queues(q, true);
Ming Leie4e73912017-06-06 23:22:03 +0800248}
249EXPORT_SYMBOL_GPL(blk_mq_unquiesce_queue);
250
Jens Axboeaed3ea92014-12-22 14:04:42 -0700251void blk_mq_wake_waiters(struct request_queue *q)
252{
253 struct blk_mq_hw_ctx *hctx;
254 unsigned int i;
255
256 queue_for_each_hw_ctx(q, hctx, i)
257 if (blk_mq_hw_queue_mapped(hctx))
258 blk_mq_tag_wakeup_all(hctx->tags, true);
259}
260
Jens Axboe320ae512013-10-24 09:20:05 +0100261bool blk_mq_can_queue(struct blk_mq_hw_ctx *hctx)
262{
263 return blk_mq_has_free_tags(hctx->tags);
264}
265EXPORT_SYMBOL(blk_mq_can_queue);
266
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200267static struct request *blk_mq_rq_ctx_init(struct blk_mq_alloc_data *data,
268 unsigned int tag, unsigned int op)
Jens Axboe320ae512013-10-24 09:20:05 +0100269{
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200270 struct blk_mq_tags *tags = blk_mq_tags_from_data(data);
271 struct request *rq = tags->static_rqs[tag];
272
Bart Van Asschec3a148d2017-06-20 11:15:43 -0700273 rq->rq_flags = 0;
274
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200275 if (data->flags & BLK_MQ_REQ_INTERNAL) {
276 rq->tag = -1;
277 rq->internal_tag = tag;
278 } else {
279 if (blk_mq_tag_busy(data->hctx)) {
280 rq->rq_flags = RQF_MQ_INFLIGHT;
281 atomic_inc(&data->hctx->nr_active);
282 }
283 rq->tag = tag;
284 rq->internal_tag = -1;
285 data->hctx->tags->rqs[rq->tag] = rq;
286 }
287
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200288 INIT_LIST_HEAD(&rq->queuelist);
289 /* csd/requeue_work/fifo_time is initialized before use */
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200290 rq->q = data->q;
291 rq->mq_ctx = data->ctx;
Christoph Hellwigef295ec2016-10-28 08:48:16 -0600292 rq->cmd_flags = op;
Bart Van Assche1b6d65a2017-11-09 10:49:55 -0800293 if (data->flags & BLK_MQ_REQ_PREEMPT)
294 rq->rq_flags |= RQF_PREEMPT;
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200295 if (blk_queue_io_stat(data->q))
Christoph Hellwige8064022016-10-20 15:12:13 +0200296 rq->rq_flags |= RQF_IO_STAT;
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200297 /* do not touch atomic flags, it needs atomic ops against the timer */
298 rq->cpu = -1;
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200299 INIT_HLIST_NODE(&rq->hash);
300 RB_CLEAR_NODE(&rq->rb_node);
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200301 rq->rq_disk = NULL;
302 rq->part = NULL;
Jens Axboe3ee32372014-06-09 09:36:53 -0600303 rq->start_time = jiffies;
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200304#ifdef CONFIG_BLK_CGROUP
305 rq->rl = NULL;
Ming Lei0fec08b2014-01-03 10:00:08 -0700306 set_start_time_ns(rq);
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200307 rq->io_start_time_ns = 0;
308#endif
309 rq->nr_phys_segments = 0;
310#if defined(CONFIG_BLK_DEV_INTEGRITY)
311 rq->nr_integrity_segments = 0;
312#endif
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200313 rq->special = NULL;
314 /* tag was already set */
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200315 rq->extra_len = 0;
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200316
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200317 INIT_LIST_HEAD(&rq->timeout_list);
Jens Axboef6be4fb2014-06-06 11:03:48 -0600318 rq->timeout = 0;
319
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200320 rq->end_io = NULL;
321 rq->end_io_data = NULL;
322 rq->next_rq = NULL;
323
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200324 data->ctx->rq_dispatched[op_is_sync(op)]++;
325 return rq;
Jens Axboe320ae512013-10-24 09:20:05 +0100326}
327
Christoph Hellwigd2c0d382017-06-16 18:15:19 +0200328static struct request *blk_mq_get_request(struct request_queue *q,
329 struct bio *bio, unsigned int op,
330 struct blk_mq_alloc_data *data)
331{
332 struct elevator_queue *e = q->elevator;
333 struct request *rq;
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200334 unsigned int tag;
Bart Van Assche21e768b2017-10-16 16:32:26 -0700335 bool put_ctx_on_error = false;
Christoph Hellwigd2c0d382017-06-16 18:15:19 +0200336
337 blk_queue_enter_live(q);
338 data->q = q;
Bart Van Assche21e768b2017-10-16 16:32:26 -0700339 if (likely(!data->ctx)) {
340 data->ctx = blk_mq_get_ctx(q);
341 put_ctx_on_error = true;
342 }
Christoph Hellwigd2c0d382017-06-16 18:15:19 +0200343 if (likely(!data->hctx))
344 data->hctx = blk_mq_map_queue(q, data->ctx->cpu);
Goldwyn Rodrigues03a07c92017-06-20 07:05:46 -0500345 if (op & REQ_NOWAIT)
346 data->flags |= BLK_MQ_REQ_NOWAIT;
Christoph Hellwigd2c0d382017-06-16 18:15:19 +0200347
348 if (e) {
349 data->flags |= BLK_MQ_REQ_INTERNAL;
350
351 /*
352 * Flush requests are special and go directly to the
353 * dispatch list.
354 */
Christoph Hellwig5bbf4e52017-06-16 18:15:26 +0200355 if (!op_is_flush(op) && e->type->ops.mq.limit_depth)
356 e->type->ops.mq.limit_depth(op, data);
Christoph Hellwigd2c0d382017-06-16 18:15:19 +0200357 }
358
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200359 tag = blk_mq_get_tag(data);
360 if (tag == BLK_MQ_TAG_FAIL) {
Bart Van Assche21e768b2017-10-16 16:32:26 -0700361 if (put_ctx_on_error) {
362 blk_mq_put_ctx(data->ctx);
Ming Lei1ad43c02017-08-02 08:01:45 +0800363 data->ctx = NULL;
364 }
Christoph Hellwig037cebb2017-06-16 18:15:23 +0200365 blk_queue_exit(q);
366 return NULL;
367 }
368
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200369 rq = blk_mq_rq_ctx_init(data, tag, op);
Christoph Hellwig037cebb2017-06-16 18:15:23 +0200370 if (!op_is_flush(op)) {
371 rq->elv.icq = NULL;
Christoph Hellwig5bbf4e52017-06-16 18:15:26 +0200372 if (e && e->type->ops.mq.prepare_request) {
Christoph Hellwig44e8c2b2017-06-16 18:15:25 +0200373 if (e->type->icq_cache && rq_ioc(bio))
374 blk_mq_sched_assign_ioc(rq, bio);
375
Christoph Hellwig5bbf4e52017-06-16 18:15:26 +0200376 e->type->ops.mq.prepare_request(rq, bio);
377 rq->rq_flags |= RQF_ELVPRIV;
Christoph Hellwig44e8c2b2017-06-16 18:15:25 +0200378 }
Christoph Hellwig037cebb2017-06-16 18:15:23 +0200379 }
380 data->hctx->queued++;
381 return rq;
Christoph Hellwigd2c0d382017-06-16 18:15:19 +0200382}
383
Bart Van Asschecd6ce142017-06-20 11:15:39 -0700384struct request *blk_mq_alloc_request(struct request_queue *q, unsigned int op,
Bart Van Assche9a95e4e2017-11-09 10:49:59 -0800385 blk_mq_req_flags_t flags)
Jens Axboe320ae512013-10-24 09:20:05 +0100386{
Jens Axboe5a797e02017-01-26 12:22:11 -0700387 struct blk_mq_alloc_data alloc_data = { .flags = flags };
Jens Axboebd166ef2017-01-17 06:03:22 -0700388 struct request *rq;
Joe Lawrencea492f072014-08-28 08:15:21 -0600389 int ret;
Jens Axboe320ae512013-10-24 09:20:05 +0100390
Bart Van Assche3a0a5292017-11-09 10:49:58 -0800391 ret = blk_queue_enter(q, flags);
Joe Lawrencea492f072014-08-28 08:15:21 -0600392 if (ret)
393 return ERR_PTR(ret);
Jens Axboe320ae512013-10-24 09:20:05 +0100394
Bart Van Asschecd6ce142017-06-20 11:15:39 -0700395 rq = blk_mq_get_request(q, NULL, op, &alloc_data);
Keith Busch3280d662017-08-14 16:40:11 -0400396 blk_queue_exit(q);
Jens Axboe841bac22016-09-21 10:08:43 -0600397
Jens Axboebd166ef2017-01-17 06:03:22 -0700398 if (!rq)
Joe Lawrencea492f072014-08-28 08:15:21 -0600399 return ERR_PTR(-EWOULDBLOCK);
Christoph Hellwig0c4de0f2016-07-19 11:31:50 +0200400
Ming Lei1ad43c02017-08-02 08:01:45 +0800401 blk_mq_put_ctx(alloc_data.ctx);
Ming Lei1ad43c02017-08-02 08:01:45 +0800402
Christoph Hellwig0c4de0f2016-07-19 11:31:50 +0200403 rq->__data_len = 0;
404 rq->__sector = (sector_t) -1;
405 rq->bio = rq->biotail = NULL;
Jens Axboe320ae512013-10-24 09:20:05 +0100406 return rq;
407}
Jens Axboe4bb659b2014-05-09 09:36:49 -0600408EXPORT_SYMBOL(blk_mq_alloc_request);
Jens Axboe320ae512013-10-24 09:20:05 +0100409
Bart Van Asschecd6ce142017-06-20 11:15:39 -0700410struct request *blk_mq_alloc_request_hctx(struct request_queue *q,
Bart Van Assche9a95e4e2017-11-09 10:49:59 -0800411 unsigned int op, blk_mq_req_flags_t flags, unsigned int hctx_idx)
Ming Lin1f5bd332016-06-13 16:45:21 +0200412{
Omar Sandoval6d2809d2017-02-27 10:28:27 -0800413 struct blk_mq_alloc_data alloc_data = { .flags = flags };
Ming Lin1f5bd332016-06-13 16:45:21 +0200414 struct request *rq;
Omar Sandoval6d2809d2017-02-27 10:28:27 -0800415 unsigned int cpu;
Ming Lin1f5bd332016-06-13 16:45:21 +0200416 int ret;
417
418 /*
419 * If the tag allocator sleeps we could get an allocation for a
420 * different hardware context. No need to complicate the low level
421 * allocator for this for the rare use case of a command tied to
422 * a specific queue.
423 */
424 if (WARN_ON_ONCE(!(flags & BLK_MQ_REQ_NOWAIT)))
425 return ERR_PTR(-EINVAL);
426
427 if (hctx_idx >= q->nr_hw_queues)
428 return ERR_PTR(-EIO);
429
Bart Van Assche3a0a5292017-11-09 10:49:58 -0800430 ret = blk_queue_enter(q, flags);
Ming Lin1f5bd332016-06-13 16:45:21 +0200431 if (ret)
432 return ERR_PTR(ret);
433
Christoph Hellwigc8712c62016-09-23 10:25:48 -0600434 /*
435 * Check if the hardware context is actually mapped to anything.
436 * If not tell the caller that it should skip this queue.
437 */
Omar Sandoval6d2809d2017-02-27 10:28:27 -0800438 alloc_data.hctx = q->queue_hw_ctx[hctx_idx];
439 if (!blk_mq_hw_queue_mapped(alloc_data.hctx)) {
440 blk_queue_exit(q);
441 return ERR_PTR(-EXDEV);
Christoph Hellwigc8712c62016-09-23 10:25:48 -0600442 }
Omar Sandoval6d2809d2017-02-27 10:28:27 -0800443 cpu = cpumask_first(alloc_data.hctx->cpumask);
444 alloc_data.ctx = __blk_mq_get_ctx(q, cpu);
Ming Lin1f5bd332016-06-13 16:45:21 +0200445
Bart Van Asschecd6ce142017-06-20 11:15:39 -0700446 rq = blk_mq_get_request(q, NULL, op, &alloc_data);
Keith Busch3280d662017-08-14 16:40:11 -0400447 blk_queue_exit(q);
Omar Sandoval6d2809d2017-02-27 10:28:27 -0800448
Omar Sandoval6d2809d2017-02-27 10:28:27 -0800449 if (!rq)
450 return ERR_PTR(-EWOULDBLOCK);
Ming Lin1f5bd332016-06-13 16:45:21 +0200451
452 return rq;
453}
454EXPORT_SYMBOL_GPL(blk_mq_alloc_request_hctx);
455
Christoph Hellwig6af54052017-06-16 18:15:22 +0200456void blk_mq_free_request(struct request *rq)
Jens Axboe320ae512013-10-24 09:20:05 +0100457{
Jens Axboe320ae512013-10-24 09:20:05 +0100458 struct request_queue *q = rq->q;
Christoph Hellwig6af54052017-06-16 18:15:22 +0200459 struct elevator_queue *e = q->elevator;
460 struct blk_mq_ctx *ctx = rq->mq_ctx;
461 struct blk_mq_hw_ctx *hctx = blk_mq_map_queue(q, ctx->cpu);
462 const int sched_tag = rq->internal_tag;
Jens Axboe320ae512013-10-24 09:20:05 +0100463
Christoph Hellwig5bbf4e52017-06-16 18:15:26 +0200464 if (rq->rq_flags & RQF_ELVPRIV) {
Christoph Hellwig6af54052017-06-16 18:15:22 +0200465 if (e && e->type->ops.mq.finish_request)
466 e->type->ops.mq.finish_request(rq);
467 if (rq->elv.icq) {
468 put_io_context(rq->elv.icq->ioc);
469 rq->elv.icq = NULL;
470 }
471 }
472
473 ctx->rq_completed[rq_is_sync(rq)]++;
Christoph Hellwige8064022016-10-20 15:12:13 +0200474 if (rq->rq_flags & RQF_MQ_INFLIGHT)
Jens Axboe0d2602c2014-05-13 15:10:52 -0600475 atomic_dec(&hctx->nr_active);
Jens Axboe87760e52016-11-09 12:38:14 -0700476
Jens Axboe7beb2f82017-09-30 02:08:24 -0600477 if (unlikely(laptop_mode && !blk_rq_is_passthrough(rq)))
478 laptop_io_completion(q->backing_dev_info);
479
Jens Axboe87760e52016-11-09 12:38:14 -0700480 wbt_done(q->rq_wb, &rq->issue_stat);
Jens Axboe0d2602c2014-05-13 15:10:52 -0600481
Shaohua Li85acb3b2017-10-06 17:56:00 -0700482 if (blk_rq_rl(rq))
483 blk_put_rl(blk_rq_rl(rq));
484
Tejun Heo1d9bd512018-01-09 08:29:48 -0800485 blk_mq_rq_update_state(rq, MQ_RQ_IDLE);
Jens Axboe06426ad2016-11-14 13:01:59 -0700486 clear_bit(REQ_ATOM_POLL_SLEPT, &rq->atomic_flags);
Jens Axboebd166ef2017-01-17 06:03:22 -0700487 if (rq->tag != -1)
488 blk_mq_put_tag(hctx, hctx->tags, ctx, rq->tag);
489 if (sched_tag != -1)
Omar Sandovalc05f8522017-04-14 01:00:01 -0700490 blk_mq_put_tag(hctx, hctx->sched_tags, ctx, sched_tag);
Bart Van Assche6d8c6c02017-04-07 12:40:09 -0600491 blk_mq_sched_restart(hctx);
Dan Williams3ef28e82015-10-21 13:20:12 -0400492 blk_queue_exit(q);
Jens Axboe320ae512013-10-24 09:20:05 +0100493}
Jens Axboe1a3b5952014-11-17 10:40:48 -0700494EXPORT_SYMBOL_GPL(blk_mq_free_request);
Jens Axboe320ae512013-10-24 09:20:05 +0100495
Christoph Hellwig2a842ac2017-06-03 09:38:04 +0200496inline void __blk_mq_end_request(struct request *rq, blk_status_t error)
Jens Axboe320ae512013-10-24 09:20:05 +0100497{
Ming Lei0d11e6a2013-12-05 10:50:39 -0700498 blk_account_io_done(rq);
499
Christoph Hellwig91b63632014-04-16 09:44:53 +0200500 if (rq->end_io) {
Jens Axboe87760e52016-11-09 12:38:14 -0700501 wbt_done(rq->q->rq_wb, &rq->issue_stat);
Jens Axboe320ae512013-10-24 09:20:05 +0100502 rq->end_io(rq, error);
Christoph Hellwig91b63632014-04-16 09:44:53 +0200503 } else {
504 if (unlikely(blk_bidi_rq(rq)))
505 blk_mq_free_request(rq->next_rq);
Jens Axboe320ae512013-10-24 09:20:05 +0100506 blk_mq_free_request(rq);
Christoph Hellwig91b63632014-04-16 09:44:53 +0200507 }
Jens Axboe320ae512013-10-24 09:20:05 +0100508}
Christoph Hellwigc8a446a2014-09-13 16:40:10 -0700509EXPORT_SYMBOL(__blk_mq_end_request);
Christoph Hellwig63151a42014-04-16 09:44:52 +0200510
Christoph Hellwig2a842ac2017-06-03 09:38:04 +0200511void blk_mq_end_request(struct request *rq, blk_status_t error)
Christoph Hellwig63151a42014-04-16 09:44:52 +0200512{
513 if (blk_update_request(rq, error, blk_rq_bytes(rq)))
514 BUG();
Christoph Hellwigc8a446a2014-09-13 16:40:10 -0700515 __blk_mq_end_request(rq, error);
Christoph Hellwig63151a42014-04-16 09:44:52 +0200516}
Christoph Hellwigc8a446a2014-09-13 16:40:10 -0700517EXPORT_SYMBOL(blk_mq_end_request);
Jens Axboe320ae512013-10-24 09:20:05 +0100518
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800519static void __blk_mq_complete_request_remote(void *data)
Jens Axboe320ae512013-10-24 09:20:05 +0100520{
Christoph Hellwig3d6efbf2014-01-08 09:33:37 -0800521 struct request *rq = data;
Jens Axboe320ae512013-10-24 09:20:05 +0100522
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800523 rq->q->softirq_done_fn(rq);
Jens Axboe320ae512013-10-24 09:20:05 +0100524}
525
Christoph Hellwig453f8342017-04-20 16:03:10 +0200526static void __blk_mq_complete_request(struct request *rq)
Jens Axboe320ae512013-10-24 09:20:05 +0100527{
528 struct blk_mq_ctx *ctx = rq->mq_ctx;
Christoph Hellwig38535202014-04-25 02:32:53 -0700529 bool shared = false;
Jens Axboe320ae512013-10-24 09:20:05 +0100530 int cpu;
531
Tejun Heo1d9bd512018-01-09 08:29:48 -0800532 WARN_ON_ONCE(blk_mq_rq_state(rq) != MQ_RQ_IN_FLIGHT);
Tejun Heo5a61c362018-01-09 08:29:52 -0800533 blk_mq_rq_update_state(rq, MQ_RQ_COMPLETE);
Tejun Heo1d9bd512018-01-09 08:29:48 -0800534
Christoph Hellwig453f8342017-04-20 16:03:10 +0200535 if (rq->internal_tag != -1)
536 blk_mq_sched_completed_request(rq);
537 if (rq->rq_flags & RQF_STATS) {
538 blk_mq_poll_stats_start(rq->q);
539 blk_stat_add(rq);
540 }
541
Christoph Hellwig38535202014-04-25 02:32:53 -0700542 if (!test_bit(QUEUE_FLAG_SAME_COMP, &rq->q->queue_flags)) {
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800543 rq->q->softirq_done_fn(rq);
544 return;
545 }
Jens Axboe320ae512013-10-24 09:20:05 +0100546
547 cpu = get_cpu();
Christoph Hellwig38535202014-04-25 02:32:53 -0700548 if (!test_bit(QUEUE_FLAG_SAME_FORCE, &rq->q->queue_flags))
549 shared = cpus_share_cache(cpu, ctx->cpu);
550
551 if (cpu != ctx->cpu && !shared && cpu_online(ctx->cpu)) {
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800552 rq->csd.func = __blk_mq_complete_request_remote;
Christoph Hellwig3d6efbf2014-01-08 09:33:37 -0800553 rq->csd.info = rq;
554 rq->csd.flags = 0;
Frederic Weisbeckerc46fff22014-02-24 16:40:02 +0100555 smp_call_function_single_async(ctx->cpu, &rq->csd);
Christoph Hellwig3d6efbf2014-01-08 09:33:37 -0800556 } else {
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800557 rq->q->softirq_done_fn(rq);
Christoph Hellwig3d6efbf2014-01-08 09:33:37 -0800558 }
Jens Axboe320ae512013-10-24 09:20:05 +0100559 put_cpu();
560}
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800561
Jens Axboe04ced152018-01-09 08:29:46 -0800562static void hctx_unlock(struct blk_mq_hw_ctx *hctx, int srcu_idx)
563{
564 if (!(hctx->flags & BLK_MQ_F_BLOCKING))
565 rcu_read_unlock();
566 else
Tejun Heo05707b62018-01-09 08:29:53 -0800567 srcu_read_unlock(hctx->srcu, srcu_idx);
Jens Axboe04ced152018-01-09 08:29:46 -0800568}
569
570static void hctx_lock(struct blk_mq_hw_ctx *hctx, int *srcu_idx)
571{
Jens Axboe08b5a6e2018-01-09 09:32:25 -0700572 if (!(hctx->flags & BLK_MQ_F_BLOCKING)) {
573 /* shut up gcc false positive */
574 *srcu_idx = 0;
Jens Axboe04ced152018-01-09 08:29:46 -0800575 rcu_read_lock();
Jens Axboe08b5a6e2018-01-09 09:32:25 -0700576 } else
Tejun Heo05707b62018-01-09 08:29:53 -0800577 *srcu_idx = srcu_read_lock(hctx->srcu);
Jens Axboe04ced152018-01-09 08:29:46 -0800578}
579
Tejun Heo1d9bd512018-01-09 08:29:48 -0800580static void blk_mq_rq_update_aborted_gstate(struct request *rq, u64 gstate)
581{
582 unsigned long flags;
583
584 /*
585 * blk_mq_rq_aborted_gstate() is used from the completion path and
586 * can thus be called from irq context. u64_stats_fetch in the
587 * middle of update on the same CPU leads to lockup. Disable irq
588 * while updating.
589 */
590 local_irq_save(flags);
591 u64_stats_update_begin(&rq->aborted_gstate_sync);
592 rq->aborted_gstate = gstate;
593 u64_stats_update_end(&rq->aborted_gstate_sync);
594 local_irq_restore(flags);
595}
596
597static u64 blk_mq_rq_aborted_gstate(struct request *rq)
598{
599 unsigned int start;
600 u64 aborted_gstate;
601
602 do {
603 start = u64_stats_fetch_begin(&rq->aborted_gstate_sync);
604 aborted_gstate = rq->aborted_gstate;
605 } while (u64_stats_fetch_retry(&rq->aborted_gstate_sync, start));
606
607 return aborted_gstate;
608}
609
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800610/**
611 * blk_mq_complete_request - end I/O on a request
612 * @rq: the request being processed
613 *
614 * Description:
615 * Ends all I/O on a request. It does not handle partial completions.
616 * The actual completion happens out-of-order, through a IPI handler.
617 **/
Christoph Hellwig08e00292017-04-20 16:03:09 +0200618void blk_mq_complete_request(struct request *rq)
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800619{
Jens Axboe95f09682014-05-27 17:46:48 -0600620 struct request_queue *q = rq->q;
Tejun Heo5197c052018-01-09 08:29:47 -0800621 struct blk_mq_hw_ctx *hctx = blk_mq_map_queue(q, rq->mq_ctx->cpu);
622 int srcu_idx;
Jens Axboe95f09682014-05-27 17:46:48 -0600623
624 if (unlikely(blk_should_fake_timeout(q)))
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800625 return;
Tejun Heo5197c052018-01-09 08:29:47 -0800626
Tejun Heo1d9bd512018-01-09 08:29:48 -0800627 /*
628 * If @rq->aborted_gstate equals the current instance, timeout is
629 * claiming @rq and we lost. This is synchronized through
630 * hctx_lock(). See blk_mq_timeout_work() for details.
631 *
632 * Completion path never blocks and we can directly use RCU here
633 * instead of hctx_lock() which can be either RCU or SRCU.
634 * However, that would complicate paths which want to synchronize
635 * against us. Let stay in sync with the issue path so that
636 * hctx_lock() covers both issue and completion paths.
637 */
Tejun Heo5197c052018-01-09 08:29:47 -0800638 hctx_lock(hctx, &srcu_idx);
Tejun Heo634f9e42018-01-09 08:29:51 -0800639 if (blk_mq_rq_aborted_gstate(rq) != rq->gstate)
Jens Axboeed851862014-05-30 21:20:50 -0600640 __blk_mq_complete_request(rq);
Tejun Heo5197c052018-01-09 08:29:47 -0800641 hctx_unlock(hctx, srcu_idx);
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800642}
643EXPORT_SYMBOL(blk_mq_complete_request);
Jens Axboe320ae512013-10-24 09:20:05 +0100644
Keith Busch973c0192015-01-07 18:55:43 -0700645int blk_mq_request_started(struct request *rq)
646{
Tejun Heo5a61c362018-01-09 08:29:52 -0800647 return blk_mq_rq_state(rq) != MQ_RQ_IDLE;
Keith Busch973c0192015-01-07 18:55:43 -0700648}
649EXPORT_SYMBOL_GPL(blk_mq_request_started);
650
Christoph Hellwige2490072014-09-13 16:40:09 -0700651void blk_mq_start_request(struct request *rq)
Jens Axboe320ae512013-10-24 09:20:05 +0100652{
653 struct request_queue *q = rq->q;
654
Jens Axboebd166ef2017-01-17 06:03:22 -0700655 blk_mq_sched_started_request(rq);
656
Jens Axboe320ae512013-10-24 09:20:05 +0100657 trace_block_rq_issue(q, rq);
658
Jens Axboecf43e6b2016-11-07 21:32:37 -0700659 if (test_bit(QUEUE_FLAG_STATS, &q->queue_flags)) {
Shaohua Li88eeca42017-03-27 15:19:41 -0700660 blk_stat_set_issue(&rq->issue_stat, blk_rq_sectors(rq));
Jens Axboecf43e6b2016-11-07 21:32:37 -0700661 rq->rq_flags |= RQF_STATS;
Jens Axboe87760e52016-11-09 12:38:14 -0700662 wbt_issue(q->rq_wb, &rq->issue_stat);
Jens Axboecf43e6b2016-11-07 21:32:37 -0700663 }
664
Tejun Heo1d9bd512018-01-09 08:29:48 -0800665 WARN_ON_ONCE(blk_mq_rq_state(rq) != MQ_RQ_IDLE);
Jens Axboe538b7532014-09-16 10:37:37 -0600666
667 /*
Tejun Heo1d9bd512018-01-09 08:29:48 -0800668 * Mark @rq in-flight which also advances the generation number,
669 * and register for timeout. Protect with a seqcount to allow the
670 * timeout path to read both @rq->gstate and @rq->deadline
671 * coherently.
Peter Zijlstraa7af0af2017-09-06 10:00:22 +0200672 *
Tejun Heo1d9bd512018-01-09 08:29:48 -0800673 * This is the only place where a request is marked in-flight. If
674 * the timeout path reads an in-flight @rq->gstate, the
675 * @rq->deadline it reads together under @rq->gstate_seq is
676 * guaranteed to be the matching one.
Jens Axboe87ee7b12014-04-24 08:51:47 -0600677 */
Tejun Heo1d9bd512018-01-09 08:29:48 -0800678 preempt_disable();
679 write_seqcount_begin(&rq->gstate_seq);
680
681 blk_mq_rq_update_state(rq, MQ_RQ_IN_FLIGHT);
682 blk_add_timer(rq);
683
684 write_seqcount_end(&rq->gstate_seq);
685 preempt_enable();
686
Christoph Hellwig49f5baa2014-02-11 08:27:14 -0800687 if (q->dma_drain_size && blk_rq_bytes(rq)) {
688 /*
689 * Make sure space for the drain appears. We know we can do
690 * this because max_hw_segments has been adjusted to be one
691 * fewer than the device can handle.
692 */
693 rq->nr_phys_segments++;
694 }
Jens Axboe320ae512013-10-24 09:20:05 +0100695}
Christoph Hellwige2490072014-09-13 16:40:09 -0700696EXPORT_SYMBOL(blk_mq_start_request);
Jens Axboe320ae512013-10-24 09:20:05 +0100697
Ming Leid9d149a2017-03-27 20:06:55 +0800698/*
Tejun Heo5a61c362018-01-09 08:29:52 -0800699 * When we reach here because queue is busy, it's safe to change the state
700 * to IDLE without checking @rq->aborted_gstate because we should still be
701 * holding the RCU read lock and thus protected against timeout.
Ming Leid9d149a2017-03-27 20:06:55 +0800702 */
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200703static void __blk_mq_requeue_request(struct request *rq)
Jens Axboe320ae512013-10-24 09:20:05 +0100704{
705 struct request_queue *q = rq->q;
706
Ming Lei923218f2017-11-02 23:24:38 +0800707 blk_mq_put_driver_tag(rq);
708
Jens Axboe320ae512013-10-24 09:20:05 +0100709 trace_block_rq_requeue(q, rq);
Jens Axboe87760e52016-11-09 12:38:14 -0700710 wbt_requeue(q->rq_wb, &rq->issue_stat);
Jens Axboebd166ef2017-01-17 06:03:22 -0700711 blk_mq_sched_requeue_request(rq);
Christoph Hellwig49f5baa2014-02-11 08:27:14 -0800712
Tejun Heo5a61c362018-01-09 08:29:52 -0800713 if (blk_mq_rq_state(rq) != MQ_RQ_IDLE) {
Tejun Heo1d9bd512018-01-09 08:29:48 -0800714 blk_mq_rq_update_state(rq, MQ_RQ_IDLE);
Christoph Hellwige2490072014-09-13 16:40:09 -0700715 if (q->dma_drain_size && blk_rq_bytes(rq))
716 rq->nr_phys_segments--;
717 }
Jens Axboe320ae512013-10-24 09:20:05 +0100718}
719
Bart Van Assche2b053ac2016-10-28 17:21:41 -0700720void blk_mq_requeue_request(struct request *rq, bool kick_requeue_list)
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200721{
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200722 __blk_mq_requeue_request(rq);
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200723
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200724 BUG_ON(blk_queued_rq(rq));
Bart Van Assche2b053ac2016-10-28 17:21:41 -0700725 blk_mq_add_to_requeue_list(rq, true, kick_requeue_list);
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200726}
727EXPORT_SYMBOL(blk_mq_requeue_request);
728
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600729static void blk_mq_requeue_work(struct work_struct *work)
730{
731 struct request_queue *q =
Mike Snitzer28494502016-09-14 13:28:30 -0400732 container_of(work, struct request_queue, requeue_work.work);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600733 LIST_HEAD(rq_list);
734 struct request *rq, *next;
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600735
Jens Axboe18e97812017-07-27 08:03:57 -0600736 spin_lock_irq(&q->requeue_lock);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600737 list_splice_init(&q->requeue_list, &rq_list);
Jens Axboe18e97812017-07-27 08:03:57 -0600738 spin_unlock_irq(&q->requeue_lock);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600739
740 list_for_each_entry_safe(rq, next, &rq_list, queuelist) {
Christoph Hellwige8064022016-10-20 15:12:13 +0200741 if (!(rq->rq_flags & RQF_SOFTBARRIER))
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600742 continue;
743
Christoph Hellwige8064022016-10-20 15:12:13 +0200744 rq->rq_flags &= ~RQF_SOFTBARRIER;
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600745 list_del_init(&rq->queuelist);
Jens Axboebd6737f2017-01-27 01:00:47 -0700746 blk_mq_sched_insert_request(rq, true, false, false, true);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600747 }
748
749 while (!list_empty(&rq_list)) {
750 rq = list_entry(rq_list.next, struct request, queuelist);
751 list_del_init(&rq->queuelist);
Jens Axboebd6737f2017-01-27 01:00:47 -0700752 blk_mq_sched_insert_request(rq, false, false, false, true);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600753 }
754
Bart Van Assche52d7f1b2016-10-28 17:20:32 -0700755 blk_mq_run_hw_queues(q, false);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600756}
757
Bart Van Assche2b053ac2016-10-28 17:21:41 -0700758void blk_mq_add_to_requeue_list(struct request *rq, bool at_head,
759 bool kick_requeue_list)
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600760{
761 struct request_queue *q = rq->q;
762 unsigned long flags;
763
764 /*
765 * We abuse this flag that is otherwise used by the I/O scheduler to
Jens Axboeff821d22017-11-10 22:05:12 -0700766 * request head insertion from the workqueue.
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600767 */
Christoph Hellwige8064022016-10-20 15:12:13 +0200768 BUG_ON(rq->rq_flags & RQF_SOFTBARRIER);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600769
770 spin_lock_irqsave(&q->requeue_lock, flags);
771 if (at_head) {
Christoph Hellwige8064022016-10-20 15:12:13 +0200772 rq->rq_flags |= RQF_SOFTBARRIER;
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600773 list_add(&rq->queuelist, &q->requeue_list);
774 } else {
775 list_add_tail(&rq->queuelist, &q->requeue_list);
776 }
777 spin_unlock_irqrestore(&q->requeue_lock, flags);
Bart Van Assche2b053ac2016-10-28 17:21:41 -0700778
779 if (kick_requeue_list)
780 blk_mq_kick_requeue_list(q);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600781}
782EXPORT_SYMBOL(blk_mq_add_to_requeue_list);
783
784void blk_mq_kick_requeue_list(struct request_queue *q)
785{
Mike Snitzer28494502016-09-14 13:28:30 -0400786 kblockd_schedule_delayed_work(&q->requeue_work, 0);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600787}
788EXPORT_SYMBOL(blk_mq_kick_requeue_list);
789
Mike Snitzer28494502016-09-14 13:28:30 -0400790void blk_mq_delay_kick_requeue_list(struct request_queue *q,
791 unsigned long msecs)
792{
Bart Van Assched4acf362017-08-09 11:28:06 -0700793 kblockd_mod_delayed_work_on(WORK_CPU_UNBOUND, &q->requeue_work,
794 msecs_to_jiffies(msecs));
Mike Snitzer28494502016-09-14 13:28:30 -0400795}
796EXPORT_SYMBOL(blk_mq_delay_kick_requeue_list);
797
Jens Axboe0e62f512014-06-04 10:23:49 -0600798struct request *blk_mq_tag_to_rq(struct blk_mq_tags *tags, unsigned int tag)
799{
Jens Axboe88c7b2b2016-08-25 08:07:30 -0600800 if (tag < tags->nr_tags) {
801 prefetch(tags->rqs[tag]);
Hannes Reinecke4ee86ba2016-03-15 12:03:28 -0700802 return tags->rqs[tag];
Jens Axboe88c7b2b2016-08-25 08:07:30 -0600803 }
Hannes Reinecke4ee86ba2016-03-15 12:03:28 -0700804
805 return NULL;
Christoph Hellwig24d2f902014-04-15 14:14:00 -0600806}
807EXPORT_SYMBOL(blk_mq_tag_to_rq);
808
Jens Axboe320ae512013-10-24 09:20:05 +0100809struct blk_mq_timeout_data {
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700810 unsigned long next;
811 unsigned int next_set;
Tejun Heo1d9bd512018-01-09 08:29:48 -0800812 unsigned int nr_expired;
Jens Axboe320ae512013-10-24 09:20:05 +0100813};
814
Tejun Heo358f70d2018-01-09 08:29:50 -0800815static void blk_mq_rq_timed_out(struct request *req, bool reserved)
Jens Axboe320ae512013-10-24 09:20:05 +0100816{
Jens Axboef8a5b122016-12-13 09:24:51 -0700817 const struct blk_mq_ops *ops = req->q->mq_ops;
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700818 enum blk_eh_timer_return ret = BLK_EH_RESET_TIMER;
Jens Axboe87ee7b12014-04-24 08:51:47 -0600819
Tejun Heo634f9e42018-01-09 08:29:51 -0800820 req->rq_flags |= RQF_MQ_TIMEOUT_EXPIRED;
821
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700822 if (ops->timeout)
Christoph Hellwig0152fb62014-09-13 16:40:13 -0700823 ret = ops->timeout(req, reserved);
Jens Axboe87ee7b12014-04-24 08:51:47 -0600824
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700825 switch (ret) {
826 case BLK_EH_HANDLED:
827 __blk_mq_complete_request(req);
828 break;
829 case BLK_EH_RESET_TIMER:
Tejun Heo1d9bd512018-01-09 08:29:48 -0800830 /*
831 * As nothing prevents from completion happening while
832 * ->aborted_gstate is set, this may lead to ignored
833 * completions and further spurious timeouts.
834 */
835 blk_mq_rq_update_aborted_gstate(req, 0);
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700836 blk_add_timer(req);
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700837 break;
838 case BLK_EH_NOT_HANDLED:
839 break;
840 default:
841 printk(KERN_ERR "block: bad eh return: %d\n", ret);
842 break;
843 }
Jens Axboe87ee7b12014-04-24 08:51:47 -0600844}
Keith Busch5b3f25f2015-01-07 18:55:46 -0700845
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700846static void blk_mq_check_expired(struct blk_mq_hw_ctx *hctx,
847 struct request *rq, void *priv, bool reserved)
Jens Axboe320ae512013-10-24 09:20:05 +0100848{
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700849 struct blk_mq_timeout_data *data = priv;
Tejun Heo1d9bd512018-01-09 08:29:48 -0800850 unsigned long gstate, deadline;
851 int start;
852
853 might_sleep();
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700854
Tejun Heo5a61c362018-01-09 08:29:52 -0800855 if (rq->rq_flags & RQF_MQ_TIMEOUT_EXPIRED)
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700856 return;
Jens Axboe320ae512013-10-24 09:20:05 +0100857
Tejun Heo1d9bd512018-01-09 08:29:48 -0800858 /* read coherent snapshots of @rq->state_gen and @rq->deadline */
859 while (true) {
860 start = read_seqcount_begin(&rq->gstate_seq);
861 gstate = READ_ONCE(rq->gstate);
862 deadline = rq->deadline;
863 if (!read_seqcount_retry(&rq->gstate_seq, start))
864 break;
865 cond_resched();
866 }
Peter Zijlstraa7af0af2017-09-06 10:00:22 +0200867
Tejun Heo1d9bd512018-01-09 08:29:48 -0800868 /* if in-flight && overdue, mark for abortion */
869 if ((gstate & MQ_RQ_STATE_MASK) == MQ_RQ_IN_FLIGHT &&
870 time_after_eq(jiffies, deadline)) {
871 blk_mq_rq_update_aborted_gstate(rq, gstate);
872 data->nr_expired++;
873 hctx->nr_expired++;
Peter Zijlstraa7af0af2017-09-06 10:00:22 +0200874 } else if (!data->next_set || time_after(data->next, deadline)) {
875 data->next = deadline;
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700876 data->next_set = 1;
877 }
Jens Axboe320ae512013-10-24 09:20:05 +0100878}
879
Tejun Heo1d9bd512018-01-09 08:29:48 -0800880static void blk_mq_terminate_expired(struct blk_mq_hw_ctx *hctx,
881 struct request *rq, void *priv, bool reserved)
882{
883 /*
884 * We marked @rq->aborted_gstate and waited for RCU. If there were
885 * completions that we lost to, they would have finished and
886 * updated @rq->gstate by now; otherwise, the completion path is
887 * now guaranteed to see @rq->aborted_gstate and yield. If
888 * @rq->aborted_gstate still matches @rq->gstate, @rq is ours.
889 */
Tejun Heo634f9e42018-01-09 08:29:51 -0800890 if (!(rq->rq_flags & RQF_MQ_TIMEOUT_EXPIRED) &&
891 READ_ONCE(rq->gstate) == rq->aborted_gstate)
Tejun Heo1d9bd512018-01-09 08:29:48 -0800892 blk_mq_rq_timed_out(rq, reserved);
893}
894
Christoph Hellwig287922e2015-10-30 20:57:30 +0800895static void blk_mq_timeout_work(struct work_struct *work)
Jens Axboe320ae512013-10-24 09:20:05 +0100896{
Christoph Hellwig287922e2015-10-30 20:57:30 +0800897 struct request_queue *q =
898 container_of(work, struct request_queue, timeout_work);
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700899 struct blk_mq_timeout_data data = {
900 .next = 0,
901 .next_set = 0,
Tejun Heo1d9bd512018-01-09 08:29:48 -0800902 .nr_expired = 0,
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700903 };
Tejun Heo1d9bd512018-01-09 08:29:48 -0800904 struct blk_mq_hw_ctx *hctx;
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700905 int i;
Jens Axboe320ae512013-10-24 09:20:05 +0100906
Gabriel Krisman Bertazi71f79fb2016-08-01 08:23:39 -0600907 /* A deadlock might occur if a request is stuck requiring a
908 * timeout at the same time a queue freeze is waiting
909 * completion, since the timeout code would not be able to
910 * acquire the queue reference here.
911 *
912 * That's why we don't use blk_queue_enter here; instead, we use
913 * percpu_ref_tryget directly, because we need to be able to
914 * obtain a reference even in the short window between the queue
915 * starting to freeze, by dropping the first reference in
Ming Lei1671d522017-03-27 20:06:57 +0800916 * blk_freeze_queue_start, and the moment the last request is
Gabriel Krisman Bertazi71f79fb2016-08-01 08:23:39 -0600917 * consumed, marked by the instant q_usage_counter reaches
918 * zero.
919 */
920 if (!percpu_ref_tryget(&q->q_usage_counter))
Christoph Hellwig287922e2015-10-30 20:57:30 +0800921 return;
922
Tejun Heo1d9bd512018-01-09 08:29:48 -0800923 /* scan for the expired ones and set their ->aborted_gstate */
Christoph Hellwig0bf6cd52015-09-27 21:01:51 +0200924 blk_mq_queue_tag_busy_iter(q, blk_mq_check_expired, &data);
Jens Axboe320ae512013-10-24 09:20:05 +0100925
Tejun Heo1d9bd512018-01-09 08:29:48 -0800926 if (data.nr_expired) {
927 bool has_rcu = false;
928
929 /*
930 * Wait till everyone sees ->aborted_gstate. The
931 * sequential waits for SRCUs aren't ideal. If this ever
932 * becomes a problem, we can add per-hw_ctx rcu_head and
933 * wait in parallel.
934 */
935 queue_for_each_hw_ctx(q, hctx, i) {
936 if (!hctx->nr_expired)
937 continue;
938
939 if (!(hctx->flags & BLK_MQ_F_BLOCKING))
940 has_rcu = true;
941 else
Tejun Heo05707b62018-01-09 08:29:53 -0800942 synchronize_srcu(hctx->srcu);
Tejun Heo1d9bd512018-01-09 08:29:48 -0800943
944 hctx->nr_expired = 0;
945 }
946 if (has_rcu)
947 synchronize_rcu();
948
949 /* terminate the ones we won */
950 blk_mq_queue_tag_busy_iter(q, blk_mq_terminate_expired, NULL);
951 }
952
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700953 if (data.next_set) {
954 data.next = blk_rq_timeout(round_jiffies_up(data.next));
955 mod_timer(&q->timeout, data.next);
Jens Axboe0d2602c2014-05-13 15:10:52 -0600956 } else {
Bart Van Asschefcd36c32018-01-10 08:33:33 -0800957 /*
958 * Request timeouts are handled as a forward rolling timer. If
959 * we end up here it means that no requests are pending and
960 * also that no request has been pending for a while. Mark
961 * each hctx as idle.
962 */
Ming Leif054b562015-04-21 10:00:19 +0800963 queue_for_each_hw_ctx(q, hctx, i) {
964 /* the hctx may be unmapped, so check it here */
965 if (blk_mq_hw_queue_mapped(hctx))
966 blk_mq_tag_idle(hctx);
967 }
Jens Axboe0d2602c2014-05-13 15:10:52 -0600968 }
Christoph Hellwig287922e2015-10-30 20:57:30 +0800969 blk_queue_exit(q);
Jens Axboe320ae512013-10-24 09:20:05 +0100970}
971
Omar Sandoval88459642016-09-17 08:38:44 -0600972struct flush_busy_ctx_data {
973 struct blk_mq_hw_ctx *hctx;
974 struct list_head *list;
975};
976
977static bool flush_busy_ctx(struct sbitmap *sb, unsigned int bitnr, void *data)
978{
979 struct flush_busy_ctx_data *flush_data = data;
980 struct blk_mq_hw_ctx *hctx = flush_data->hctx;
981 struct blk_mq_ctx *ctx = hctx->ctxs[bitnr];
982
983 sbitmap_clear_bit(sb, bitnr);
984 spin_lock(&ctx->lock);
985 list_splice_tail_init(&ctx->rq_list, flush_data->list);
986 spin_unlock(&ctx->lock);
987 return true;
988}
989
Jens Axboe320ae512013-10-24 09:20:05 +0100990/*
Jens Axboe1429d7c2014-05-19 09:23:55 -0600991 * Process software queues that have been marked busy, splicing them
992 * to the for-dispatch
993 */
Jens Axboe2c3ad662016-12-14 14:34:47 -0700994void blk_mq_flush_busy_ctxs(struct blk_mq_hw_ctx *hctx, struct list_head *list)
Jens Axboe1429d7c2014-05-19 09:23:55 -0600995{
Omar Sandoval88459642016-09-17 08:38:44 -0600996 struct flush_busy_ctx_data data = {
997 .hctx = hctx,
998 .list = list,
999 };
Jens Axboe1429d7c2014-05-19 09:23:55 -06001000
Omar Sandoval88459642016-09-17 08:38:44 -06001001 sbitmap_for_each_set(&hctx->ctx_map, flush_busy_ctx, &data);
Jens Axboe1429d7c2014-05-19 09:23:55 -06001002}
Jens Axboe2c3ad662016-12-14 14:34:47 -07001003EXPORT_SYMBOL_GPL(blk_mq_flush_busy_ctxs);
Jens Axboe1429d7c2014-05-19 09:23:55 -06001004
Ming Leib3476892017-10-14 17:22:30 +08001005struct dispatch_rq_data {
1006 struct blk_mq_hw_ctx *hctx;
1007 struct request *rq;
1008};
1009
1010static bool dispatch_rq_from_ctx(struct sbitmap *sb, unsigned int bitnr,
1011 void *data)
1012{
1013 struct dispatch_rq_data *dispatch_data = data;
1014 struct blk_mq_hw_ctx *hctx = dispatch_data->hctx;
1015 struct blk_mq_ctx *ctx = hctx->ctxs[bitnr];
1016
1017 spin_lock(&ctx->lock);
1018 if (unlikely(!list_empty(&ctx->rq_list))) {
1019 dispatch_data->rq = list_entry_rq(ctx->rq_list.next);
1020 list_del_init(&dispatch_data->rq->queuelist);
1021 if (list_empty(&ctx->rq_list))
1022 sbitmap_clear_bit(sb, bitnr);
1023 }
1024 spin_unlock(&ctx->lock);
1025
1026 return !dispatch_data->rq;
1027}
1028
1029struct request *blk_mq_dequeue_from_ctx(struct blk_mq_hw_ctx *hctx,
1030 struct blk_mq_ctx *start)
1031{
1032 unsigned off = start ? start->index_hw : 0;
1033 struct dispatch_rq_data data = {
1034 .hctx = hctx,
1035 .rq = NULL,
1036 };
1037
1038 __sbitmap_for_each_set(&hctx->ctx_map, off,
1039 dispatch_rq_from_ctx, &data);
1040
1041 return data.rq;
1042}
1043
Jens Axboe703fd1c2016-09-16 13:59:14 -06001044static inline unsigned int queued_to_index(unsigned int queued)
1045{
1046 if (!queued)
1047 return 0;
Jens Axboe1429d7c2014-05-19 09:23:55 -06001048
Jens Axboe703fd1c2016-09-16 13:59:14 -06001049 return min(BLK_MQ_MAX_DISPATCH_ORDER - 1, ilog2(queued) + 1);
Jens Axboe1429d7c2014-05-19 09:23:55 -06001050}
1051
Jens Axboebd6737f2017-01-27 01:00:47 -07001052bool blk_mq_get_driver_tag(struct request *rq, struct blk_mq_hw_ctx **hctx,
1053 bool wait)
Jens Axboebd166ef2017-01-17 06:03:22 -07001054{
1055 struct blk_mq_alloc_data data = {
1056 .q = rq->q,
Jens Axboebd166ef2017-01-17 06:03:22 -07001057 .hctx = blk_mq_map_queue(rq->q, rq->mq_ctx->cpu),
1058 .flags = wait ? 0 : BLK_MQ_REQ_NOWAIT,
1059 };
1060
Jens Axboe5feeacd2017-04-20 17:23:13 -06001061 might_sleep_if(wait);
1062
Omar Sandoval81380ca2017-04-07 08:56:26 -06001063 if (rq->tag != -1)
1064 goto done;
Jens Axboebd166ef2017-01-17 06:03:22 -07001065
Sagi Grimberg415b8062017-02-27 10:04:39 -07001066 if (blk_mq_tag_is_reserved(data.hctx->sched_tags, rq->internal_tag))
1067 data.flags |= BLK_MQ_REQ_RESERVED;
1068
Jens Axboebd166ef2017-01-17 06:03:22 -07001069 rq->tag = blk_mq_get_tag(&data);
1070 if (rq->tag >= 0) {
Jens Axboe200e86b2017-01-25 08:11:38 -07001071 if (blk_mq_tag_busy(data.hctx)) {
1072 rq->rq_flags |= RQF_MQ_INFLIGHT;
1073 atomic_inc(&data.hctx->nr_active);
1074 }
Jens Axboebd166ef2017-01-17 06:03:22 -07001075 data.hctx->tags->rqs[rq->tag] = rq;
Jens Axboebd166ef2017-01-17 06:03:22 -07001076 }
1077
Omar Sandoval81380ca2017-04-07 08:56:26 -06001078done:
1079 if (hctx)
1080 *hctx = data.hctx;
1081 return rq->tag != -1;
Jens Axboebd166ef2017-01-17 06:03:22 -07001082}
1083
Jens Axboeeb619fd2017-11-09 08:32:43 -07001084static int blk_mq_dispatch_wake(wait_queue_entry_t *wait, unsigned mode,
1085 int flags, void *key)
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001086{
1087 struct blk_mq_hw_ctx *hctx;
1088
1089 hctx = container_of(wait, struct blk_mq_hw_ctx, dispatch_wait);
1090
Jens Axboeeb619fd2017-11-09 08:32:43 -07001091 list_del_init(&wait->entry);
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001092 blk_mq_run_hw_queue(hctx, true);
1093 return 1;
1094}
1095
Jens Axboef906a6a2017-11-09 16:10:13 -07001096/*
1097 * Mark us waiting for a tag. For shared tags, this involves hooking us into
Bart Van Asscheee3e4de2018-01-09 10:09:15 -08001098 * the tag wakeups. For non-shared tags, we can simply mark us needing a
1099 * restart. For both cases, take care to check the condition again after
Jens Axboef906a6a2017-11-09 16:10:13 -07001100 * marking us as waiting.
1101 */
1102static bool blk_mq_mark_tag_wait(struct blk_mq_hw_ctx **hctx,
1103 struct request *rq)
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001104{
Jens Axboeeb619fd2017-11-09 08:32:43 -07001105 struct blk_mq_hw_ctx *this_hctx = *hctx;
Jens Axboef906a6a2017-11-09 16:10:13 -07001106 bool shared_tags = (this_hctx->flags & BLK_MQ_F_TAG_SHARED) != 0;
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001107 struct sbq_wait_state *ws;
Jens Axboef906a6a2017-11-09 16:10:13 -07001108 wait_queue_entry_t *wait;
1109 bool ret;
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001110
Jens Axboef906a6a2017-11-09 16:10:13 -07001111 if (!shared_tags) {
1112 if (!test_bit(BLK_MQ_S_SCHED_RESTART, &this_hctx->state))
1113 set_bit(BLK_MQ_S_SCHED_RESTART, &this_hctx->state);
1114 } else {
1115 wait = &this_hctx->dispatch_wait;
1116 if (!list_empty_careful(&wait->entry))
1117 return false;
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001118
Jens Axboef906a6a2017-11-09 16:10:13 -07001119 spin_lock(&this_hctx->lock);
1120 if (!list_empty(&wait->entry)) {
1121 spin_unlock(&this_hctx->lock);
1122 return false;
1123 }
1124
1125 ws = bt_wait_ptr(&this_hctx->tags->bitmap_tags, this_hctx);
1126 add_wait_queue(&ws->wait, wait);
Jens Axboeeb619fd2017-11-09 08:32:43 -07001127 }
1128
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001129 /*
Jens Axboeeb619fd2017-11-09 08:32:43 -07001130 * It's possible that a tag was freed in the window between the
1131 * allocation failure and adding the hardware queue to the wait
1132 * queue.
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001133 */
Jens Axboef906a6a2017-11-09 16:10:13 -07001134 ret = blk_mq_get_driver_tag(rq, hctx, false);
Jens Axboeeb619fd2017-11-09 08:32:43 -07001135
Jens Axboef906a6a2017-11-09 16:10:13 -07001136 if (!shared_tags) {
1137 /*
1138 * Don't clear RESTART here, someone else could have set it.
1139 * At most this will cost an extra queue run.
1140 */
1141 return ret;
1142 } else {
1143 if (!ret) {
1144 spin_unlock(&this_hctx->lock);
1145 return false;
1146 }
1147
1148 /*
1149 * We got a tag, remove ourselves from the wait queue to ensure
1150 * someone else gets the wakeup.
1151 */
1152 spin_lock_irq(&ws->wait.lock);
1153 list_del_init(&wait->entry);
1154 spin_unlock_irq(&ws->wait.lock);
1155 spin_unlock(&this_hctx->lock);
1156 return true;
1157 }
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001158}
1159
Ming Leide148292017-10-14 17:22:29 +08001160bool blk_mq_dispatch_rq_list(struct request_queue *q, struct list_head *list,
Jens Axboeeb619fd2017-11-09 08:32:43 -07001161 bool got_budget)
Jens Axboef04c3df2016-12-07 08:41:17 -07001162{
Omar Sandoval81380ca2017-04-07 08:56:26 -06001163 struct blk_mq_hw_ctx *hctx;
Jianchao Wang6d6f167c2017-11-02 23:24:32 +08001164 struct request *rq, *nxt;
Jens Axboeeb619fd2017-11-09 08:32:43 -07001165 bool no_tag = false;
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001166 int errors, queued;
Jens Axboef04c3df2016-12-07 08:41:17 -07001167
Omar Sandoval81380ca2017-04-07 08:56:26 -06001168 if (list_empty(list))
1169 return false;
1170
Ming Leide148292017-10-14 17:22:29 +08001171 WARN_ON(!list_is_singular(list) && got_budget);
1172
Jens Axboef04c3df2016-12-07 08:41:17 -07001173 /*
Jens Axboef04c3df2016-12-07 08:41:17 -07001174 * Now process all the entries, sending them to the driver.
1175 */
Jens Axboe93efe982017-03-24 12:04:19 -06001176 errors = queued = 0;
Omar Sandoval81380ca2017-04-07 08:56:26 -06001177 do {
Jens Axboef04c3df2016-12-07 08:41:17 -07001178 struct blk_mq_queue_data bd;
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001179 blk_status_t ret;
Jens Axboef04c3df2016-12-07 08:41:17 -07001180
1181 rq = list_first_entry(list, struct request, queuelist);
Jens Axboebd166ef2017-01-17 06:03:22 -07001182 if (!blk_mq_get_driver_tag(rq, &hctx, false)) {
Jens Axboe3c782d62017-01-26 12:50:36 -07001183 /*
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001184 * The initial allocation attempt failed, so we need to
Jens Axboeeb619fd2017-11-09 08:32:43 -07001185 * rerun the hardware queue when a tag is freed. The
1186 * waitqueue takes care of that. If the queue is run
1187 * before we add this entry back on the dispatch list,
1188 * we'll re-run it below.
Jens Axboe3c782d62017-01-26 12:50:36 -07001189 */
Jens Axboef906a6a2017-11-09 16:10:13 -07001190 if (!blk_mq_mark_tag_wait(&hctx, rq)) {
Ming Leide148292017-10-14 17:22:29 +08001191 if (got_budget)
1192 blk_mq_put_dispatch_budget(hctx);
Jens Axboef906a6a2017-11-09 16:10:13 -07001193 /*
1194 * For non-shared tags, the RESTART check
1195 * will suffice.
1196 */
1197 if (hctx->flags & BLK_MQ_F_TAG_SHARED)
1198 no_tag = true;
Omar Sandoval807b1042017-04-05 12:01:35 -07001199 break;
Ming Leide148292017-10-14 17:22:29 +08001200 }
1201 }
1202
Ming Lei0c6af1c2017-11-08 09:11:22 +08001203 if (!got_budget && !blk_mq_get_dispatch_budget(hctx)) {
1204 blk_mq_put_driver_tag(rq);
Ming Lei88022d72017-11-05 02:21:12 +08001205 break;
Ming Lei0c6af1c2017-11-08 09:11:22 +08001206 }
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001207
Jens Axboef04c3df2016-12-07 08:41:17 -07001208 list_del_init(&rq->queuelist);
1209
1210 bd.rq = rq;
Jens Axboe113285b2017-03-02 13:26:04 -07001211
1212 /*
1213 * Flag last if we have no more requests, or if we have more
1214 * but can't assign a driver tag to it.
1215 */
1216 if (list_empty(list))
1217 bd.last = true;
1218 else {
Jens Axboe113285b2017-03-02 13:26:04 -07001219 nxt = list_first_entry(list, struct request, queuelist);
1220 bd.last = !blk_mq_get_driver_tag(nxt, NULL, false);
1221 }
Jens Axboef04c3df2016-12-07 08:41:17 -07001222
1223 ret = q->mq_ops->queue_rq(hctx, &bd);
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001224 if (ret == BLK_STS_RESOURCE) {
Jianchao Wang6d6f167c2017-11-02 23:24:32 +08001225 /*
1226 * If an I/O scheduler has been configured and we got a
Jens Axboeff821d22017-11-10 22:05:12 -07001227 * driver tag for the next request already, free it
1228 * again.
Jianchao Wang6d6f167c2017-11-02 23:24:32 +08001229 */
1230 if (!list_empty(list)) {
1231 nxt = list_first_entry(list, struct request, queuelist);
1232 blk_mq_put_driver_tag(nxt);
1233 }
Jens Axboef04c3df2016-12-07 08:41:17 -07001234 list_add(&rq->queuelist, list);
1235 __blk_mq_requeue_request(rq);
1236 break;
Jens Axboef04c3df2016-12-07 08:41:17 -07001237 }
1238
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001239 if (unlikely(ret != BLK_STS_OK)) {
1240 errors++;
1241 blk_mq_end_request(rq, BLK_STS_IOERR);
1242 continue;
1243 }
1244
1245 queued++;
Omar Sandoval81380ca2017-04-07 08:56:26 -06001246 } while (!list_empty(list));
Jens Axboef04c3df2016-12-07 08:41:17 -07001247
1248 hctx->dispatched[queued_to_index(queued)]++;
1249
1250 /*
1251 * Any items that need requeuing? Stuff them into hctx->dispatch,
1252 * that is where we will continue on next queue run.
1253 */
1254 if (!list_empty(list)) {
1255 spin_lock(&hctx->lock);
Jens Axboec13660a2017-01-26 12:40:07 -07001256 list_splice_init(list, &hctx->dispatch);
Jens Axboef04c3df2016-12-07 08:41:17 -07001257 spin_unlock(&hctx->lock);
1258
1259 /*
Bart Van Assche710c7852017-04-07 11:16:51 -07001260 * If SCHED_RESTART was set by the caller of this function and
1261 * it is no longer set that means that it was cleared by another
1262 * thread and hence that a queue rerun is needed.
Jens Axboef04c3df2016-12-07 08:41:17 -07001263 *
Jens Axboeeb619fd2017-11-09 08:32:43 -07001264 * If 'no_tag' is set, that means that we failed getting
1265 * a driver tag with an I/O scheduler attached. If our dispatch
1266 * waitqueue is no longer active, ensure that we run the queue
1267 * AFTER adding our entries back to the list.
Jens Axboebd166ef2017-01-17 06:03:22 -07001268 *
Bart Van Assche710c7852017-04-07 11:16:51 -07001269 * If no I/O scheduler has been configured it is possible that
1270 * the hardware queue got stopped and restarted before requests
1271 * were pushed back onto the dispatch list. Rerun the queue to
1272 * avoid starvation. Notes:
1273 * - blk_mq_run_hw_queue() checks whether or not a queue has
1274 * been stopped before rerunning a queue.
1275 * - Some but not all block drivers stop a queue before
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001276 * returning BLK_STS_RESOURCE. Two exceptions are scsi-mq
Bart Van Assche710c7852017-04-07 11:16:51 -07001277 * and dm-rq.
Jens Axboebd166ef2017-01-17 06:03:22 -07001278 */
Jens Axboeeb619fd2017-11-09 08:32:43 -07001279 if (!blk_mq_sched_needs_restart(hctx) ||
1280 (no_tag && list_empty_careful(&hctx->dispatch_wait.entry)))
Jens Axboebd166ef2017-01-17 06:03:22 -07001281 blk_mq_run_hw_queue(hctx, true);
Jens Axboef04c3df2016-12-07 08:41:17 -07001282 }
1283
Jens Axboe93efe982017-03-24 12:04:19 -06001284 return (queued + errors) != 0;
Jens Axboef04c3df2016-12-07 08:41:17 -07001285}
1286
Bart Van Assche6a83e742016-11-02 10:09:51 -06001287static void __blk_mq_run_hw_queue(struct blk_mq_hw_ctx *hctx)
1288{
1289 int srcu_idx;
1290
Jens Axboeb7a71e62017-08-01 09:28:24 -06001291 /*
1292 * We should be running this queue from one of the CPUs that
1293 * are mapped to it.
1294 */
Bart Van Assche6a83e742016-11-02 10:09:51 -06001295 WARN_ON(!cpumask_test_cpu(raw_smp_processor_id(), hctx->cpumask) &&
1296 cpu_online(hctx->next_cpu));
1297
Jens Axboeb7a71e62017-08-01 09:28:24 -06001298 /*
1299 * We can't run the queue inline with ints disabled. Ensure that
1300 * we catch bad users of this early.
1301 */
1302 WARN_ON_ONCE(in_interrupt());
1303
Jens Axboe04ced152018-01-09 08:29:46 -08001304 might_sleep_if(hctx->flags & BLK_MQ_F_BLOCKING);
Jens Axboebf4907c2017-03-30 12:30:39 -06001305
Jens Axboe04ced152018-01-09 08:29:46 -08001306 hctx_lock(hctx, &srcu_idx);
1307 blk_mq_sched_dispatch_requests(hctx);
1308 hctx_unlock(hctx, srcu_idx);
Bart Van Assche6a83e742016-11-02 10:09:51 -06001309}
1310
Jens Axboe506e9312014-05-07 10:26:44 -06001311/*
1312 * It'd be great if the workqueue API had a way to pass
1313 * in a mask and had some smarts for more clever placement.
1314 * For now we just round-robin here, switching for every
1315 * BLK_MQ_CPU_WORK_BATCH queued items.
1316 */
1317static int blk_mq_hctx_next_cpu(struct blk_mq_hw_ctx *hctx)
1318{
Christoph Hellwigb657d7e2014-11-24 09:27:23 +01001319 if (hctx->queue->nr_hw_queues == 1)
1320 return WORK_CPU_UNBOUND;
Jens Axboe506e9312014-05-07 10:26:44 -06001321
1322 if (--hctx->next_cpu_batch <= 0) {
Gabriel Krisman Bertazic02ebfd2016-09-28 00:24:24 -03001323 int next_cpu;
Jens Axboe506e9312014-05-07 10:26:44 -06001324
1325 next_cpu = cpumask_next(hctx->next_cpu, hctx->cpumask);
1326 if (next_cpu >= nr_cpu_ids)
1327 next_cpu = cpumask_first(hctx->cpumask);
1328
1329 hctx->next_cpu = next_cpu;
1330 hctx->next_cpu_batch = BLK_MQ_CPU_WORK_BATCH;
1331 }
1332
Christoph Hellwigb657d7e2014-11-24 09:27:23 +01001333 return hctx->next_cpu;
Jens Axboe506e9312014-05-07 10:26:44 -06001334}
1335
Bart Van Assche7587a5a2017-04-07 11:16:52 -07001336static void __blk_mq_delay_run_hw_queue(struct blk_mq_hw_ctx *hctx, bool async,
1337 unsigned long msecs)
Jens Axboe320ae512013-10-24 09:20:05 +01001338{
Bart Van Assche5435c022017-06-20 11:15:49 -07001339 if (WARN_ON_ONCE(!blk_mq_hw_queue_mapped(hctx)))
1340 return;
1341
1342 if (unlikely(blk_mq_hctx_stopped(hctx)))
Jens Axboe320ae512013-10-24 09:20:05 +01001343 return;
1344
Jens Axboe1b792f22016-09-21 10:12:13 -06001345 if (!async && !(hctx->flags & BLK_MQ_F_BLOCKING)) {
Paolo Bonzini2a90d4a2014-11-07 23:04:00 +01001346 int cpu = get_cpu();
1347 if (cpumask_test_cpu(cpu, hctx->cpumask)) {
Paolo Bonzini398205b2014-11-07 23:03:59 +01001348 __blk_mq_run_hw_queue(hctx);
Paolo Bonzini2a90d4a2014-11-07 23:04:00 +01001349 put_cpu();
Paolo Bonzini398205b2014-11-07 23:03:59 +01001350 return;
1351 }
Jens Axboee4043dc2014-04-09 10:18:23 -06001352
Paolo Bonzini2a90d4a2014-11-07 23:04:00 +01001353 put_cpu();
Jens Axboee4043dc2014-04-09 10:18:23 -06001354 }
Paolo Bonzini398205b2014-11-07 23:03:59 +01001355
Jens Axboe9f993732017-04-10 09:54:54 -06001356 kblockd_schedule_delayed_work_on(blk_mq_hctx_next_cpu(hctx),
1357 &hctx->run_work,
1358 msecs_to_jiffies(msecs));
Bart Van Assche7587a5a2017-04-07 11:16:52 -07001359}
1360
1361void blk_mq_delay_run_hw_queue(struct blk_mq_hw_ctx *hctx, unsigned long msecs)
1362{
1363 __blk_mq_delay_run_hw_queue(hctx, true, msecs);
1364}
1365EXPORT_SYMBOL(blk_mq_delay_run_hw_queue);
1366
Jens Axboe79f720a2017-11-10 09:13:21 -07001367bool blk_mq_run_hw_queue(struct blk_mq_hw_ctx *hctx, bool async)
Bart Van Assche7587a5a2017-04-07 11:16:52 -07001368{
Ming Lei24f5a902018-01-06 16:27:38 +08001369 int srcu_idx;
1370 bool need_run;
1371
1372 /*
1373 * When queue is quiesced, we may be switching io scheduler, or
1374 * updating nr_hw_queues, or other things, and we can't run queue
1375 * any more, even __blk_mq_hctx_has_pending() can't be called safely.
1376 *
1377 * And queue will be rerun in blk_mq_unquiesce_queue() if it is
1378 * quiesced.
1379 */
Jens Axboe04ced152018-01-09 08:29:46 -08001380 hctx_lock(hctx, &srcu_idx);
1381 need_run = !blk_queue_quiesced(hctx->queue) &&
1382 blk_mq_hctx_has_pending(hctx);
1383 hctx_unlock(hctx, srcu_idx);
Ming Lei24f5a902018-01-06 16:27:38 +08001384
1385 if (need_run) {
Jens Axboe79f720a2017-11-10 09:13:21 -07001386 __blk_mq_delay_run_hw_queue(hctx, async, 0);
1387 return true;
1388 }
1389
1390 return false;
Jens Axboe320ae512013-10-24 09:20:05 +01001391}
Omar Sandoval5b727272017-04-14 01:00:00 -07001392EXPORT_SYMBOL(blk_mq_run_hw_queue);
Jens Axboe320ae512013-10-24 09:20:05 +01001393
Mike Snitzerb94ec292015-03-11 23:56:38 -04001394void blk_mq_run_hw_queues(struct request_queue *q, bool async)
Jens Axboe320ae512013-10-24 09:20:05 +01001395{
1396 struct blk_mq_hw_ctx *hctx;
1397 int i;
1398
1399 queue_for_each_hw_ctx(q, hctx, i) {
Jens Axboe79f720a2017-11-10 09:13:21 -07001400 if (blk_mq_hctx_stopped(hctx))
Jens Axboe320ae512013-10-24 09:20:05 +01001401 continue;
1402
Mike Snitzerb94ec292015-03-11 23:56:38 -04001403 blk_mq_run_hw_queue(hctx, async);
Jens Axboe320ae512013-10-24 09:20:05 +01001404 }
1405}
Mike Snitzerb94ec292015-03-11 23:56:38 -04001406EXPORT_SYMBOL(blk_mq_run_hw_queues);
Jens Axboe320ae512013-10-24 09:20:05 +01001407
Bart Van Asschefd001442016-10-28 17:19:37 -07001408/**
1409 * blk_mq_queue_stopped() - check whether one or more hctxs have been stopped
1410 * @q: request queue.
1411 *
1412 * The caller is responsible for serializing this function against
1413 * blk_mq_{start,stop}_hw_queue().
1414 */
1415bool blk_mq_queue_stopped(struct request_queue *q)
1416{
1417 struct blk_mq_hw_ctx *hctx;
1418 int i;
1419
1420 queue_for_each_hw_ctx(q, hctx, i)
1421 if (blk_mq_hctx_stopped(hctx))
1422 return true;
1423
1424 return false;
1425}
1426EXPORT_SYMBOL(blk_mq_queue_stopped);
1427
Ming Lei39a70c72017-06-06 23:22:09 +08001428/*
1429 * This function is often used for pausing .queue_rq() by driver when
1430 * there isn't enough resource or some conditions aren't satisfied, and
Bart Van Assche4d606212017-08-17 16:23:00 -07001431 * BLK_STS_RESOURCE is usually returned.
Ming Lei39a70c72017-06-06 23:22:09 +08001432 *
1433 * We do not guarantee that dispatch can be drained or blocked
1434 * after blk_mq_stop_hw_queue() returns. Please use
1435 * blk_mq_quiesce_queue() for that requirement.
1436 */
Jens Axboe320ae512013-10-24 09:20:05 +01001437void blk_mq_stop_hw_queue(struct blk_mq_hw_ctx *hctx)
1438{
Ming Lei641a9ed2017-06-06 23:22:10 +08001439 cancel_delayed_work(&hctx->run_work);
1440
1441 set_bit(BLK_MQ_S_STOPPED, &hctx->state);
Jens Axboe320ae512013-10-24 09:20:05 +01001442}
1443EXPORT_SYMBOL(blk_mq_stop_hw_queue);
1444
Ming Lei39a70c72017-06-06 23:22:09 +08001445/*
1446 * This function is often used for pausing .queue_rq() by driver when
1447 * there isn't enough resource or some conditions aren't satisfied, and
Bart Van Assche4d606212017-08-17 16:23:00 -07001448 * BLK_STS_RESOURCE is usually returned.
Ming Lei39a70c72017-06-06 23:22:09 +08001449 *
1450 * We do not guarantee that dispatch can be drained or blocked
1451 * after blk_mq_stop_hw_queues() returns. Please use
1452 * blk_mq_quiesce_queue() for that requirement.
1453 */
Jens Axboe2719aa22017-05-03 11:08:14 -06001454void blk_mq_stop_hw_queues(struct request_queue *q)
1455{
Ming Lei641a9ed2017-06-06 23:22:10 +08001456 struct blk_mq_hw_ctx *hctx;
1457 int i;
1458
1459 queue_for_each_hw_ctx(q, hctx, i)
1460 blk_mq_stop_hw_queue(hctx);
Christoph Hellwig280d45f2013-10-25 14:45:58 +01001461}
1462EXPORT_SYMBOL(blk_mq_stop_hw_queues);
1463
Jens Axboe320ae512013-10-24 09:20:05 +01001464void blk_mq_start_hw_queue(struct blk_mq_hw_ctx *hctx)
1465{
1466 clear_bit(BLK_MQ_S_STOPPED, &hctx->state);
Jens Axboee4043dc2014-04-09 10:18:23 -06001467
Jens Axboe0ffbce82014-06-25 08:22:34 -06001468 blk_mq_run_hw_queue(hctx, false);
Jens Axboe320ae512013-10-24 09:20:05 +01001469}
1470EXPORT_SYMBOL(blk_mq_start_hw_queue);
1471
Christoph Hellwig2f268552014-04-16 09:44:56 +02001472void blk_mq_start_hw_queues(struct request_queue *q)
1473{
1474 struct blk_mq_hw_ctx *hctx;
1475 int i;
1476
1477 queue_for_each_hw_ctx(q, hctx, i)
1478 blk_mq_start_hw_queue(hctx);
1479}
1480EXPORT_SYMBOL(blk_mq_start_hw_queues);
1481
Jens Axboeae911c52016-12-08 13:19:30 -07001482void blk_mq_start_stopped_hw_queue(struct blk_mq_hw_ctx *hctx, bool async)
1483{
1484 if (!blk_mq_hctx_stopped(hctx))
1485 return;
1486
1487 clear_bit(BLK_MQ_S_STOPPED, &hctx->state);
1488 blk_mq_run_hw_queue(hctx, async);
1489}
1490EXPORT_SYMBOL_GPL(blk_mq_start_stopped_hw_queue);
1491
Christoph Hellwig1b4a3252014-04-16 09:44:54 +02001492void blk_mq_start_stopped_hw_queues(struct request_queue *q, bool async)
Jens Axboe320ae512013-10-24 09:20:05 +01001493{
1494 struct blk_mq_hw_ctx *hctx;
1495 int i;
1496
Jens Axboeae911c52016-12-08 13:19:30 -07001497 queue_for_each_hw_ctx(q, hctx, i)
1498 blk_mq_start_stopped_hw_queue(hctx, async);
Jens Axboe320ae512013-10-24 09:20:05 +01001499}
1500EXPORT_SYMBOL(blk_mq_start_stopped_hw_queues);
1501
Christoph Hellwig70f4db62014-04-16 10:48:08 -06001502static void blk_mq_run_work_fn(struct work_struct *work)
Jens Axboe320ae512013-10-24 09:20:05 +01001503{
1504 struct blk_mq_hw_ctx *hctx;
1505
Jens Axboe9f993732017-04-10 09:54:54 -06001506 hctx = container_of(work, struct blk_mq_hw_ctx, run_work.work);
Jens Axboe21c6e932017-04-10 09:54:56 -06001507
1508 /*
1509 * If we are stopped, don't run the queue. The exception is if
1510 * BLK_MQ_S_START_ON_RUN is set. For that case, we auto-clear
1511 * the STOPPED bit and run it.
1512 */
1513 if (test_bit(BLK_MQ_S_STOPPED, &hctx->state)) {
1514 if (!test_bit(BLK_MQ_S_START_ON_RUN, &hctx->state))
1515 return;
1516
1517 clear_bit(BLK_MQ_S_START_ON_RUN, &hctx->state);
1518 clear_bit(BLK_MQ_S_STOPPED, &hctx->state);
1519 }
Jens Axboee4043dc2014-04-09 10:18:23 -06001520
Jens Axboe320ae512013-10-24 09:20:05 +01001521 __blk_mq_run_hw_queue(hctx);
1522}
1523
Christoph Hellwig70f4db62014-04-16 10:48:08 -06001524
1525void blk_mq_delay_queue(struct blk_mq_hw_ctx *hctx, unsigned long msecs)
1526{
Bart Van Assche5435c022017-06-20 11:15:49 -07001527 if (WARN_ON_ONCE(!blk_mq_hw_queue_mapped(hctx)))
Ming Lei19c66e52014-12-03 19:38:04 +08001528 return;
Christoph Hellwig70f4db62014-04-16 10:48:08 -06001529
Jens Axboe21c6e932017-04-10 09:54:56 -06001530 /*
1531 * Stop the hw queue, then modify currently delayed work.
1532 * This should prevent us from running the queue prematurely.
1533 * Mark the queue as auto-clearing STOPPED when it runs.
1534 */
Jens Axboe7e79dad2017-01-19 07:58:59 -07001535 blk_mq_stop_hw_queue(hctx);
Jens Axboe21c6e932017-04-10 09:54:56 -06001536 set_bit(BLK_MQ_S_START_ON_RUN, &hctx->state);
1537 kblockd_mod_delayed_work_on(blk_mq_hctx_next_cpu(hctx),
1538 &hctx->run_work,
1539 msecs_to_jiffies(msecs));
Christoph Hellwig70f4db62014-04-16 10:48:08 -06001540}
1541EXPORT_SYMBOL(blk_mq_delay_queue);
1542
Ming Leicfd0c552015-10-20 23:13:57 +08001543static inline void __blk_mq_insert_req_list(struct blk_mq_hw_ctx *hctx,
Ming Leicfd0c552015-10-20 23:13:57 +08001544 struct request *rq,
1545 bool at_head)
Jens Axboe320ae512013-10-24 09:20:05 +01001546{
Jens Axboee57690f2016-08-24 15:34:35 -06001547 struct blk_mq_ctx *ctx = rq->mq_ctx;
1548
Bart Van Assche7b607812017-06-20 11:15:47 -07001549 lockdep_assert_held(&ctx->lock);
1550
Jens Axboe01b983c2013-11-19 18:59:10 -07001551 trace_block_rq_insert(hctx->queue, rq);
1552
Christoph Hellwig72a0a362014-02-07 10:22:36 -08001553 if (at_head)
1554 list_add(&rq->queuelist, &ctx->rq_list);
1555 else
1556 list_add_tail(&rq->queuelist, &ctx->rq_list);
Ming Leicfd0c552015-10-20 23:13:57 +08001557}
Jens Axboe4bb659b2014-05-09 09:36:49 -06001558
Jens Axboe2c3ad662016-12-14 14:34:47 -07001559void __blk_mq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq,
1560 bool at_head)
Ming Leicfd0c552015-10-20 23:13:57 +08001561{
1562 struct blk_mq_ctx *ctx = rq->mq_ctx;
1563
Bart Van Assche7b607812017-06-20 11:15:47 -07001564 lockdep_assert_held(&ctx->lock);
1565
Jens Axboee57690f2016-08-24 15:34:35 -06001566 __blk_mq_insert_req_list(hctx, rq, at_head);
Jens Axboe320ae512013-10-24 09:20:05 +01001567 blk_mq_hctx_mark_pending(hctx, ctx);
Jens Axboe320ae512013-10-24 09:20:05 +01001568}
1569
Jens Axboe157f3772017-09-11 16:43:57 -06001570/*
1571 * Should only be used carefully, when the caller knows we want to
1572 * bypass a potential IO scheduler on the target device.
1573 */
Ming Leib0850292017-11-02 23:24:34 +08001574void blk_mq_request_bypass_insert(struct request *rq, bool run_queue)
Jens Axboe157f3772017-09-11 16:43:57 -06001575{
1576 struct blk_mq_ctx *ctx = rq->mq_ctx;
1577 struct blk_mq_hw_ctx *hctx = blk_mq_map_queue(rq->q, ctx->cpu);
1578
1579 spin_lock(&hctx->lock);
1580 list_add_tail(&rq->queuelist, &hctx->dispatch);
1581 spin_unlock(&hctx->lock);
1582
Ming Leib0850292017-11-02 23:24:34 +08001583 if (run_queue)
1584 blk_mq_run_hw_queue(hctx, false);
Jens Axboe157f3772017-09-11 16:43:57 -06001585}
1586
Jens Axboebd166ef2017-01-17 06:03:22 -07001587void blk_mq_insert_requests(struct blk_mq_hw_ctx *hctx, struct blk_mq_ctx *ctx,
1588 struct list_head *list)
Jens Axboe320ae512013-10-24 09:20:05 +01001589
1590{
Jens Axboe320ae512013-10-24 09:20:05 +01001591 /*
1592 * preemption doesn't flush plug list, so it's possible ctx->cpu is
1593 * offline now
1594 */
1595 spin_lock(&ctx->lock);
1596 while (!list_empty(list)) {
1597 struct request *rq;
1598
1599 rq = list_first_entry(list, struct request, queuelist);
Jens Axboee57690f2016-08-24 15:34:35 -06001600 BUG_ON(rq->mq_ctx != ctx);
Jens Axboe320ae512013-10-24 09:20:05 +01001601 list_del_init(&rq->queuelist);
Jens Axboee57690f2016-08-24 15:34:35 -06001602 __blk_mq_insert_req_list(hctx, rq, false);
Jens Axboe320ae512013-10-24 09:20:05 +01001603 }
Ming Leicfd0c552015-10-20 23:13:57 +08001604 blk_mq_hctx_mark_pending(hctx, ctx);
Jens Axboe320ae512013-10-24 09:20:05 +01001605 spin_unlock(&ctx->lock);
Jens Axboe320ae512013-10-24 09:20:05 +01001606}
1607
1608static int plug_ctx_cmp(void *priv, struct list_head *a, struct list_head *b)
1609{
1610 struct request *rqa = container_of(a, struct request, queuelist);
1611 struct request *rqb = container_of(b, struct request, queuelist);
1612
1613 return !(rqa->mq_ctx < rqb->mq_ctx ||
1614 (rqa->mq_ctx == rqb->mq_ctx &&
1615 blk_rq_pos(rqa) < blk_rq_pos(rqb)));
1616}
1617
1618void blk_mq_flush_plug_list(struct blk_plug *plug, bool from_schedule)
1619{
1620 struct blk_mq_ctx *this_ctx;
1621 struct request_queue *this_q;
1622 struct request *rq;
1623 LIST_HEAD(list);
1624 LIST_HEAD(ctx_list);
1625 unsigned int depth;
1626
1627 list_splice_init(&plug->mq_list, &list);
1628
1629 list_sort(NULL, &list, plug_ctx_cmp);
1630
1631 this_q = NULL;
1632 this_ctx = NULL;
1633 depth = 0;
1634
1635 while (!list_empty(&list)) {
1636 rq = list_entry_rq(list.next);
1637 list_del_init(&rq->queuelist);
1638 BUG_ON(!rq->q);
1639 if (rq->mq_ctx != this_ctx) {
1640 if (this_ctx) {
Jens Axboebd166ef2017-01-17 06:03:22 -07001641 trace_block_unplug(this_q, depth, from_schedule);
1642 blk_mq_sched_insert_requests(this_q, this_ctx,
1643 &ctx_list,
1644 from_schedule);
Jens Axboe320ae512013-10-24 09:20:05 +01001645 }
1646
1647 this_ctx = rq->mq_ctx;
1648 this_q = rq->q;
1649 depth = 0;
1650 }
1651
1652 depth++;
1653 list_add_tail(&rq->queuelist, &ctx_list);
1654 }
1655
1656 /*
1657 * If 'this_ctx' is set, we know we have entries to complete
1658 * on 'ctx_list'. Do those.
1659 */
1660 if (this_ctx) {
Jens Axboebd166ef2017-01-17 06:03:22 -07001661 trace_block_unplug(this_q, depth, from_schedule);
1662 blk_mq_sched_insert_requests(this_q, this_ctx, &ctx_list,
1663 from_schedule);
Jens Axboe320ae512013-10-24 09:20:05 +01001664 }
1665}
1666
1667static void blk_mq_bio_to_request(struct request *rq, struct bio *bio)
1668{
Bart Van Asscheda8d7f02017-04-19 14:01:24 -07001669 blk_init_request_from_bio(rq, bio);
Jens Axboe4b570522014-05-29 11:00:11 -06001670
Shaohua Li85acb3b2017-10-06 17:56:00 -07001671 blk_rq_set_rl(rq, blk_get_rl(rq->q, bio));
1672
Jens Axboe6e85eaf2016-12-02 20:00:14 -07001673 blk_account_io_start(rq, true);
Jens Axboe320ae512013-10-24 09:20:05 +01001674}
1675
Ming Leiab42f352017-05-26 19:53:19 +08001676static inline void blk_mq_queue_io(struct blk_mq_hw_ctx *hctx,
1677 struct blk_mq_ctx *ctx,
1678 struct request *rq)
1679{
1680 spin_lock(&ctx->lock);
1681 __blk_mq_insert_request(hctx, rq, false);
1682 spin_unlock(&ctx->lock);
Jens Axboe07068d52014-05-22 10:40:51 -06001683}
1684
Jens Axboefd2d3322017-01-12 10:04:45 -07001685static blk_qc_t request_to_qc_t(struct blk_mq_hw_ctx *hctx, struct request *rq)
1686{
Jens Axboebd166ef2017-01-17 06:03:22 -07001687 if (rq->tag != -1)
1688 return blk_tag_to_qc_t(rq->tag, hctx->queue_num, false);
1689
1690 return blk_tag_to_qc_t(rq->internal_tag, hctx->queue_num, true);
Jens Axboefd2d3322017-01-12 10:04:45 -07001691}
1692
Ming Leid964f042017-06-06 23:22:00 +08001693static void __blk_mq_try_issue_directly(struct blk_mq_hw_ctx *hctx,
1694 struct request *rq,
Jens Axboe04ced152018-01-09 08:29:46 -08001695 blk_qc_t *cookie)
Shaohua Lif984df12015-05-08 10:51:32 -07001696{
Shaohua Lif984df12015-05-08 10:51:32 -07001697 struct request_queue *q = rq->q;
Shaohua Lif984df12015-05-08 10:51:32 -07001698 struct blk_mq_queue_data bd = {
1699 .rq = rq,
Omar Sandovald945a362017-04-05 12:01:36 -07001700 .last = true,
Shaohua Lif984df12015-05-08 10:51:32 -07001701 };
Jens Axboebd166ef2017-01-17 06:03:22 -07001702 blk_qc_t new_cookie;
Jens Axboef06345a2017-06-12 11:22:46 -06001703 blk_status_t ret;
Ming Leid964f042017-06-06 23:22:00 +08001704 bool run_queue = true;
1705
Ming Leif4560ff2017-06-18 14:24:27 -06001706 /* RCU or SRCU read lock is needed before checking quiesced flag */
1707 if (blk_mq_hctx_stopped(hctx) || blk_queue_quiesced(q)) {
Ming Leid964f042017-06-06 23:22:00 +08001708 run_queue = false;
1709 goto insert;
1710 }
Shaohua Lif984df12015-05-08 10:51:32 -07001711
Jens Axboebd166ef2017-01-17 06:03:22 -07001712 if (q->elevator)
Bart Van Assche2253efc2016-10-28 17:20:02 -07001713 goto insert;
1714
Ming Leid964f042017-06-06 23:22:00 +08001715 if (!blk_mq_get_driver_tag(rq, NULL, false))
Jens Axboebd166ef2017-01-17 06:03:22 -07001716 goto insert;
1717
Ming Lei88022d72017-11-05 02:21:12 +08001718 if (!blk_mq_get_dispatch_budget(hctx)) {
Ming Leide148292017-10-14 17:22:29 +08001719 blk_mq_put_driver_tag(rq);
1720 goto insert;
Ming Lei88022d72017-11-05 02:21:12 +08001721 }
Ming Leide148292017-10-14 17:22:29 +08001722
Jens Axboebd166ef2017-01-17 06:03:22 -07001723 new_cookie = request_to_qc_t(hctx, rq);
1724
Shaohua Lif984df12015-05-08 10:51:32 -07001725 /*
1726 * For OK queue, we are done. For error, kill it. Any other
1727 * error (busy), just add it to our list as we previously
1728 * would have done
1729 */
1730 ret = q->mq_ops->queue_rq(hctx, &bd);
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001731 switch (ret) {
1732 case BLK_STS_OK:
Jens Axboe7b371632015-11-05 10:41:40 -07001733 *cookie = new_cookie;
Bart Van Assche2253efc2016-10-28 17:20:02 -07001734 return;
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001735 case BLK_STS_RESOURCE:
1736 __blk_mq_requeue_request(rq);
1737 goto insert;
1738 default:
Jens Axboe7b371632015-11-05 10:41:40 -07001739 *cookie = BLK_QC_T_NONE;
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001740 blk_mq_end_request(rq, ret);
Bart Van Assche2253efc2016-10-28 17:20:02 -07001741 return;
Jens Axboe7b371632015-11-05 10:41:40 -07001742 }
1743
Bart Van Assche2253efc2016-10-28 17:20:02 -07001744insert:
Jens Axboe04ced152018-01-09 08:29:46 -08001745 blk_mq_sched_insert_request(rq, false, run_queue, false,
1746 hctx->flags & BLK_MQ_F_BLOCKING);
Shaohua Lif984df12015-05-08 10:51:32 -07001747}
1748
Christoph Hellwig5eb61262017-03-22 15:01:51 -04001749static void blk_mq_try_issue_directly(struct blk_mq_hw_ctx *hctx,
1750 struct request *rq, blk_qc_t *cookie)
1751{
Jens Axboe04ced152018-01-09 08:29:46 -08001752 int srcu_idx;
Jens Axboebf4907c2017-03-30 12:30:39 -06001753
Jens Axboe04ced152018-01-09 08:29:46 -08001754 might_sleep_if(hctx->flags & BLK_MQ_F_BLOCKING);
Jens Axboebf4907c2017-03-30 12:30:39 -06001755
Jens Axboe04ced152018-01-09 08:29:46 -08001756 hctx_lock(hctx, &srcu_idx);
1757 __blk_mq_try_issue_directly(hctx, rq, cookie);
1758 hctx_unlock(hctx, srcu_idx);
Christoph Hellwig5eb61262017-03-22 15:01:51 -04001759}
1760
Jens Axboedece1632015-11-05 10:41:16 -07001761static blk_qc_t blk_mq_make_request(struct request_queue *q, struct bio *bio)
Jens Axboe07068d52014-05-22 10:40:51 -06001762{
Christoph Hellwigef295ec2016-10-28 08:48:16 -06001763 const int is_sync = op_is_sync(bio->bi_opf);
Christoph Hellwigf73f44e2017-01-27 08:30:47 -07001764 const int is_flush_fua = op_is_flush(bio->bi_opf);
Jens Axboe5a797e02017-01-26 12:22:11 -07001765 struct blk_mq_alloc_data data = { .flags = 0 };
Jens Axboe07068d52014-05-22 10:40:51 -06001766 struct request *rq;
Christoph Hellwig5eb61262017-03-22 15:01:51 -04001767 unsigned int request_count = 0;
Shaohua Lif984df12015-05-08 10:51:32 -07001768 struct blk_plug *plug;
Shaohua Li5b3f3412015-05-08 10:51:33 -07001769 struct request *same_queue_rq = NULL;
Jens Axboe7b371632015-11-05 10:41:40 -07001770 blk_qc_t cookie;
Jens Axboe87760e52016-11-09 12:38:14 -07001771 unsigned int wb_acct;
Jens Axboe07068d52014-05-22 10:40:51 -06001772
1773 blk_queue_bounce(q, &bio);
1774
NeilBrownaf67c312017-06-18 14:38:57 +10001775 blk_queue_split(q, &bio);
Wen Xiongf36ea502017-05-10 08:54:11 -05001776
Dmitry Monakhove23947b2017-06-29 11:31:11 -07001777 if (!bio_integrity_prep(bio))
Jens Axboedece1632015-11-05 10:41:16 -07001778 return BLK_QC_T_NONE;
Jens Axboe07068d52014-05-22 10:40:51 -06001779
Omar Sandoval87c279e2016-06-01 22:18:48 -07001780 if (!is_flush_fua && !blk_queue_nomerges(q) &&
1781 blk_attempt_plug_merge(q, bio, &request_count, &same_queue_rq))
1782 return BLK_QC_T_NONE;
Shaohua Lif984df12015-05-08 10:51:32 -07001783
Jens Axboebd166ef2017-01-17 06:03:22 -07001784 if (blk_mq_sched_bio_merge(q, bio))
1785 return BLK_QC_T_NONE;
1786
Jens Axboe87760e52016-11-09 12:38:14 -07001787 wb_acct = wbt_wait(q->rq_wb, bio, NULL);
1788
Jens Axboebd166ef2017-01-17 06:03:22 -07001789 trace_block_getrq(q, bio, bio->bi_opf);
1790
Christoph Hellwigd2c0d382017-06-16 18:15:19 +02001791 rq = blk_mq_get_request(q, bio, bio->bi_opf, &data);
Jens Axboe87760e52016-11-09 12:38:14 -07001792 if (unlikely(!rq)) {
1793 __wbt_done(q->rq_wb, wb_acct);
Goldwyn Rodrigues03a07c92017-06-20 07:05:46 -05001794 if (bio->bi_opf & REQ_NOWAIT)
1795 bio_wouldblock_error(bio);
Jens Axboedece1632015-11-05 10:41:16 -07001796 return BLK_QC_T_NONE;
Jens Axboe87760e52016-11-09 12:38:14 -07001797 }
1798
1799 wbt_track(&rq->issue_stat, wb_acct);
Jens Axboe07068d52014-05-22 10:40:51 -06001800
Jens Axboefd2d3322017-01-12 10:04:45 -07001801 cookie = request_to_qc_t(data.hctx, rq);
Jens Axboe07068d52014-05-22 10:40:51 -06001802
Shaohua Lif984df12015-05-08 10:51:32 -07001803 plug = current->plug;
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001804 if (unlikely(is_flush_fua)) {
Shaohua Lif984df12015-05-08 10:51:32 -07001805 blk_mq_put_ctx(data.ctx);
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001806 blk_mq_bio_to_request(rq, bio);
Ming Lei923218f2017-11-02 23:24:38 +08001807
1808 /* bypass scheduler for flush rq */
1809 blk_insert_flush(rq);
1810 blk_mq_run_hw_queue(data.hctx, true);
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001811 } else if (plug && q->nr_hw_queues == 1) {
Shaohua Li600271d2016-11-03 17:03:54 -07001812 struct request *last = NULL;
1813
Jens Axboeb00c53e2017-04-20 16:40:36 -06001814 blk_mq_put_ctx(data.ctx);
Jeff Moyere6c44382015-05-08 10:51:30 -07001815 blk_mq_bio_to_request(rq, bio);
Ming Lei0a6219a2016-11-16 18:07:05 +08001816
1817 /*
1818 * @request_count may become stale because of schedule
1819 * out, so check the list again.
1820 */
1821 if (list_empty(&plug->mq_list))
1822 request_count = 0;
Christoph Hellwig254d2592017-03-22 15:01:50 -04001823 else if (blk_queue_nomerges(q))
1824 request_count = blk_plug_queued_count(q);
1825
Ming Lei676d0602015-10-20 23:13:56 +08001826 if (!request_count)
Jeff Moyere6c44382015-05-08 10:51:30 -07001827 trace_block_plug(q);
Shaohua Li600271d2016-11-03 17:03:54 -07001828 else
1829 last = list_entry_rq(plug->mq_list.prev);
Jens Axboeb094f892015-11-20 20:29:45 -07001830
Shaohua Li600271d2016-11-03 17:03:54 -07001831 if (request_count >= BLK_MAX_REQUEST_COUNT || (last &&
1832 blk_rq_bytes(last) >= BLK_PLUG_FLUSH_SIZE)) {
Jeff Moyere6c44382015-05-08 10:51:30 -07001833 blk_flush_plug_list(plug, false);
1834 trace_block_plug(q);
Jens Axboe320ae512013-10-24 09:20:05 +01001835 }
Jens Axboeb094f892015-11-20 20:29:45 -07001836
Jeff Moyere6c44382015-05-08 10:51:30 -07001837 list_add_tail(&rq->queuelist, &plug->mq_list);
Christoph Hellwig22997222017-03-22 15:01:52 -04001838 } else if (plug && !blk_queue_nomerges(q)) {
Jens Axboe320ae512013-10-24 09:20:05 +01001839 blk_mq_bio_to_request(rq, bio);
Jens Axboe320ae512013-10-24 09:20:05 +01001840
Jens Axboe320ae512013-10-24 09:20:05 +01001841 /*
1842 * We do limited plugging. If the bio can be merged, do that.
1843 * Otherwise the existing request in the plug list will be
1844 * issued. So the plug list will have one request at most
Christoph Hellwig22997222017-03-22 15:01:52 -04001845 * The plug list might get flushed before this. If that happens,
1846 * the plug list is empty, and same_queue_rq is invalid.
Jens Axboe320ae512013-10-24 09:20:05 +01001847 */
Christoph Hellwig22997222017-03-22 15:01:52 -04001848 if (list_empty(&plug->mq_list))
1849 same_queue_rq = NULL;
1850 if (same_queue_rq)
1851 list_del_init(&same_queue_rq->queuelist);
1852 list_add_tail(&rq->queuelist, &plug->mq_list);
1853
Jens Axboebf4907c2017-03-30 12:30:39 -06001854 blk_mq_put_ctx(data.ctx);
1855
Ming Leidad7a3b2017-06-06 23:21:59 +08001856 if (same_queue_rq) {
1857 data.hctx = blk_mq_map_queue(q,
1858 same_queue_rq->mq_ctx->cpu);
Christoph Hellwig22997222017-03-22 15:01:52 -04001859 blk_mq_try_issue_directly(data.hctx, same_queue_rq,
1860 &cookie);
Ming Leidad7a3b2017-06-06 23:21:59 +08001861 }
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001862 } else if (q->nr_hw_queues > 1 && is_sync) {
Jens Axboebd166ef2017-01-17 06:03:22 -07001863 blk_mq_put_ctx(data.ctx);
1864 blk_mq_bio_to_request(rq, bio);
Christoph Hellwig22997222017-03-22 15:01:52 -04001865 blk_mq_try_issue_directly(data.hctx, rq, &cookie);
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001866 } else if (q->elevator) {
Jens Axboeb00c53e2017-04-20 16:40:36 -06001867 blk_mq_put_ctx(data.ctx);
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001868 blk_mq_bio_to_request(rq, bio);
1869 blk_mq_sched_insert_request(rq, false, true, true, true);
Ming Leiab42f352017-05-26 19:53:19 +08001870 } else {
Jens Axboeb00c53e2017-04-20 16:40:36 -06001871 blk_mq_put_ctx(data.ctx);
Ming Leiab42f352017-05-26 19:53:19 +08001872 blk_mq_bio_to_request(rq, bio);
1873 blk_mq_queue_io(data.hctx, data.ctx, rq);
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001874 blk_mq_run_hw_queue(data.hctx, true);
Ming Leiab42f352017-05-26 19:53:19 +08001875 }
Jens Axboe320ae512013-10-24 09:20:05 +01001876
Jens Axboe7b371632015-11-05 10:41:40 -07001877 return cookie;
Jens Axboe320ae512013-10-24 09:20:05 +01001878}
1879
Jens Axboecc71a6f2017-01-11 14:29:56 -07001880void blk_mq_free_rqs(struct blk_mq_tag_set *set, struct blk_mq_tags *tags,
1881 unsigned int hctx_idx)
Jens Axboe320ae512013-10-24 09:20:05 +01001882{
1883 struct page *page;
1884
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001885 if (tags->rqs && set->ops->exit_request) {
Christoph Hellwige9b267d2014-04-15 13:59:10 -06001886 int i;
1887
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001888 for (i = 0; i < tags->nr_tags; i++) {
Jens Axboe2af8cbe2017-01-13 14:39:30 -07001889 struct request *rq = tags->static_rqs[i];
1890
1891 if (!rq)
Christoph Hellwige9b267d2014-04-15 13:59:10 -06001892 continue;
Christoph Hellwigd6296d392017-05-01 10:19:08 -06001893 set->ops->exit_request(set, rq, hctx_idx);
Jens Axboe2af8cbe2017-01-13 14:39:30 -07001894 tags->static_rqs[i] = NULL;
Christoph Hellwige9b267d2014-04-15 13:59:10 -06001895 }
1896 }
1897
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001898 while (!list_empty(&tags->page_list)) {
1899 page = list_first_entry(&tags->page_list, struct page, lru);
Dave Hansen67534712014-01-08 20:17:46 -07001900 list_del_init(&page->lru);
Catalin Marinasf75782e2015-09-14 18:16:02 +01001901 /*
1902 * Remove kmemleak object previously allocated in
1903 * blk_mq_init_rq_map().
1904 */
1905 kmemleak_free(page_address(page));
Jens Axboe320ae512013-10-24 09:20:05 +01001906 __free_pages(page, page->private);
1907 }
Jens Axboecc71a6f2017-01-11 14:29:56 -07001908}
Jens Axboe320ae512013-10-24 09:20:05 +01001909
Jens Axboecc71a6f2017-01-11 14:29:56 -07001910void blk_mq_free_rq_map(struct blk_mq_tags *tags)
1911{
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001912 kfree(tags->rqs);
Jens Axboecc71a6f2017-01-11 14:29:56 -07001913 tags->rqs = NULL;
Jens Axboe2af8cbe2017-01-13 14:39:30 -07001914 kfree(tags->static_rqs);
1915 tags->static_rqs = NULL;
Jens Axboe320ae512013-10-24 09:20:05 +01001916
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001917 blk_mq_free_tags(tags);
Jens Axboe320ae512013-10-24 09:20:05 +01001918}
1919
Jens Axboecc71a6f2017-01-11 14:29:56 -07001920struct blk_mq_tags *blk_mq_alloc_rq_map(struct blk_mq_tag_set *set,
1921 unsigned int hctx_idx,
1922 unsigned int nr_tags,
1923 unsigned int reserved_tags)
Jens Axboe320ae512013-10-24 09:20:05 +01001924{
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001925 struct blk_mq_tags *tags;
Shaohua Li59f082e2017-02-01 09:53:14 -08001926 int node;
Jens Axboe320ae512013-10-24 09:20:05 +01001927
Shaohua Li59f082e2017-02-01 09:53:14 -08001928 node = blk_mq_hw_queue_to_node(set->mq_map, hctx_idx);
1929 if (node == NUMA_NO_NODE)
1930 node = set->numa_node;
1931
1932 tags = blk_mq_init_tags(nr_tags, reserved_tags, node,
Shaohua Li24391c02015-01-23 14:18:00 -07001933 BLK_MQ_FLAG_TO_ALLOC_POLICY(set->flags));
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001934 if (!tags)
1935 return NULL;
Jens Axboe320ae512013-10-24 09:20:05 +01001936
Jens Axboecc71a6f2017-01-11 14:29:56 -07001937 tags->rqs = kzalloc_node(nr_tags * sizeof(struct request *),
Gabriel Krisman Bertazi36e1f3d12016-12-06 13:31:44 -02001938 GFP_NOIO | __GFP_NOWARN | __GFP_NORETRY,
Shaohua Li59f082e2017-02-01 09:53:14 -08001939 node);
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001940 if (!tags->rqs) {
1941 blk_mq_free_tags(tags);
1942 return NULL;
1943 }
Jens Axboe320ae512013-10-24 09:20:05 +01001944
Jens Axboe2af8cbe2017-01-13 14:39:30 -07001945 tags->static_rqs = kzalloc_node(nr_tags * sizeof(struct request *),
1946 GFP_NOIO | __GFP_NOWARN | __GFP_NORETRY,
Shaohua Li59f082e2017-02-01 09:53:14 -08001947 node);
Jens Axboe2af8cbe2017-01-13 14:39:30 -07001948 if (!tags->static_rqs) {
1949 kfree(tags->rqs);
1950 blk_mq_free_tags(tags);
1951 return NULL;
1952 }
1953
Jens Axboecc71a6f2017-01-11 14:29:56 -07001954 return tags;
1955}
1956
1957static size_t order_to_size(unsigned int order)
1958{
1959 return (size_t)PAGE_SIZE << order;
1960}
1961
Tejun Heo1d9bd512018-01-09 08:29:48 -08001962static int blk_mq_init_request(struct blk_mq_tag_set *set, struct request *rq,
1963 unsigned int hctx_idx, int node)
1964{
1965 int ret;
1966
1967 if (set->ops->init_request) {
1968 ret = set->ops->init_request(set, rq, hctx_idx, node);
1969 if (ret)
1970 return ret;
1971 }
1972
1973 seqcount_init(&rq->gstate_seq);
1974 u64_stats_init(&rq->aborted_gstate_sync);
1975 return 0;
1976}
1977
Jens Axboecc71a6f2017-01-11 14:29:56 -07001978int blk_mq_alloc_rqs(struct blk_mq_tag_set *set, struct blk_mq_tags *tags,
1979 unsigned int hctx_idx, unsigned int depth)
1980{
1981 unsigned int i, j, entries_per_page, max_order = 4;
1982 size_t rq_size, left;
Shaohua Li59f082e2017-02-01 09:53:14 -08001983 int node;
1984
1985 node = blk_mq_hw_queue_to_node(set->mq_map, hctx_idx);
1986 if (node == NUMA_NO_NODE)
1987 node = set->numa_node;
Jens Axboecc71a6f2017-01-11 14:29:56 -07001988
1989 INIT_LIST_HEAD(&tags->page_list);
1990
Jens Axboe320ae512013-10-24 09:20:05 +01001991 /*
1992 * rq_size is the size of the request plus driver payload, rounded
1993 * to the cacheline size
1994 */
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001995 rq_size = round_up(sizeof(struct request) + set->cmd_size,
Jens Axboe320ae512013-10-24 09:20:05 +01001996 cache_line_size());
Jens Axboecc71a6f2017-01-11 14:29:56 -07001997 left = rq_size * depth;
Jens Axboe320ae512013-10-24 09:20:05 +01001998
Jens Axboecc71a6f2017-01-11 14:29:56 -07001999 for (i = 0; i < depth; ) {
Jens Axboe320ae512013-10-24 09:20:05 +01002000 int this_order = max_order;
2001 struct page *page;
2002 int to_do;
2003 void *p;
2004
Bartlomiej Zolnierkiewiczb3a834b2016-05-16 09:54:47 -06002005 while (this_order && left < order_to_size(this_order - 1))
Jens Axboe320ae512013-10-24 09:20:05 +01002006 this_order--;
2007
2008 do {
Shaohua Li59f082e2017-02-01 09:53:14 -08002009 page = alloc_pages_node(node,
Gabriel Krisman Bertazi36e1f3d12016-12-06 13:31:44 -02002010 GFP_NOIO | __GFP_NOWARN | __GFP_NORETRY | __GFP_ZERO,
Jens Axboea5164402014-09-10 09:02:03 -06002011 this_order);
Jens Axboe320ae512013-10-24 09:20:05 +01002012 if (page)
2013 break;
2014 if (!this_order--)
2015 break;
2016 if (order_to_size(this_order) < rq_size)
2017 break;
2018 } while (1);
2019
2020 if (!page)
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002021 goto fail;
Jens Axboe320ae512013-10-24 09:20:05 +01002022
2023 page->private = this_order;
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002024 list_add_tail(&page->lru, &tags->page_list);
Jens Axboe320ae512013-10-24 09:20:05 +01002025
2026 p = page_address(page);
Catalin Marinasf75782e2015-09-14 18:16:02 +01002027 /*
2028 * Allow kmemleak to scan these pages as they contain pointers
2029 * to additional allocations like via ops->init_request().
2030 */
Gabriel Krisman Bertazi36e1f3d12016-12-06 13:31:44 -02002031 kmemleak_alloc(p, order_to_size(this_order), 1, GFP_NOIO);
Jens Axboe320ae512013-10-24 09:20:05 +01002032 entries_per_page = order_to_size(this_order) / rq_size;
Jens Axboecc71a6f2017-01-11 14:29:56 -07002033 to_do = min(entries_per_page, depth - i);
Jens Axboe320ae512013-10-24 09:20:05 +01002034 left -= to_do * rq_size;
2035 for (j = 0; j < to_do; j++) {
Jens Axboe2af8cbe2017-01-13 14:39:30 -07002036 struct request *rq = p;
2037
2038 tags->static_rqs[i] = rq;
Tejun Heo1d9bd512018-01-09 08:29:48 -08002039 if (blk_mq_init_request(set, rq, hctx_idx, node)) {
2040 tags->static_rqs[i] = NULL;
2041 goto fail;
Christoph Hellwige9b267d2014-04-15 13:59:10 -06002042 }
2043
Jens Axboe320ae512013-10-24 09:20:05 +01002044 p += rq_size;
2045 i++;
2046 }
2047 }
Jens Axboecc71a6f2017-01-11 14:29:56 -07002048 return 0;
Jens Axboe320ae512013-10-24 09:20:05 +01002049
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002050fail:
Jens Axboecc71a6f2017-01-11 14:29:56 -07002051 blk_mq_free_rqs(set, tags, hctx_idx);
2052 return -ENOMEM;
Jens Axboe320ae512013-10-24 09:20:05 +01002053}
2054
Jens Axboee57690f2016-08-24 15:34:35 -06002055/*
2056 * 'cpu' is going away. splice any existing rq_list entries from this
2057 * software queue to the hw queue dispatch list, and ensure that it
2058 * gets run.
2059 */
Thomas Gleixner9467f852016-09-22 08:05:17 -06002060static int blk_mq_hctx_notify_dead(unsigned int cpu, struct hlist_node *node)
Jens Axboe484b4062014-05-21 14:01:15 -06002061{
Thomas Gleixner9467f852016-09-22 08:05:17 -06002062 struct blk_mq_hw_ctx *hctx;
Jens Axboe484b4062014-05-21 14:01:15 -06002063 struct blk_mq_ctx *ctx;
2064 LIST_HEAD(tmp);
2065
Thomas Gleixner9467f852016-09-22 08:05:17 -06002066 hctx = hlist_entry_safe(node, struct blk_mq_hw_ctx, cpuhp_dead);
Jens Axboee57690f2016-08-24 15:34:35 -06002067 ctx = __blk_mq_get_ctx(hctx->queue, cpu);
Jens Axboe484b4062014-05-21 14:01:15 -06002068
2069 spin_lock(&ctx->lock);
2070 if (!list_empty(&ctx->rq_list)) {
2071 list_splice_init(&ctx->rq_list, &tmp);
2072 blk_mq_hctx_clear_pending(hctx, ctx);
2073 }
2074 spin_unlock(&ctx->lock);
2075
2076 if (list_empty(&tmp))
Thomas Gleixner9467f852016-09-22 08:05:17 -06002077 return 0;
Jens Axboe484b4062014-05-21 14:01:15 -06002078
Jens Axboee57690f2016-08-24 15:34:35 -06002079 spin_lock(&hctx->lock);
2080 list_splice_tail_init(&tmp, &hctx->dispatch);
2081 spin_unlock(&hctx->lock);
Jens Axboe484b4062014-05-21 14:01:15 -06002082
2083 blk_mq_run_hw_queue(hctx, true);
Thomas Gleixner9467f852016-09-22 08:05:17 -06002084 return 0;
Jens Axboe484b4062014-05-21 14:01:15 -06002085}
2086
Thomas Gleixner9467f852016-09-22 08:05:17 -06002087static void blk_mq_remove_cpuhp(struct blk_mq_hw_ctx *hctx)
Jens Axboe484b4062014-05-21 14:01:15 -06002088{
Thomas Gleixner9467f852016-09-22 08:05:17 -06002089 cpuhp_state_remove_instance_nocalls(CPUHP_BLK_MQ_DEAD,
2090 &hctx->cpuhp_dead);
Jens Axboe484b4062014-05-21 14:01:15 -06002091}
2092
Ming Leic3b4afc2015-06-04 22:25:04 +08002093/* hctx->ctxs will be freed in queue's release handler */
Ming Lei08e98fc2014-09-25 23:23:38 +08002094static void blk_mq_exit_hctx(struct request_queue *q,
2095 struct blk_mq_tag_set *set,
2096 struct blk_mq_hw_ctx *hctx, unsigned int hctx_idx)
2097{
Omar Sandoval9c1051a2017-05-04 08:17:21 -06002098 blk_mq_debugfs_unregister_hctx(hctx);
2099
Ming Lei8ab0b7d2018-01-09 21:28:29 +08002100 if (blk_mq_hw_queue_mapped(hctx))
2101 blk_mq_tag_idle(hctx);
Ming Lei08e98fc2014-09-25 23:23:38 +08002102
Ming Leif70ced02014-09-25 23:23:47 +08002103 if (set->ops->exit_request)
Christoph Hellwigd6296d392017-05-01 10:19:08 -06002104 set->ops->exit_request(set, hctx->fq->flush_rq, hctx_idx);
Ming Leif70ced02014-09-25 23:23:47 +08002105
Omar Sandoval93252632017-04-05 12:01:31 -07002106 blk_mq_sched_exit_hctx(q, hctx, hctx_idx);
2107
Ming Lei08e98fc2014-09-25 23:23:38 +08002108 if (set->ops->exit_hctx)
2109 set->ops->exit_hctx(hctx, hctx_idx);
2110
Bart Van Assche6a83e742016-11-02 10:09:51 -06002111 if (hctx->flags & BLK_MQ_F_BLOCKING)
Tejun Heo05707b62018-01-09 08:29:53 -08002112 cleanup_srcu_struct(hctx->srcu);
Bart Van Assche6a83e742016-11-02 10:09:51 -06002113
Thomas Gleixner9467f852016-09-22 08:05:17 -06002114 blk_mq_remove_cpuhp(hctx);
Ming Leif70ced02014-09-25 23:23:47 +08002115 blk_free_flush_queue(hctx->fq);
Omar Sandoval88459642016-09-17 08:38:44 -06002116 sbitmap_free(&hctx->ctx_map);
Ming Lei08e98fc2014-09-25 23:23:38 +08002117}
2118
Ming Lei624dbe42014-05-27 23:35:13 +08002119static void blk_mq_exit_hw_queues(struct request_queue *q,
2120 struct blk_mq_tag_set *set, int nr_queue)
2121{
2122 struct blk_mq_hw_ctx *hctx;
2123 unsigned int i;
2124
2125 queue_for_each_hw_ctx(q, hctx, i) {
2126 if (i == nr_queue)
2127 break;
Ming Lei08e98fc2014-09-25 23:23:38 +08002128 blk_mq_exit_hctx(q, set, hctx, i);
Ming Lei624dbe42014-05-27 23:35:13 +08002129 }
Ming Lei624dbe42014-05-27 23:35:13 +08002130}
2131
Ming Lei08e98fc2014-09-25 23:23:38 +08002132static int blk_mq_init_hctx(struct request_queue *q,
2133 struct blk_mq_tag_set *set,
2134 struct blk_mq_hw_ctx *hctx, unsigned hctx_idx)
2135{
2136 int node;
2137
2138 node = hctx->numa_node;
2139 if (node == NUMA_NO_NODE)
2140 node = hctx->numa_node = set->numa_node;
2141
Jens Axboe9f993732017-04-10 09:54:54 -06002142 INIT_DELAYED_WORK(&hctx->run_work, blk_mq_run_work_fn);
Ming Lei08e98fc2014-09-25 23:23:38 +08002143 spin_lock_init(&hctx->lock);
2144 INIT_LIST_HEAD(&hctx->dispatch);
2145 hctx->queue = q;
Jeff Moyer2404e602015-11-03 10:40:06 -05002146 hctx->flags = set->flags & ~BLK_MQ_F_TAG_SHARED;
Ming Lei08e98fc2014-09-25 23:23:38 +08002147
Thomas Gleixner9467f852016-09-22 08:05:17 -06002148 cpuhp_state_add_instance_nocalls(CPUHP_BLK_MQ_DEAD, &hctx->cpuhp_dead);
Ming Lei08e98fc2014-09-25 23:23:38 +08002149
2150 hctx->tags = set->tags[hctx_idx];
2151
2152 /*
2153 * Allocate space for all possible cpus to avoid allocation at
2154 * runtime
2155 */
Johannes Thumshirnd904bfa2017-11-15 17:32:33 -08002156 hctx->ctxs = kmalloc_array_node(nr_cpu_ids, sizeof(void *),
Ming Lei08e98fc2014-09-25 23:23:38 +08002157 GFP_KERNEL, node);
2158 if (!hctx->ctxs)
2159 goto unregister_cpu_notifier;
2160
Omar Sandoval88459642016-09-17 08:38:44 -06002161 if (sbitmap_init_node(&hctx->ctx_map, nr_cpu_ids, ilog2(8), GFP_KERNEL,
2162 node))
Ming Lei08e98fc2014-09-25 23:23:38 +08002163 goto free_ctxs;
2164
2165 hctx->nr_ctx = 0;
2166
Jens Axboeeb619fd2017-11-09 08:32:43 -07002167 init_waitqueue_func_entry(&hctx->dispatch_wait, blk_mq_dispatch_wake);
2168 INIT_LIST_HEAD(&hctx->dispatch_wait.entry);
2169
Ming Lei08e98fc2014-09-25 23:23:38 +08002170 if (set->ops->init_hctx &&
2171 set->ops->init_hctx(hctx, set->driver_data, hctx_idx))
2172 goto free_bitmap;
2173
Omar Sandoval93252632017-04-05 12:01:31 -07002174 if (blk_mq_sched_init_hctx(q, hctx, hctx_idx))
2175 goto exit_hctx;
2176
Ming Leif70ced02014-09-25 23:23:47 +08002177 hctx->fq = blk_alloc_flush_queue(q, hctx->numa_node, set->cmd_size);
2178 if (!hctx->fq)
Omar Sandoval93252632017-04-05 12:01:31 -07002179 goto sched_exit_hctx;
Ming Leif70ced02014-09-25 23:23:47 +08002180
Tejun Heo1d9bd512018-01-09 08:29:48 -08002181 if (blk_mq_init_request(set, hctx->fq->flush_rq, hctx_idx, node))
Ming Leif70ced02014-09-25 23:23:47 +08002182 goto free_fq;
2183
Bart Van Assche6a83e742016-11-02 10:09:51 -06002184 if (hctx->flags & BLK_MQ_F_BLOCKING)
Tejun Heo05707b62018-01-09 08:29:53 -08002185 init_srcu_struct(hctx->srcu);
Bart Van Assche6a83e742016-11-02 10:09:51 -06002186
Omar Sandoval9c1051a2017-05-04 08:17:21 -06002187 blk_mq_debugfs_register_hctx(q, hctx);
2188
Ming Lei08e98fc2014-09-25 23:23:38 +08002189 return 0;
2190
Ming Leif70ced02014-09-25 23:23:47 +08002191 free_fq:
2192 kfree(hctx->fq);
Omar Sandoval93252632017-04-05 12:01:31 -07002193 sched_exit_hctx:
2194 blk_mq_sched_exit_hctx(q, hctx, hctx_idx);
Ming Leif70ced02014-09-25 23:23:47 +08002195 exit_hctx:
2196 if (set->ops->exit_hctx)
2197 set->ops->exit_hctx(hctx, hctx_idx);
Ming Lei08e98fc2014-09-25 23:23:38 +08002198 free_bitmap:
Omar Sandoval88459642016-09-17 08:38:44 -06002199 sbitmap_free(&hctx->ctx_map);
Ming Lei08e98fc2014-09-25 23:23:38 +08002200 free_ctxs:
2201 kfree(hctx->ctxs);
2202 unregister_cpu_notifier:
Thomas Gleixner9467f852016-09-22 08:05:17 -06002203 blk_mq_remove_cpuhp(hctx);
Ming Lei08e98fc2014-09-25 23:23:38 +08002204 return -1;
2205}
2206
Jens Axboe320ae512013-10-24 09:20:05 +01002207static void blk_mq_init_cpu_queues(struct request_queue *q,
2208 unsigned int nr_hw_queues)
2209{
2210 unsigned int i;
2211
2212 for_each_possible_cpu(i) {
2213 struct blk_mq_ctx *__ctx = per_cpu_ptr(q->queue_ctx, i);
2214 struct blk_mq_hw_ctx *hctx;
2215
Jens Axboe320ae512013-10-24 09:20:05 +01002216 __ctx->cpu = i;
2217 spin_lock_init(&__ctx->lock);
2218 INIT_LIST_HEAD(&__ctx->rq_list);
2219 __ctx->queue = q;
2220
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002221 /* If the cpu isn't present, the cpu is mapped to first hctx */
2222 if (!cpu_present(i))
Jens Axboe320ae512013-10-24 09:20:05 +01002223 continue;
2224
Christoph Hellwig7d7e0f92016-09-14 16:18:54 +02002225 hctx = blk_mq_map_queue(q, i);
Jens Axboee4043dc2014-04-09 10:18:23 -06002226
Jens Axboe320ae512013-10-24 09:20:05 +01002227 /*
2228 * Set local node, IFF we have more than one hw queue. If
2229 * not, we remain on the home node of the device
2230 */
2231 if (nr_hw_queues > 1 && hctx->numa_node == NUMA_NO_NODE)
Raghavendra K Tbffed452015-12-02 16:59:05 +05302232 hctx->numa_node = local_memory_node(cpu_to_node(i));
Jens Axboe320ae512013-10-24 09:20:05 +01002233 }
2234}
2235
Jens Axboecc71a6f2017-01-11 14:29:56 -07002236static bool __blk_mq_alloc_rq_map(struct blk_mq_tag_set *set, int hctx_idx)
2237{
2238 int ret = 0;
2239
2240 set->tags[hctx_idx] = blk_mq_alloc_rq_map(set, hctx_idx,
2241 set->queue_depth, set->reserved_tags);
2242 if (!set->tags[hctx_idx])
2243 return false;
2244
2245 ret = blk_mq_alloc_rqs(set, set->tags[hctx_idx], hctx_idx,
2246 set->queue_depth);
2247 if (!ret)
2248 return true;
2249
2250 blk_mq_free_rq_map(set->tags[hctx_idx]);
2251 set->tags[hctx_idx] = NULL;
2252 return false;
2253}
2254
2255static void blk_mq_free_map_and_requests(struct blk_mq_tag_set *set,
2256 unsigned int hctx_idx)
2257{
Jens Axboebd166ef2017-01-17 06:03:22 -07002258 if (set->tags[hctx_idx]) {
2259 blk_mq_free_rqs(set, set->tags[hctx_idx], hctx_idx);
2260 blk_mq_free_rq_map(set->tags[hctx_idx]);
2261 set->tags[hctx_idx] = NULL;
2262 }
Jens Axboecc71a6f2017-01-11 14:29:56 -07002263}
2264
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002265static void blk_mq_map_swqueue(struct request_queue *q)
Jens Axboe320ae512013-10-24 09:20:05 +01002266{
Gabriel Krisman Bertazid1b1cea2016-12-14 18:48:36 -02002267 unsigned int i, hctx_idx;
Jens Axboe320ae512013-10-24 09:20:05 +01002268 struct blk_mq_hw_ctx *hctx;
2269 struct blk_mq_ctx *ctx;
Ming Lei2a34c082015-04-21 10:00:20 +08002270 struct blk_mq_tag_set *set = q->tag_set;
Jens Axboe320ae512013-10-24 09:20:05 +01002271
Akinobu Mita60de0742015-09-27 02:09:25 +09002272 /*
2273 * Avoid others reading imcomplete hctx->cpumask through sysfs
2274 */
2275 mutex_lock(&q->sysfs_lock);
2276
Jens Axboe320ae512013-10-24 09:20:05 +01002277 queue_for_each_hw_ctx(q, hctx, i) {
Jens Axboee4043dc2014-04-09 10:18:23 -06002278 cpumask_clear(hctx->cpumask);
Jens Axboe320ae512013-10-24 09:20:05 +01002279 hctx->nr_ctx = 0;
2280 }
2281
2282 /*
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002283 * Map software to hardware queues.
2284 *
2285 * If the cpu isn't present, the cpu is mapped to first hctx.
Jens Axboe320ae512013-10-24 09:20:05 +01002286 */
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002287 for_each_present_cpu(i) {
Gabriel Krisman Bertazid1b1cea2016-12-14 18:48:36 -02002288 hctx_idx = q->mq_map[i];
2289 /* unmapped hw queue can be remapped after CPU topo changed */
Jens Axboecc71a6f2017-01-11 14:29:56 -07002290 if (!set->tags[hctx_idx] &&
2291 !__blk_mq_alloc_rq_map(set, hctx_idx)) {
Gabriel Krisman Bertazid1b1cea2016-12-14 18:48:36 -02002292 /*
2293 * If tags initialization fail for some hctx,
2294 * that hctx won't be brought online. In this
2295 * case, remap the current ctx to hctx[0] which
2296 * is guaranteed to always have tags allocated
2297 */
Jens Axboecc71a6f2017-01-11 14:29:56 -07002298 q->mq_map[i] = 0;
Gabriel Krisman Bertazid1b1cea2016-12-14 18:48:36 -02002299 }
2300
Thomas Gleixner897bb0c2016-03-19 11:30:33 +01002301 ctx = per_cpu_ptr(q->queue_ctx, i);
Christoph Hellwig7d7e0f92016-09-14 16:18:54 +02002302 hctx = blk_mq_map_queue(q, i);
Keith Busch868f2f02015-12-17 17:08:14 -07002303
Jens Axboee4043dc2014-04-09 10:18:23 -06002304 cpumask_set_cpu(i, hctx->cpumask);
Jens Axboe320ae512013-10-24 09:20:05 +01002305 ctx->index_hw = hctx->nr_ctx;
2306 hctx->ctxs[hctx->nr_ctx++] = ctx;
2307 }
Jens Axboe506e9312014-05-07 10:26:44 -06002308
Akinobu Mita60de0742015-09-27 02:09:25 +09002309 mutex_unlock(&q->sysfs_lock);
2310
Jens Axboe506e9312014-05-07 10:26:44 -06002311 queue_for_each_hw_ctx(q, hctx, i) {
Jens Axboe484b4062014-05-21 14:01:15 -06002312 /*
Jens Axboea68aafa2014-08-15 13:19:15 -06002313 * If no software queues are mapped to this hardware queue,
2314 * disable it and free the request entries.
Jens Axboe484b4062014-05-21 14:01:15 -06002315 */
2316 if (!hctx->nr_ctx) {
Gabriel Krisman Bertazid1b1cea2016-12-14 18:48:36 -02002317 /* Never unmap queue 0. We need it as a
2318 * fallback in case of a new remap fails
2319 * allocation
2320 */
Jens Axboecc71a6f2017-01-11 14:29:56 -07002321 if (i && set->tags[i])
2322 blk_mq_free_map_and_requests(set, i);
2323
Ming Lei2a34c082015-04-21 10:00:20 +08002324 hctx->tags = NULL;
Jens Axboe484b4062014-05-21 14:01:15 -06002325 continue;
2326 }
2327
Ming Lei2a34c082015-04-21 10:00:20 +08002328 hctx->tags = set->tags[i];
2329 WARN_ON(!hctx->tags);
2330
Jens Axboe484b4062014-05-21 14:01:15 -06002331 /*
Chong Yuan889fa312015-04-15 11:39:29 -06002332 * Set the map size to the number of mapped software queues.
2333 * This is more accurate and more efficient than looping
2334 * over all possibly mapped software queues.
2335 */
Omar Sandoval88459642016-09-17 08:38:44 -06002336 sbitmap_resize(&hctx->ctx_map, hctx->nr_ctx);
Chong Yuan889fa312015-04-15 11:39:29 -06002337
2338 /*
Jens Axboe484b4062014-05-21 14:01:15 -06002339 * Initialize batch roundrobin counts
2340 */
Jens Axboe506e9312014-05-07 10:26:44 -06002341 hctx->next_cpu = cpumask_first(hctx->cpumask);
2342 hctx->next_cpu_batch = BLK_MQ_CPU_WORK_BATCH;
2343 }
Jens Axboe320ae512013-10-24 09:20:05 +01002344}
2345
Jens Axboe8e8320c2017-06-20 17:56:13 -06002346/*
2347 * Caller needs to ensure that we're either frozen/quiesced, or that
2348 * the queue isn't live yet.
2349 */
Jeff Moyer2404e602015-11-03 10:40:06 -05002350static void queue_set_hctx_shared(struct request_queue *q, bool shared)
Jens Axboe0d2602c2014-05-13 15:10:52 -06002351{
2352 struct blk_mq_hw_ctx *hctx;
Jens Axboe0d2602c2014-05-13 15:10:52 -06002353 int i;
2354
Jeff Moyer2404e602015-11-03 10:40:06 -05002355 queue_for_each_hw_ctx(q, hctx, i) {
Jens Axboe8e8320c2017-06-20 17:56:13 -06002356 if (shared) {
2357 if (test_bit(BLK_MQ_S_SCHED_RESTART, &hctx->state))
2358 atomic_inc(&q->shared_hctx_restart);
Jeff Moyer2404e602015-11-03 10:40:06 -05002359 hctx->flags |= BLK_MQ_F_TAG_SHARED;
Jens Axboe8e8320c2017-06-20 17:56:13 -06002360 } else {
2361 if (test_bit(BLK_MQ_S_SCHED_RESTART, &hctx->state))
2362 atomic_dec(&q->shared_hctx_restart);
Jeff Moyer2404e602015-11-03 10:40:06 -05002363 hctx->flags &= ~BLK_MQ_F_TAG_SHARED;
Jens Axboe8e8320c2017-06-20 17:56:13 -06002364 }
Jeff Moyer2404e602015-11-03 10:40:06 -05002365 }
2366}
2367
Jens Axboe8e8320c2017-06-20 17:56:13 -06002368static void blk_mq_update_tag_set_depth(struct blk_mq_tag_set *set,
2369 bool shared)
Jeff Moyer2404e602015-11-03 10:40:06 -05002370{
2371 struct request_queue *q;
Jens Axboe0d2602c2014-05-13 15:10:52 -06002372
Bart Van Assche705cda92017-04-07 11:16:49 -07002373 lockdep_assert_held(&set->tag_list_lock);
2374
Jens Axboe0d2602c2014-05-13 15:10:52 -06002375 list_for_each_entry(q, &set->tag_list, tag_set_list) {
2376 blk_mq_freeze_queue(q);
Jeff Moyer2404e602015-11-03 10:40:06 -05002377 queue_set_hctx_shared(q, shared);
Jens Axboe0d2602c2014-05-13 15:10:52 -06002378 blk_mq_unfreeze_queue(q);
2379 }
2380}
2381
2382static void blk_mq_del_queue_tag_set(struct request_queue *q)
2383{
2384 struct blk_mq_tag_set *set = q->tag_set;
2385
Jens Axboe0d2602c2014-05-13 15:10:52 -06002386 mutex_lock(&set->tag_list_lock);
Bart Van Assche705cda92017-04-07 11:16:49 -07002387 list_del_rcu(&q->tag_set_list);
2388 INIT_LIST_HEAD(&q->tag_set_list);
Jeff Moyer2404e602015-11-03 10:40:06 -05002389 if (list_is_singular(&set->tag_list)) {
2390 /* just transitioned to unshared */
2391 set->flags &= ~BLK_MQ_F_TAG_SHARED;
2392 /* update existing queue */
2393 blk_mq_update_tag_set_depth(set, false);
2394 }
Jens Axboe0d2602c2014-05-13 15:10:52 -06002395 mutex_unlock(&set->tag_list_lock);
Bart Van Assche705cda92017-04-07 11:16:49 -07002396
2397 synchronize_rcu();
Jens Axboe0d2602c2014-05-13 15:10:52 -06002398}
2399
2400static void blk_mq_add_queue_tag_set(struct blk_mq_tag_set *set,
2401 struct request_queue *q)
2402{
2403 q->tag_set = set;
2404
2405 mutex_lock(&set->tag_list_lock);
Jeff Moyer2404e602015-11-03 10:40:06 -05002406
Jens Axboeff821d22017-11-10 22:05:12 -07002407 /*
2408 * Check to see if we're transitioning to shared (from 1 to 2 queues).
2409 */
2410 if (!list_empty(&set->tag_list) &&
2411 !(set->flags & BLK_MQ_F_TAG_SHARED)) {
Jeff Moyer2404e602015-11-03 10:40:06 -05002412 set->flags |= BLK_MQ_F_TAG_SHARED;
2413 /* update existing queue */
2414 blk_mq_update_tag_set_depth(set, true);
2415 }
2416 if (set->flags & BLK_MQ_F_TAG_SHARED)
2417 queue_set_hctx_shared(q, true);
Bart Van Assche705cda92017-04-07 11:16:49 -07002418 list_add_tail_rcu(&q->tag_set_list, &set->tag_list);
Jeff Moyer2404e602015-11-03 10:40:06 -05002419
Jens Axboe0d2602c2014-05-13 15:10:52 -06002420 mutex_unlock(&set->tag_list_lock);
2421}
2422
Ming Leie09aae7e2015-01-29 20:17:27 +08002423/*
2424 * It is the actual release handler for mq, but we do it from
2425 * request queue's release handler for avoiding use-after-free
2426 * and headache because q->mq_kobj shouldn't have been introduced,
2427 * but we can't group ctx/kctx kobj without it.
2428 */
2429void blk_mq_release(struct request_queue *q)
2430{
2431 struct blk_mq_hw_ctx *hctx;
2432 unsigned int i;
2433
2434 /* hctx kobj stays in hctx */
Ming Leic3b4afc2015-06-04 22:25:04 +08002435 queue_for_each_hw_ctx(q, hctx, i) {
2436 if (!hctx)
2437 continue;
Ming Lei6c8b2322017-02-22 18:14:01 +08002438 kobject_put(&hctx->kobj);
Ming Leic3b4afc2015-06-04 22:25:04 +08002439 }
Ming Leie09aae7e2015-01-29 20:17:27 +08002440
Akinobu Mitaa723bab2015-09-27 02:09:21 +09002441 q->mq_map = NULL;
2442
Ming Leie09aae7e2015-01-29 20:17:27 +08002443 kfree(q->queue_hw_ctx);
2444
Ming Lei7ea5fe32017-02-22 18:14:00 +08002445 /*
2446 * release .mq_kobj and sw queue's kobject now because
2447 * both share lifetime with request queue.
2448 */
2449 blk_mq_sysfs_deinit(q);
2450
Ming Leie09aae7e2015-01-29 20:17:27 +08002451 free_percpu(q->queue_ctx);
2452}
2453
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002454struct request_queue *blk_mq_init_queue(struct blk_mq_tag_set *set)
Jens Axboe320ae512013-10-24 09:20:05 +01002455{
Mike Snitzerb62c21b2015-03-12 23:56:02 -04002456 struct request_queue *uninit_q, *q;
2457
2458 uninit_q = blk_alloc_queue_node(GFP_KERNEL, set->numa_node);
2459 if (!uninit_q)
2460 return ERR_PTR(-ENOMEM);
2461
2462 q = blk_mq_init_allocated_queue(set, uninit_q);
2463 if (IS_ERR(q))
2464 blk_cleanup_queue(uninit_q);
2465
2466 return q;
2467}
2468EXPORT_SYMBOL(blk_mq_init_queue);
2469
Bart Van Assche07319672017-06-20 11:15:38 -07002470static int blk_mq_hw_ctx_size(struct blk_mq_tag_set *tag_set)
2471{
2472 int hw_ctx_size = sizeof(struct blk_mq_hw_ctx);
2473
Tejun Heo05707b62018-01-09 08:29:53 -08002474 BUILD_BUG_ON(ALIGN(offsetof(struct blk_mq_hw_ctx, srcu),
Bart Van Assche07319672017-06-20 11:15:38 -07002475 __alignof__(struct blk_mq_hw_ctx)) !=
2476 sizeof(struct blk_mq_hw_ctx));
2477
2478 if (tag_set->flags & BLK_MQ_F_BLOCKING)
2479 hw_ctx_size += sizeof(struct srcu_struct);
2480
2481 return hw_ctx_size;
2482}
2483
Keith Busch868f2f02015-12-17 17:08:14 -07002484static void blk_mq_realloc_hw_ctxs(struct blk_mq_tag_set *set,
2485 struct request_queue *q)
Mike Snitzerb62c21b2015-03-12 23:56:02 -04002486{
Keith Busch868f2f02015-12-17 17:08:14 -07002487 int i, j;
2488 struct blk_mq_hw_ctx **hctxs = q->queue_hw_ctx;
Jens Axboe320ae512013-10-24 09:20:05 +01002489
Keith Busch868f2f02015-12-17 17:08:14 -07002490 blk_mq_sysfs_unregister(q);
Ming Leifb350e02018-01-06 16:27:40 +08002491
2492 /* protect against switching io scheduler */
2493 mutex_lock(&q->sysfs_lock);
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002494 for (i = 0; i < set->nr_hw_queues; i++) {
Keith Busch868f2f02015-12-17 17:08:14 -07002495 int node;
Jens Axboef14bbe72014-05-27 12:06:53 -06002496
Keith Busch868f2f02015-12-17 17:08:14 -07002497 if (hctxs[i])
2498 continue;
2499
2500 node = blk_mq_hw_queue_to_node(q->mq_map, i);
Bart Van Assche07319672017-06-20 11:15:38 -07002501 hctxs[i] = kzalloc_node(blk_mq_hw_ctx_size(set),
Christoph Hellwigcdef54d2014-05-28 18:11:06 +02002502 GFP_KERNEL, node);
Jens Axboe320ae512013-10-24 09:20:05 +01002503 if (!hctxs[i])
Keith Busch868f2f02015-12-17 17:08:14 -07002504 break;
Jens Axboe320ae512013-10-24 09:20:05 +01002505
Jens Axboea86073e2014-10-13 15:41:54 -06002506 if (!zalloc_cpumask_var_node(&hctxs[i]->cpumask, GFP_KERNEL,
Keith Busch868f2f02015-12-17 17:08:14 -07002507 node)) {
2508 kfree(hctxs[i]);
2509 hctxs[i] = NULL;
2510 break;
2511 }
Jens Axboee4043dc2014-04-09 10:18:23 -06002512
Jens Axboe0d2602c2014-05-13 15:10:52 -06002513 atomic_set(&hctxs[i]->nr_active, 0);
Jens Axboef14bbe72014-05-27 12:06:53 -06002514 hctxs[i]->numa_node = node;
Jens Axboe320ae512013-10-24 09:20:05 +01002515 hctxs[i]->queue_num = i;
Keith Busch868f2f02015-12-17 17:08:14 -07002516
2517 if (blk_mq_init_hctx(q, set, hctxs[i], i)) {
2518 free_cpumask_var(hctxs[i]->cpumask);
2519 kfree(hctxs[i]);
2520 hctxs[i] = NULL;
2521 break;
2522 }
2523 blk_mq_hctx_kobj_init(hctxs[i]);
Jens Axboe320ae512013-10-24 09:20:05 +01002524 }
Keith Busch868f2f02015-12-17 17:08:14 -07002525 for (j = i; j < q->nr_hw_queues; j++) {
2526 struct blk_mq_hw_ctx *hctx = hctxs[j];
2527
2528 if (hctx) {
Jens Axboecc71a6f2017-01-11 14:29:56 -07002529 if (hctx->tags)
2530 blk_mq_free_map_and_requests(set, j);
Keith Busch868f2f02015-12-17 17:08:14 -07002531 blk_mq_exit_hctx(q, set, hctx, j);
Keith Busch868f2f02015-12-17 17:08:14 -07002532 kobject_put(&hctx->kobj);
Keith Busch868f2f02015-12-17 17:08:14 -07002533 hctxs[j] = NULL;
2534
2535 }
2536 }
2537 q->nr_hw_queues = i;
Ming Leifb350e02018-01-06 16:27:40 +08002538 mutex_unlock(&q->sysfs_lock);
Keith Busch868f2f02015-12-17 17:08:14 -07002539 blk_mq_sysfs_register(q);
2540}
2541
2542struct request_queue *blk_mq_init_allocated_queue(struct blk_mq_tag_set *set,
2543 struct request_queue *q)
2544{
Ming Lei66841672016-02-12 15:27:00 +08002545 /* mark the queue as mq asap */
2546 q->mq_ops = set->ops;
2547
Omar Sandoval34dbad52017-03-21 08:56:08 -07002548 q->poll_cb = blk_stat_alloc_callback(blk_mq_poll_stats_fn,
Stephen Bates720b8cc2017-04-07 06:24:03 -06002549 blk_mq_poll_stats_bkt,
2550 BLK_MQ_POLL_STATS_BKTS, q);
Omar Sandoval34dbad52017-03-21 08:56:08 -07002551 if (!q->poll_cb)
2552 goto err_exit;
2553
Keith Busch868f2f02015-12-17 17:08:14 -07002554 q->queue_ctx = alloc_percpu(struct blk_mq_ctx);
2555 if (!q->queue_ctx)
Ming Linc7de5722016-05-25 23:23:27 -07002556 goto err_exit;
Keith Busch868f2f02015-12-17 17:08:14 -07002557
Ming Lei737f98c2017-02-22 18:13:59 +08002558 /* init q->mq_kobj and sw queues' kobjects */
2559 blk_mq_sysfs_init(q);
2560
Keith Busch868f2f02015-12-17 17:08:14 -07002561 q->queue_hw_ctx = kzalloc_node(nr_cpu_ids * sizeof(*(q->queue_hw_ctx)),
2562 GFP_KERNEL, set->numa_node);
2563 if (!q->queue_hw_ctx)
2564 goto err_percpu;
2565
Christoph Hellwigbdd17e72016-09-14 16:18:53 +02002566 q->mq_map = set->mq_map;
Keith Busch868f2f02015-12-17 17:08:14 -07002567
2568 blk_mq_realloc_hw_ctxs(set, q);
2569 if (!q->nr_hw_queues)
2570 goto err_hctxs;
Jens Axboe320ae512013-10-24 09:20:05 +01002571
Christoph Hellwig287922e2015-10-30 20:57:30 +08002572 INIT_WORK(&q->timeout_work, blk_mq_timeout_work);
Ming Leie56f6982015-07-16 19:53:22 +08002573 blk_queue_rq_timeout(q, set->timeout ? set->timeout : 30 * HZ);
Jens Axboe320ae512013-10-24 09:20:05 +01002574
2575 q->nr_queues = nr_cpu_ids;
Jens Axboe320ae512013-10-24 09:20:05 +01002576
Jens Axboe94eddfb2013-11-19 09:25:07 -07002577 q->queue_flags |= QUEUE_FLAG_MQ_DEFAULT;
Jens Axboe320ae512013-10-24 09:20:05 +01002578
Jens Axboe05f1dd52014-05-29 09:53:32 -06002579 if (!(set->flags & BLK_MQ_F_SG_MERGE))
2580 q->queue_flags |= 1 << QUEUE_FLAG_NO_SG_MERGE;
2581
Christoph Hellwig1be036e2014-02-07 10:22:39 -08002582 q->sg_reserved_size = INT_MAX;
2583
Mike Snitzer28494502016-09-14 13:28:30 -04002584 INIT_DELAYED_WORK(&q->requeue_work, blk_mq_requeue_work);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -06002585 INIT_LIST_HEAD(&q->requeue_list);
2586 spin_lock_init(&q->requeue_lock);
2587
Christoph Hellwig254d2592017-03-22 15:01:50 -04002588 blk_queue_make_request(q, blk_mq_make_request);
Christoph Hellwigea435e12017-11-02 21:29:54 +03002589 if (q->mq_ops->poll)
2590 q->poll_fn = blk_mq_poll;
Jens Axboe07068d52014-05-22 10:40:51 -06002591
Jens Axboeeba71762014-05-20 15:17:27 -06002592 /*
2593 * Do this after blk_queue_make_request() overrides it...
2594 */
2595 q->nr_requests = set->queue_depth;
2596
Jens Axboe64f1c212016-11-14 13:03:03 -07002597 /*
2598 * Default to classic polling
2599 */
2600 q->poll_nsec = -1;
2601
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002602 if (set->ops->complete)
2603 blk_queue_softirq_done(q, set->ops->complete);
Christoph Hellwig30a91cb2014-02-10 03:24:38 -08002604
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002605 blk_mq_init_cpu_queues(q, set->nr_hw_queues);
Jens Axboe0d2602c2014-05-13 15:10:52 -06002606 blk_mq_add_queue_tag_set(set, q);
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002607 blk_mq_map_swqueue(q);
Akinobu Mita4593fdb2015-09-27 02:09:20 +09002608
Jens Axboed3484992017-01-13 14:43:58 -07002609 if (!(set->flags & BLK_MQ_F_NO_SCHED)) {
2610 int ret;
2611
2612 ret = blk_mq_sched_init(q);
2613 if (ret)
2614 return ERR_PTR(ret);
2615 }
2616
Jens Axboe320ae512013-10-24 09:20:05 +01002617 return q;
Christoph Hellwig18741982014-02-10 09:29:00 -07002618
Jens Axboe320ae512013-10-24 09:20:05 +01002619err_hctxs:
Keith Busch868f2f02015-12-17 17:08:14 -07002620 kfree(q->queue_hw_ctx);
Jens Axboe320ae512013-10-24 09:20:05 +01002621err_percpu:
Keith Busch868f2f02015-12-17 17:08:14 -07002622 free_percpu(q->queue_ctx);
Ming Linc7de5722016-05-25 23:23:27 -07002623err_exit:
2624 q->mq_ops = NULL;
Jens Axboe320ae512013-10-24 09:20:05 +01002625 return ERR_PTR(-ENOMEM);
2626}
Mike Snitzerb62c21b2015-03-12 23:56:02 -04002627EXPORT_SYMBOL(blk_mq_init_allocated_queue);
Jens Axboe320ae512013-10-24 09:20:05 +01002628
2629void blk_mq_free_queue(struct request_queue *q)
2630{
Ming Lei624dbe42014-05-27 23:35:13 +08002631 struct blk_mq_tag_set *set = q->tag_set;
Jens Axboe320ae512013-10-24 09:20:05 +01002632
Jens Axboe0d2602c2014-05-13 15:10:52 -06002633 blk_mq_del_queue_tag_set(q);
Ming Lei624dbe42014-05-27 23:35:13 +08002634 blk_mq_exit_hw_queues(q, set, set->nr_hw_queues);
Jens Axboe320ae512013-10-24 09:20:05 +01002635}
Jens Axboe320ae512013-10-24 09:20:05 +01002636
2637/* Basically redo blk_mq_init_queue with queue frozen */
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002638static void blk_mq_queue_reinit(struct request_queue *q)
Jens Axboe320ae512013-10-24 09:20:05 +01002639{
Christoph Hellwig4ecd4fe2015-05-07 09:38:13 +02002640 WARN_ON_ONCE(!atomic_read(&q->mq_freeze_depth));
Jens Axboe320ae512013-10-24 09:20:05 +01002641
Omar Sandoval9c1051a2017-05-04 08:17:21 -06002642 blk_mq_debugfs_unregister_hctxs(q);
Jens Axboe67aec142014-05-30 08:25:36 -06002643 blk_mq_sysfs_unregister(q);
2644
Jens Axboe320ae512013-10-24 09:20:05 +01002645 /*
2646 * redo blk_mq_init_cpu_queues and blk_mq_init_hw_queues. FIXME: maybe
Jens Axboeff821d22017-11-10 22:05:12 -07002647 * we should change hctx numa_node according to the new topology (this
2648 * involves freeing and re-allocating memory, worth doing?)
Jens Axboe320ae512013-10-24 09:20:05 +01002649 */
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002650 blk_mq_map_swqueue(q);
Jens Axboe320ae512013-10-24 09:20:05 +01002651
Jens Axboe67aec142014-05-30 08:25:36 -06002652 blk_mq_sysfs_register(q);
Omar Sandoval9c1051a2017-05-04 08:17:21 -06002653 blk_mq_debugfs_register_hctxs(q);
Jens Axboe320ae512013-10-24 09:20:05 +01002654}
2655
Jens Axboea5164402014-09-10 09:02:03 -06002656static int __blk_mq_alloc_rq_maps(struct blk_mq_tag_set *set)
2657{
2658 int i;
2659
Jens Axboecc71a6f2017-01-11 14:29:56 -07002660 for (i = 0; i < set->nr_hw_queues; i++)
2661 if (!__blk_mq_alloc_rq_map(set, i))
Jens Axboea5164402014-09-10 09:02:03 -06002662 goto out_unwind;
Jens Axboea5164402014-09-10 09:02:03 -06002663
2664 return 0;
2665
2666out_unwind:
2667 while (--i >= 0)
Jens Axboecc71a6f2017-01-11 14:29:56 -07002668 blk_mq_free_rq_map(set->tags[i]);
Jens Axboea5164402014-09-10 09:02:03 -06002669
Jens Axboea5164402014-09-10 09:02:03 -06002670 return -ENOMEM;
2671}
2672
2673/*
2674 * Allocate the request maps associated with this tag_set. Note that this
2675 * may reduce the depth asked for, if memory is tight. set->queue_depth
2676 * will be updated to reflect the allocated depth.
2677 */
2678static int blk_mq_alloc_rq_maps(struct blk_mq_tag_set *set)
2679{
2680 unsigned int depth;
2681 int err;
2682
2683 depth = set->queue_depth;
2684 do {
2685 err = __blk_mq_alloc_rq_maps(set);
2686 if (!err)
2687 break;
2688
2689 set->queue_depth >>= 1;
2690 if (set->queue_depth < set->reserved_tags + BLK_MQ_TAG_MIN) {
2691 err = -ENOMEM;
2692 break;
2693 }
2694 } while (set->queue_depth);
2695
2696 if (!set->queue_depth || err) {
2697 pr_err("blk-mq: failed to allocate request map\n");
2698 return -ENOMEM;
2699 }
2700
2701 if (depth != set->queue_depth)
2702 pr_info("blk-mq: reduced tag depth (%u -> %u)\n",
2703 depth, set->queue_depth);
2704
2705 return 0;
2706}
2707
Omar Sandovalebe8bdd2017-04-07 08:53:11 -06002708static int blk_mq_update_queue_map(struct blk_mq_tag_set *set)
2709{
Ming Lei7d4901a2018-01-06 16:27:39 +08002710 if (set->ops->map_queues) {
2711 int cpu;
2712 /*
2713 * transport .map_queues is usually done in the following
2714 * way:
2715 *
2716 * for (queue = 0; queue < set->nr_hw_queues; queue++) {
2717 * mask = get_cpu_mask(queue)
2718 * for_each_cpu(cpu, mask)
2719 * set->mq_map[cpu] = queue;
2720 * }
2721 *
2722 * When we need to remap, the table has to be cleared for
2723 * killing stale mapping since one CPU may not be mapped
2724 * to any hw queue.
2725 */
2726 for_each_possible_cpu(cpu)
2727 set->mq_map[cpu] = 0;
2728
Omar Sandovalebe8bdd2017-04-07 08:53:11 -06002729 return set->ops->map_queues(set);
Ming Lei7d4901a2018-01-06 16:27:39 +08002730 } else
Omar Sandovalebe8bdd2017-04-07 08:53:11 -06002731 return blk_mq_map_queues(set);
2732}
2733
Jens Axboea4391c62014-06-05 15:21:56 -06002734/*
2735 * Alloc a tag set to be associated with one or more request queues.
2736 * May fail with EINVAL for various error conditions. May adjust the
2737 * requested depth down, if if it too large. In that case, the set
2738 * value will be stored in set->queue_depth.
2739 */
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002740int blk_mq_alloc_tag_set(struct blk_mq_tag_set *set)
2741{
Christoph Hellwigda695ba2016-09-14 16:18:55 +02002742 int ret;
2743
Bart Van Assche205fb5f2014-10-30 14:45:11 +01002744 BUILD_BUG_ON(BLK_MQ_MAX_DEPTH > 1 << BLK_MQ_UNIQUE_TAG_BITS);
2745
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002746 if (!set->nr_hw_queues)
2747 return -EINVAL;
Jens Axboea4391c62014-06-05 15:21:56 -06002748 if (!set->queue_depth)
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002749 return -EINVAL;
2750 if (set->queue_depth < set->reserved_tags + BLK_MQ_TAG_MIN)
2751 return -EINVAL;
2752
Christoph Hellwig7d7e0f92016-09-14 16:18:54 +02002753 if (!set->ops->queue_rq)
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002754 return -EINVAL;
2755
Ming Leide148292017-10-14 17:22:29 +08002756 if (!set->ops->get_budget ^ !set->ops->put_budget)
2757 return -EINVAL;
2758
Jens Axboea4391c62014-06-05 15:21:56 -06002759 if (set->queue_depth > BLK_MQ_MAX_DEPTH) {
2760 pr_info("blk-mq: reduced tag depth to %u\n",
2761 BLK_MQ_MAX_DEPTH);
2762 set->queue_depth = BLK_MQ_MAX_DEPTH;
2763 }
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002764
Shaohua Li6637fad2014-11-30 16:00:58 -08002765 /*
2766 * If a crashdump is active, then we are potentially in a very
2767 * memory constrained environment. Limit us to 1 queue and
2768 * 64 tags to prevent using too much memory.
2769 */
2770 if (is_kdump_kernel()) {
2771 set->nr_hw_queues = 1;
2772 set->queue_depth = min(64U, set->queue_depth);
2773 }
Keith Busch868f2f02015-12-17 17:08:14 -07002774 /*
2775 * There is no use for more h/w queues than cpus.
2776 */
2777 if (set->nr_hw_queues > nr_cpu_ids)
2778 set->nr_hw_queues = nr_cpu_ids;
Shaohua Li6637fad2014-11-30 16:00:58 -08002779
Keith Busch868f2f02015-12-17 17:08:14 -07002780 set->tags = kzalloc_node(nr_cpu_ids * sizeof(struct blk_mq_tags *),
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002781 GFP_KERNEL, set->numa_node);
2782 if (!set->tags)
Jens Axboea5164402014-09-10 09:02:03 -06002783 return -ENOMEM;
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002784
Christoph Hellwigda695ba2016-09-14 16:18:55 +02002785 ret = -ENOMEM;
2786 set->mq_map = kzalloc_node(sizeof(*set->mq_map) * nr_cpu_ids,
2787 GFP_KERNEL, set->numa_node);
Christoph Hellwigbdd17e72016-09-14 16:18:53 +02002788 if (!set->mq_map)
2789 goto out_free_tags;
2790
Omar Sandovalebe8bdd2017-04-07 08:53:11 -06002791 ret = blk_mq_update_queue_map(set);
Christoph Hellwigda695ba2016-09-14 16:18:55 +02002792 if (ret)
2793 goto out_free_mq_map;
2794
2795 ret = blk_mq_alloc_rq_maps(set);
2796 if (ret)
Christoph Hellwigbdd17e72016-09-14 16:18:53 +02002797 goto out_free_mq_map;
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002798
Jens Axboe0d2602c2014-05-13 15:10:52 -06002799 mutex_init(&set->tag_list_lock);
2800 INIT_LIST_HEAD(&set->tag_list);
2801
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002802 return 0;
Christoph Hellwigbdd17e72016-09-14 16:18:53 +02002803
2804out_free_mq_map:
2805 kfree(set->mq_map);
2806 set->mq_map = NULL;
2807out_free_tags:
Robert Elliott5676e7b2014-09-02 11:38:44 -05002808 kfree(set->tags);
2809 set->tags = NULL;
Christoph Hellwigda695ba2016-09-14 16:18:55 +02002810 return ret;
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002811}
2812EXPORT_SYMBOL(blk_mq_alloc_tag_set);
2813
2814void blk_mq_free_tag_set(struct blk_mq_tag_set *set)
2815{
2816 int i;
2817
Jens Axboecc71a6f2017-01-11 14:29:56 -07002818 for (i = 0; i < nr_cpu_ids; i++)
2819 blk_mq_free_map_and_requests(set, i);
Jens Axboe484b4062014-05-21 14:01:15 -06002820
Christoph Hellwigbdd17e72016-09-14 16:18:53 +02002821 kfree(set->mq_map);
2822 set->mq_map = NULL;
2823
Ming Lei981bd182014-04-24 00:07:34 +08002824 kfree(set->tags);
Robert Elliott5676e7b2014-09-02 11:38:44 -05002825 set->tags = NULL;
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002826}
2827EXPORT_SYMBOL(blk_mq_free_tag_set);
2828
Jens Axboee3a2b3f2014-05-20 11:49:02 -06002829int blk_mq_update_nr_requests(struct request_queue *q, unsigned int nr)
2830{
2831 struct blk_mq_tag_set *set = q->tag_set;
2832 struct blk_mq_hw_ctx *hctx;
2833 int i, ret;
2834
Jens Axboebd166ef2017-01-17 06:03:22 -07002835 if (!set)
Jens Axboee3a2b3f2014-05-20 11:49:02 -06002836 return -EINVAL;
2837
Jens Axboe70f36b62017-01-19 10:59:07 -07002838 blk_mq_freeze_queue(q);
Ming Lei24f5a902018-01-06 16:27:38 +08002839 blk_mq_quiesce_queue(q);
Jens Axboe70f36b62017-01-19 10:59:07 -07002840
Jens Axboee3a2b3f2014-05-20 11:49:02 -06002841 ret = 0;
2842 queue_for_each_hw_ctx(q, hctx, i) {
Keith Busche9137d42016-02-18 14:56:35 -07002843 if (!hctx->tags)
2844 continue;
Jens Axboebd166ef2017-01-17 06:03:22 -07002845 /*
2846 * If we're using an MQ scheduler, just update the scheduler
2847 * queue depth. This is similar to what the old code would do.
2848 */
Jens Axboe70f36b62017-01-19 10:59:07 -07002849 if (!hctx->sched_tags) {
weiping zhangc2e82a22017-09-22 23:36:28 +08002850 ret = blk_mq_tag_update_depth(hctx, &hctx->tags, nr,
Jens Axboe70f36b62017-01-19 10:59:07 -07002851 false);
2852 } else {
2853 ret = blk_mq_tag_update_depth(hctx, &hctx->sched_tags,
2854 nr, true);
2855 }
Jens Axboee3a2b3f2014-05-20 11:49:02 -06002856 if (ret)
2857 break;
2858 }
2859
2860 if (!ret)
2861 q->nr_requests = nr;
2862
Ming Lei24f5a902018-01-06 16:27:38 +08002863 blk_mq_unquiesce_queue(q);
Jens Axboe70f36b62017-01-19 10:59:07 -07002864 blk_mq_unfreeze_queue(q);
Jens Axboe70f36b62017-01-19 10:59:07 -07002865
Jens Axboee3a2b3f2014-05-20 11:49:02 -06002866 return ret;
2867}
2868
Keith Busche4dc2b32017-05-30 14:39:11 -04002869static void __blk_mq_update_nr_hw_queues(struct blk_mq_tag_set *set,
2870 int nr_hw_queues)
Keith Busch868f2f02015-12-17 17:08:14 -07002871{
2872 struct request_queue *q;
2873
Bart Van Assche705cda92017-04-07 11:16:49 -07002874 lockdep_assert_held(&set->tag_list_lock);
2875
Keith Busch868f2f02015-12-17 17:08:14 -07002876 if (nr_hw_queues > nr_cpu_ids)
2877 nr_hw_queues = nr_cpu_ids;
2878 if (nr_hw_queues < 1 || nr_hw_queues == set->nr_hw_queues)
2879 return;
2880
2881 list_for_each_entry(q, &set->tag_list, tag_set_list)
2882 blk_mq_freeze_queue(q);
2883
2884 set->nr_hw_queues = nr_hw_queues;
Omar Sandovalebe8bdd2017-04-07 08:53:11 -06002885 blk_mq_update_queue_map(set);
Keith Busch868f2f02015-12-17 17:08:14 -07002886 list_for_each_entry(q, &set->tag_list, tag_set_list) {
2887 blk_mq_realloc_hw_ctxs(set, q);
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002888 blk_mq_queue_reinit(q);
Keith Busch868f2f02015-12-17 17:08:14 -07002889 }
2890
2891 list_for_each_entry(q, &set->tag_list, tag_set_list)
2892 blk_mq_unfreeze_queue(q);
2893}
Keith Busche4dc2b32017-05-30 14:39:11 -04002894
2895void blk_mq_update_nr_hw_queues(struct blk_mq_tag_set *set, int nr_hw_queues)
2896{
2897 mutex_lock(&set->tag_list_lock);
2898 __blk_mq_update_nr_hw_queues(set, nr_hw_queues);
2899 mutex_unlock(&set->tag_list_lock);
2900}
Keith Busch868f2f02015-12-17 17:08:14 -07002901EXPORT_SYMBOL_GPL(blk_mq_update_nr_hw_queues);
2902
Omar Sandoval34dbad52017-03-21 08:56:08 -07002903/* Enable polling stats and return whether they were already enabled. */
2904static bool blk_poll_stats_enable(struct request_queue *q)
2905{
2906 if (test_bit(QUEUE_FLAG_POLL_STATS, &q->queue_flags) ||
2907 test_and_set_bit(QUEUE_FLAG_POLL_STATS, &q->queue_flags))
2908 return true;
2909 blk_stat_add_callback(q, q->poll_cb);
2910 return false;
2911}
2912
2913static void blk_mq_poll_stats_start(struct request_queue *q)
2914{
2915 /*
2916 * We don't arm the callback if polling stats are not enabled or the
2917 * callback is already active.
2918 */
2919 if (!test_bit(QUEUE_FLAG_POLL_STATS, &q->queue_flags) ||
2920 blk_stat_is_active(q->poll_cb))
2921 return;
2922
2923 blk_stat_activate_msecs(q->poll_cb, 100);
2924}
2925
2926static void blk_mq_poll_stats_fn(struct blk_stat_callback *cb)
2927{
2928 struct request_queue *q = cb->data;
Stephen Bates720b8cc2017-04-07 06:24:03 -06002929 int bucket;
Omar Sandoval34dbad52017-03-21 08:56:08 -07002930
Stephen Bates720b8cc2017-04-07 06:24:03 -06002931 for (bucket = 0; bucket < BLK_MQ_POLL_STATS_BKTS; bucket++) {
2932 if (cb->stat[bucket].nr_samples)
2933 q->poll_stat[bucket] = cb->stat[bucket];
2934 }
Omar Sandoval34dbad52017-03-21 08:56:08 -07002935}
2936
Jens Axboe64f1c212016-11-14 13:03:03 -07002937static unsigned long blk_mq_poll_nsecs(struct request_queue *q,
2938 struct blk_mq_hw_ctx *hctx,
2939 struct request *rq)
2940{
Jens Axboe64f1c212016-11-14 13:03:03 -07002941 unsigned long ret = 0;
Stephen Bates720b8cc2017-04-07 06:24:03 -06002942 int bucket;
Jens Axboe64f1c212016-11-14 13:03:03 -07002943
2944 /*
2945 * If stats collection isn't on, don't sleep but turn it on for
2946 * future users
2947 */
Omar Sandoval34dbad52017-03-21 08:56:08 -07002948 if (!blk_poll_stats_enable(q))
Jens Axboe64f1c212016-11-14 13:03:03 -07002949 return 0;
2950
2951 /*
Jens Axboe64f1c212016-11-14 13:03:03 -07002952 * As an optimistic guess, use half of the mean service time
2953 * for this type of request. We can (and should) make this smarter.
2954 * For instance, if the completion latencies are tight, we can
2955 * get closer than just half the mean. This is especially
2956 * important on devices where the completion latencies are longer
Stephen Bates720b8cc2017-04-07 06:24:03 -06002957 * than ~10 usec. We do use the stats for the relevant IO size
2958 * if available which does lead to better estimates.
Jens Axboe64f1c212016-11-14 13:03:03 -07002959 */
Stephen Bates720b8cc2017-04-07 06:24:03 -06002960 bucket = blk_mq_poll_stats_bkt(rq);
2961 if (bucket < 0)
2962 return ret;
2963
2964 if (q->poll_stat[bucket].nr_samples)
2965 ret = (q->poll_stat[bucket].mean + 1) / 2;
Jens Axboe64f1c212016-11-14 13:03:03 -07002966
2967 return ret;
2968}
2969
Jens Axboe06426ad2016-11-14 13:01:59 -07002970static bool blk_mq_poll_hybrid_sleep(struct request_queue *q,
Jens Axboe64f1c212016-11-14 13:03:03 -07002971 struct blk_mq_hw_ctx *hctx,
Jens Axboe06426ad2016-11-14 13:01:59 -07002972 struct request *rq)
2973{
2974 struct hrtimer_sleeper hs;
2975 enum hrtimer_mode mode;
Jens Axboe64f1c212016-11-14 13:03:03 -07002976 unsigned int nsecs;
Jens Axboe06426ad2016-11-14 13:01:59 -07002977 ktime_t kt;
2978
Jens Axboe64f1c212016-11-14 13:03:03 -07002979 if (test_bit(REQ_ATOM_POLL_SLEPT, &rq->atomic_flags))
2980 return false;
2981
2982 /*
2983 * poll_nsec can be:
2984 *
2985 * -1: don't ever hybrid sleep
2986 * 0: use half of prev avg
2987 * >0: use this specific value
2988 */
2989 if (q->poll_nsec == -1)
2990 return false;
2991 else if (q->poll_nsec > 0)
2992 nsecs = q->poll_nsec;
2993 else
2994 nsecs = blk_mq_poll_nsecs(q, hctx, rq);
2995
2996 if (!nsecs)
Jens Axboe06426ad2016-11-14 13:01:59 -07002997 return false;
2998
2999 set_bit(REQ_ATOM_POLL_SLEPT, &rq->atomic_flags);
3000
3001 /*
3002 * This will be replaced with the stats tracking code, using
3003 * 'avg_completion_time / 2' as the pre-sleep target.
3004 */
Thomas Gleixner8b0e1952016-12-25 12:30:41 +01003005 kt = nsecs;
Jens Axboe06426ad2016-11-14 13:01:59 -07003006
3007 mode = HRTIMER_MODE_REL;
3008 hrtimer_init_on_stack(&hs.timer, CLOCK_MONOTONIC, mode);
3009 hrtimer_set_expires(&hs.timer, kt);
3010
3011 hrtimer_init_sleeper(&hs, current);
3012 do {
Tejun Heo5a61c362018-01-09 08:29:52 -08003013 if (blk_mq_rq_state(rq) == MQ_RQ_COMPLETE)
Jens Axboe06426ad2016-11-14 13:01:59 -07003014 break;
3015 set_current_state(TASK_UNINTERRUPTIBLE);
3016 hrtimer_start_expires(&hs.timer, mode);
3017 if (hs.task)
3018 io_schedule();
3019 hrtimer_cancel(&hs.timer);
3020 mode = HRTIMER_MODE_ABS;
3021 } while (hs.task && !signal_pending(current));
3022
3023 __set_current_state(TASK_RUNNING);
3024 destroy_hrtimer_on_stack(&hs.timer);
3025 return true;
3026}
3027
Jens Axboebbd7bb72016-11-04 09:34:34 -06003028static bool __blk_mq_poll(struct blk_mq_hw_ctx *hctx, struct request *rq)
3029{
3030 struct request_queue *q = hctx->queue;
3031 long state;
3032
Jens Axboe06426ad2016-11-14 13:01:59 -07003033 /*
3034 * If we sleep, have the caller restart the poll loop to reset
3035 * the state. Like for the other success return cases, the
3036 * caller is responsible for checking if the IO completed. If
3037 * the IO isn't complete, we'll get called again and will go
3038 * straight to the busy poll loop.
3039 */
Jens Axboe64f1c212016-11-14 13:03:03 -07003040 if (blk_mq_poll_hybrid_sleep(q, hctx, rq))
Jens Axboe06426ad2016-11-14 13:01:59 -07003041 return true;
3042
Jens Axboebbd7bb72016-11-04 09:34:34 -06003043 hctx->poll_considered++;
3044
3045 state = current->state;
3046 while (!need_resched()) {
3047 int ret;
3048
3049 hctx->poll_invoked++;
3050
3051 ret = q->mq_ops->poll(hctx, rq->tag);
3052 if (ret > 0) {
3053 hctx->poll_success++;
3054 set_current_state(TASK_RUNNING);
3055 return true;
3056 }
3057
3058 if (signal_pending_state(state, current))
3059 set_current_state(TASK_RUNNING);
3060
3061 if (current->state == TASK_RUNNING)
3062 return true;
3063 if (ret < 0)
3064 break;
3065 cpu_relax();
3066 }
3067
3068 return false;
3069}
3070
Christoph Hellwigea435e12017-11-02 21:29:54 +03003071static bool blk_mq_poll(struct request_queue *q, blk_qc_t cookie)
Jens Axboebbd7bb72016-11-04 09:34:34 -06003072{
3073 struct blk_mq_hw_ctx *hctx;
Jens Axboebbd7bb72016-11-04 09:34:34 -06003074 struct request *rq;
3075
Christoph Hellwigea435e12017-11-02 21:29:54 +03003076 if (!test_bit(QUEUE_FLAG_POLL, &q->queue_flags))
Jens Axboebbd7bb72016-11-04 09:34:34 -06003077 return false;
3078
Jens Axboebbd7bb72016-11-04 09:34:34 -06003079 hctx = q->queue_hw_ctx[blk_qc_t_to_queue_num(cookie)];
Jens Axboebd166ef2017-01-17 06:03:22 -07003080 if (!blk_qc_t_is_internal(cookie))
3081 rq = blk_mq_tag_to_rq(hctx->tags, blk_qc_t_to_tag(cookie));
Jens Axboe3a07bb12017-04-20 14:53:28 -06003082 else {
Jens Axboebd166ef2017-01-17 06:03:22 -07003083 rq = blk_mq_tag_to_rq(hctx->sched_tags, blk_qc_t_to_tag(cookie));
Jens Axboe3a07bb12017-04-20 14:53:28 -06003084 /*
3085 * With scheduling, if the request has completed, we'll
3086 * get a NULL return here, as we clear the sched tag when
3087 * that happens. The request still remains valid, like always,
3088 * so we should be safe with just the NULL check.
3089 */
3090 if (!rq)
3091 return false;
3092 }
Jens Axboebbd7bb72016-11-04 09:34:34 -06003093
3094 return __blk_mq_poll(hctx, rq);
3095}
Jens Axboebbd7bb72016-11-04 09:34:34 -06003096
Jens Axboe320ae512013-10-24 09:20:05 +01003097static int __init blk_mq_init(void)
3098{
Thomas Gleixner9467f852016-09-22 08:05:17 -06003099 cpuhp_setup_state_multi(CPUHP_BLK_MQ_DEAD, "block/mq:dead", NULL,
3100 blk_mq_hctx_notify_dead);
Jens Axboe320ae512013-10-24 09:20:05 +01003101 return 0;
3102}
3103subsys_initcall(blk_mq_init);