blob: 435a5a0d441f2fb4702468c98faf8a0c85087b9f [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 Busch6bae363e2017-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 Busch6bae363e2017-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
273 if (data->flags & BLK_MQ_REQ_INTERNAL) {
274 rq->tag = -1;
275 rq->internal_tag = tag;
276 } else {
277 if (blk_mq_tag_busy(data->hctx)) {
278 rq->rq_flags = RQF_MQ_INFLIGHT;
279 atomic_inc(&data->hctx->nr_active);
280 }
281 rq->tag = tag;
282 rq->internal_tag = -1;
283 data->hctx->tags->rqs[rq->tag] = rq;
284 }
285
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200286 /* csd/requeue_work/fifo_time is initialized before use */
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200287 rq->q = data->q;
288 rq->mq_ctx = data->ctx;
Jens Axboe7c3fb702018-01-10 11:46:39 -0700289 rq->rq_flags = 0;
290 rq->cpu = -1;
Christoph Hellwigef295ec2016-10-28 08:48:16 -0600291 rq->cmd_flags = op;
Bart Van Assche1b6d65a2017-11-09 10:49:55 -0800292 if (data->flags & BLK_MQ_REQ_PREEMPT)
293 rq->rq_flags |= RQF_PREEMPT;
Christoph Hellwige4cdf1a2017-06-16 18:15:27 +0200294 if (blk_queue_io_stat(data->q))
Christoph Hellwige8064022016-10-20 15:12:13 +0200295 rq->rq_flags |= RQF_IO_STAT;
Jens Axboe7c3fb702018-01-10 11:46:39 -0700296 INIT_LIST_HEAD(&rq->queuelist);
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200297 INIT_HLIST_NODE(&rq->hash);
298 RB_CLEAR_NODE(&rq->rb_node);
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200299 rq->rq_disk = NULL;
300 rq->part = NULL;
Jens Axboe3ee32372014-06-09 09:36:53 -0600301 rq->start_time = jiffies;
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200302 rq->nr_phys_segments = 0;
303#if defined(CONFIG_BLK_DEV_INTEGRITY)
304 rq->nr_integrity_segments = 0;
305#endif
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200306 rq->special = NULL;
307 /* tag was already set */
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200308 rq->extra_len = 0;
Jens Axboee14575b32018-01-10 11:34:25 -0700309 rq->__deadline = 0;
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200310
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200311 INIT_LIST_HEAD(&rq->timeout_list);
Jens Axboef6be4fb2014-06-06 11:03:48 -0600312 rq->timeout = 0;
313
Christoph Hellwigaf76e552014-05-06 12:12:45 +0200314 rq->end_io = NULL;
315 rq->end_io_data = NULL;
316 rq->next_rq = NULL;
317
Jens Axboe7c3fb702018-01-10 11:46:39 -0700318#ifdef CONFIG_BLK_CGROUP
319 rq->rl = NULL;
320 set_start_time_ns(rq);
321 rq->io_start_time_ns = 0;
322#endif
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 Axboebd166ef2017-01-17 06:03:22 -0700486 if (rq->tag != -1)
487 blk_mq_put_tag(hctx, hctx->tags, ctx, rq->tag);
488 if (sched_tag != -1)
Omar Sandovalc05f8522017-04-14 01:00:01 -0700489 blk_mq_put_tag(hctx, hctx->sched_tags, ctx, sched_tag);
Bart Van Assche6d8c6c02017-04-07 12:40:09 -0600490 blk_mq_sched_restart(hctx);
Dan Williams3ef28e82015-10-21 13:20:12 -0400491 blk_queue_exit(q);
Jens Axboe320ae512013-10-24 09:20:05 +0100492}
Jens Axboe1a3b5952014-11-17 10:40:48 -0700493EXPORT_SYMBOL_GPL(blk_mq_free_request);
Jens Axboe320ae512013-10-24 09:20:05 +0100494
Christoph Hellwig2a842ac2017-06-03 09:38:04 +0200495inline void __blk_mq_end_request(struct request *rq, blk_status_t error)
Jens Axboe320ae512013-10-24 09:20:05 +0100496{
Ming Lei0d11e6a2013-12-05 10:50:39 -0700497 blk_account_io_done(rq);
498
Christoph Hellwig91b63632014-04-16 09:44:53 +0200499 if (rq->end_io) {
Jens Axboe87760e52016-11-09 12:38:14 -0700500 wbt_done(rq->q->rq_wb, &rq->issue_stat);
Jens Axboe320ae512013-10-24 09:20:05 +0100501 rq->end_io(rq, error);
Christoph Hellwig91b63632014-04-16 09:44:53 +0200502 } else {
503 if (unlikely(blk_bidi_rq(rq)))
504 blk_mq_free_request(rq->next_rq);
Jens Axboe320ae512013-10-24 09:20:05 +0100505 blk_mq_free_request(rq);
Christoph Hellwig91b63632014-04-16 09:44:53 +0200506 }
Jens Axboe320ae512013-10-24 09:20:05 +0100507}
Christoph Hellwigc8a446a2014-09-13 16:40:10 -0700508EXPORT_SYMBOL(__blk_mq_end_request);
Christoph Hellwig63151a42014-04-16 09:44:52 +0200509
Christoph Hellwig2a842ac2017-06-03 09:38:04 +0200510void blk_mq_end_request(struct request *rq, blk_status_t error)
Christoph Hellwig63151a42014-04-16 09:44:52 +0200511{
512 if (blk_update_request(rq, error, blk_rq_bytes(rq)))
513 BUG();
Christoph Hellwigc8a446a2014-09-13 16:40:10 -0700514 __blk_mq_end_request(rq, error);
Christoph Hellwig63151a42014-04-16 09:44:52 +0200515}
Christoph Hellwigc8a446a2014-09-13 16:40:10 -0700516EXPORT_SYMBOL(blk_mq_end_request);
Jens Axboe320ae512013-10-24 09:20:05 +0100517
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800518static void __blk_mq_complete_request_remote(void *data)
Jens Axboe320ae512013-10-24 09:20:05 +0100519{
Christoph Hellwig3d6efbf2014-01-08 09:33:37 -0800520 struct request *rq = data;
Jens Axboe320ae512013-10-24 09:20:05 +0100521
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800522 rq->q->softirq_done_fn(rq);
Jens Axboe320ae512013-10-24 09:20:05 +0100523}
524
Christoph Hellwig453f8342017-04-20 16:03:10 +0200525static void __blk_mq_complete_request(struct request *rq)
Jens Axboe320ae512013-10-24 09:20:05 +0100526{
527 struct blk_mq_ctx *ctx = rq->mq_ctx;
Christoph Hellwig38535202014-04-25 02:32:53 -0700528 bool shared = false;
Jens Axboe320ae512013-10-24 09:20:05 +0100529 int cpu;
530
Tejun Heo1d9bd512018-01-09 08:29:48 -0800531 WARN_ON_ONCE(blk_mq_rq_state(rq) != MQ_RQ_IN_FLIGHT);
Tejun Heo5a61c362018-01-09 08:29:52 -0800532 blk_mq_rq_update_state(rq, MQ_RQ_COMPLETE);
Tejun Heo1d9bd512018-01-09 08:29:48 -0800533
Christoph Hellwig453f8342017-04-20 16:03:10 +0200534 if (rq->internal_tag != -1)
535 blk_mq_sched_completed_request(rq);
536 if (rq->rq_flags & RQF_STATS) {
537 blk_mq_poll_stats_start(rq->q);
538 blk_stat_add(rq);
539 }
540
Christoph Hellwig38535202014-04-25 02:32:53 -0700541 if (!test_bit(QUEUE_FLAG_SAME_COMP, &rq->q->queue_flags)) {
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800542 rq->q->softirq_done_fn(rq);
543 return;
544 }
Jens Axboe320ae512013-10-24 09:20:05 +0100545
546 cpu = get_cpu();
Christoph Hellwig38535202014-04-25 02:32:53 -0700547 if (!test_bit(QUEUE_FLAG_SAME_FORCE, &rq->q->queue_flags))
548 shared = cpus_share_cache(cpu, ctx->cpu);
549
550 if (cpu != ctx->cpu && !shared && cpu_online(ctx->cpu)) {
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800551 rq->csd.func = __blk_mq_complete_request_remote;
Christoph Hellwig3d6efbf2014-01-08 09:33:37 -0800552 rq->csd.info = rq;
553 rq->csd.flags = 0;
Frederic Weisbeckerc46fff22014-02-24 16:40:02 +0100554 smp_call_function_single_async(ctx->cpu, &rq->csd);
Christoph Hellwig3d6efbf2014-01-08 09:33:37 -0800555 } else {
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800556 rq->q->softirq_done_fn(rq);
Christoph Hellwig3d6efbf2014-01-08 09:33:37 -0800557 }
Jens Axboe320ae512013-10-24 09:20:05 +0100558 put_cpu();
559}
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800560
Jens Axboe04ced152018-01-09 08:29:46 -0800561static void hctx_unlock(struct blk_mq_hw_ctx *hctx, int srcu_idx)
562{
563 if (!(hctx->flags & BLK_MQ_F_BLOCKING))
564 rcu_read_unlock();
565 else
Tejun Heo05707b62018-01-09 08:29:53 -0800566 srcu_read_unlock(hctx->srcu, srcu_idx);
Jens Axboe04ced152018-01-09 08:29:46 -0800567}
568
569static void hctx_lock(struct blk_mq_hw_ctx *hctx, int *srcu_idx)
570{
Jens Axboe08b5a6e2018-01-09 09:32:25 -0700571 if (!(hctx->flags & BLK_MQ_F_BLOCKING)) {
572 /* shut up gcc false positive */
573 *srcu_idx = 0;
Jens Axboe04ced152018-01-09 08:29:46 -0800574 rcu_read_lock();
Jens Axboe08b5a6e2018-01-09 09:32:25 -0700575 } else
Tejun Heo05707b62018-01-09 08:29:53 -0800576 *srcu_idx = srcu_read_lock(hctx->srcu);
Jens Axboe04ced152018-01-09 08:29:46 -0800577}
578
Tejun Heo1d9bd512018-01-09 08:29:48 -0800579static void blk_mq_rq_update_aborted_gstate(struct request *rq, u64 gstate)
580{
581 unsigned long flags;
582
583 /*
584 * blk_mq_rq_aborted_gstate() is used from the completion path and
585 * can thus be called from irq context. u64_stats_fetch in the
586 * middle of update on the same CPU leads to lockup. Disable irq
587 * while updating.
588 */
589 local_irq_save(flags);
590 u64_stats_update_begin(&rq->aborted_gstate_sync);
591 rq->aborted_gstate = gstate;
592 u64_stats_update_end(&rq->aborted_gstate_sync);
593 local_irq_restore(flags);
594}
595
596static u64 blk_mq_rq_aborted_gstate(struct request *rq)
597{
598 unsigned int start;
599 u64 aborted_gstate;
600
601 do {
602 start = u64_stats_fetch_begin(&rq->aborted_gstate_sync);
603 aborted_gstate = rq->aborted_gstate;
604 } while (u64_stats_fetch_retry(&rq->aborted_gstate_sync, start));
605
606 return aborted_gstate;
607}
608
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800609/**
610 * blk_mq_complete_request - end I/O on a request
611 * @rq: the request being processed
612 *
613 * Description:
614 * Ends all I/O on a request. It does not handle partial completions.
615 * The actual completion happens out-of-order, through a IPI handler.
616 **/
Christoph Hellwig08e00292017-04-20 16:03:09 +0200617void blk_mq_complete_request(struct request *rq)
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800618{
Jens Axboe95f09682014-05-27 17:46:48 -0600619 struct request_queue *q = rq->q;
Tejun Heo5197c052018-01-09 08:29:47 -0800620 struct blk_mq_hw_ctx *hctx = blk_mq_map_queue(q, rq->mq_ctx->cpu);
621 int srcu_idx;
Jens Axboe95f09682014-05-27 17:46:48 -0600622
623 if (unlikely(blk_should_fake_timeout(q)))
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800624 return;
Tejun Heo5197c052018-01-09 08:29:47 -0800625
Tejun Heo1d9bd512018-01-09 08:29:48 -0800626 /*
627 * If @rq->aborted_gstate equals the current instance, timeout is
628 * claiming @rq and we lost. This is synchronized through
629 * hctx_lock(). See blk_mq_timeout_work() for details.
630 *
631 * Completion path never blocks and we can directly use RCU here
632 * instead of hctx_lock() which can be either RCU or SRCU.
633 * However, that would complicate paths which want to synchronize
634 * against us. Let stay in sync with the issue path so that
635 * hctx_lock() covers both issue and completion paths.
636 */
Tejun Heo5197c052018-01-09 08:29:47 -0800637 hctx_lock(hctx, &srcu_idx);
Tejun Heo634f9e42018-01-09 08:29:51 -0800638 if (blk_mq_rq_aborted_gstate(rq) != rq->gstate)
Jens Axboeed851862014-05-30 21:20:50 -0600639 __blk_mq_complete_request(rq);
Tejun Heo5197c052018-01-09 08:29:47 -0800640 hctx_unlock(hctx, srcu_idx);
Christoph Hellwig30a91cb2014-02-10 03:24:38 -0800641}
642EXPORT_SYMBOL(blk_mq_complete_request);
Jens Axboe320ae512013-10-24 09:20:05 +0100643
Keith Busch973c0192015-01-07 18:55:43 -0700644int blk_mq_request_started(struct request *rq)
645{
Tejun Heo5a61c362018-01-09 08:29:52 -0800646 return blk_mq_rq_state(rq) != MQ_RQ_IDLE;
Keith Busch973c0192015-01-07 18:55:43 -0700647}
648EXPORT_SYMBOL_GPL(blk_mq_request_started);
649
Christoph Hellwige2490072014-09-13 16:40:09 -0700650void blk_mq_start_request(struct request *rq)
Jens Axboe320ae512013-10-24 09:20:05 +0100651{
652 struct request_queue *q = rq->q;
653
Jens Axboebd166ef2017-01-17 06:03:22 -0700654 blk_mq_sched_started_request(rq);
655
Jens Axboe320ae512013-10-24 09:20:05 +0100656 trace_block_rq_issue(q, rq);
657
Jens Axboecf43e6b2016-11-07 21:32:37 -0700658 if (test_bit(QUEUE_FLAG_STATS, &q->queue_flags)) {
Shaohua Li88eeca42017-03-27 15:19:41 -0700659 blk_stat_set_issue(&rq->issue_stat, blk_rq_sectors(rq));
Jens Axboecf43e6b2016-11-07 21:32:37 -0700660 rq->rq_flags |= RQF_STATS;
Jens Axboe87760e52016-11-09 12:38:14 -0700661 wbt_issue(q->rq_wb, &rq->issue_stat);
Jens Axboecf43e6b2016-11-07 21:32:37 -0700662 }
663
Tejun Heo1d9bd512018-01-09 08:29:48 -0800664 WARN_ON_ONCE(blk_mq_rq_state(rq) != MQ_RQ_IDLE);
Jens Axboe538b7532014-09-16 10:37:37 -0600665
666 /*
Tejun Heo1d9bd512018-01-09 08:29:48 -0800667 * Mark @rq in-flight which also advances the generation number,
668 * and register for timeout. Protect with a seqcount to allow the
669 * timeout path to read both @rq->gstate and @rq->deadline
670 * coherently.
Peter Zijlstraa7af0af2017-09-06 10:00:22 +0200671 *
Tejun Heo1d9bd512018-01-09 08:29:48 -0800672 * This is the only place where a request is marked in-flight. If
673 * the timeout path reads an in-flight @rq->gstate, the
674 * @rq->deadline it reads together under @rq->gstate_seq is
675 * guaranteed to be the matching one.
Jens Axboe87ee7b12014-04-24 08:51:47 -0600676 */
Tejun Heo1d9bd512018-01-09 08:29:48 -0800677 preempt_disable();
678 write_seqcount_begin(&rq->gstate_seq);
679
680 blk_mq_rq_update_state(rq, MQ_RQ_IN_FLIGHT);
681 blk_add_timer(rq);
682
683 write_seqcount_end(&rq->gstate_seq);
684 preempt_enable();
685
Christoph Hellwig49f5baa2014-02-11 08:27:14 -0800686 if (q->dma_drain_size && blk_rq_bytes(rq)) {
687 /*
688 * Make sure space for the drain appears. We know we can do
689 * this because max_hw_segments has been adjusted to be one
690 * fewer than the device can handle.
691 */
692 rq->nr_phys_segments++;
693 }
Jens Axboe320ae512013-10-24 09:20:05 +0100694}
Christoph Hellwige2490072014-09-13 16:40:09 -0700695EXPORT_SYMBOL(blk_mq_start_request);
Jens Axboe320ae512013-10-24 09:20:05 +0100696
Ming Leid9d149a2017-03-27 20:06:55 +0800697/*
Tejun Heo5a61c362018-01-09 08:29:52 -0800698 * When we reach here because queue is busy, it's safe to change the state
699 * to IDLE without checking @rq->aborted_gstate because we should still be
700 * holding the RCU read lock and thus protected against timeout.
Ming Leid9d149a2017-03-27 20:06:55 +0800701 */
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200702static void __blk_mq_requeue_request(struct request *rq)
Jens Axboe320ae512013-10-24 09:20:05 +0100703{
704 struct request_queue *q = rq->q;
705
Ming Lei923218f2017-11-02 23:24:38 +0800706 blk_mq_put_driver_tag(rq);
707
Jens Axboe320ae512013-10-24 09:20:05 +0100708 trace_block_rq_requeue(q, rq);
Jens Axboe87760e52016-11-09 12:38:14 -0700709 wbt_requeue(q->rq_wb, &rq->issue_stat);
Jens Axboebd166ef2017-01-17 06:03:22 -0700710 blk_mq_sched_requeue_request(rq);
Christoph Hellwig49f5baa2014-02-11 08:27:14 -0800711
Tejun Heo5a61c362018-01-09 08:29:52 -0800712 if (blk_mq_rq_state(rq) != MQ_RQ_IDLE) {
Tejun Heo1d9bd512018-01-09 08:29:48 -0800713 blk_mq_rq_update_state(rq, MQ_RQ_IDLE);
Christoph Hellwige2490072014-09-13 16:40:09 -0700714 if (q->dma_drain_size && blk_rq_bytes(rq))
715 rq->nr_phys_segments--;
716 }
Jens Axboe320ae512013-10-24 09:20:05 +0100717}
718
Bart Van Assche2b053ac2016-10-28 17:21:41 -0700719void blk_mq_requeue_request(struct request *rq, bool kick_requeue_list)
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200720{
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200721 __blk_mq_requeue_request(rq);
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200722
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200723 BUG_ON(blk_queued_rq(rq));
Bart Van Assche2b053ac2016-10-28 17:21:41 -0700724 blk_mq_add_to_requeue_list(rq, true, kick_requeue_list);
Christoph Hellwiged0791b2014-04-16 09:44:57 +0200725}
726EXPORT_SYMBOL(blk_mq_requeue_request);
727
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600728static void blk_mq_requeue_work(struct work_struct *work)
729{
730 struct request_queue *q =
Mike Snitzer28494502016-09-14 13:28:30 -0400731 container_of(work, struct request_queue, requeue_work.work);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600732 LIST_HEAD(rq_list);
733 struct request *rq, *next;
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600734
Jens Axboe18e97812017-07-27 08:03:57 -0600735 spin_lock_irq(&q->requeue_lock);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600736 list_splice_init(&q->requeue_list, &rq_list);
Jens Axboe18e97812017-07-27 08:03:57 -0600737 spin_unlock_irq(&q->requeue_lock);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600738
739 list_for_each_entry_safe(rq, next, &rq_list, queuelist) {
Christoph Hellwige8064022016-10-20 15:12:13 +0200740 if (!(rq->rq_flags & RQF_SOFTBARRIER))
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600741 continue;
742
Christoph Hellwige8064022016-10-20 15:12:13 +0200743 rq->rq_flags &= ~RQF_SOFTBARRIER;
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600744 list_del_init(&rq->queuelist);
Jens Axboebd6737f2017-01-27 01:00:47 -0700745 blk_mq_sched_insert_request(rq, true, false, false, true);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600746 }
747
748 while (!list_empty(&rq_list)) {
749 rq = list_entry(rq_list.next, struct request, queuelist);
750 list_del_init(&rq->queuelist);
Jens Axboebd6737f2017-01-27 01:00:47 -0700751 blk_mq_sched_insert_request(rq, false, false, false, true);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600752 }
753
Bart Van Assche52d7f1b2016-10-28 17:20:32 -0700754 blk_mq_run_hw_queues(q, false);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600755}
756
Bart Van Assche2b053ac2016-10-28 17:21:41 -0700757void blk_mq_add_to_requeue_list(struct request *rq, bool at_head,
758 bool kick_requeue_list)
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600759{
760 struct request_queue *q = rq->q;
761 unsigned long flags;
762
763 /*
764 * We abuse this flag that is otherwise used by the I/O scheduler to
Jens Axboeff821d22017-11-10 22:05:12 -0700765 * request head insertion from the workqueue.
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600766 */
Christoph Hellwige8064022016-10-20 15:12:13 +0200767 BUG_ON(rq->rq_flags & RQF_SOFTBARRIER);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600768
769 spin_lock_irqsave(&q->requeue_lock, flags);
770 if (at_head) {
Christoph Hellwige8064022016-10-20 15:12:13 +0200771 rq->rq_flags |= RQF_SOFTBARRIER;
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600772 list_add(&rq->queuelist, &q->requeue_list);
773 } else {
774 list_add_tail(&rq->queuelist, &q->requeue_list);
775 }
776 spin_unlock_irqrestore(&q->requeue_lock, flags);
Bart Van Assche2b053ac2016-10-28 17:21:41 -0700777
778 if (kick_requeue_list)
779 blk_mq_kick_requeue_list(q);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600780}
781EXPORT_SYMBOL(blk_mq_add_to_requeue_list);
782
783void blk_mq_kick_requeue_list(struct request_queue *q)
784{
Mike Snitzer28494502016-09-14 13:28:30 -0400785 kblockd_schedule_delayed_work(&q->requeue_work, 0);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -0600786}
787EXPORT_SYMBOL(blk_mq_kick_requeue_list);
788
Mike Snitzer28494502016-09-14 13:28:30 -0400789void blk_mq_delay_kick_requeue_list(struct request_queue *q,
790 unsigned long msecs)
791{
Bart Van Assched4acf362017-08-09 11:28:06 -0700792 kblockd_mod_delayed_work_on(WORK_CPU_UNBOUND, &q->requeue_work,
793 msecs_to_jiffies(msecs));
Mike Snitzer28494502016-09-14 13:28:30 -0400794}
795EXPORT_SYMBOL(blk_mq_delay_kick_requeue_list);
796
Jens Axboe0e62f512014-06-04 10:23:49 -0600797struct request *blk_mq_tag_to_rq(struct blk_mq_tags *tags, unsigned int tag)
798{
Jens Axboe88c7b2b2016-08-25 08:07:30 -0600799 if (tag < tags->nr_tags) {
800 prefetch(tags->rqs[tag]);
Hannes Reinecke4ee86ba2016-03-15 12:03:28 -0700801 return tags->rqs[tag];
Jens Axboe88c7b2b2016-08-25 08:07:30 -0600802 }
Hannes Reinecke4ee86ba2016-03-15 12:03:28 -0700803
804 return NULL;
Christoph Hellwig24d2f902014-04-15 14:14:00 -0600805}
806EXPORT_SYMBOL(blk_mq_tag_to_rq);
807
Jens Axboe320ae512013-10-24 09:20:05 +0100808struct blk_mq_timeout_data {
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700809 unsigned long next;
810 unsigned int next_set;
Tejun Heo1d9bd512018-01-09 08:29:48 -0800811 unsigned int nr_expired;
Jens Axboe320ae512013-10-24 09:20:05 +0100812};
813
Tejun Heo358f70d2018-01-09 08:29:50 -0800814static void blk_mq_rq_timed_out(struct request *req, bool reserved)
Jens Axboe320ae512013-10-24 09:20:05 +0100815{
Jens Axboef8a5b122016-12-13 09:24:51 -0700816 const struct blk_mq_ops *ops = req->q->mq_ops;
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700817 enum blk_eh_timer_return ret = BLK_EH_RESET_TIMER;
Jens Axboe87ee7b12014-04-24 08:51:47 -0600818
Tejun Heo634f9e42018-01-09 08:29:51 -0800819 req->rq_flags |= RQF_MQ_TIMEOUT_EXPIRED;
820
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700821 if (ops->timeout)
Christoph Hellwig0152fb62014-09-13 16:40:13 -0700822 ret = ops->timeout(req, reserved);
Jens Axboe87ee7b12014-04-24 08:51:47 -0600823
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700824 switch (ret) {
825 case BLK_EH_HANDLED:
826 __blk_mq_complete_request(req);
827 break;
828 case BLK_EH_RESET_TIMER:
Tejun Heo1d9bd512018-01-09 08:29:48 -0800829 /*
830 * As nothing prevents from completion happening while
831 * ->aborted_gstate is set, this may lead to ignored
832 * completions and further spurious timeouts.
833 */
834 blk_mq_rq_update_aborted_gstate(req, 0);
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700835 blk_add_timer(req);
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700836 break;
837 case BLK_EH_NOT_HANDLED:
838 break;
839 default:
840 printk(KERN_ERR "block: bad eh return: %d\n", ret);
841 break;
842 }
Jens Axboe87ee7b12014-04-24 08:51:47 -0600843}
Keith Busch5b3f25f2015-01-07 18:55:46 -0700844
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700845static void blk_mq_check_expired(struct blk_mq_hw_ctx *hctx,
846 struct request *rq, void *priv, bool reserved)
Jens Axboe320ae512013-10-24 09:20:05 +0100847{
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700848 struct blk_mq_timeout_data *data = priv;
Tejun Heo1d9bd512018-01-09 08:29:48 -0800849 unsigned long gstate, deadline;
850 int start;
851
852 might_sleep();
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700853
Tejun Heo5a61c362018-01-09 08:29:52 -0800854 if (rq->rq_flags & RQF_MQ_TIMEOUT_EXPIRED)
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700855 return;
Jens Axboe320ae512013-10-24 09:20:05 +0100856
Tejun Heo1d9bd512018-01-09 08:29:48 -0800857 /* read coherent snapshots of @rq->state_gen and @rq->deadline */
858 while (true) {
859 start = read_seqcount_begin(&rq->gstate_seq);
860 gstate = READ_ONCE(rq->gstate);
Jens Axboe0a72e7f2018-01-09 14:23:42 -0700861 deadline = blk_rq_deadline(rq);
Tejun Heo1d9bd512018-01-09 08:29:48 -0800862 if (!read_seqcount_retry(&rq->gstate_seq, start))
863 break;
864 cond_resched();
865 }
Peter Zijlstraa7af0af2017-09-06 10:00:22 +0200866
Tejun Heo1d9bd512018-01-09 08:29:48 -0800867 /* if in-flight && overdue, mark for abortion */
868 if ((gstate & MQ_RQ_STATE_MASK) == MQ_RQ_IN_FLIGHT &&
869 time_after_eq(jiffies, deadline)) {
870 blk_mq_rq_update_aborted_gstate(rq, gstate);
871 data->nr_expired++;
872 hctx->nr_expired++;
Peter Zijlstraa7af0af2017-09-06 10:00:22 +0200873 } else if (!data->next_set || time_after(data->next, deadline)) {
874 data->next = deadline;
Christoph Hellwig46f92d42014-09-13 16:40:12 -0700875 data->next_set = 1;
876 }
Jens Axboe320ae512013-10-24 09:20:05 +0100877}
878
Tejun Heo1d9bd512018-01-09 08:29:48 -0800879static void blk_mq_terminate_expired(struct blk_mq_hw_ctx *hctx,
880 struct request *rq, void *priv, bool reserved)
881{
882 /*
883 * We marked @rq->aborted_gstate and waited for RCU. If there were
884 * completions that we lost to, they would have finished and
885 * updated @rq->gstate by now; otherwise, the completion path is
886 * now guaranteed to see @rq->aborted_gstate and yield. If
887 * @rq->aborted_gstate still matches @rq->gstate, @rq is ours.
888 */
Tejun Heo634f9e42018-01-09 08:29:51 -0800889 if (!(rq->rq_flags & RQF_MQ_TIMEOUT_EXPIRED) &&
890 READ_ONCE(rq->gstate) == rq->aborted_gstate)
Tejun Heo1d9bd512018-01-09 08:29:48 -0800891 blk_mq_rq_timed_out(rq, reserved);
892}
893
Christoph Hellwig287922e2015-10-30 20:57:30 +0800894static void blk_mq_timeout_work(struct work_struct *work)
Jens Axboe320ae512013-10-24 09:20:05 +0100895{
Christoph Hellwig287922e2015-10-30 20:57:30 +0800896 struct request_queue *q =
897 container_of(work, struct request_queue, timeout_work);
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700898 struct blk_mq_timeout_data data = {
899 .next = 0,
900 .next_set = 0,
Tejun Heo1d9bd512018-01-09 08:29:48 -0800901 .nr_expired = 0,
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700902 };
Tejun Heo1d9bd512018-01-09 08:29:48 -0800903 struct blk_mq_hw_ctx *hctx;
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700904 int i;
Jens Axboe320ae512013-10-24 09:20:05 +0100905
Gabriel Krisman Bertazi71f79fb2016-08-01 08:23:39 -0600906 /* A deadlock might occur if a request is stuck requiring a
907 * timeout at the same time a queue freeze is waiting
908 * completion, since the timeout code would not be able to
909 * acquire the queue reference here.
910 *
911 * That's why we don't use blk_queue_enter here; instead, we use
912 * percpu_ref_tryget directly, because we need to be able to
913 * obtain a reference even in the short window between the queue
914 * starting to freeze, by dropping the first reference in
Ming Lei1671d522017-03-27 20:06:57 +0800915 * blk_freeze_queue_start, and the moment the last request is
Gabriel Krisman Bertazi71f79fb2016-08-01 08:23:39 -0600916 * consumed, marked by the instant q_usage_counter reaches
917 * zero.
918 */
919 if (!percpu_ref_tryget(&q->q_usage_counter))
Christoph Hellwig287922e2015-10-30 20:57:30 +0800920 return;
921
Tejun Heo1d9bd512018-01-09 08:29:48 -0800922 /* scan for the expired ones and set their ->aborted_gstate */
Christoph Hellwig0bf6cd52015-09-27 21:01:51 +0200923 blk_mq_queue_tag_busy_iter(q, blk_mq_check_expired, &data);
Jens Axboe320ae512013-10-24 09:20:05 +0100924
Tejun Heo1d9bd512018-01-09 08:29:48 -0800925 if (data.nr_expired) {
926 bool has_rcu = false;
927
928 /*
929 * Wait till everyone sees ->aborted_gstate. The
930 * sequential waits for SRCUs aren't ideal. If this ever
931 * becomes a problem, we can add per-hw_ctx rcu_head and
932 * wait in parallel.
933 */
934 queue_for_each_hw_ctx(q, hctx, i) {
935 if (!hctx->nr_expired)
936 continue;
937
938 if (!(hctx->flags & BLK_MQ_F_BLOCKING))
939 has_rcu = true;
940 else
Tejun Heo05707b62018-01-09 08:29:53 -0800941 synchronize_srcu(hctx->srcu);
Tejun Heo1d9bd512018-01-09 08:29:48 -0800942
943 hctx->nr_expired = 0;
944 }
945 if (has_rcu)
946 synchronize_rcu();
947
948 /* terminate the ones we won */
949 blk_mq_queue_tag_busy_iter(q, blk_mq_terminate_expired, NULL);
950 }
951
Christoph Hellwig81481eb2014-09-13 16:40:11 -0700952 if (data.next_set) {
953 data.next = blk_rq_timeout(round_jiffies_up(data.next));
954 mod_timer(&q->timeout, data.next);
Jens Axboe0d2602c2014-05-13 15:10:52 -0600955 } else {
Bart Van Asschefcd36c32018-01-10 08:33:33 -0800956 /*
957 * Request timeouts are handled as a forward rolling timer. If
958 * we end up here it means that no requests are pending and
959 * also that no request has been pending for a while. Mark
960 * each hctx as idle.
961 */
Ming Leif054b562015-04-21 10:00:19 +0800962 queue_for_each_hw_ctx(q, hctx, i) {
963 /* the hctx may be unmapped, so check it here */
964 if (blk_mq_hw_queue_mapped(hctx))
965 blk_mq_tag_idle(hctx);
966 }
Jens Axboe0d2602c2014-05-13 15:10:52 -0600967 }
Christoph Hellwig287922e2015-10-30 20:57:30 +0800968 blk_queue_exit(q);
Jens Axboe320ae512013-10-24 09:20:05 +0100969}
970
Omar Sandoval88459642016-09-17 08:38:44 -0600971struct flush_busy_ctx_data {
972 struct blk_mq_hw_ctx *hctx;
973 struct list_head *list;
974};
975
976static bool flush_busy_ctx(struct sbitmap *sb, unsigned int bitnr, void *data)
977{
978 struct flush_busy_ctx_data *flush_data = data;
979 struct blk_mq_hw_ctx *hctx = flush_data->hctx;
980 struct blk_mq_ctx *ctx = hctx->ctxs[bitnr];
981
982 sbitmap_clear_bit(sb, bitnr);
983 spin_lock(&ctx->lock);
984 list_splice_tail_init(&ctx->rq_list, flush_data->list);
985 spin_unlock(&ctx->lock);
986 return true;
987}
988
Jens Axboe320ae512013-10-24 09:20:05 +0100989/*
Jens Axboe1429d7c2014-05-19 09:23:55 -0600990 * Process software queues that have been marked busy, splicing them
991 * to the for-dispatch
992 */
Jens Axboe2c3ad662016-12-14 14:34:47 -0700993void blk_mq_flush_busy_ctxs(struct blk_mq_hw_ctx *hctx, struct list_head *list)
Jens Axboe1429d7c2014-05-19 09:23:55 -0600994{
Omar Sandoval88459642016-09-17 08:38:44 -0600995 struct flush_busy_ctx_data data = {
996 .hctx = hctx,
997 .list = list,
998 };
Jens Axboe1429d7c2014-05-19 09:23:55 -0600999
Omar Sandoval88459642016-09-17 08:38:44 -06001000 sbitmap_for_each_set(&hctx->ctx_map, flush_busy_ctx, &data);
Jens Axboe1429d7c2014-05-19 09:23:55 -06001001}
Jens Axboe2c3ad662016-12-14 14:34:47 -07001002EXPORT_SYMBOL_GPL(blk_mq_flush_busy_ctxs);
Jens Axboe1429d7c2014-05-19 09:23:55 -06001003
Ming Leib3476892017-10-14 17:22:30 +08001004struct dispatch_rq_data {
1005 struct blk_mq_hw_ctx *hctx;
1006 struct request *rq;
1007};
1008
1009static bool dispatch_rq_from_ctx(struct sbitmap *sb, unsigned int bitnr,
1010 void *data)
1011{
1012 struct dispatch_rq_data *dispatch_data = data;
1013 struct blk_mq_hw_ctx *hctx = dispatch_data->hctx;
1014 struct blk_mq_ctx *ctx = hctx->ctxs[bitnr];
1015
1016 spin_lock(&ctx->lock);
1017 if (unlikely(!list_empty(&ctx->rq_list))) {
1018 dispatch_data->rq = list_entry_rq(ctx->rq_list.next);
1019 list_del_init(&dispatch_data->rq->queuelist);
1020 if (list_empty(&ctx->rq_list))
1021 sbitmap_clear_bit(sb, bitnr);
1022 }
1023 spin_unlock(&ctx->lock);
1024
1025 return !dispatch_data->rq;
1026}
1027
1028struct request *blk_mq_dequeue_from_ctx(struct blk_mq_hw_ctx *hctx,
1029 struct blk_mq_ctx *start)
1030{
1031 unsigned off = start ? start->index_hw : 0;
1032 struct dispatch_rq_data data = {
1033 .hctx = hctx,
1034 .rq = NULL,
1035 };
1036
1037 __sbitmap_for_each_set(&hctx->ctx_map, off,
1038 dispatch_rq_from_ctx, &data);
1039
1040 return data.rq;
1041}
1042
Jens Axboe703fd1c2016-09-16 13:59:14 -06001043static inline unsigned int queued_to_index(unsigned int queued)
1044{
1045 if (!queued)
1046 return 0;
Jens Axboe1429d7c2014-05-19 09:23:55 -06001047
Jens Axboe703fd1c2016-09-16 13:59:14 -06001048 return min(BLK_MQ_MAX_DISPATCH_ORDER - 1, ilog2(queued) + 1);
Jens Axboe1429d7c2014-05-19 09:23:55 -06001049}
1050
Jens Axboebd6737f2017-01-27 01:00:47 -07001051bool blk_mq_get_driver_tag(struct request *rq, struct blk_mq_hw_ctx **hctx,
1052 bool wait)
Jens Axboebd166ef2017-01-17 06:03:22 -07001053{
1054 struct blk_mq_alloc_data data = {
1055 .q = rq->q,
Jens Axboebd166ef2017-01-17 06:03:22 -07001056 .hctx = blk_mq_map_queue(rq->q, rq->mq_ctx->cpu),
1057 .flags = wait ? 0 : BLK_MQ_REQ_NOWAIT,
1058 };
1059
Jens Axboe5feeacd2017-04-20 17:23:13 -06001060 might_sleep_if(wait);
1061
Omar Sandoval81380ca2017-04-07 08:56:26 -06001062 if (rq->tag != -1)
1063 goto done;
Jens Axboebd166ef2017-01-17 06:03:22 -07001064
Sagi Grimberg415b8062017-02-27 10:04:39 -07001065 if (blk_mq_tag_is_reserved(data.hctx->sched_tags, rq->internal_tag))
1066 data.flags |= BLK_MQ_REQ_RESERVED;
1067
Jens Axboebd166ef2017-01-17 06:03:22 -07001068 rq->tag = blk_mq_get_tag(&data);
1069 if (rq->tag >= 0) {
Jens Axboe200e86b2017-01-25 08:11:38 -07001070 if (blk_mq_tag_busy(data.hctx)) {
1071 rq->rq_flags |= RQF_MQ_INFLIGHT;
1072 atomic_inc(&data.hctx->nr_active);
1073 }
Jens Axboebd166ef2017-01-17 06:03:22 -07001074 data.hctx->tags->rqs[rq->tag] = rq;
Jens Axboebd166ef2017-01-17 06:03:22 -07001075 }
1076
Omar Sandoval81380ca2017-04-07 08:56:26 -06001077done:
1078 if (hctx)
1079 *hctx = data.hctx;
1080 return rq->tag != -1;
Jens Axboebd166ef2017-01-17 06:03:22 -07001081}
1082
Jens Axboeeb619fd2017-11-09 08:32:43 -07001083static int blk_mq_dispatch_wake(wait_queue_entry_t *wait, unsigned mode,
1084 int flags, void *key)
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001085{
1086 struct blk_mq_hw_ctx *hctx;
1087
1088 hctx = container_of(wait, struct blk_mq_hw_ctx, dispatch_wait);
1089
Jens Axboeeb619fd2017-11-09 08:32:43 -07001090 list_del_init(&wait->entry);
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001091 blk_mq_run_hw_queue(hctx, true);
1092 return 1;
1093}
1094
Jens Axboef906a6a2017-11-09 16:10:13 -07001095/*
1096 * Mark us waiting for a tag. For shared tags, this involves hooking us into
Bart Van Asscheee3e4de2018-01-09 10:09:15 -08001097 * the tag wakeups. For non-shared tags, we can simply mark us needing a
1098 * restart. For both cases, take care to check the condition again after
Jens Axboef906a6a2017-11-09 16:10:13 -07001099 * marking us as waiting.
1100 */
1101static bool blk_mq_mark_tag_wait(struct blk_mq_hw_ctx **hctx,
1102 struct request *rq)
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001103{
Jens Axboeeb619fd2017-11-09 08:32:43 -07001104 struct blk_mq_hw_ctx *this_hctx = *hctx;
Jens Axboef906a6a2017-11-09 16:10:13 -07001105 bool shared_tags = (this_hctx->flags & BLK_MQ_F_TAG_SHARED) != 0;
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001106 struct sbq_wait_state *ws;
Jens Axboef906a6a2017-11-09 16:10:13 -07001107 wait_queue_entry_t *wait;
1108 bool ret;
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001109
Jens Axboef906a6a2017-11-09 16:10:13 -07001110 if (!shared_tags) {
1111 if (!test_bit(BLK_MQ_S_SCHED_RESTART, &this_hctx->state))
1112 set_bit(BLK_MQ_S_SCHED_RESTART, &this_hctx->state);
1113 } else {
1114 wait = &this_hctx->dispatch_wait;
1115 if (!list_empty_careful(&wait->entry))
1116 return false;
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001117
Jens Axboef906a6a2017-11-09 16:10:13 -07001118 spin_lock(&this_hctx->lock);
1119 if (!list_empty(&wait->entry)) {
1120 spin_unlock(&this_hctx->lock);
1121 return false;
1122 }
1123
1124 ws = bt_wait_ptr(&this_hctx->tags->bitmap_tags, this_hctx);
1125 add_wait_queue(&ws->wait, wait);
Jens Axboeeb619fd2017-11-09 08:32:43 -07001126 }
1127
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001128 /*
Jens Axboeeb619fd2017-11-09 08:32:43 -07001129 * It's possible that a tag was freed in the window between the
1130 * allocation failure and adding the hardware queue to the wait
1131 * queue.
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001132 */
Jens Axboef906a6a2017-11-09 16:10:13 -07001133 ret = blk_mq_get_driver_tag(rq, hctx, false);
Jens Axboeeb619fd2017-11-09 08:32:43 -07001134
Jens Axboef906a6a2017-11-09 16:10:13 -07001135 if (!shared_tags) {
1136 /*
1137 * Don't clear RESTART here, someone else could have set it.
1138 * At most this will cost an extra queue run.
1139 */
1140 return ret;
1141 } else {
1142 if (!ret) {
1143 spin_unlock(&this_hctx->lock);
1144 return false;
1145 }
1146
1147 /*
1148 * We got a tag, remove ourselves from the wait queue to ensure
1149 * someone else gets the wakeup.
1150 */
1151 spin_lock_irq(&ws->wait.lock);
1152 list_del_init(&wait->entry);
1153 spin_unlock_irq(&ws->wait.lock);
1154 spin_unlock(&this_hctx->lock);
1155 return true;
1156 }
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001157}
1158
Ming Leide148292017-10-14 17:22:29 +08001159bool blk_mq_dispatch_rq_list(struct request_queue *q, struct list_head *list,
Jens Axboeeb619fd2017-11-09 08:32:43 -07001160 bool got_budget)
Jens Axboef04c3df2016-12-07 08:41:17 -07001161{
Omar Sandoval81380ca2017-04-07 08:56:26 -06001162 struct blk_mq_hw_ctx *hctx;
Jianchao Wang6d6f167c2017-11-02 23:24:32 +08001163 struct request *rq, *nxt;
Jens Axboeeb619fd2017-11-09 08:32:43 -07001164 bool no_tag = false;
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001165 int errors, queued;
Jens Axboef04c3df2016-12-07 08:41:17 -07001166
Omar Sandoval81380ca2017-04-07 08:56:26 -06001167 if (list_empty(list))
1168 return false;
1169
Ming Leide148292017-10-14 17:22:29 +08001170 WARN_ON(!list_is_singular(list) && got_budget);
1171
Jens Axboef04c3df2016-12-07 08:41:17 -07001172 /*
Jens Axboef04c3df2016-12-07 08:41:17 -07001173 * Now process all the entries, sending them to the driver.
1174 */
Jens Axboe93efe982017-03-24 12:04:19 -06001175 errors = queued = 0;
Omar Sandoval81380ca2017-04-07 08:56:26 -06001176 do {
Jens Axboef04c3df2016-12-07 08:41:17 -07001177 struct blk_mq_queue_data bd;
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001178 blk_status_t ret;
Jens Axboef04c3df2016-12-07 08:41:17 -07001179
1180 rq = list_first_entry(list, struct request, queuelist);
Jens Axboebd166ef2017-01-17 06:03:22 -07001181 if (!blk_mq_get_driver_tag(rq, &hctx, false)) {
Jens Axboe3c782d62017-01-26 12:50:36 -07001182 /*
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001183 * The initial allocation attempt failed, so we need to
Jens Axboeeb619fd2017-11-09 08:32:43 -07001184 * rerun the hardware queue when a tag is freed. The
1185 * waitqueue takes care of that. If the queue is run
1186 * before we add this entry back on the dispatch list,
1187 * we'll re-run it below.
Jens Axboe3c782d62017-01-26 12:50:36 -07001188 */
Jens Axboef906a6a2017-11-09 16:10:13 -07001189 if (!blk_mq_mark_tag_wait(&hctx, rq)) {
Ming Leide148292017-10-14 17:22:29 +08001190 if (got_budget)
1191 blk_mq_put_dispatch_budget(hctx);
Jens Axboef906a6a2017-11-09 16:10:13 -07001192 /*
1193 * For non-shared tags, the RESTART check
1194 * will suffice.
1195 */
1196 if (hctx->flags & BLK_MQ_F_TAG_SHARED)
1197 no_tag = true;
Omar Sandoval807b1042017-04-05 12:01:35 -07001198 break;
Ming Leide148292017-10-14 17:22:29 +08001199 }
1200 }
1201
Ming Lei0c6af1c2017-11-08 09:11:22 +08001202 if (!got_budget && !blk_mq_get_dispatch_budget(hctx)) {
1203 blk_mq_put_driver_tag(rq);
Ming Lei88022d72017-11-05 02:21:12 +08001204 break;
Ming Lei0c6af1c2017-11-08 09:11:22 +08001205 }
Omar Sandovalda55f2c2017-02-22 10:58:29 -08001206
Jens Axboef04c3df2016-12-07 08:41:17 -07001207 list_del_init(&rq->queuelist);
1208
1209 bd.rq = rq;
Jens Axboe113285b2017-03-02 13:26:04 -07001210
1211 /*
1212 * Flag last if we have no more requests, or if we have more
1213 * but can't assign a driver tag to it.
1214 */
1215 if (list_empty(list))
1216 bd.last = true;
1217 else {
Jens Axboe113285b2017-03-02 13:26:04 -07001218 nxt = list_first_entry(list, struct request, queuelist);
1219 bd.last = !blk_mq_get_driver_tag(nxt, NULL, false);
1220 }
Jens Axboef04c3df2016-12-07 08:41:17 -07001221
1222 ret = q->mq_ops->queue_rq(hctx, &bd);
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001223 if (ret == BLK_STS_RESOURCE) {
Jianchao Wang6d6f167c2017-11-02 23:24:32 +08001224 /*
1225 * If an I/O scheduler has been configured and we got a
Jens Axboeff821d22017-11-10 22:05:12 -07001226 * driver tag for the next request already, free it
1227 * again.
Jianchao Wang6d6f167c2017-11-02 23:24:32 +08001228 */
1229 if (!list_empty(list)) {
1230 nxt = list_first_entry(list, struct request, queuelist);
1231 blk_mq_put_driver_tag(nxt);
1232 }
Jens Axboef04c3df2016-12-07 08:41:17 -07001233 list_add(&rq->queuelist, list);
1234 __blk_mq_requeue_request(rq);
1235 break;
Jens Axboef04c3df2016-12-07 08:41:17 -07001236 }
1237
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001238 if (unlikely(ret != BLK_STS_OK)) {
1239 errors++;
1240 blk_mq_end_request(rq, BLK_STS_IOERR);
1241 continue;
1242 }
1243
1244 queued++;
Omar Sandoval81380ca2017-04-07 08:56:26 -06001245 } while (!list_empty(list));
Jens Axboef04c3df2016-12-07 08:41:17 -07001246
1247 hctx->dispatched[queued_to_index(queued)]++;
1248
1249 /*
1250 * Any items that need requeuing? Stuff them into hctx->dispatch,
1251 * that is where we will continue on next queue run.
1252 */
1253 if (!list_empty(list)) {
1254 spin_lock(&hctx->lock);
Jens Axboec13660a2017-01-26 12:40:07 -07001255 list_splice_init(list, &hctx->dispatch);
Jens Axboef04c3df2016-12-07 08:41:17 -07001256 spin_unlock(&hctx->lock);
1257
1258 /*
Bart Van Assche710c7852017-04-07 11:16:51 -07001259 * If SCHED_RESTART was set by the caller of this function and
1260 * it is no longer set that means that it was cleared by another
1261 * thread and hence that a queue rerun is needed.
Jens Axboef04c3df2016-12-07 08:41:17 -07001262 *
Jens Axboeeb619fd2017-11-09 08:32:43 -07001263 * If 'no_tag' is set, that means that we failed getting
1264 * a driver tag with an I/O scheduler attached. If our dispatch
1265 * waitqueue is no longer active, ensure that we run the queue
1266 * AFTER adding our entries back to the list.
Jens Axboebd166ef2017-01-17 06:03:22 -07001267 *
Bart Van Assche710c7852017-04-07 11:16:51 -07001268 * If no I/O scheduler has been configured it is possible that
1269 * the hardware queue got stopped and restarted before requests
1270 * were pushed back onto the dispatch list. Rerun the queue to
1271 * avoid starvation. Notes:
1272 * - blk_mq_run_hw_queue() checks whether or not a queue has
1273 * been stopped before rerunning a queue.
1274 * - Some but not all block drivers stop a queue before
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001275 * returning BLK_STS_RESOURCE. Two exceptions are scsi-mq
Bart Van Assche710c7852017-04-07 11:16:51 -07001276 * and dm-rq.
Jens Axboebd166ef2017-01-17 06:03:22 -07001277 */
Jens Axboeeb619fd2017-11-09 08:32:43 -07001278 if (!blk_mq_sched_needs_restart(hctx) ||
1279 (no_tag && list_empty_careful(&hctx->dispatch_wait.entry)))
Jens Axboebd166ef2017-01-17 06:03:22 -07001280 blk_mq_run_hw_queue(hctx, true);
Jens Axboef04c3df2016-12-07 08:41:17 -07001281 }
1282
Jens Axboe93efe982017-03-24 12:04:19 -06001283 return (queued + errors) != 0;
Jens Axboef04c3df2016-12-07 08:41:17 -07001284}
1285
Bart Van Assche6a83e742016-11-02 10:09:51 -06001286static void __blk_mq_run_hw_queue(struct blk_mq_hw_ctx *hctx)
1287{
1288 int srcu_idx;
1289
Jens Axboeb7a71e62017-08-01 09:28:24 -06001290 /*
1291 * We should be running this queue from one of the CPUs that
1292 * are mapped to it.
1293 */
Bart Van Assche6a83e742016-11-02 10:09:51 -06001294 WARN_ON(!cpumask_test_cpu(raw_smp_processor_id(), hctx->cpumask) &&
1295 cpu_online(hctx->next_cpu));
1296
Jens Axboeb7a71e62017-08-01 09:28:24 -06001297 /*
1298 * We can't run the queue inline with ints disabled. Ensure that
1299 * we catch bad users of this early.
1300 */
1301 WARN_ON_ONCE(in_interrupt());
1302
Jens Axboe04ced152018-01-09 08:29:46 -08001303 might_sleep_if(hctx->flags & BLK_MQ_F_BLOCKING);
Jens Axboebf4907c2017-03-30 12:30:39 -06001304
Jens Axboe04ced152018-01-09 08:29:46 -08001305 hctx_lock(hctx, &srcu_idx);
1306 blk_mq_sched_dispatch_requests(hctx);
1307 hctx_unlock(hctx, srcu_idx);
Bart Van Assche6a83e742016-11-02 10:09:51 -06001308}
1309
Jens Axboe506e9312014-05-07 10:26:44 -06001310/*
1311 * It'd be great if the workqueue API had a way to pass
1312 * in a mask and had some smarts for more clever placement.
1313 * For now we just round-robin here, switching for every
1314 * BLK_MQ_CPU_WORK_BATCH queued items.
1315 */
1316static int blk_mq_hctx_next_cpu(struct blk_mq_hw_ctx *hctx)
1317{
Christoph Hellwigb657d7e2014-11-24 09:27:23 +01001318 if (hctx->queue->nr_hw_queues == 1)
1319 return WORK_CPU_UNBOUND;
Jens Axboe506e9312014-05-07 10:26:44 -06001320
1321 if (--hctx->next_cpu_batch <= 0) {
Gabriel Krisman Bertazic02ebfd2016-09-28 00:24:24 -03001322 int next_cpu;
Jens Axboe506e9312014-05-07 10:26:44 -06001323
1324 next_cpu = cpumask_next(hctx->next_cpu, hctx->cpumask);
1325 if (next_cpu >= nr_cpu_ids)
1326 next_cpu = cpumask_first(hctx->cpumask);
1327
1328 hctx->next_cpu = next_cpu;
1329 hctx->next_cpu_batch = BLK_MQ_CPU_WORK_BATCH;
1330 }
1331
Christoph Hellwigb657d7e2014-11-24 09:27:23 +01001332 return hctx->next_cpu;
Jens Axboe506e9312014-05-07 10:26:44 -06001333}
1334
Bart Van Assche7587a5a2017-04-07 11:16:52 -07001335static void __blk_mq_delay_run_hw_queue(struct blk_mq_hw_ctx *hctx, bool async,
1336 unsigned long msecs)
Jens Axboe320ae512013-10-24 09:20:05 +01001337{
Bart Van Assche5435c022017-06-20 11:15:49 -07001338 if (WARN_ON_ONCE(!blk_mq_hw_queue_mapped(hctx)))
1339 return;
1340
1341 if (unlikely(blk_mq_hctx_stopped(hctx)))
Jens Axboe320ae512013-10-24 09:20:05 +01001342 return;
1343
Jens Axboe1b792f22016-09-21 10:12:13 -06001344 if (!async && !(hctx->flags & BLK_MQ_F_BLOCKING)) {
Paolo Bonzini2a90d4a2014-11-07 23:04:00 +01001345 int cpu = get_cpu();
1346 if (cpumask_test_cpu(cpu, hctx->cpumask)) {
Paolo Bonzini398205b2014-11-07 23:03:59 +01001347 __blk_mq_run_hw_queue(hctx);
Paolo Bonzini2a90d4a2014-11-07 23:04:00 +01001348 put_cpu();
Paolo Bonzini398205b2014-11-07 23:03:59 +01001349 return;
1350 }
Jens Axboee4043dc2014-04-09 10:18:23 -06001351
Paolo Bonzini2a90d4a2014-11-07 23:04:00 +01001352 put_cpu();
Jens Axboee4043dc2014-04-09 10:18:23 -06001353 }
Paolo Bonzini398205b2014-11-07 23:03:59 +01001354
Jens Axboe9f993732017-04-10 09:54:54 -06001355 kblockd_schedule_delayed_work_on(blk_mq_hctx_next_cpu(hctx),
1356 &hctx->run_work,
1357 msecs_to_jiffies(msecs));
Bart Van Assche7587a5a2017-04-07 11:16:52 -07001358}
1359
1360void blk_mq_delay_run_hw_queue(struct blk_mq_hw_ctx *hctx, unsigned long msecs)
1361{
1362 __blk_mq_delay_run_hw_queue(hctx, true, msecs);
1363}
1364EXPORT_SYMBOL(blk_mq_delay_run_hw_queue);
1365
Jens Axboe79f720a2017-11-10 09:13:21 -07001366bool blk_mq_run_hw_queue(struct blk_mq_hw_ctx *hctx, bool async)
Bart Van Assche7587a5a2017-04-07 11:16:52 -07001367{
Ming Lei24f5a902018-01-06 16:27:38 +08001368 int srcu_idx;
1369 bool need_run;
1370
1371 /*
1372 * When queue is quiesced, we may be switching io scheduler, or
1373 * updating nr_hw_queues, or other things, and we can't run queue
1374 * any more, even __blk_mq_hctx_has_pending() can't be called safely.
1375 *
1376 * And queue will be rerun in blk_mq_unquiesce_queue() if it is
1377 * quiesced.
1378 */
Jens Axboe04ced152018-01-09 08:29:46 -08001379 hctx_lock(hctx, &srcu_idx);
1380 need_run = !blk_queue_quiesced(hctx->queue) &&
1381 blk_mq_hctx_has_pending(hctx);
1382 hctx_unlock(hctx, srcu_idx);
Ming Lei24f5a902018-01-06 16:27:38 +08001383
1384 if (need_run) {
Jens Axboe79f720a2017-11-10 09:13:21 -07001385 __blk_mq_delay_run_hw_queue(hctx, async, 0);
1386 return true;
1387 }
1388
1389 return false;
Jens Axboe320ae512013-10-24 09:20:05 +01001390}
Omar Sandoval5b727272017-04-14 01:00:00 -07001391EXPORT_SYMBOL(blk_mq_run_hw_queue);
Jens Axboe320ae512013-10-24 09:20:05 +01001392
Mike Snitzerb94ec292015-03-11 23:56:38 -04001393void blk_mq_run_hw_queues(struct request_queue *q, bool async)
Jens Axboe320ae512013-10-24 09:20:05 +01001394{
1395 struct blk_mq_hw_ctx *hctx;
1396 int i;
1397
1398 queue_for_each_hw_ctx(q, hctx, i) {
Jens Axboe79f720a2017-11-10 09:13:21 -07001399 if (blk_mq_hctx_stopped(hctx))
Jens Axboe320ae512013-10-24 09:20:05 +01001400 continue;
1401
Mike Snitzerb94ec292015-03-11 23:56:38 -04001402 blk_mq_run_hw_queue(hctx, async);
Jens Axboe320ae512013-10-24 09:20:05 +01001403 }
1404}
Mike Snitzerb94ec292015-03-11 23:56:38 -04001405EXPORT_SYMBOL(blk_mq_run_hw_queues);
Jens Axboe320ae512013-10-24 09:20:05 +01001406
Bart Van Asschefd001442016-10-28 17:19:37 -07001407/**
1408 * blk_mq_queue_stopped() - check whether one or more hctxs have been stopped
1409 * @q: request queue.
1410 *
1411 * The caller is responsible for serializing this function against
1412 * blk_mq_{start,stop}_hw_queue().
1413 */
1414bool blk_mq_queue_stopped(struct request_queue *q)
1415{
1416 struct blk_mq_hw_ctx *hctx;
1417 int i;
1418
1419 queue_for_each_hw_ctx(q, hctx, i)
1420 if (blk_mq_hctx_stopped(hctx))
1421 return true;
1422
1423 return false;
1424}
1425EXPORT_SYMBOL(blk_mq_queue_stopped);
1426
Ming Lei39a70c72017-06-06 23:22:09 +08001427/*
1428 * This function is often used for pausing .queue_rq() by driver when
1429 * there isn't enough resource or some conditions aren't satisfied, and
Bart Van Assche4d606212017-08-17 16:23:00 -07001430 * BLK_STS_RESOURCE is usually returned.
Ming Lei39a70c72017-06-06 23:22:09 +08001431 *
1432 * We do not guarantee that dispatch can be drained or blocked
1433 * after blk_mq_stop_hw_queue() returns. Please use
1434 * blk_mq_quiesce_queue() for that requirement.
1435 */
Jens Axboe320ae512013-10-24 09:20:05 +01001436void blk_mq_stop_hw_queue(struct blk_mq_hw_ctx *hctx)
1437{
Ming Lei641a9ed2017-06-06 23:22:10 +08001438 cancel_delayed_work(&hctx->run_work);
1439
1440 set_bit(BLK_MQ_S_STOPPED, &hctx->state);
Jens Axboe320ae512013-10-24 09:20:05 +01001441}
1442EXPORT_SYMBOL(blk_mq_stop_hw_queue);
1443
Ming Lei39a70c72017-06-06 23:22:09 +08001444/*
1445 * This function is often used for pausing .queue_rq() by driver when
1446 * there isn't enough resource or some conditions aren't satisfied, and
Bart Van Assche4d606212017-08-17 16:23:00 -07001447 * BLK_STS_RESOURCE is usually returned.
Ming Lei39a70c72017-06-06 23:22:09 +08001448 *
1449 * We do not guarantee that dispatch can be drained or blocked
1450 * after blk_mq_stop_hw_queues() returns. Please use
1451 * blk_mq_quiesce_queue() for that requirement.
1452 */
Jens Axboe2719aa22017-05-03 11:08:14 -06001453void blk_mq_stop_hw_queues(struct request_queue *q)
1454{
Ming Lei641a9ed2017-06-06 23:22:10 +08001455 struct blk_mq_hw_ctx *hctx;
1456 int i;
1457
1458 queue_for_each_hw_ctx(q, hctx, i)
1459 blk_mq_stop_hw_queue(hctx);
Christoph Hellwig280d45f2013-10-25 14:45:58 +01001460}
1461EXPORT_SYMBOL(blk_mq_stop_hw_queues);
1462
Jens Axboe320ae512013-10-24 09:20:05 +01001463void blk_mq_start_hw_queue(struct blk_mq_hw_ctx *hctx)
1464{
1465 clear_bit(BLK_MQ_S_STOPPED, &hctx->state);
Jens Axboee4043dc2014-04-09 10:18:23 -06001466
Jens Axboe0ffbce82014-06-25 08:22:34 -06001467 blk_mq_run_hw_queue(hctx, false);
Jens Axboe320ae512013-10-24 09:20:05 +01001468}
1469EXPORT_SYMBOL(blk_mq_start_hw_queue);
1470
Christoph Hellwig2f268552014-04-16 09:44:56 +02001471void blk_mq_start_hw_queues(struct request_queue *q)
1472{
1473 struct blk_mq_hw_ctx *hctx;
1474 int i;
1475
1476 queue_for_each_hw_ctx(q, hctx, i)
1477 blk_mq_start_hw_queue(hctx);
1478}
1479EXPORT_SYMBOL(blk_mq_start_hw_queues);
1480
Jens Axboeae911c52016-12-08 13:19:30 -07001481void blk_mq_start_stopped_hw_queue(struct blk_mq_hw_ctx *hctx, bool async)
1482{
1483 if (!blk_mq_hctx_stopped(hctx))
1484 return;
1485
1486 clear_bit(BLK_MQ_S_STOPPED, &hctx->state);
1487 blk_mq_run_hw_queue(hctx, async);
1488}
1489EXPORT_SYMBOL_GPL(blk_mq_start_stopped_hw_queue);
1490
Christoph Hellwig1b4a3252014-04-16 09:44:54 +02001491void blk_mq_start_stopped_hw_queues(struct request_queue *q, bool async)
Jens Axboe320ae512013-10-24 09:20:05 +01001492{
1493 struct blk_mq_hw_ctx *hctx;
1494 int i;
1495
Jens Axboeae911c52016-12-08 13:19:30 -07001496 queue_for_each_hw_ctx(q, hctx, i)
1497 blk_mq_start_stopped_hw_queue(hctx, async);
Jens Axboe320ae512013-10-24 09:20:05 +01001498}
1499EXPORT_SYMBOL(blk_mq_start_stopped_hw_queues);
1500
Christoph Hellwig70f4db62014-04-16 10:48:08 -06001501static void blk_mq_run_work_fn(struct work_struct *work)
Jens Axboe320ae512013-10-24 09:20:05 +01001502{
1503 struct blk_mq_hw_ctx *hctx;
1504
Jens Axboe9f993732017-04-10 09:54:54 -06001505 hctx = container_of(work, struct blk_mq_hw_ctx, run_work.work);
Jens Axboe21c6e932017-04-10 09:54:56 -06001506
1507 /*
1508 * If we are stopped, don't run the queue. The exception is if
1509 * BLK_MQ_S_START_ON_RUN is set. For that case, we auto-clear
1510 * the STOPPED bit and run it.
1511 */
1512 if (test_bit(BLK_MQ_S_STOPPED, &hctx->state)) {
1513 if (!test_bit(BLK_MQ_S_START_ON_RUN, &hctx->state))
1514 return;
1515
1516 clear_bit(BLK_MQ_S_START_ON_RUN, &hctx->state);
1517 clear_bit(BLK_MQ_S_STOPPED, &hctx->state);
1518 }
Jens Axboee4043dc2014-04-09 10:18:23 -06001519
Jens Axboe320ae512013-10-24 09:20:05 +01001520 __blk_mq_run_hw_queue(hctx);
1521}
1522
Christoph Hellwig70f4db62014-04-16 10:48:08 -06001523
1524void blk_mq_delay_queue(struct blk_mq_hw_ctx *hctx, unsigned long msecs)
1525{
Bart Van Assche5435c022017-06-20 11:15:49 -07001526 if (WARN_ON_ONCE(!blk_mq_hw_queue_mapped(hctx)))
Ming Lei19c66e52014-12-03 19:38:04 +08001527 return;
Christoph Hellwig70f4db62014-04-16 10:48:08 -06001528
Jens Axboe21c6e932017-04-10 09:54:56 -06001529 /*
1530 * Stop the hw queue, then modify currently delayed work.
1531 * This should prevent us from running the queue prematurely.
1532 * Mark the queue as auto-clearing STOPPED when it runs.
1533 */
Jens Axboe7e79dad2017-01-19 07:58:59 -07001534 blk_mq_stop_hw_queue(hctx);
Jens Axboe21c6e932017-04-10 09:54:56 -06001535 set_bit(BLK_MQ_S_START_ON_RUN, &hctx->state);
1536 kblockd_mod_delayed_work_on(blk_mq_hctx_next_cpu(hctx),
1537 &hctx->run_work,
1538 msecs_to_jiffies(msecs));
Christoph Hellwig70f4db62014-04-16 10:48:08 -06001539}
1540EXPORT_SYMBOL(blk_mq_delay_queue);
1541
Ming Leicfd0c552015-10-20 23:13:57 +08001542static inline void __blk_mq_insert_req_list(struct blk_mq_hw_ctx *hctx,
Ming Leicfd0c552015-10-20 23:13:57 +08001543 struct request *rq,
1544 bool at_head)
Jens Axboe320ae512013-10-24 09:20:05 +01001545{
Jens Axboee57690f2016-08-24 15:34:35 -06001546 struct blk_mq_ctx *ctx = rq->mq_ctx;
1547
Bart Van Assche7b607812017-06-20 11:15:47 -07001548 lockdep_assert_held(&ctx->lock);
1549
Jens Axboe01b983c2013-11-19 18:59:10 -07001550 trace_block_rq_insert(hctx->queue, rq);
1551
Christoph Hellwig72a0a362014-02-07 10:22:36 -08001552 if (at_head)
1553 list_add(&rq->queuelist, &ctx->rq_list);
1554 else
1555 list_add_tail(&rq->queuelist, &ctx->rq_list);
Ming Leicfd0c552015-10-20 23:13:57 +08001556}
Jens Axboe4bb659b2014-05-09 09:36:49 -06001557
Jens Axboe2c3ad662016-12-14 14:34:47 -07001558void __blk_mq_insert_request(struct blk_mq_hw_ctx *hctx, struct request *rq,
1559 bool at_head)
Ming Leicfd0c552015-10-20 23:13:57 +08001560{
1561 struct blk_mq_ctx *ctx = rq->mq_ctx;
1562
Bart Van Assche7b607812017-06-20 11:15:47 -07001563 lockdep_assert_held(&ctx->lock);
1564
Jens Axboee57690f2016-08-24 15:34:35 -06001565 __blk_mq_insert_req_list(hctx, rq, at_head);
Jens Axboe320ae512013-10-24 09:20:05 +01001566 blk_mq_hctx_mark_pending(hctx, ctx);
Jens Axboe320ae512013-10-24 09:20:05 +01001567}
1568
Jens Axboe157f3772017-09-11 16:43:57 -06001569/*
1570 * Should only be used carefully, when the caller knows we want to
1571 * bypass a potential IO scheduler on the target device.
1572 */
Ming Leib0850292017-11-02 23:24:34 +08001573void blk_mq_request_bypass_insert(struct request *rq, bool run_queue)
Jens Axboe157f3772017-09-11 16:43:57 -06001574{
1575 struct blk_mq_ctx *ctx = rq->mq_ctx;
1576 struct blk_mq_hw_ctx *hctx = blk_mq_map_queue(rq->q, ctx->cpu);
1577
1578 spin_lock(&hctx->lock);
1579 list_add_tail(&rq->queuelist, &hctx->dispatch);
1580 spin_unlock(&hctx->lock);
1581
Ming Leib0850292017-11-02 23:24:34 +08001582 if (run_queue)
1583 blk_mq_run_hw_queue(hctx, false);
Jens Axboe157f3772017-09-11 16:43:57 -06001584}
1585
Jens Axboebd166ef2017-01-17 06:03:22 -07001586void blk_mq_insert_requests(struct blk_mq_hw_ctx *hctx, struct blk_mq_ctx *ctx,
1587 struct list_head *list)
Jens Axboe320ae512013-10-24 09:20:05 +01001588
1589{
Jens Axboe320ae512013-10-24 09:20:05 +01001590 /*
1591 * preemption doesn't flush plug list, so it's possible ctx->cpu is
1592 * offline now
1593 */
1594 spin_lock(&ctx->lock);
1595 while (!list_empty(list)) {
1596 struct request *rq;
1597
1598 rq = list_first_entry(list, struct request, queuelist);
Jens Axboee57690f2016-08-24 15:34:35 -06001599 BUG_ON(rq->mq_ctx != ctx);
Jens Axboe320ae512013-10-24 09:20:05 +01001600 list_del_init(&rq->queuelist);
Jens Axboee57690f2016-08-24 15:34:35 -06001601 __blk_mq_insert_req_list(hctx, rq, false);
Jens Axboe320ae512013-10-24 09:20:05 +01001602 }
Ming Leicfd0c552015-10-20 23:13:57 +08001603 blk_mq_hctx_mark_pending(hctx, ctx);
Jens Axboe320ae512013-10-24 09:20:05 +01001604 spin_unlock(&ctx->lock);
Jens Axboe320ae512013-10-24 09:20:05 +01001605}
1606
1607static int plug_ctx_cmp(void *priv, struct list_head *a, struct list_head *b)
1608{
1609 struct request *rqa = container_of(a, struct request, queuelist);
1610 struct request *rqb = container_of(b, struct request, queuelist);
1611
1612 return !(rqa->mq_ctx < rqb->mq_ctx ||
1613 (rqa->mq_ctx == rqb->mq_ctx &&
1614 blk_rq_pos(rqa) < blk_rq_pos(rqb)));
1615}
1616
1617void blk_mq_flush_plug_list(struct blk_plug *plug, bool from_schedule)
1618{
1619 struct blk_mq_ctx *this_ctx;
1620 struct request_queue *this_q;
1621 struct request *rq;
1622 LIST_HEAD(list);
1623 LIST_HEAD(ctx_list);
1624 unsigned int depth;
1625
1626 list_splice_init(&plug->mq_list, &list);
1627
1628 list_sort(NULL, &list, plug_ctx_cmp);
1629
1630 this_q = NULL;
1631 this_ctx = NULL;
1632 depth = 0;
1633
1634 while (!list_empty(&list)) {
1635 rq = list_entry_rq(list.next);
1636 list_del_init(&rq->queuelist);
1637 BUG_ON(!rq->q);
1638 if (rq->mq_ctx != this_ctx) {
1639 if (this_ctx) {
Jens Axboebd166ef2017-01-17 06:03:22 -07001640 trace_block_unplug(this_q, depth, from_schedule);
1641 blk_mq_sched_insert_requests(this_q, this_ctx,
1642 &ctx_list,
1643 from_schedule);
Jens Axboe320ae512013-10-24 09:20:05 +01001644 }
1645
1646 this_ctx = rq->mq_ctx;
1647 this_q = rq->q;
1648 depth = 0;
1649 }
1650
1651 depth++;
1652 list_add_tail(&rq->queuelist, &ctx_list);
1653 }
1654
1655 /*
1656 * If 'this_ctx' is set, we know we have entries to complete
1657 * on 'ctx_list'. Do those.
1658 */
1659 if (this_ctx) {
Jens Axboebd166ef2017-01-17 06:03:22 -07001660 trace_block_unplug(this_q, depth, from_schedule);
1661 blk_mq_sched_insert_requests(this_q, this_ctx, &ctx_list,
1662 from_schedule);
Jens Axboe320ae512013-10-24 09:20:05 +01001663 }
1664}
1665
1666static void blk_mq_bio_to_request(struct request *rq, struct bio *bio)
1667{
Bart Van Asscheda8d7f02017-04-19 14:01:24 -07001668 blk_init_request_from_bio(rq, bio);
Jens Axboe4b570522014-05-29 11:00:11 -06001669
Shaohua Li85acb3b2017-10-06 17:56:00 -07001670 blk_rq_set_rl(rq, blk_get_rl(rq->q, bio));
1671
Jens Axboe6e85eaf2016-12-02 20:00:14 -07001672 blk_account_io_start(rq, true);
Jens Axboe320ae512013-10-24 09:20:05 +01001673}
1674
Ming Leiab42f352017-05-26 19:53:19 +08001675static inline void blk_mq_queue_io(struct blk_mq_hw_ctx *hctx,
1676 struct blk_mq_ctx *ctx,
1677 struct request *rq)
1678{
1679 spin_lock(&ctx->lock);
1680 __blk_mq_insert_request(hctx, rq, false);
1681 spin_unlock(&ctx->lock);
Jens Axboe07068d52014-05-22 10:40:51 -06001682}
1683
Jens Axboefd2d3322017-01-12 10:04:45 -07001684static blk_qc_t request_to_qc_t(struct blk_mq_hw_ctx *hctx, struct request *rq)
1685{
Jens Axboebd166ef2017-01-17 06:03:22 -07001686 if (rq->tag != -1)
1687 return blk_tag_to_qc_t(rq->tag, hctx->queue_num, false);
1688
1689 return blk_tag_to_qc_t(rq->internal_tag, hctx->queue_num, true);
Jens Axboefd2d3322017-01-12 10:04:45 -07001690}
1691
Ming Leid964f042017-06-06 23:22:00 +08001692static void __blk_mq_try_issue_directly(struct blk_mq_hw_ctx *hctx,
1693 struct request *rq,
Jens Axboe04ced152018-01-09 08:29:46 -08001694 blk_qc_t *cookie)
Shaohua Lif984df12015-05-08 10:51:32 -07001695{
Shaohua Lif984df12015-05-08 10:51:32 -07001696 struct request_queue *q = rq->q;
Shaohua Lif984df12015-05-08 10:51:32 -07001697 struct blk_mq_queue_data bd = {
1698 .rq = rq,
Omar Sandovald945a362017-04-05 12:01:36 -07001699 .last = true,
Shaohua Lif984df12015-05-08 10:51:32 -07001700 };
Jens Axboebd166ef2017-01-17 06:03:22 -07001701 blk_qc_t new_cookie;
Jens Axboef06345a2017-06-12 11:22:46 -06001702 blk_status_t ret;
Ming Leid964f042017-06-06 23:22:00 +08001703 bool run_queue = true;
1704
Ming Leif4560ff2017-06-18 14:24:27 -06001705 /* RCU or SRCU read lock is needed before checking quiesced flag */
1706 if (blk_mq_hctx_stopped(hctx) || blk_queue_quiesced(q)) {
Ming Leid964f042017-06-06 23:22:00 +08001707 run_queue = false;
1708 goto insert;
1709 }
Shaohua Lif984df12015-05-08 10:51:32 -07001710
Jens Axboebd166ef2017-01-17 06:03:22 -07001711 if (q->elevator)
Bart Van Assche2253efc2016-10-28 17:20:02 -07001712 goto insert;
1713
Ming Leid964f042017-06-06 23:22:00 +08001714 if (!blk_mq_get_driver_tag(rq, NULL, false))
Jens Axboebd166ef2017-01-17 06:03:22 -07001715 goto insert;
1716
Ming Lei88022d72017-11-05 02:21:12 +08001717 if (!blk_mq_get_dispatch_budget(hctx)) {
Ming Leide148292017-10-14 17:22:29 +08001718 blk_mq_put_driver_tag(rq);
1719 goto insert;
Ming Lei88022d72017-11-05 02:21:12 +08001720 }
Ming Leide148292017-10-14 17:22:29 +08001721
Jens Axboebd166ef2017-01-17 06:03:22 -07001722 new_cookie = request_to_qc_t(hctx, rq);
1723
Shaohua Lif984df12015-05-08 10:51:32 -07001724 /*
1725 * For OK queue, we are done. For error, kill it. Any other
1726 * error (busy), just add it to our list as we previously
1727 * would have done
1728 */
1729 ret = q->mq_ops->queue_rq(hctx, &bd);
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001730 switch (ret) {
1731 case BLK_STS_OK:
Jens Axboe7b371632015-11-05 10:41:40 -07001732 *cookie = new_cookie;
Bart Van Assche2253efc2016-10-28 17:20:02 -07001733 return;
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001734 case BLK_STS_RESOURCE:
1735 __blk_mq_requeue_request(rq);
1736 goto insert;
1737 default:
Jens Axboe7b371632015-11-05 10:41:40 -07001738 *cookie = BLK_QC_T_NONE;
Christoph Hellwigfc17b652017-06-03 09:38:05 +02001739 blk_mq_end_request(rq, ret);
Bart Van Assche2253efc2016-10-28 17:20:02 -07001740 return;
Jens Axboe7b371632015-11-05 10:41:40 -07001741 }
1742
Bart Van Assche2253efc2016-10-28 17:20:02 -07001743insert:
Jens Axboe04ced152018-01-09 08:29:46 -08001744 blk_mq_sched_insert_request(rq, false, run_queue, false,
1745 hctx->flags & BLK_MQ_F_BLOCKING);
Shaohua Lif984df12015-05-08 10:51:32 -07001746}
1747
Christoph Hellwig5eb61262017-03-22 15:01:51 -04001748static void blk_mq_try_issue_directly(struct blk_mq_hw_ctx *hctx,
1749 struct request *rq, blk_qc_t *cookie)
1750{
Jens Axboe04ced152018-01-09 08:29:46 -08001751 int srcu_idx;
Jens Axboebf4907c2017-03-30 12:30:39 -06001752
Jens Axboe04ced152018-01-09 08:29:46 -08001753 might_sleep_if(hctx->flags & BLK_MQ_F_BLOCKING);
Jens Axboebf4907c2017-03-30 12:30:39 -06001754
Jens Axboe04ced152018-01-09 08:29:46 -08001755 hctx_lock(hctx, &srcu_idx);
1756 __blk_mq_try_issue_directly(hctx, rq, cookie);
1757 hctx_unlock(hctx, srcu_idx);
Christoph Hellwig5eb61262017-03-22 15:01:51 -04001758}
1759
Jens Axboedece1632015-11-05 10:41:16 -07001760static blk_qc_t blk_mq_make_request(struct request_queue *q, struct bio *bio)
Jens Axboe07068d52014-05-22 10:40:51 -06001761{
Christoph Hellwigef295ec2016-10-28 08:48:16 -06001762 const int is_sync = op_is_sync(bio->bi_opf);
Christoph Hellwigf73f44e2017-01-27 08:30:47 -07001763 const int is_flush_fua = op_is_flush(bio->bi_opf);
Jens Axboe5a797e02017-01-26 12:22:11 -07001764 struct blk_mq_alloc_data data = { .flags = 0 };
Jens Axboe07068d52014-05-22 10:40:51 -06001765 struct request *rq;
Christoph Hellwig5eb61262017-03-22 15:01:51 -04001766 unsigned int request_count = 0;
Shaohua Lif984df12015-05-08 10:51:32 -07001767 struct blk_plug *plug;
Shaohua Li5b3f3412015-05-08 10:51:33 -07001768 struct request *same_queue_rq = NULL;
Jens Axboe7b371632015-11-05 10:41:40 -07001769 blk_qc_t cookie;
Jens Axboe87760e52016-11-09 12:38:14 -07001770 unsigned int wb_acct;
Jens Axboe07068d52014-05-22 10:40:51 -06001771
1772 blk_queue_bounce(q, &bio);
1773
NeilBrownaf67c312017-06-18 14:38:57 +10001774 blk_queue_split(q, &bio);
Wen Xiongf36ea502017-05-10 08:54:11 -05001775
Dmitry Monakhove23947b2017-06-29 11:31:11 -07001776 if (!bio_integrity_prep(bio))
Jens Axboedece1632015-11-05 10:41:16 -07001777 return BLK_QC_T_NONE;
Jens Axboe07068d52014-05-22 10:40:51 -06001778
Omar Sandoval87c279e2016-06-01 22:18:48 -07001779 if (!is_flush_fua && !blk_queue_nomerges(q) &&
1780 blk_attempt_plug_merge(q, bio, &request_count, &same_queue_rq))
1781 return BLK_QC_T_NONE;
Shaohua Lif984df12015-05-08 10:51:32 -07001782
Jens Axboebd166ef2017-01-17 06:03:22 -07001783 if (blk_mq_sched_bio_merge(q, bio))
1784 return BLK_QC_T_NONE;
1785
Jens Axboe87760e52016-11-09 12:38:14 -07001786 wb_acct = wbt_wait(q->rq_wb, bio, NULL);
1787
Jens Axboebd166ef2017-01-17 06:03:22 -07001788 trace_block_getrq(q, bio, bio->bi_opf);
1789
Christoph Hellwigd2c0d382017-06-16 18:15:19 +02001790 rq = blk_mq_get_request(q, bio, bio->bi_opf, &data);
Jens Axboe87760e52016-11-09 12:38:14 -07001791 if (unlikely(!rq)) {
1792 __wbt_done(q->rq_wb, wb_acct);
Goldwyn Rodrigues03a07c92017-06-20 07:05:46 -05001793 if (bio->bi_opf & REQ_NOWAIT)
1794 bio_wouldblock_error(bio);
Jens Axboedece1632015-11-05 10:41:16 -07001795 return BLK_QC_T_NONE;
Jens Axboe87760e52016-11-09 12:38:14 -07001796 }
1797
1798 wbt_track(&rq->issue_stat, wb_acct);
Jens Axboe07068d52014-05-22 10:40:51 -06001799
Jens Axboefd2d3322017-01-12 10:04:45 -07001800 cookie = request_to_qc_t(data.hctx, rq);
Jens Axboe07068d52014-05-22 10:40:51 -06001801
Shaohua Lif984df12015-05-08 10:51:32 -07001802 plug = current->plug;
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001803 if (unlikely(is_flush_fua)) {
Shaohua Lif984df12015-05-08 10:51:32 -07001804 blk_mq_put_ctx(data.ctx);
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001805 blk_mq_bio_to_request(rq, bio);
Ming Lei923218f2017-11-02 23:24:38 +08001806
1807 /* bypass scheduler for flush rq */
1808 blk_insert_flush(rq);
1809 blk_mq_run_hw_queue(data.hctx, true);
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001810 } else if (plug && q->nr_hw_queues == 1) {
Shaohua Li600271d2016-11-03 17:03:54 -07001811 struct request *last = NULL;
1812
Jens Axboeb00c53e2017-04-20 16:40:36 -06001813 blk_mq_put_ctx(data.ctx);
Jeff Moyere6c44382015-05-08 10:51:30 -07001814 blk_mq_bio_to_request(rq, bio);
Ming Lei0a6219a2016-11-16 18:07:05 +08001815
1816 /*
1817 * @request_count may become stale because of schedule
1818 * out, so check the list again.
1819 */
1820 if (list_empty(&plug->mq_list))
1821 request_count = 0;
Christoph Hellwig254d2592017-03-22 15:01:50 -04001822 else if (blk_queue_nomerges(q))
1823 request_count = blk_plug_queued_count(q);
1824
Ming Lei676d0602015-10-20 23:13:56 +08001825 if (!request_count)
Jeff Moyere6c44382015-05-08 10:51:30 -07001826 trace_block_plug(q);
Shaohua Li600271d2016-11-03 17:03:54 -07001827 else
1828 last = list_entry_rq(plug->mq_list.prev);
Jens Axboeb094f892015-11-20 20:29:45 -07001829
Shaohua Li600271d2016-11-03 17:03:54 -07001830 if (request_count >= BLK_MAX_REQUEST_COUNT || (last &&
1831 blk_rq_bytes(last) >= BLK_PLUG_FLUSH_SIZE)) {
Jeff Moyere6c44382015-05-08 10:51:30 -07001832 blk_flush_plug_list(plug, false);
1833 trace_block_plug(q);
Jens Axboe320ae512013-10-24 09:20:05 +01001834 }
Jens Axboeb094f892015-11-20 20:29:45 -07001835
Jeff Moyere6c44382015-05-08 10:51:30 -07001836 list_add_tail(&rq->queuelist, &plug->mq_list);
Christoph Hellwig22997222017-03-22 15:01:52 -04001837 } else if (plug && !blk_queue_nomerges(q)) {
Jens Axboe320ae512013-10-24 09:20:05 +01001838 blk_mq_bio_to_request(rq, bio);
Jens Axboe320ae512013-10-24 09:20:05 +01001839
Jens Axboe320ae512013-10-24 09:20:05 +01001840 /*
1841 * We do limited plugging. If the bio can be merged, do that.
1842 * Otherwise the existing request in the plug list will be
1843 * issued. So the plug list will have one request at most
Christoph Hellwig22997222017-03-22 15:01:52 -04001844 * The plug list might get flushed before this. If that happens,
1845 * the plug list is empty, and same_queue_rq is invalid.
Jens Axboe320ae512013-10-24 09:20:05 +01001846 */
Christoph Hellwig22997222017-03-22 15:01:52 -04001847 if (list_empty(&plug->mq_list))
1848 same_queue_rq = NULL;
1849 if (same_queue_rq)
1850 list_del_init(&same_queue_rq->queuelist);
1851 list_add_tail(&rq->queuelist, &plug->mq_list);
1852
Jens Axboebf4907c2017-03-30 12:30:39 -06001853 blk_mq_put_ctx(data.ctx);
1854
Ming Leidad7a3b2017-06-06 23:21:59 +08001855 if (same_queue_rq) {
1856 data.hctx = blk_mq_map_queue(q,
1857 same_queue_rq->mq_ctx->cpu);
Christoph Hellwig22997222017-03-22 15:01:52 -04001858 blk_mq_try_issue_directly(data.hctx, same_queue_rq,
1859 &cookie);
Ming Leidad7a3b2017-06-06 23:21:59 +08001860 }
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001861 } else if (q->nr_hw_queues > 1 && is_sync) {
Jens Axboebd166ef2017-01-17 06:03:22 -07001862 blk_mq_put_ctx(data.ctx);
1863 blk_mq_bio_to_request(rq, bio);
Christoph Hellwig22997222017-03-22 15:01:52 -04001864 blk_mq_try_issue_directly(data.hctx, rq, &cookie);
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001865 } else if (q->elevator) {
Jens Axboeb00c53e2017-04-20 16:40:36 -06001866 blk_mq_put_ctx(data.ctx);
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001867 blk_mq_bio_to_request(rq, bio);
1868 blk_mq_sched_insert_request(rq, false, true, true, true);
Ming Leiab42f352017-05-26 19:53:19 +08001869 } else {
Jens Axboeb00c53e2017-04-20 16:40:36 -06001870 blk_mq_put_ctx(data.ctx);
Ming Leiab42f352017-05-26 19:53:19 +08001871 blk_mq_bio_to_request(rq, bio);
1872 blk_mq_queue_io(data.hctx, data.ctx, rq);
Christoph Hellwiga4d907b2017-03-22 15:01:53 -04001873 blk_mq_run_hw_queue(data.hctx, true);
Ming Leiab42f352017-05-26 19:53:19 +08001874 }
Jens Axboe320ae512013-10-24 09:20:05 +01001875
Jens Axboe7b371632015-11-05 10:41:40 -07001876 return cookie;
Jens Axboe320ae512013-10-24 09:20:05 +01001877}
1878
Jens Axboecc71a6f2017-01-11 14:29:56 -07001879void blk_mq_free_rqs(struct blk_mq_tag_set *set, struct blk_mq_tags *tags,
1880 unsigned int hctx_idx)
Jens Axboe320ae512013-10-24 09:20:05 +01001881{
1882 struct page *page;
1883
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001884 if (tags->rqs && set->ops->exit_request) {
Christoph Hellwige9b267d2014-04-15 13:59:10 -06001885 int i;
1886
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001887 for (i = 0; i < tags->nr_tags; i++) {
Jens Axboe2af8cbe2017-01-13 14:39:30 -07001888 struct request *rq = tags->static_rqs[i];
1889
1890 if (!rq)
Christoph Hellwige9b267d2014-04-15 13:59:10 -06001891 continue;
Christoph Hellwigd6296d392017-05-01 10:19:08 -06001892 set->ops->exit_request(set, rq, hctx_idx);
Jens Axboe2af8cbe2017-01-13 14:39:30 -07001893 tags->static_rqs[i] = NULL;
Christoph Hellwige9b267d2014-04-15 13:59:10 -06001894 }
1895 }
1896
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001897 while (!list_empty(&tags->page_list)) {
1898 page = list_first_entry(&tags->page_list, struct page, lru);
Dave Hansen67534712014-01-08 20:17:46 -07001899 list_del_init(&page->lru);
Catalin Marinasf75782e2015-09-14 18:16:02 +01001900 /*
1901 * Remove kmemleak object previously allocated in
1902 * blk_mq_init_rq_map().
1903 */
1904 kmemleak_free(page_address(page));
Jens Axboe320ae512013-10-24 09:20:05 +01001905 __free_pages(page, page->private);
1906 }
Jens Axboecc71a6f2017-01-11 14:29:56 -07001907}
Jens Axboe320ae512013-10-24 09:20:05 +01001908
Jens Axboecc71a6f2017-01-11 14:29:56 -07001909void blk_mq_free_rq_map(struct blk_mq_tags *tags)
1910{
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001911 kfree(tags->rqs);
Jens Axboecc71a6f2017-01-11 14:29:56 -07001912 tags->rqs = NULL;
Jens Axboe2af8cbe2017-01-13 14:39:30 -07001913 kfree(tags->static_rqs);
1914 tags->static_rqs = NULL;
Jens Axboe320ae512013-10-24 09:20:05 +01001915
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001916 blk_mq_free_tags(tags);
Jens Axboe320ae512013-10-24 09:20:05 +01001917}
1918
Jens Axboecc71a6f2017-01-11 14:29:56 -07001919struct blk_mq_tags *blk_mq_alloc_rq_map(struct blk_mq_tag_set *set,
1920 unsigned int hctx_idx,
1921 unsigned int nr_tags,
1922 unsigned int reserved_tags)
Jens Axboe320ae512013-10-24 09:20:05 +01001923{
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001924 struct blk_mq_tags *tags;
Shaohua Li59f082e2017-02-01 09:53:14 -08001925 int node;
Jens Axboe320ae512013-10-24 09:20:05 +01001926
Shaohua Li59f082e2017-02-01 09:53:14 -08001927 node = blk_mq_hw_queue_to_node(set->mq_map, hctx_idx);
1928 if (node == NUMA_NO_NODE)
1929 node = set->numa_node;
1930
1931 tags = blk_mq_init_tags(nr_tags, reserved_tags, node,
Shaohua Li24391c02015-01-23 14:18:00 -07001932 BLK_MQ_FLAG_TO_ALLOC_POLICY(set->flags));
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001933 if (!tags)
1934 return NULL;
Jens Axboe320ae512013-10-24 09:20:05 +01001935
Jens Axboecc71a6f2017-01-11 14:29:56 -07001936 tags->rqs = kzalloc_node(nr_tags * sizeof(struct request *),
Gabriel Krisman Bertazi36e1f3d12016-12-06 13:31:44 -02001937 GFP_NOIO | __GFP_NOWARN | __GFP_NORETRY,
Shaohua Li59f082e2017-02-01 09:53:14 -08001938 node);
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001939 if (!tags->rqs) {
1940 blk_mq_free_tags(tags);
1941 return NULL;
1942 }
Jens Axboe320ae512013-10-24 09:20:05 +01001943
Jens Axboe2af8cbe2017-01-13 14:39:30 -07001944 tags->static_rqs = kzalloc_node(nr_tags * sizeof(struct request *),
1945 GFP_NOIO | __GFP_NOWARN | __GFP_NORETRY,
Shaohua Li59f082e2017-02-01 09:53:14 -08001946 node);
Jens Axboe2af8cbe2017-01-13 14:39:30 -07001947 if (!tags->static_rqs) {
1948 kfree(tags->rqs);
1949 blk_mq_free_tags(tags);
1950 return NULL;
1951 }
1952
Jens Axboecc71a6f2017-01-11 14:29:56 -07001953 return tags;
1954}
1955
1956static size_t order_to_size(unsigned int order)
1957{
1958 return (size_t)PAGE_SIZE << order;
1959}
1960
Tejun Heo1d9bd512018-01-09 08:29:48 -08001961static int blk_mq_init_request(struct blk_mq_tag_set *set, struct request *rq,
1962 unsigned int hctx_idx, int node)
1963{
1964 int ret;
1965
1966 if (set->ops->init_request) {
1967 ret = set->ops->init_request(set, rq, hctx_idx, node);
1968 if (ret)
1969 return ret;
1970 }
1971
1972 seqcount_init(&rq->gstate_seq);
1973 u64_stats_init(&rq->aborted_gstate_sync);
1974 return 0;
1975}
1976
Jens Axboecc71a6f2017-01-11 14:29:56 -07001977int blk_mq_alloc_rqs(struct blk_mq_tag_set *set, struct blk_mq_tags *tags,
1978 unsigned int hctx_idx, unsigned int depth)
1979{
1980 unsigned int i, j, entries_per_page, max_order = 4;
1981 size_t rq_size, left;
Shaohua Li59f082e2017-02-01 09:53:14 -08001982 int node;
1983
1984 node = blk_mq_hw_queue_to_node(set->mq_map, hctx_idx);
1985 if (node == NUMA_NO_NODE)
1986 node = set->numa_node;
Jens Axboecc71a6f2017-01-11 14:29:56 -07001987
1988 INIT_LIST_HEAD(&tags->page_list);
1989
Jens Axboe320ae512013-10-24 09:20:05 +01001990 /*
1991 * rq_size is the size of the request plus driver payload, rounded
1992 * to the cacheline size
1993 */
Christoph Hellwig24d2f902014-04-15 14:14:00 -06001994 rq_size = round_up(sizeof(struct request) + set->cmd_size,
Jens Axboe320ae512013-10-24 09:20:05 +01001995 cache_line_size());
Jens Axboecc71a6f2017-01-11 14:29:56 -07001996 left = rq_size * depth;
Jens Axboe320ae512013-10-24 09:20:05 +01001997
Jens Axboecc71a6f2017-01-11 14:29:56 -07001998 for (i = 0; i < depth; ) {
Jens Axboe320ae512013-10-24 09:20:05 +01001999 int this_order = max_order;
2000 struct page *page;
2001 int to_do;
2002 void *p;
2003
Bartlomiej Zolnierkiewiczb3a834b2016-05-16 09:54:47 -06002004 while (this_order && left < order_to_size(this_order - 1))
Jens Axboe320ae512013-10-24 09:20:05 +01002005 this_order--;
2006
2007 do {
Shaohua Li59f082e2017-02-01 09:53:14 -08002008 page = alloc_pages_node(node,
Gabriel Krisman Bertazi36e1f3d12016-12-06 13:31:44 -02002009 GFP_NOIO | __GFP_NOWARN | __GFP_NORETRY | __GFP_ZERO,
Jens Axboea5164402014-09-10 09:02:03 -06002010 this_order);
Jens Axboe320ae512013-10-24 09:20:05 +01002011 if (page)
2012 break;
2013 if (!this_order--)
2014 break;
2015 if (order_to_size(this_order) < rq_size)
2016 break;
2017 } while (1);
2018
2019 if (!page)
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002020 goto fail;
Jens Axboe320ae512013-10-24 09:20:05 +01002021
2022 page->private = this_order;
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002023 list_add_tail(&page->lru, &tags->page_list);
Jens Axboe320ae512013-10-24 09:20:05 +01002024
2025 p = page_address(page);
Catalin Marinasf75782e2015-09-14 18:16:02 +01002026 /*
2027 * Allow kmemleak to scan these pages as they contain pointers
2028 * to additional allocations like via ops->init_request().
2029 */
Gabriel Krisman Bertazi36e1f3d12016-12-06 13:31:44 -02002030 kmemleak_alloc(p, order_to_size(this_order), 1, GFP_NOIO);
Jens Axboe320ae512013-10-24 09:20:05 +01002031 entries_per_page = order_to_size(this_order) / rq_size;
Jens Axboecc71a6f2017-01-11 14:29:56 -07002032 to_do = min(entries_per_page, depth - i);
Jens Axboe320ae512013-10-24 09:20:05 +01002033 left -= to_do * rq_size;
2034 for (j = 0; j < to_do; j++) {
Jens Axboe2af8cbe2017-01-13 14:39:30 -07002035 struct request *rq = p;
2036
2037 tags->static_rqs[i] = rq;
Tejun Heo1d9bd512018-01-09 08:29:48 -08002038 if (blk_mq_init_request(set, rq, hctx_idx, node)) {
2039 tags->static_rqs[i] = NULL;
2040 goto fail;
Christoph Hellwige9b267d2014-04-15 13:59:10 -06002041 }
2042
Jens Axboe320ae512013-10-24 09:20:05 +01002043 p += rq_size;
2044 i++;
2045 }
2046 }
Jens Axboecc71a6f2017-01-11 14:29:56 -07002047 return 0;
Jens Axboe320ae512013-10-24 09:20:05 +01002048
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002049fail:
Jens Axboecc71a6f2017-01-11 14:29:56 -07002050 blk_mq_free_rqs(set, tags, hctx_idx);
2051 return -ENOMEM;
Jens Axboe320ae512013-10-24 09:20:05 +01002052}
2053
Jens Axboee57690f2016-08-24 15:34:35 -06002054/*
2055 * 'cpu' is going away. splice any existing rq_list entries from this
2056 * software queue to the hw queue dispatch list, and ensure that it
2057 * gets run.
2058 */
Thomas Gleixner9467f852016-09-22 08:05:17 -06002059static int blk_mq_hctx_notify_dead(unsigned int cpu, struct hlist_node *node)
Jens Axboe484b4062014-05-21 14:01:15 -06002060{
Thomas Gleixner9467f852016-09-22 08:05:17 -06002061 struct blk_mq_hw_ctx *hctx;
Jens Axboe484b4062014-05-21 14:01:15 -06002062 struct blk_mq_ctx *ctx;
2063 LIST_HEAD(tmp);
2064
Thomas Gleixner9467f852016-09-22 08:05:17 -06002065 hctx = hlist_entry_safe(node, struct blk_mq_hw_ctx, cpuhp_dead);
Jens Axboee57690f2016-08-24 15:34:35 -06002066 ctx = __blk_mq_get_ctx(hctx->queue, cpu);
Jens Axboe484b4062014-05-21 14:01:15 -06002067
2068 spin_lock(&ctx->lock);
2069 if (!list_empty(&ctx->rq_list)) {
2070 list_splice_init(&ctx->rq_list, &tmp);
2071 blk_mq_hctx_clear_pending(hctx, ctx);
2072 }
2073 spin_unlock(&ctx->lock);
2074
2075 if (list_empty(&tmp))
Thomas Gleixner9467f852016-09-22 08:05:17 -06002076 return 0;
Jens Axboe484b4062014-05-21 14:01:15 -06002077
Jens Axboee57690f2016-08-24 15:34:35 -06002078 spin_lock(&hctx->lock);
2079 list_splice_tail_init(&tmp, &hctx->dispatch);
2080 spin_unlock(&hctx->lock);
Jens Axboe484b4062014-05-21 14:01:15 -06002081
2082 blk_mq_run_hw_queue(hctx, true);
Thomas Gleixner9467f852016-09-22 08:05:17 -06002083 return 0;
Jens Axboe484b4062014-05-21 14:01:15 -06002084}
2085
Thomas Gleixner9467f852016-09-22 08:05:17 -06002086static void blk_mq_remove_cpuhp(struct blk_mq_hw_ctx *hctx)
Jens Axboe484b4062014-05-21 14:01:15 -06002087{
Thomas Gleixner9467f852016-09-22 08:05:17 -06002088 cpuhp_state_remove_instance_nocalls(CPUHP_BLK_MQ_DEAD,
2089 &hctx->cpuhp_dead);
Jens Axboe484b4062014-05-21 14:01:15 -06002090}
2091
Ming Leic3b4afc2015-06-04 22:25:04 +08002092/* hctx->ctxs will be freed in queue's release handler */
Ming Lei08e98fc2014-09-25 23:23:38 +08002093static void blk_mq_exit_hctx(struct request_queue *q,
2094 struct blk_mq_tag_set *set,
2095 struct blk_mq_hw_ctx *hctx, unsigned int hctx_idx)
2096{
Omar Sandoval9c1051a2017-05-04 08:17:21 -06002097 blk_mq_debugfs_unregister_hctx(hctx);
2098
Ming Lei8ab0b7d2018-01-09 21:28:29 +08002099 if (blk_mq_hw_queue_mapped(hctx))
2100 blk_mq_tag_idle(hctx);
Ming Lei08e98fc2014-09-25 23:23:38 +08002101
Ming Leif70ced02014-09-25 23:23:47 +08002102 if (set->ops->exit_request)
Christoph Hellwigd6296d392017-05-01 10:19:08 -06002103 set->ops->exit_request(set, hctx->fq->flush_rq, hctx_idx);
Ming Leif70ced02014-09-25 23:23:47 +08002104
Omar Sandoval93252632017-04-05 12:01:31 -07002105 blk_mq_sched_exit_hctx(q, hctx, hctx_idx);
2106
Ming Lei08e98fc2014-09-25 23:23:38 +08002107 if (set->ops->exit_hctx)
2108 set->ops->exit_hctx(hctx, hctx_idx);
2109
Bart Van Assche6a83e742016-11-02 10:09:51 -06002110 if (hctx->flags & BLK_MQ_F_BLOCKING)
Tejun Heo05707b62018-01-09 08:29:53 -08002111 cleanup_srcu_struct(hctx->srcu);
Bart Van Assche6a83e742016-11-02 10:09:51 -06002112
Thomas Gleixner9467f852016-09-22 08:05:17 -06002113 blk_mq_remove_cpuhp(hctx);
Ming Leif70ced02014-09-25 23:23:47 +08002114 blk_free_flush_queue(hctx->fq);
Omar Sandoval88459642016-09-17 08:38:44 -06002115 sbitmap_free(&hctx->ctx_map);
Ming Lei08e98fc2014-09-25 23:23:38 +08002116}
2117
Ming Lei624dbe42014-05-27 23:35:13 +08002118static void blk_mq_exit_hw_queues(struct request_queue *q,
2119 struct blk_mq_tag_set *set, int nr_queue)
2120{
2121 struct blk_mq_hw_ctx *hctx;
2122 unsigned int i;
2123
2124 queue_for_each_hw_ctx(q, hctx, i) {
2125 if (i == nr_queue)
2126 break;
Ming Lei08e98fc2014-09-25 23:23:38 +08002127 blk_mq_exit_hctx(q, set, hctx, i);
Ming Lei624dbe42014-05-27 23:35:13 +08002128 }
Ming Lei624dbe42014-05-27 23:35:13 +08002129}
2130
Ming Lei08e98fc2014-09-25 23:23:38 +08002131static int blk_mq_init_hctx(struct request_queue *q,
2132 struct blk_mq_tag_set *set,
2133 struct blk_mq_hw_ctx *hctx, unsigned hctx_idx)
2134{
2135 int node;
2136
2137 node = hctx->numa_node;
2138 if (node == NUMA_NO_NODE)
2139 node = hctx->numa_node = set->numa_node;
2140
Jens Axboe9f993732017-04-10 09:54:54 -06002141 INIT_DELAYED_WORK(&hctx->run_work, blk_mq_run_work_fn);
Ming Lei08e98fc2014-09-25 23:23:38 +08002142 spin_lock_init(&hctx->lock);
2143 INIT_LIST_HEAD(&hctx->dispatch);
2144 hctx->queue = q;
Jeff Moyer2404e602015-11-03 10:40:06 -05002145 hctx->flags = set->flags & ~BLK_MQ_F_TAG_SHARED;
Ming Lei08e98fc2014-09-25 23:23:38 +08002146
Thomas Gleixner9467f852016-09-22 08:05:17 -06002147 cpuhp_state_add_instance_nocalls(CPUHP_BLK_MQ_DEAD, &hctx->cpuhp_dead);
Ming Lei08e98fc2014-09-25 23:23:38 +08002148
2149 hctx->tags = set->tags[hctx_idx];
2150
2151 /*
2152 * Allocate space for all possible cpus to avoid allocation at
2153 * runtime
2154 */
Johannes Thumshirnd904bfa2017-11-15 17:32:33 -08002155 hctx->ctxs = kmalloc_array_node(nr_cpu_ids, sizeof(void *),
Ming Lei08e98fc2014-09-25 23:23:38 +08002156 GFP_KERNEL, node);
2157 if (!hctx->ctxs)
2158 goto unregister_cpu_notifier;
2159
Omar Sandoval88459642016-09-17 08:38:44 -06002160 if (sbitmap_init_node(&hctx->ctx_map, nr_cpu_ids, ilog2(8), GFP_KERNEL,
2161 node))
Ming Lei08e98fc2014-09-25 23:23:38 +08002162 goto free_ctxs;
2163
2164 hctx->nr_ctx = 0;
2165
Jens Axboeeb619fd2017-11-09 08:32:43 -07002166 init_waitqueue_func_entry(&hctx->dispatch_wait, blk_mq_dispatch_wake);
2167 INIT_LIST_HEAD(&hctx->dispatch_wait.entry);
2168
Ming Lei08e98fc2014-09-25 23:23:38 +08002169 if (set->ops->init_hctx &&
2170 set->ops->init_hctx(hctx, set->driver_data, hctx_idx))
2171 goto free_bitmap;
2172
Omar Sandoval93252632017-04-05 12:01:31 -07002173 if (blk_mq_sched_init_hctx(q, hctx, hctx_idx))
2174 goto exit_hctx;
2175
Ming Leif70ced02014-09-25 23:23:47 +08002176 hctx->fq = blk_alloc_flush_queue(q, hctx->numa_node, set->cmd_size);
2177 if (!hctx->fq)
Omar Sandoval93252632017-04-05 12:01:31 -07002178 goto sched_exit_hctx;
Ming Leif70ced02014-09-25 23:23:47 +08002179
Tejun Heo1d9bd512018-01-09 08:29:48 -08002180 if (blk_mq_init_request(set, hctx->fq->flush_rq, hctx_idx, node))
Ming Leif70ced02014-09-25 23:23:47 +08002181 goto free_fq;
2182
Bart Van Assche6a83e742016-11-02 10:09:51 -06002183 if (hctx->flags & BLK_MQ_F_BLOCKING)
Tejun Heo05707b62018-01-09 08:29:53 -08002184 init_srcu_struct(hctx->srcu);
Bart Van Assche6a83e742016-11-02 10:09:51 -06002185
Omar Sandoval9c1051a2017-05-04 08:17:21 -06002186 blk_mq_debugfs_register_hctx(q, hctx);
2187
Ming Lei08e98fc2014-09-25 23:23:38 +08002188 return 0;
2189
Ming Leif70ced02014-09-25 23:23:47 +08002190 free_fq:
2191 kfree(hctx->fq);
Omar Sandoval93252632017-04-05 12:01:31 -07002192 sched_exit_hctx:
2193 blk_mq_sched_exit_hctx(q, hctx, hctx_idx);
Ming Leif70ced02014-09-25 23:23:47 +08002194 exit_hctx:
2195 if (set->ops->exit_hctx)
2196 set->ops->exit_hctx(hctx, hctx_idx);
Ming Lei08e98fc2014-09-25 23:23:38 +08002197 free_bitmap:
Omar Sandoval88459642016-09-17 08:38:44 -06002198 sbitmap_free(&hctx->ctx_map);
Ming Lei08e98fc2014-09-25 23:23:38 +08002199 free_ctxs:
2200 kfree(hctx->ctxs);
2201 unregister_cpu_notifier:
Thomas Gleixner9467f852016-09-22 08:05:17 -06002202 blk_mq_remove_cpuhp(hctx);
Ming Lei08e98fc2014-09-25 23:23:38 +08002203 return -1;
2204}
2205
Jens Axboe320ae512013-10-24 09:20:05 +01002206static void blk_mq_init_cpu_queues(struct request_queue *q,
2207 unsigned int nr_hw_queues)
2208{
2209 unsigned int i;
2210
2211 for_each_possible_cpu(i) {
2212 struct blk_mq_ctx *__ctx = per_cpu_ptr(q->queue_ctx, i);
2213 struct blk_mq_hw_ctx *hctx;
2214
Jens Axboe320ae512013-10-24 09:20:05 +01002215 __ctx->cpu = i;
2216 spin_lock_init(&__ctx->lock);
2217 INIT_LIST_HEAD(&__ctx->rq_list);
2218 __ctx->queue = q;
2219
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002220 /* If the cpu isn't present, the cpu is mapped to first hctx */
2221 if (!cpu_present(i))
Jens Axboe320ae512013-10-24 09:20:05 +01002222 continue;
2223
Christoph Hellwig7d7e0f92016-09-14 16:18:54 +02002224 hctx = blk_mq_map_queue(q, i);
Jens Axboee4043dc2014-04-09 10:18:23 -06002225
Jens Axboe320ae512013-10-24 09:20:05 +01002226 /*
2227 * Set local node, IFF we have more than one hw queue. If
2228 * not, we remain on the home node of the device
2229 */
2230 if (nr_hw_queues > 1 && hctx->numa_node == NUMA_NO_NODE)
Raghavendra K Tbffed452015-12-02 16:59:05 +05302231 hctx->numa_node = local_memory_node(cpu_to_node(i));
Jens Axboe320ae512013-10-24 09:20:05 +01002232 }
2233}
2234
Jens Axboecc71a6f2017-01-11 14:29:56 -07002235static bool __blk_mq_alloc_rq_map(struct blk_mq_tag_set *set, int hctx_idx)
2236{
2237 int ret = 0;
2238
2239 set->tags[hctx_idx] = blk_mq_alloc_rq_map(set, hctx_idx,
2240 set->queue_depth, set->reserved_tags);
2241 if (!set->tags[hctx_idx])
2242 return false;
2243
2244 ret = blk_mq_alloc_rqs(set, set->tags[hctx_idx], hctx_idx,
2245 set->queue_depth);
2246 if (!ret)
2247 return true;
2248
2249 blk_mq_free_rq_map(set->tags[hctx_idx]);
2250 set->tags[hctx_idx] = NULL;
2251 return false;
2252}
2253
2254static void blk_mq_free_map_and_requests(struct blk_mq_tag_set *set,
2255 unsigned int hctx_idx)
2256{
Jens Axboebd166ef2017-01-17 06:03:22 -07002257 if (set->tags[hctx_idx]) {
2258 blk_mq_free_rqs(set, set->tags[hctx_idx], hctx_idx);
2259 blk_mq_free_rq_map(set->tags[hctx_idx]);
2260 set->tags[hctx_idx] = NULL;
2261 }
Jens Axboecc71a6f2017-01-11 14:29:56 -07002262}
2263
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002264static void blk_mq_map_swqueue(struct request_queue *q)
Jens Axboe320ae512013-10-24 09:20:05 +01002265{
Gabriel Krisman Bertazid1b1cea2016-12-14 18:48:36 -02002266 unsigned int i, hctx_idx;
Jens Axboe320ae512013-10-24 09:20:05 +01002267 struct blk_mq_hw_ctx *hctx;
2268 struct blk_mq_ctx *ctx;
Ming Lei2a34c082015-04-21 10:00:20 +08002269 struct blk_mq_tag_set *set = q->tag_set;
Jens Axboe320ae512013-10-24 09:20:05 +01002270
Akinobu Mita60de0742015-09-27 02:09:25 +09002271 /*
2272 * Avoid others reading imcomplete hctx->cpumask through sysfs
2273 */
2274 mutex_lock(&q->sysfs_lock);
2275
Jens Axboe320ae512013-10-24 09:20:05 +01002276 queue_for_each_hw_ctx(q, hctx, i) {
Jens Axboee4043dc2014-04-09 10:18:23 -06002277 cpumask_clear(hctx->cpumask);
Jens Axboe320ae512013-10-24 09:20:05 +01002278 hctx->nr_ctx = 0;
2279 }
2280
2281 /*
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002282 * Map software to hardware queues.
2283 *
2284 * If the cpu isn't present, the cpu is mapped to first hctx.
Jens Axboe320ae512013-10-24 09:20:05 +01002285 */
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002286 for_each_present_cpu(i) {
Gabriel Krisman Bertazid1b1cea2016-12-14 18:48:36 -02002287 hctx_idx = q->mq_map[i];
2288 /* unmapped hw queue can be remapped after CPU topo changed */
Jens Axboecc71a6f2017-01-11 14:29:56 -07002289 if (!set->tags[hctx_idx] &&
2290 !__blk_mq_alloc_rq_map(set, hctx_idx)) {
Gabriel Krisman Bertazid1b1cea2016-12-14 18:48:36 -02002291 /*
2292 * If tags initialization fail for some hctx,
2293 * that hctx won't be brought online. In this
2294 * case, remap the current ctx to hctx[0] which
2295 * is guaranteed to always have tags allocated
2296 */
Jens Axboecc71a6f2017-01-11 14:29:56 -07002297 q->mq_map[i] = 0;
Gabriel Krisman Bertazid1b1cea2016-12-14 18:48:36 -02002298 }
2299
Thomas Gleixner897bb0c2016-03-19 11:30:33 +01002300 ctx = per_cpu_ptr(q->queue_ctx, i);
Christoph Hellwig7d7e0f92016-09-14 16:18:54 +02002301 hctx = blk_mq_map_queue(q, i);
Keith Busch868f2f02015-12-17 17:08:14 -07002302
Jens Axboee4043dc2014-04-09 10:18:23 -06002303 cpumask_set_cpu(i, hctx->cpumask);
Jens Axboe320ae512013-10-24 09:20:05 +01002304 ctx->index_hw = hctx->nr_ctx;
2305 hctx->ctxs[hctx->nr_ctx++] = ctx;
2306 }
Jens Axboe506e9312014-05-07 10:26:44 -06002307
Akinobu Mita60de0742015-09-27 02:09:25 +09002308 mutex_unlock(&q->sysfs_lock);
2309
Jens Axboe506e9312014-05-07 10:26:44 -06002310 queue_for_each_hw_ctx(q, hctx, i) {
Jens Axboe484b4062014-05-21 14:01:15 -06002311 /*
Jens Axboea68aafa2014-08-15 13:19:15 -06002312 * If no software queues are mapped to this hardware queue,
2313 * disable it and free the request entries.
Jens Axboe484b4062014-05-21 14:01:15 -06002314 */
2315 if (!hctx->nr_ctx) {
Gabriel Krisman Bertazid1b1cea2016-12-14 18:48:36 -02002316 /* Never unmap queue 0. We need it as a
2317 * fallback in case of a new remap fails
2318 * allocation
2319 */
Jens Axboecc71a6f2017-01-11 14:29:56 -07002320 if (i && set->tags[i])
2321 blk_mq_free_map_and_requests(set, i);
2322
Ming Lei2a34c082015-04-21 10:00:20 +08002323 hctx->tags = NULL;
Jens Axboe484b4062014-05-21 14:01:15 -06002324 continue;
2325 }
2326
Ming Lei2a34c082015-04-21 10:00:20 +08002327 hctx->tags = set->tags[i];
2328 WARN_ON(!hctx->tags);
2329
Jens Axboe484b4062014-05-21 14:01:15 -06002330 /*
Chong Yuan889fa312015-04-15 11:39:29 -06002331 * Set the map size to the number of mapped software queues.
2332 * This is more accurate and more efficient than looping
2333 * over all possibly mapped software queues.
2334 */
Omar Sandoval88459642016-09-17 08:38:44 -06002335 sbitmap_resize(&hctx->ctx_map, hctx->nr_ctx);
Chong Yuan889fa312015-04-15 11:39:29 -06002336
2337 /*
Jens Axboe484b4062014-05-21 14:01:15 -06002338 * Initialize batch roundrobin counts
2339 */
Jens Axboe506e9312014-05-07 10:26:44 -06002340 hctx->next_cpu = cpumask_first(hctx->cpumask);
2341 hctx->next_cpu_batch = BLK_MQ_CPU_WORK_BATCH;
2342 }
Jens Axboe320ae512013-10-24 09:20:05 +01002343}
2344
Jens Axboe8e8320c2017-06-20 17:56:13 -06002345/*
2346 * Caller needs to ensure that we're either frozen/quiesced, or that
2347 * the queue isn't live yet.
2348 */
Jeff Moyer2404e602015-11-03 10:40:06 -05002349static void queue_set_hctx_shared(struct request_queue *q, bool shared)
Jens Axboe0d2602c2014-05-13 15:10:52 -06002350{
2351 struct blk_mq_hw_ctx *hctx;
Jens Axboe0d2602c2014-05-13 15:10:52 -06002352 int i;
2353
Jeff Moyer2404e602015-11-03 10:40:06 -05002354 queue_for_each_hw_ctx(q, hctx, i) {
Jens Axboe8e8320c2017-06-20 17:56:13 -06002355 if (shared) {
2356 if (test_bit(BLK_MQ_S_SCHED_RESTART, &hctx->state))
2357 atomic_inc(&q->shared_hctx_restart);
Jeff Moyer2404e602015-11-03 10:40:06 -05002358 hctx->flags |= BLK_MQ_F_TAG_SHARED;
Jens Axboe8e8320c2017-06-20 17:56:13 -06002359 } else {
2360 if (test_bit(BLK_MQ_S_SCHED_RESTART, &hctx->state))
2361 atomic_dec(&q->shared_hctx_restart);
Jeff Moyer2404e602015-11-03 10:40:06 -05002362 hctx->flags &= ~BLK_MQ_F_TAG_SHARED;
Jens Axboe8e8320c2017-06-20 17:56:13 -06002363 }
Jeff Moyer2404e602015-11-03 10:40:06 -05002364 }
2365}
2366
Jens Axboe8e8320c2017-06-20 17:56:13 -06002367static void blk_mq_update_tag_set_depth(struct blk_mq_tag_set *set,
2368 bool shared)
Jeff Moyer2404e602015-11-03 10:40:06 -05002369{
2370 struct request_queue *q;
Jens Axboe0d2602c2014-05-13 15:10:52 -06002371
Bart Van Assche705cda92017-04-07 11:16:49 -07002372 lockdep_assert_held(&set->tag_list_lock);
2373
Jens Axboe0d2602c2014-05-13 15:10:52 -06002374 list_for_each_entry(q, &set->tag_list, tag_set_list) {
2375 blk_mq_freeze_queue(q);
Jeff Moyer2404e602015-11-03 10:40:06 -05002376 queue_set_hctx_shared(q, shared);
Jens Axboe0d2602c2014-05-13 15:10:52 -06002377 blk_mq_unfreeze_queue(q);
2378 }
2379}
2380
2381static void blk_mq_del_queue_tag_set(struct request_queue *q)
2382{
2383 struct blk_mq_tag_set *set = q->tag_set;
2384
Jens Axboe0d2602c2014-05-13 15:10:52 -06002385 mutex_lock(&set->tag_list_lock);
Bart Van Assche705cda92017-04-07 11:16:49 -07002386 list_del_rcu(&q->tag_set_list);
2387 INIT_LIST_HEAD(&q->tag_set_list);
Jeff Moyer2404e602015-11-03 10:40:06 -05002388 if (list_is_singular(&set->tag_list)) {
2389 /* just transitioned to unshared */
2390 set->flags &= ~BLK_MQ_F_TAG_SHARED;
2391 /* update existing queue */
2392 blk_mq_update_tag_set_depth(set, false);
2393 }
Jens Axboe0d2602c2014-05-13 15:10:52 -06002394 mutex_unlock(&set->tag_list_lock);
Bart Van Assche705cda92017-04-07 11:16:49 -07002395
2396 synchronize_rcu();
Jens Axboe0d2602c2014-05-13 15:10:52 -06002397}
2398
2399static void blk_mq_add_queue_tag_set(struct blk_mq_tag_set *set,
2400 struct request_queue *q)
2401{
2402 q->tag_set = set;
2403
2404 mutex_lock(&set->tag_list_lock);
Jeff Moyer2404e602015-11-03 10:40:06 -05002405
Jens Axboeff821d22017-11-10 22:05:12 -07002406 /*
2407 * Check to see if we're transitioning to shared (from 1 to 2 queues).
2408 */
2409 if (!list_empty(&set->tag_list) &&
2410 !(set->flags & BLK_MQ_F_TAG_SHARED)) {
Jeff Moyer2404e602015-11-03 10:40:06 -05002411 set->flags |= BLK_MQ_F_TAG_SHARED;
2412 /* update existing queue */
2413 blk_mq_update_tag_set_depth(set, true);
2414 }
2415 if (set->flags & BLK_MQ_F_TAG_SHARED)
2416 queue_set_hctx_shared(q, true);
Bart Van Assche705cda92017-04-07 11:16:49 -07002417 list_add_tail_rcu(&q->tag_set_list, &set->tag_list);
Jeff Moyer2404e602015-11-03 10:40:06 -05002418
Jens Axboe0d2602c2014-05-13 15:10:52 -06002419 mutex_unlock(&set->tag_list_lock);
2420}
2421
Ming Leie09aae72015-01-29 20:17:27 +08002422/*
2423 * It is the actual release handler for mq, but we do it from
2424 * request queue's release handler for avoiding use-after-free
2425 * and headache because q->mq_kobj shouldn't have been introduced,
2426 * but we can't group ctx/kctx kobj without it.
2427 */
2428void blk_mq_release(struct request_queue *q)
2429{
2430 struct blk_mq_hw_ctx *hctx;
2431 unsigned int i;
2432
2433 /* hctx kobj stays in hctx */
Ming Leic3b4afc2015-06-04 22:25:04 +08002434 queue_for_each_hw_ctx(q, hctx, i) {
2435 if (!hctx)
2436 continue;
Ming Lei6c8b2322017-02-22 18:14:01 +08002437 kobject_put(&hctx->kobj);
Ming Leic3b4afc2015-06-04 22:25:04 +08002438 }
Ming Leie09aae72015-01-29 20:17:27 +08002439
Akinobu Mitaa723bab2015-09-27 02:09:21 +09002440 q->mq_map = NULL;
2441
Ming Leie09aae72015-01-29 20:17:27 +08002442 kfree(q->queue_hw_ctx);
2443
Ming Lei7ea5fe32017-02-22 18:14:00 +08002444 /*
2445 * release .mq_kobj and sw queue's kobject now because
2446 * both share lifetime with request queue.
2447 */
2448 blk_mq_sysfs_deinit(q);
2449
Ming Leie09aae72015-01-29 20:17:27 +08002450 free_percpu(q->queue_ctx);
2451}
2452
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002453struct request_queue *blk_mq_init_queue(struct blk_mq_tag_set *set)
Jens Axboe320ae512013-10-24 09:20:05 +01002454{
Mike Snitzerb62c21b2015-03-12 23:56:02 -04002455 struct request_queue *uninit_q, *q;
2456
2457 uninit_q = blk_alloc_queue_node(GFP_KERNEL, set->numa_node);
2458 if (!uninit_q)
2459 return ERR_PTR(-ENOMEM);
2460
2461 q = blk_mq_init_allocated_queue(set, uninit_q);
2462 if (IS_ERR(q))
2463 blk_cleanup_queue(uninit_q);
2464
2465 return q;
2466}
2467EXPORT_SYMBOL(blk_mq_init_queue);
2468
Bart Van Assche07319672017-06-20 11:15:38 -07002469static int blk_mq_hw_ctx_size(struct blk_mq_tag_set *tag_set)
2470{
2471 int hw_ctx_size = sizeof(struct blk_mq_hw_ctx);
2472
Tejun Heo05707b62018-01-09 08:29:53 -08002473 BUILD_BUG_ON(ALIGN(offsetof(struct blk_mq_hw_ctx, srcu),
Bart Van Assche07319672017-06-20 11:15:38 -07002474 __alignof__(struct blk_mq_hw_ctx)) !=
2475 sizeof(struct blk_mq_hw_ctx));
2476
2477 if (tag_set->flags & BLK_MQ_F_BLOCKING)
2478 hw_ctx_size += sizeof(struct srcu_struct);
2479
2480 return hw_ctx_size;
2481}
2482
Keith Busch868f2f02015-12-17 17:08:14 -07002483static void blk_mq_realloc_hw_ctxs(struct blk_mq_tag_set *set,
2484 struct request_queue *q)
Mike Snitzerb62c21b2015-03-12 23:56:02 -04002485{
Keith Busch868f2f02015-12-17 17:08:14 -07002486 int i, j;
2487 struct blk_mq_hw_ctx **hctxs = q->queue_hw_ctx;
Jens Axboe320ae512013-10-24 09:20:05 +01002488
Keith Busch868f2f02015-12-17 17:08:14 -07002489 blk_mq_sysfs_unregister(q);
Ming Leifb350e02018-01-06 16:27:40 +08002490
2491 /* protect against switching io scheduler */
2492 mutex_lock(&q->sysfs_lock);
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002493 for (i = 0; i < set->nr_hw_queues; i++) {
Keith Busch868f2f02015-12-17 17:08:14 -07002494 int node;
Jens Axboef14bbe72014-05-27 12:06:53 -06002495
Keith Busch868f2f02015-12-17 17:08:14 -07002496 if (hctxs[i])
2497 continue;
2498
2499 node = blk_mq_hw_queue_to_node(q->mq_map, i);
Bart Van Assche07319672017-06-20 11:15:38 -07002500 hctxs[i] = kzalloc_node(blk_mq_hw_ctx_size(set),
Christoph Hellwigcdef54d2014-05-28 18:11:06 +02002501 GFP_KERNEL, node);
Jens Axboe320ae512013-10-24 09:20:05 +01002502 if (!hctxs[i])
Keith Busch868f2f02015-12-17 17:08:14 -07002503 break;
Jens Axboe320ae512013-10-24 09:20:05 +01002504
Jens Axboea86073e2014-10-13 15:41:54 -06002505 if (!zalloc_cpumask_var_node(&hctxs[i]->cpumask, GFP_KERNEL,
Keith Busch868f2f02015-12-17 17:08:14 -07002506 node)) {
2507 kfree(hctxs[i]);
2508 hctxs[i] = NULL;
2509 break;
2510 }
Jens Axboee4043dc2014-04-09 10:18:23 -06002511
Jens Axboe0d2602c2014-05-13 15:10:52 -06002512 atomic_set(&hctxs[i]->nr_active, 0);
Jens Axboef14bbe72014-05-27 12:06:53 -06002513 hctxs[i]->numa_node = node;
Jens Axboe320ae512013-10-24 09:20:05 +01002514 hctxs[i]->queue_num = i;
Keith Busch868f2f02015-12-17 17:08:14 -07002515
2516 if (blk_mq_init_hctx(q, set, hctxs[i], i)) {
2517 free_cpumask_var(hctxs[i]->cpumask);
2518 kfree(hctxs[i]);
2519 hctxs[i] = NULL;
2520 break;
2521 }
2522 blk_mq_hctx_kobj_init(hctxs[i]);
Jens Axboe320ae512013-10-24 09:20:05 +01002523 }
Keith Busch868f2f02015-12-17 17:08:14 -07002524 for (j = i; j < q->nr_hw_queues; j++) {
2525 struct blk_mq_hw_ctx *hctx = hctxs[j];
2526
2527 if (hctx) {
Jens Axboecc71a6f2017-01-11 14:29:56 -07002528 if (hctx->tags)
2529 blk_mq_free_map_and_requests(set, j);
Keith Busch868f2f02015-12-17 17:08:14 -07002530 blk_mq_exit_hctx(q, set, hctx, j);
Keith Busch868f2f02015-12-17 17:08:14 -07002531 kobject_put(&hctx->kobj);
Keith Busch868f2f02015-12-17 17:08:14 -07002532 hctxs[j] = NULL;
2533
2534 }
2535 }
2536 q->nr_hw_queues = i;
Ming Leifb350e02018-01-06 16:27:40 +08002537 mutex_unlock(&q->sysfs_lock);
Keith Busch868f2f02015-12-17 17:08:14 -07002538 blk_mq_sysfs_register(q);
2539}
2540
2541struct request_queue *blk_mq_init_allocated_queue(struct blk_mq_tag_set *set,
2542 struct request_queue *q)
2543{
Ming Lei66841672016-02-12 15:27:00 +08002544 /* mark the queue as mq asap */
2545 q->mq_ops = set->ops;
2546
Omar Sandoval34dbad52017-03-21 08:56:08 -07002547 q->poll_cb = blk_stat_alloc_callback(blk_mq_poll_stats_fn,
Stephen Bates720b8cc2017-04-07 06:24:03 -06002548 blk_mq_poll_stats_bkt,
2549 BLK_MQ_POLL_STATS_BKTS, q);
Omar Sandoval34dbad52017-03-21 08:56:08 -07002550 if (!q->poll_cb)
2551 goto err_exit;
2552
Keith Busch868f2f02015-12-17 17:08:14 -07002553 q->queue_ctx = alloc_percpu(struct blk_mq_ctx);
2554 if (!q->queue_ctx)
Ming Linc7de5722016-05-25 23:23:27 -07002555 goto err_exit;
Keith Busch868f2f02015-12-17 17:08:14 -07002556
Ming Lei737f98c2017-02-22 18:13:59 +08002557 /* init q->mq_kobj and sw queues' kobjects */
2558 blk_mq_sysfs_init(q);
2559
Keith Busch868f2f02015-12-17 17:08:14 -07002560 q->queue_hw_ctx = kzalloc_node(nr_cpu_ids * sizeof(*(q->queue_hw_ctx)),
2561 GFP_KERNEL, set->numa_node);
2562 if (!q->queue_hw_ctx)
2563 goto err_percpu;
2564
Christoph Hellwigbdd17e72016-09-14 16:18:53 +02002565 q->mq_map = set->mq_map;
Keith Busch868f2f02015-12-17 17:08:14 -07002566
2567 blk_mq_realloc_hw_ctxs(set, q);
2568 if (!q->nr_hw_queues)
2569 goto err_hctxs;
Jens Axboe320ae512013-10-24 09:20:05 +01002570
Christoph Hellwig287922e2015-10-30 20:57:30 +08002571 INIT_WORK(&q->timeout_work, blk_mq_timeout_work);
Ming Leie56f6982015-07-16 19:53:22 +08002572 blk_queue_rq_timeout(q, set->timeout ? set->timeout : 30 * HZ);
Jens Axboe320ae512013-10-24 09:20:05 +01002573
2574 q->nr_queues = nr_cpu_ids;
Jens Axboe320ae512013-10-24 09:20:05 +01002575
Jens Axboe94eddfb2013-11-19 09:25:07 -07002576 q->queue_flags |= QUEUE_FLAG_MQ_DEFAULT;
Jens Axboe320ae512013-10-24 09:20:05 +01002577
Jens Axboe05f1dd52014-05-29 09:53:32 -06002578 if (!(set->flags & BLK_MQ_F_SG_MERGE))
2579 q->queue_flags |= 1 << QUEUE_FLAG_NO_SG_MERGE;
2580
Christoph Hellwig1be036e2014-02-07 10:22:39 -08002581 q->sg_reserved_size = INT_MAX;
2582
Mike Snitzer28494502016-09-14 13:28:30 -04002583 INIT_DELAYED_WORK(&q->requeue_work, blk_mq_requeue_work);
Christoph Hellwig6fca6a62014-05-28 08:08:02 -06002584 INIT_LIST_HEAD(&q->requeue_list);
2585 spin_lock_init(&q->requeue_lock);
2586
Christoph Hellwig254d2592017-03-22 15:01:50 -04002587 blk_queue_make_request(q, blk_mq_make_request);
Christoph Hellwigea435e12017-11-02 21:29:54 +03002588 if (q->mq_ops->poll)
2589 q->poll_fn = blk_mq_poll;
Jens Axboe07068d52014-05-22 10:40:51 -06002590
Jens Axboeeba71762014-05-20 15:17:27 -06002591 /*
2592 * Do this after blk_queue_make_request() overrides it...
2593 */
2594 q->nr_requests = set->queue_depth;
2595
Jens Axboe64f1c212016-11-14 13:03:03 -07002596 /*
2597 * Default to classic polling
2598 */
2599 q->poll_nsec = -1;
2600
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002601 if (set->ops->complete)
2602 blk_queue_softirq_done(q, set->ops->complete);
Christoph Hellwig30a91cb2014-02-10 03:24:38 -08002603
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002604 blk_mq_init_cpu_queues(q, set->nr_hw_queues);
Jens Axboe0d2602c2014-05-13 15:10:52 -06002605 blk_mq_add_queue_tag_set(set, q);
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002606 blk_mq_map_swqueue(q);
Akinobu Mita4593fdb2015-09-27 02:09:20 +09002607
Jens Axboed3484992017-01-13 14:43:58 -07002608 if (!(set->flags & BLK_MQ_F_NO_SCHED)) {
2609 int ret;
2610
2611 ret = blk_mq_sched_init(q);
2612 if (ret)
2613 return ERR_PTR(ret);
2614 }
2615
Jens Axboe320ae512013-10-24 09:20:05 +01002616 return q;
Christoph Hellwig18741982014-02-10 09:29:00 -07002617
Jens Axboe320ae512013-10-24 09:20:05 +01002618err_hctxs:
Keith Busch868f2f02015-12-17 17:08:14 -07002619 kfree(q->queue_hw_ctx);
Jens Axboe320ae512013-10-24 09:20:05 +01002620err_percpu:
Keith Busch868f2f02015-12-17 17:08:14 -07002621 free_percpu(q->queue_ctx);
Ming Linc7de5722016-05-25 23:23:27 -07002622err_exit:
2623 q->mq_ops = NULL;
Jens Axboe320ae512013-10-24 09:20:05 +01002624 return ERR_PTR(-ENOMEM);
2625}
Mike Snitzerb62c21b2015-03-12 23:56:02 -04002626EXPORT_SYMBOL(blk_mq_init_allocated_queue);
Jens Axboe320ae512013-10-24 09:20:05 +01002627
2628void blk_mq_free_queue(struct request_queue *q)
2629{
Ming Lei624dbe42014-05-27 23:35:13 +08002630 struct blk_mq_tag_set *set = q->tag_set;
Jens Axboe320ae512013-10-24 09:20:05 +01002631
Jens Axboe0d2602c2014-05-13 15:10:52 -06002632 blk_mq_del_queue_tag_set(q);
Ming Lei624dbe42014-05-27 23:35:13 +08002633 blk_mq_exit_hw_queues(q, set, set->nr_hw_queues);
Jens Axboe320ae512013-10-24 09:20:05 +01002634}
Jens Axboe320ae512013-10-24 09:20:05 +01002635
2636/* Basically redo blk_mq_init_queue with queue frozen */
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002637static void blk_mq_queue_reinit(struct request_queue *q)
Jens Axboe320ae512013-10-24 09:20:05 +01002638{
Christoph Hellwig4ecd4fe2015-05-07 09:38:13 +02002639 WARN_ON_ONCE(!atomic_read(&q->mq_freeze_depth));
Jens Axboe320ae512013-10-24 09:20:05 +01002640
Omar Sandoval9c1051a2017-05-04 08:17:21 -06002641 blk_mq_debugfs_unregister_hctxs(q);
Jens Axboe67aec142014-05-30 08:25:36 -06002642 blk_mq_sysfs_unregister(q);
2643
Jens Axboe320ae512013-10-24 09:20:05 +01002644 /*
2645 * redo blk_mq_init_cpu_queues and blk_mq_init_hw_queues. FIXME: maybe
Jens Axboeff821d22017-11-10 22:05:12 -07002646 * we should change hctx numa_node according to the new topology (this
2647 * involves freeing and re-allocating memory, worth doing?)
Jens Axboe320ae512013-10-24 09:20:05 +01002648 */
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002649 blk_mq_map_swqueue(q);
Jens Axboe320ae512013-10-24 09:20:05 +01002650
Jens Axboe67aec142014-05-30 08:25:36 -06002651 blk_mq_sysfs_register(q);
Omar Sandoval9c1051a2017-05-04 08:17:21 -06002652 blk_mq_debugfs_register_hctxs(q);
Jens Axboe320ae512013-10-24 09:20:05 +01002653}
2654
Jens Axboea5164402014-09-10 09:02:03 -06002655static int __blk_mq_alloc_rq_maps(struct blk_mq_tag_set *set)
2656{
2657 int i;
2658
Jens Axboecc71a6f2017-01-11 14:29:56 -07002659 for (i = 0; i < set->nr_hw_queues; i++)
2660 if (!__blk_mq_alloc_rq_map(set, i))
Jens Axboea5164402014-09-10 09:02:03 -06002661 goto out_unwind;
Jens Axboea5164402014-09-10 09:02:03 -06002662
2663 return 0;
2664
2665out_unwind:
2666 while (--i >= 0)
Jens Axboecc71a6f2017-01-11 14:29:56 -07002667 blk_mq_free_rq_map(set->tags[i]);
Jens Axboea5164402014-09-10 09:02:03 -06002668
Jens Axboea5164402014-09-10 09:02:03 -06002669 return -ENOMEM;
2670}
2671
2672/*
2673 * Allocate the request maps associated with this tag_set. Note that this
2674 * may reduce the depth asked for, if memory is tight. set->queue_depth
2675 * will be updated to reflect the allocated depth.
2676 */
2677static int blk_mq_alloc_rq_maps(struct blk_mq_tag_set *set)
2678{
2679 unsigned int depth;
2680 int err;
2681
2682 depth = set->queue_depth;
2683 do {
2684 err = __blk_mq_alloc_rq_maps(set);
2685 if (!err)
2686 break;
2687
2688 set->queue_depth >>= 1;
2689 if (set->queue_depth < set->reserved_tags + BLK_MQ_TAG_MIN) {
2690 err = -ENOMEM;
2691 break;
2692 }
2693 } while (set->queue_depth);
2694
2695 if (!set->queue_depth || err) {
2696 pr_err("blk-mq: failed to allocate request map\n");
2697 return -ENOMEM;
2698 }
2699
2700 if (depth != set->queue_depth)
2701 pr_info("blk-mq: reduced tag depth (%u -> %u)\n",
2702 depth, set->queue_depth);
2703
2704 return 0;
2705}
2706
Omar Sandovalebe8bdd2017-04-07 08:53:11 -06002707static int blk_mq_update_queue_map(struct blk_mq_tag_set *set)
2708{
Ming Lei7d4901a2018-01-06 16:27:39 +08002709 if (set->ops->map_queues) {
2710 int cpu;
2711 /*
2712 * transport .map_queues is usually done in the following
2713 * way:
2714 *
2715 * for (queue = 0; queue < set->nr_hw_queues; queue++) {
2716 * mask = get_cpu_mask(queue)
2717 * for_each_cpu(cpu, mask)
2718 * set->mq_map[cpu] = queue;
2719 * }
2720 *
2721 * When we need to remap, the table has to be cleared for
2722 * killing stale mapping since one CPU may not be mapped
2723 * to any hw queue.
2724 */
2725 for_each_possible_cpu(cpu)
2726 set->mq_map[cpu] = 0;
2727
Omar Sandovalebe8bdd2017-04-07 08:53:11 -06002728 return set->ops->map_queues(set);
Ming Lei7d4901a2018-01-06 16:27:39 +08002729 } else
Omar Sandovalebe8bdd2017-04-07 08:53:11 -06002730 return blk_mq_map_queues(set);
2731}
2732
Jens Axboea4391c62014-06-05 15:21:56 -06002733/*
2734 * Alloc a tag set to be associated with one or more request queues.
2735 * May fail with EINVAL for various error conditions. May adjust the
2736 * requested depth down, if if it too large. In that case, the set
2737 * value will be stored in set->queue_depth.
2738 */
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002739int blk_mq_alloc_tag_set(struct blk_mq_tag_set *set)
2740{
Christoph Hellwigda695ba2016-09-14 16:18:55 +02002741 int ret;
2742
Bart Van Assche205fb5f2014-10-30 14:45:11 +01002743 BUILD_BUG_ON(BLK_MQ_MAX_DEPTH > 1 << BLK_MQ_UNIQUE_TAG_BITS);
2744
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002745 if (!set->nr_hw_queues)
2746 return -EINVAL;
Jens Axboea4391c62014-06-05 15:21:56 -06002747 if (!set->queue_depth)
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002748 return -EINVAL;
2749 if (set->queue_depth < set->reserved_tags + BLK_MQ_TAG_MIN)
2750 return -EINVAL;
2751
Christoph Hellwig7d7e0f92016-09-14 16:18:54 +02002752 if (!set->ops->queue_rq)
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002753 return -EINVAL;
2754
Ming Leide148292017-10-14 17:22:29 +08002755 if (!set->ops->get_budget ^ !set->ops->put_budget)
2756 return -EINVAL;
2757
Jens Axboea4391c62014-06-05 15:21:56 -06002758 if (set->queue_depth > BLK_MQ_MAX_DEPTH) {
2759 pr_info("blk-mq: reduced tag depth to %u\n",
2760 BLK_MQ_MAX_DEPTH);
2761 set->queue_depth = BLK_MQ_MAX_DEPTH;
2762 }
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002763
Shaohua Li6637fad2014-11-30 16:00:58 -08002764 /*
2765 * If a crashdump is active, then we are potentially in a very
2766 * memory constrained environment. Limit us to 1 queue and
2767 * 64 tags to prevent using too much memory.
2768 */
2769 if (is_kdump_kernel()) {
2770 set->nr_hw_queues = 1;
2771 set->queue_depth = min(64U, set->queue_depth);
2772 }
Keith Busch868f2f02015-12-17 17:08:14 -07002773 /*
2774 * There is no use for more h/w queues than cpus.
2775 */
2776 if (set->nr_hw_queues > nr_cpu_ids)
2777 set->nr_hw_queues = nr_cpu_ids;
Shaohua Li6637fad2014-11-30 16:00:58 -08002778
Keith Busch868f2f02015-12-17 17:08:14 -07002779 set->tags = kzalloc_node(nr_cpu_ids * sizeof(struct blk_mq_tags *),
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002780 GFP_KERNEL, set->numa_node);
2781 if (!set->tags)
Jens Axboea5164402014-09-10 09:02:03 -06002782 return -ENOMEM;
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002783
Christoph Hellwigda695ba2016-09-14 16:18:55 +02002784 ret = -ENOMEM;
2785 set->mq_map = kzalloc_node(sizeof(*set->mq_map) * nr_cpu_ids,
2786 GFP_KERNEL, set->numa_node);
Christoph Hellwigbdd17e72016-09-14 16:18:53 +02002787 if (!set->mq_map)
2788 goto out_free_tags;
2789
Omar Sandovalebe8bdd2017-04-07 08:53:11 -06002790 ret = blk_mq_update_queue_map(set);
Christoph Hellwigda695ba2016-09-14 16:18:55 +02002791 if (ret)
2792 goto out_free_mq_map;
2793
2794 ret = blk_mq_alloc_rq_maps(set);
2795 if (ret)
Christoph Hellwigbdd17e72016-09-14 16:18:53 +02002796 goto out_free_mq_map;
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002797
Jens Axboe0d2602c2014-05-13 15:10:52 -06002798 mutex_init(&set->tag_list_lock);
2799 INIT_LIST_HEAD(&set->tag_list);
2800
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002801 return 0;
Christoph Hellwigbdd17e72016-09-14 16:18:53 +02002802
2803out_free_mq_map:
2804 kfree(set->mq_map);
2805 set->mq_map = NULL;
2806out_free_tags:
Robert Elliott5676e7b2014-09-02 11:38:44 -05002807 kfree(set->tags);
2808 set->tags = NULL;
Christoph Hellwigda695ba2016-09-14 16:18:55 +02002809 return ret;
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002810}
2811EXPORT_SYMBOL(blk_mq_alloc_tag_set);
2812
2813void blk_mq_free_tag_set(struct blk_mq_tag_set *set)
2814{
2815 int i;
2816
Jens Axboecc71a6f2017-01-11 14:29:56 -07002817 for (i = 0; i < nr_cpu_ids; i++)
2818 blk_mq_free_map_and_requests(set, i);
Jens Axboe484b4062014-05-21 14:01:15 -06002819
Christoph Hellwigbdd17e72016-09-14 16:18:53 +02002820 kfree(set->mq_map);
2821 set->mq_map = NULL;
2822
Ming Lei981bd182014-04-24 00:07:34 +08002823 kfree(set->tags);
Robert Elliott5676e7b2014-09-02 11:38:44 -05002824 set->tags = NULL;
Christoph Hellwig24d2f902014-04-15 14:14:00 -06002825}
2826EXPORT_SYMBOL(blk_mq_free_tag_set);
2827
Jens Axboee3a2b3f2014-05-20 11:49:02 -06002828int blk_mq_update_nr_requests(struct request_queue *q, unsigned int nr)
2829{
2830 struct blk_mq_tag_set *set = q->tag_set;
2831 struct blk_mq_hw_ctx *hctx;
2832 int i, ret;
2833
Jens Axboebd166ef2017-01-17 06:03:22 -07002834 if (!set)
Jens Axboee3a2b3f2014-05-20 11:49:02 -06002835 return -EINVAL;
2836
Jens Axboe70f36b62017-01-19 10:59:07 -07002837 blk_mq_freeze_queue(q);
Ming Lei24f5a902018-01-06 16:27:38 +08002838 blk_mq_quiesce_queue(q);
Jens Axboe70f36b62017-01-19 10:59:07 -07002839
Jens Axboee3a2b3f2014-05-20 11:49:02 -06002840 ret = 0;
2841 queue_for_each_hw_ctx(q, hctx, i) {
Keith Busche9137d42016-02-18 14:56:35 -07002842 if (!hctx->tags)
2843 continue;
Jens Axboebd166ef2017-01-17 06:03:22 -07002844 /*
2845 * If we're using an MQ scheduler, just update the scheduler
2846 * queue depth. This is similar to what the old code would do.
2847 */
Jens Axboe70f36b62017-01-19 10:59:07 -07002848 if (!hctx->sched_tags) {
weiping zhangc2e82a22017-09-22 23:36:28 +08002849 ret = blk_mq_tag_update_depth(hctx, &hctx->tags, nr,
Jens Axboe70f36b62017-01-19 10:59:07 -07002850 false);
2851 } else {
2852 ret = blk_mq_tag_update_depth(hctx, &hctx->sched_tags,
2853 nr, true);
2854 }
Jens Axboee3a2b3f2014-05-20 11:49:02 -06002855 if (ret)
2856 break;
2857 }
2858
2859 if (!ret)
2860 q->nr_requests = nr;
2861
Ming Lei24f5a902018-01-06 16:27:38 +08002862 blk_mq_unquiesce_queue(q);
Jens Axboe70f36b62017-01-19 10:59:07 -07002863 blk_mq_unfreeze_queue(q);
Jens Axboe70f36b62017-01-19 10:59:07 -07002864
Jens Axboee3a2b3f2014-05-20 11:49:02 -06002865 return ret;
2866}
2867
Keith Busche4dc2b32017-05-30 14:39:11 -04002868static void __blk_mq_update_nr_hw_queues(struct blk_mq_tag_set *set,
2869 int nr_hw_queues)
Keith Busch868f2f02015-12-17 17:08:14 -07002870{
2871 struct request_queue *q;
2872
Bart Van Assche705cda92017-04-07 11:16:49 -07002873 lockdep_assert_held(&set->tag_list_lock);
2874
Keith Busch868f2f02015-12-17 17:08:14 -07002875 if (nr_hw_queues > nr_cpu_ids)
2876 nr_hw_queues = nr_cpu_ids;
2877 if (nr_hw_queues < 1 || nr_hw_queues == set->nr_hw_queues)
2878 return;
2879
2880 list_for_each_entry(q, &set->tag_list, tag_set_list)
2881 blk_mq_freeze_queue(q);
2882
2883 set->nr_hw_queues = nr_hw_queues;
Omar Sandovalebe8bdd2017-04-07 08:53:11 -06002884 blk_mq_update_queue_map(set);
Keith Busch868f2f02015-12-17 17:08:14 -07002885 list_for_each_entry(q, &set->tag_list, tag_set_list) {
2886 blk_mq_realloc_hw_ctxs(set, q);
Christoph Hellwig4b855ad2017-06-26 12:20:57 +02002887 blk_mq_queue_reinit(q);
Keith Busch868f2f02015-12-17 17:08:14 -07002888 }
2889
2890 list_for_each_entry(q, &set->tag_list, tag_set_list)
2891 blk_mq_unfreeze_queue(q);
2892}
Keith Busche4dc2b32017-05-30 14:39:11 -04002893
2894void blk_mq_update_nr_hw_queues(struct blk_mq_tag_set *set, int nr_hw_queues)
2895{
2896 mutex_lock(&set->tag_list_lock);
2897 __blk_mq_update_nr_hw_queues(set, nr_hw_queues);
2898 mutex_unlock(&set->tag_list_lock);
2899}
Keith Busch868f2f02015-12-17 17:08:14 -07002900EXPORT_SYMBOL_GPL(blk_mq_update_nr_hw_queues);
2901
Omar Sandoval34dbad52017-03-21 08:56:08 -07002902/* Enable polling stats and return whether they were already enabled. */
2903static bool blk_poll_stats_enable(struct request_queue *q)
2904{
2905 if (test_bit(QUEUE_FLAG_POLL_STATS, &q->queue_flags) ||
2906 test_and_set_bit(QUEUE_FLAG_POLL_STATS, &q->queue_flags))
2907 return true;
2908 blk_stat_add_callback(q, q->poll_cb);
2909 return false;
2910}
2911
2912static void blk_mq_poll_stats_start(struct request_queue *q)
2913{
2914 /*
2915 * We don't arm the callback if polling stats are not enabled or the
2916 * callback is already active.
2917 */
2918 if (!test_bit(QUEUE_FLAG_POLL_STATS, &q->queue_flags) ||
2919 blk_stat_is_active(q->poll_cb))
2920 return;
2921
2922 blk_stat_activate_msecs(q->poll_cb, 100);
2923}
2924
2925static void blk_mq_poll_stats_fn(struct blk_stat_callback *cb)
2926{
2927 struct request_queue *q = cb->data;
Stephen Bates720b8cc2017-04-07 06:24:03 -06002928 int bucket;
Omar Sandoval34dbad52017-03-21 08:56:08 -07002929
Stephen Bates720b8cc2017-04-07 06:24:03 -06002930 for (bucket = 0; bucket < BLK_MQ_POLL_STATS_BKTS; bucket++) {
2931 if (cb->stat[bucket].nr_samples)
2932 q->poll_stat[bucket] = cb->stat[bucket];
2933 }
Omar Sandoval34dbad52017-03-21 08:56:08 -07002934}
2935
Jens Axboe64f1c212016-11-14 13:03:03 -07002936static unsigned long blk_mq_poll_nsecs(struct request_queue *q,
2937 struct blk_mq_hw_ctx *hctx,
2938 struct request *rq)
2939{
Jens Axboe64f1c212016-11-14 13:03:03 -07002940 unsigned long ret = 0;
Stephen Bates720b8cc2017-04-07 06:24:03 -06002941 int bucket;
Jens Axboe64f1c212016-11-14 13:03:03 -07002942
2943 /*
2944 * If stats collection isn't on, don't sleep but turn it on for
2945 * future users
2946 */
Omar Sandoval34dbad52017-03-21 08:56:08 -07002947 if (!blk_poll_stats_enable(q))
Jens Axboe64f1c212016-11-14 13:03:03 -07002948 return 0;
2949
2950 /*
Jens Axboe64f1c212016-11-14 13:03:03 -07002951 * As an optimistic guess, use half of the mean service time
2952 * for this type of request. We can (and should) make this smarter.
2953 * For instance, if the completion latencies are tight, we can
2954 * get closer than just half the mean. This is especially
2955 * important on devices where the completion latencies are longer
Stephen Bates720b8cc2017-04-07 06:24:03 -06002956 * than ~10 usec. We do use the stats for the relevant IO size
2957 * if available which does lead to better estimates.
Jens Axboe64f1c212016-11-14 13:03:03 -07002958 */
Stephen Bates720b8cc2017-04-07 06:24:03 -06002959 bucket = blk_mq_poll_stats_bkt(rq);
2960 if (bucket < 0)
2961 return ret;
2962
2963 if (q->poll_stat[bucket].nr_samples)
2964 ret = (q->poll_stat[bucket].mean + 1) / 2;
Jens Axboe64f1c212016-11-14 13:03:03 -07002965
2966 return ret;
2967}
2968
Jens Axboe06426ad2016-11-14 13:01:59 -07002969static bool blk_mq_poll_hybrid_sleep(struct request_queue *q,
Jens Axboe64f1c212016-11-14 13:03:03 -07002970 struct blk_mq_hw_ctx *hctx,
Jens Axboe06426ad2016-11-14 13:01:59 -07002971 struct request *rq)
2972{
2973 struct hrtimer_sleeper hs;
2974 enum hrtimer_mode mode;
Jens Axboe64f1c212016-11-14 13:03:03 -07002975 unsigned int nsecs;
Jens Axboe06426ad2016-11-14 13:01:59 -07002976 ktime_t kt;
2977
Jens Axboe76a86f92018-01-10 11:30:56 -07002978 if (rq->rq_flags & RQF_MQ_POLL_SLEPT)
Jens Axboe64f1c212016-11-14 13:03:03 -07002979 return false;
2980
2981 /*
2982 * poll_nsec can be:
2983 *
2984 * -1: don't ever hybrid sleep
2985 * 0: use half of prev avg
2986 * >0: use this specific value
2987 */
2988 if (q->poll_nsec == -1)
2989 return false;
2990 else if (q->poll_nsec > 0)
2991 nsecs = q->poll_nsec;
2992 else
2993 nsecs = blk_mq_poll_nsecs(q, hctx, rq);
2994
2995 if (!nsecs)
Jens Axboe06426ad2016-11-14 13:01:59 -07002996 return false;
2997
Jens Axboe76a86f92018-01-10 11:30:56 -07002998 rq->rq_flags |= RQF_MQ_POLL_SLEPT;
Jens Axboe06426ad2016-11-14 13:01:59 -07002999
3000 /*
3001 * This will be replaced with the stats tracking code, using
3002 * 'avg_completion_time / 2' as the pre-sleep target.
3003 */
Thomas Gleixner8b0e1952016-12-25 12:30:41 +01003004 kt = nsecs;
Jens Axboe06426ad2016-11-14 13:01:59 -07003005
3006 mode = HRTIMER_MODE_REL;
3007 hrtimer_init_on_stack(&hs.timer, CLOCK_MONOTONIC, mode);
3008 hrtimer_set_expires(&hs.timer, kt);
3009
3010 hrtimer_init_sleeper(&hs, current);
3011 do {
Tejun Heo5a61c362018-01-09 08:29:52 -08003012 if (blk_mq_rq_state(rq) == MQ_RQ_COMPLETE)
Jens Axboe06426ad2016-11-14 13:01:59 -07003013 break;
3014 set_current_state(TASK_UNINTERRUPTIBLE);
3015 hrtimer_start_expires(&hs.timer, mode);
3016 if (hs.task)
3017 io_schedule();
3018 hrtimer_cancel(&hs.timer);
3019 mode = HRTIMER_MODE_ABS;
3020 } while (hs.task && !signal_pending(current));
3021
3022 __set_current_state(TASK_RUNNING);
3023 destroy_hrtimer_on_stack(&hs.timer);
3024 return true;
3025}
3026
Jens Axboebbd7bb72016-11-04 09:34:34 -06003027static bool __blk_mq_poll(struct blk_mq_hw_ctx *hctx, struct request *rq)
3028{
3029 struct request_queue *q = hctx->queue;
3030 long state;
3031
Jens Axboe06426ad2016-11-14 13:01:59 -07003032 /*
3033 * If we sleep, have the caller restart the poll loop to reset
3034 * the state. Like for the other success return cases, the
3035 * caller is responsible for checking if the IO completed. If
3036 * the IO isn't complete, we'll get called again and will go
3037 * straight to the busy poll loop.
3038 */
Jens Axboe64f1c212016-11-14 13:03:03 -07003039 if (blk_mq_poll_hybrid_sleep(q, hctx, rq))
Jens Axboe06426ad2016-11-14 13:01:59 -07003040 return true;
3041
Jens Axboebbd7bb72016-11-04 09:34:34 -06003042 hctx->poll_considered++;
3043
3044 state = current->state;
3045 while (!need_resched()) {
3046 int ret;
3047
3048 hctx->poll_invoked++;
3049
3050 ret = q->mq_ops->poll(hctx, rq->tag);
3051 if (ret > 0) {
3052 hctx->poll_success++;
3053 set_current_state(TASK_RUNNING);
3054 return true;
3055 }
3056
3057 if (signal_pending_state(state, current))
3058 set_current_state(TASK_RUNNING);
3059
3060 if (current->state == TASK_RUNNING)
3061 return true;
3062 if (ret < 0)
3063 break;
3064 cpu_relax();
3065 }
3066
3067 return false;
3068}
3069
Christoph Hellwigea435e12017-11-02 21:29:54 +03003070static bool blk_mq_poll(struct request_queue *q, blk_qc_t cookie)
Jens Axboebbd7bb72016-11-04 09:34:34 -06003071{
3072 struct blk_mq_hw_ctx *hctx;
Jens Axboebbd7bb72016-11-04 09:34:34 -06003073 struct request *rq;
3074
Christoph Hellwigea435e12017-11-02 21:29:54 +03003075 if (!test_bit(QUEUE_FLAG_POLL, &q->queue_flags))
Jens Axboebbd7bb72016-11-04 09:34:34 -06003076 return false;
3077
Jens Axboebbd7bb72016-11-04 09:34:34 -06003078 hctx = q->queue_hw_ctx[blk_qc_t_to_queue_num(cookie)];
Jens Axboebd166ef2017-01-17 06:03:22 -07003079 if (!blk_qc_t_is_internal(cookie))
3080 rq = blk_mq_tag_to_rq(hctx->tags, blk_qc_t_to_tag(cookie));
Jens Axboe3a07bb12017-04-20 14:53:28 -06003081 else {
Jens Axboebd166ef2017-01-17 06:03:22 -07003082 rq = blk_mq_tag_to_rq(hctx->sched_tags, blk_qc_t_to_tag(cookie));
Jens Axboe3a07bb12017-04-20 14:53:28 -06003083 /*
3084 * With scheduling, if the request has completed, we'll
3085 * get a NULL return here, as we clear the sched tag when
3086 * that happens. The request still remains valid, like always,
3087 * so we should be safe with just the NULL check.
3088 */
3089 if (!rq)
3090 return false;
3091 }
Jens Axboebbd7bb72016-11-04 09:34:34 -06003092
3093 return __blk_mq_poll(hctx, rq);
3094}
Jens Axboebbd7bb72016-11-04 09:34:34 -06003095
Jens Axboe320ae512013-10-24 09:20:05 +01003096static int __init blk_mq_init(void)
3097{
Thomas Gleixner9467f852016-09-22 08:05:17 -06003098 cpuhp_setup_state_multi(CPUHP_BLK_MQ_DEAD, "block/mq:dead", NULL,
3099 blk_mq_hctx_notify_dead);
Jens Axboe320ae512013-10-24 09:20:05 +01003100 return 0;
3101}
3102subsys_initcall(blk_mq_init);