pci.c 54.1 KB
Newer Older
M
Matthew Wilcox 已提交
1 2
/*
 * NVM Express device driver
3
 * Copyright (c) 2011-2014, Intel Corporation.
M
Matthew Wilcox 已提交
4 5 6 7 8 9 10 11 12 13 14
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 */

K
Keith Busch 已提交
15
#include <linux/aer.h>
16
#include <linux/bitops.h>
M
Matthew Wilcox 已提交
17
#include <linux/blkdev.h>
M
Matias Bjørling 已提交
18
#include <linux/blk-mq.h>
K
Keith Busch 已提交
19
#include <linux/cpu.h>
20
#include <linux/delay.h>
M
Matthew Wilcox 已提交
21 22 23
#include <linux/errno.h>
#include <linux/fs.h>
#include <linux/genhd.h>
K
Keith Busch 已提交
24
#include <linux/hdreg.h>
25
#include <linux/idr.h>
M
Matthew Wilcox 已提交
26 27 28 29 30 31 32 33
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/kdev_t.h>
#include <linux/kernel.h>
#include <linux/mm.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
34
#include <linux/mutex.h>
M
Matthew Wilcox 已提交
35
#include <linux/pci.h>
36
#include <linux/poison.h>
37
#include <linux/ptrace.h>
M
Matthew Wilcox 已提交
38 39
#include <linux/sched.h>
#include <linux/slab.h>
K
Keith Busch 已提交
40
#include <linux/t10-pi.h>
41
#include <linux/timer.h>
M
Matthew Wilcox 已提交
42
#include <linux/types.h>
43
#include <linux/io-64-nonatomic-lo-hi.h>
K
Keith Busch 已提交
44
#include <asm/unaligned.h>
45

46 47
#include "nvme.h"

48
#define NVME_Q_DEPTH		1024
J
Jens Axboe 已提交
49
#define NVME_AQ_DEPTH		256
M
Matthew Wilcox 已提交
50 51
#define SQ_SIZE(depth)		(depth * sizeof(struct nvme_command))
#define CQ_SIZE(depth)		(depth * sizeof(struct nvme_completion))
52 53 54 55 56 57 58
		
/*
 * We handle AEN commands ourselves and don't even let the
 * block layer know about them.
 */
#define NVME_NR_AEN_COMMANDS	1
#define NVME_AQ_BLKMQ_DEPTH	(NVME_AQ_DEPTH - NVME_NR_AEN_COMMANDS)
59

60 61 62
static int use_threaded_interrupts;
module_param(use_threaded_interrupts, int, 0);

63 64 65 66
static bool use_cmb_sqes = true;
module_param(use_cmb_sqes, bool, 0644);
MODULE_PARM_DESC(use_cmb_sqes, "use controller's memory buffer for I/O SQes");

K
Keith Busch 已提交
67
static struct workqueue_struct *nvme_workq;
68

69 70
struct nvme_dev;
struct nvme_queue;
71

72
static int nvme_reset(struct nvme_dev *dev);
J
Jens Axboe 已提交
73
static void nvme_process_cq(struct nvme_queue *nvmeq);
74
static void nvme_remove_dead_ctrl(struct nvme_dev *dev);
75
static void nvme_dev_disable(struct nvme_dev *dev, bool shutdown);
76

77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96
/*
 * Represents an NVM Express device.  Each nvme_dev is a PCI function.
 */
struct nvme_dev {
	struct nvme_queue **queues;
	struct blk_mq_tag_set tagset;
	struct blk_mq_tag_set admin_tagset;
	u32 __iomem *dbs;
	struct device *dev;
	struct dma_pool *prp_page_pool;
	struct dma_pool *prp_small_pool;
	unsigned queue_count;
	unsigned online_queues;
	unsigned max_qid;
	int q_depth;
	u32 db_stride;
	struct msix_entry *entry;
	void __iomem *bar;
	struct work_struct reset_work;
	struct work_struct scan_work;
97
	struct work_struct remove_work;
98
	struct work_struct async_work;
99
	struct timer_list watchdog_timer;
100
	struct mutex shutdown_lock;
101 102 103 104 105
	bool subsystem;
	void __iomem *cmb;
	dma_addr_t cmb_dma_addr;
	u64 cmb_size;
	u32 cmbsz;
106
	unsigned long flags;
K
Keith Busch 已提交
107

108
#define NVME_CTRL_RESETTING    0
109 110

	struct nvme_ctrl ctrl;
K
Keith Busch 已提交
111
	struct completion ioq_wait;
K
Keith Busch 已提交
112
};
113

114 115 116 117 118
static inline struct nvme_dev *to_nvme_dev(struct nvme_ctrl *ctrl)
{
	return container_of(ctrl, struct nvme_dev, ctrl);
}

M
Matthew Wilcox 已提交
119 120 121 122 123 124
/*
 * An NVM Express queue.  Each device has at least two (one for admin
 * commands and one for I/O commands).
 */
struct nvme_queue {
	struct device *q_dmadev;
M
Matthew Wilcox 已提交
125
	struct nvme_dev *dev;
126
	char irqname[24];	/* nvme4294967295-65535\0 */
M
Matthew Wilcox 已提交
127 128
	spinlock_t q_lock;
	struct nvme_command *sq_cmds;
129
	struct nvme_command __iomem *sq_cmds_io;
M
Matthew Wilcox 已提交
130
	volatile struct nvme_completion *cqes;
131
	struct blk_mq_tags **tags;
M
Matthew Wilcox 已提交
132 133 134 135
	dma_addr_t sq_dma_addr;
	dma_addr_t cq_dma_addr;
	u32 __iomem *q_db;
	u16 q_depth;
J
Jens Axboe 已提交
136
	s16 cq_vector;
M
Matthew Wilcox 已提交
137 138 139
	u16 sq_head;
	u16 sq_tail;
	u16 cq_head;
K
Keith Busch 已提交
140
	u16 qid;
141 142
	u8 cq_phase;
	u8 cqe_seen;
M
Matthew Wilcox 已提交
143 144
};

145 146 147
/*
 * The nvme_iod describes the data in an I/O, including the list of PRP
 * entries.  You can't see it in this data structure because C doesn't let
C
Christoph Hellwig 已提交
148
 * me express that.  Use nvme_init_iod to ensure there's enough space
149 150 151
 * allocated to store the PRP list.
 */
struct nvme_iod {
C
Christoph Hellwig 已提交
152 153
	struct nvme_queue *nvmeq;
	int aborted;
154 155 156 157
	int npages;		/* In the PRP list. 0 means small pool in use */
	int nents;		/* Used in scatterlist */
	int length;		/* Of data, in bytes */
	dma_addr_t first_dma;
158
	struct scatterlist meta_sg; /* metadata requires single contiguous buffer */
C
Christoph Hellwig 已提交
159 160
	struct scatterlist *sg;
	struct scatterlist inline_sg[0];
M
Matthew Wilcox 已提交
161 162 163 164 165 166 167 168 169 170 171 172
};

/*
 * Check we didin't inadvertently grow the command struct
 */
static inline void _nvme_check_size(void)
{
	BUILD_BUG_ON(sizeof(struct nvme_rw_command) != 64);
	BUILD_BUG_ON(sizeof(struct nvme_create_cq) != 64);
	BUILD_BUG_ON(sizeof(struct nvme_create_sq) != 64);
	BUILD_BUG_ON(sizeof(struct nvme_delete_queue) != 64);
	BUILD_BUG_ON(sizeof(struct nvme_features) != 64);
173
	BUILD_BUG_ON(sizeof(struct nvme_format_cmd) != 64);
K
Keith Busch 已提交
174
	BUILD_BUG_ON(sizeof(struct nvme_abort_cmd) != 64);
M
Matthew Wilcox 已提交
175 176 177 178
	BUILD_BUG_ON(sizeof(struct nvme_command) != 64);
	BUILD_BUG_ON(sizeof(struct nvme_id_ctrl) != 4096);
	BUILD_BUG_ON(sizeof(struct nvme_id_ns) != 4096);
	BUILD_BUG_ON(sizeof(struct nvme_lba_range_type) != 64);
K
Keith Busch 已提交
179
	BUILD_BUG_ON(sizeof(struct nvme_smart_log) != 512);
M
Matthew Wilcox 已提交
180 181
}

182 183 184 185
/*
 * Max size of iod being embedded in the request payload
 */
#define NVME_INT_PAGES		2
186
#define NVME_INT_BYTES(dev)	(NVME_INT_PAGES * (dev)->ctrl.page_size)
187 188 189 190 191 192 193 194

/*
 * Will slightly overestimate the number of pages needed.  This is OK
 * as it only leads to a small amount of wasted memory for the lifetime of
 * the I/O.
 */
static int nvme_npages(unsigned size, struct nvme_dev *dev)
{
195 196
	unsigned nprps = DIV_ROUND_UP(size + dev->ctrl.page_size,
				      dev->ctrl.page_size);
197 198 199
	return DIV_ROUND_UP(8 * nprps, PAGE_SIZE - 8);
}

C
Christoph Hellwig 已提交
200 201
static unsigned int nvme_iod_alloc_size(struct nvme_dev *dev,
		unsigned int size, unsigned int nseg)
202
{
C
Christoph Hellwig 已提交
203 204 205
	return sizeof(__le64 *) * nvme_npages(size, dev) +
			sizeof(struct scatterlist) * nseg;
}
206

C
Christoph Hellwig 已提交
207 208 209 210
static unsigned int nvme_cmd_size(struct nvme_dev *dev)
{
	return sizeof(struct nvme_iod) +
		nvme_iod_alloc_size(dev, NVME_INT_BYTES(dev), NVME_INT_PAGES);
211 212
}

M
Matias Bjørling 已提交
213 214
static int nvme_admin_init_hctx(struct blk_mq_hw_ctx *hctx, void *data,
				unsigned int hctx_idx)
215
{
M
Matias Bjørling 已提交
216 217 218
	struct nvme_dev *dev = data;
	struct nvme_queue *nvmeq = dev->queues[0];

219 220 221 222
	WARN_ON(hctx_idx != 0);
	WARN_ON(dev->admin_tagset.tags[0] != hctx->tags);
	WARN_ON(nvmeq->tags);

M
Matias Bjørling 已提交
223
	hctx->driver_data = nvmeq;
224
	nvmeq->tags = &dev->admin_tagset.tags[0];
M
Matias Bjørling 已提交
225
	return 0;
226 227
}

228 229 230 231 232 233 234
static void nvme_admin_exit_hctx(struct blk_mq_hw_ctx *hctx, unsigned int hctx_idx)
{
	struct nvme_queue *nvmeq = hctx->driver_data;

	nvmeq->tags = NULL;
}

M
Matias Bjørling 已提交
235 236 237
static int nvme_admin_init_request(void *data, struct request *req,
				unsigned int hctx_idx, unsigned int rq_idx,
				unsigned int numa_node)
238
{
M
Matias Bjørling 已提交
239
	struct nvme_dev *dev = data;
C
Christoph Hellwig 已提交
240
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
M
Matias Bjørling 已提交
241 242 243
	struct nvme_queue *nvmeq = dev->queues[0];

	BUG_ON(!nvmeq);
C
Christoph Hellwig 已提交
244
	iod->nvmeq = nvmeq;
M
Matias Bjørling 已提交
245
	return 0;
246 247
}

M
Matias Bjørling 已提交
248 249
static int nvme_init_hctx(struct blk_mq_hw_ctx *hctx, void *data,
			  unsigned int hctx_idx)
M
Matthew Wilcox 已提交
250
{
M
Matias Bjørling 已提交
251
	struct nvme_dev *dev = data;
252
	struct nvme_queue *nvmeq = dev->queues[hctx_idx + 1];
M
Matias Bjørling 已提交
253

254 255
	if (!nvmeq->tags)
		nvmeq->tags = &dev->tagset.tags[hctx_idx];
M
Matthew Wilcox 已提交
256

257
	WARN_ON(dev->tagset.tags[hctx_idx] != hctx->tags);
M
Matias Bjørling 已提交
258 259
	hctx->driver_data = nvmeq;
	return 0;
M
Matthew Wilcox 已提交
260 261
}

M
Matias Bjørling 已提交
262 263 264
static int nvme_init_request(void *data, struct request *req,
				unsigned int hctx_idx, unsigned int rq_idx,
				unsigned int numa_node)
M
Matthew Wilcox 已提交
265
{
M
Matias Bjørling 已提交
266
	struct nvme_dev *dev = data;
C
Christoph Hellwig 已提交
267
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
M
Matias Bjørling 已提交
268 269 270
	struct nvme_queue *nvmeq = dev->queues[hctx_idx + 1];

	BUG_ON(!nvmeq);
C
Christoph Hellwig 已提交
271
	iod->nvmeq = nvmeq;
M
Matias Bjørling 已提交
272 273 274
	return 0;
}

275 276
static void nvme_complete_async_event(struct nvme_dev *dev,
		struct nvme_completion *cqe)
M
Matias Bjørling 已提交
277
{
278 279
	u16 status = le16_to_cpu(cqe->status) >> 1;
	u32 result = le32_to_cpu(cqe->result);
M
Matias Bjørling 已提交
280

281
	if (status == NVME_SC_SUCCESS || status == NVME_SC_ABORT_REQ) {
282
		++dev->ctrl.event_limit;
283 284 285
		queue_work(nvme_workq, &dev->async_work);
	}

K
Keith Busch 已提交
286 287 288 289 290
	if (status != NVME_SC_SUCCESS)
		return;

	switch (result & 0xff07) {
	case NVME_AER_NOTICE_NS_CHANGED:
291
		dev_info(dev->ctrl.device, "rescanning\n");
292
		queue_work(nvme_workq, &dev->scan_work);
K
Keith Busch 已提交
293
	default:
294
		dev_warn(dev->ctrl.device, "async event result %08x\n", result);
M
Matias Bjørling 已提交
295
	}
M
Matthew Wilcox 已提交
296 297 298
}

/**
299
 * __nvme_submit_cmd() - Copy a command into a queue and ring the doorbell
M
Matthew Wilcox 已提交
300 301 302 303 304
 * @nvmeq: The queue to use
 * @cmd: The command to send
 *
 * Safe to use from interrupt context
 */
305 306
static void __nvme_submit_cmd(struct nvme_queue *nvmeq,
						struct nvme_command *cmd)
M
Matthew Wilcox 已提交
307
{
M
Matias Bjørling 已提交
308 309
	u16 tail = nvmeq->sq_tail;

310 311 312 313 314
	if (nvmeq->sq_cmds_io)
		memcpy_toio(&nvmeq->sq_cmds_io[tail], cmd, sizeof(*cmd));
	else
		memcpy(&nvmeq->sq_cmds[tail], cmd, sizeof(*cmd));

M
Matthew Wilcox 已提交
315 316
	if (++tail == nvmeq->q_depth)
		tail = 0;
317
	writel(tail, nvmeq->q_db);
M
Matthew Wilcox 已提交
318 319 320
	nvmeq->sq_tail = tail;
}

C
Christoph Hellwig 已提交
321
static __le64 **iod_list(struct request *req)
M
Matthew Wilcox 已提交
322
{
C
Christoph Hellwig 已提交
323 324
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
	return (__le64 **)(iod->sg + req->nr_phys_segments);
M
Matthew Wilcox 已提交
325 326
}

C
Christoph Hellwig 已提交
327
static int nvme_init_iod(struct request *rq, struct nvme_dev *dev)
328
{
C
Christoph Hellwig 已提交
329 330 331
	struct nvme_iod *iod = blk_mq_rq_to_pdu(rq);
	int nseg = rq->nr_phys_segments;
	unsigned size;
332

C
Christoph Hellwig 已提交
333 334 335 336
	if (rq->cmd_flags & REQ_DISCARD)
		size = sizeof(struct nvme_dsm_range);
	else
		size = blk_rq_bytes(rq);
337

C
Christoph Hellwig 已提交
338 339 340 341 342 343
	if (nseg > NVME_INT_PAGES || size > NVME_INT_BYTES(dev)) {
		iod->sg = kmalloc(nvme_iod_alloc_size(dev, size, nseg), GFP_ATOMIC);
		if (!iod->sg)
			return BLK_MQ_RQ_QUEUE_BUSY;
	} else {
		iod->sg = iod->inline_sg;
344 345
	}

C
Christoph Hellwig 已提交
346 347 348 349 350
	iod->aborted = 0;
	iod->npages = -1;
	iod->nents = 0;
	iod->length = size;
	return 0;
351 352
}

C
Christoph Hellwig 已提交
353
static void nvme_free_iod(struct nvme_dev *dev, struct request *req)
M
Matthew Wilcox 已提交
354
{
C
Christoph Hellwig 已提交
355
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
356
	const int last_prp = dev->ctrl.page_size / 8 - 1;
357
	int i;
C
Christoph Hellwig 已提交
358
	__le64 **list = iod_list(req);
359 360 361 362 363 364 365 366 367 368
	dma_addr_t prp_dma = iod->first_dma;

	if (iod->npages == 0)
		dma_pool_free(dev->prp_small_pool, list[0], prp_dma);
	for (i = 0; i < iod->npages; i++) {
		__le64 *prp_list = list[i];
		dma_addr_t next_prp_dma = le64_to_cpu(prp_list[last_prp]);
		dma_pool_free(dev->prp_page_pool, prp_list, prp_dma);
		prp_dma = next_prp_dma;
	}
369

C
Christoph Hellwig 已提交
370 371
	if (iod->sg != iod->inline_sg)
		kfree(iod->sg);
K
Keith Busch 已提交
372 373
}

374
#ifdef CONFIG_BLK_DEV_INTEGRITY
K
Keith Busch 已提交
375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418
static void nvme_dif_prep(u32 p, u32 v, struct t10_pi_tuple *pi)
{
	if (be32_to_cpu(pi->ref_tag) == v)
		pi->ref_tag = cpu_to_be32(p);
}

static void nvme_dif_complete(u32 p, u32 v, struct t10_pi_tuple *pi)
{
	if (be32_to_cpu(pi->ref_tag) == p)
		pi->ref_tag = cpu_to_be32(v);
}

/**
 * nvme_dif_remap - remaps ref tags to bip seed and physical lba
 *
 * The virtual start sector is the one that was originally submitted by the
 * block layer.	Due to partitioning, MD/DM cloning, etc. the actual physical
 * start sector may be different. Remap protection information to match the
 * physical LBA on writes, and back to the original seed on reads.
 *
 * Type 0 and 3 do not have a ref tag, so no remapping required.
 */
static void nvme_dif_remap(struct request *req,
			void (*dif_swap)(u32 p, u32 v, struct t10_pi_tuple *pi))
{
	struct nvme_ns *ns = req->rq_disk->private_data;
	struct bio_integrity_payload *bip;
	struct t10_pi_tuple *pi;
	void *p, *pmap;
	u32 i, nlb, ts, phys, virt;

	if (!ns->pi_type || ns->pi_type == NVME_NS_DPS_PI_TYPE3)
		return;

	bip = bio_integrity(req->bio);
	if (!bip)
		return;

	pmap = kmap_atomic(bip->bip_vec->bv_page) + bip->bip_vec->bv_offset;

	p = pmap;
	virt = bip_get_seed(bip);
	phys = nvme_block_nr(ns, blk_rq_pos(req));
	nlb = (blk_rq_bytes(req) >> ns->lba_shift);
419
	ts = ns->disk->queue->integrity.tuple_size;
K
Keith Busch 已提交
420 421 422 423 424 425 426 427

	for (i = 0; i < nlb; i++, virt++, phys++) {
		pi = (struct t10_pi_tuple *)p;
		dif_swap(phys, virt, pi);
		p += ts;
	}
	kunmap_atomic(pmap);
}
428 429 430 431 432 433 434 435 436 437 438 439 440
#else /* CONFIG_BLK_DEV_INTEGRITY */
static void nvme_dif_remap(struct request *req,
			void (*dif_swap)(u32 p, u32 v, struct t10_pi_tuple *pi))
{
}
static void nvme_dif_prep(u32 p, u32 v, struct t10_pi_tuple *pi)
{
}
static void nvme_dif_complete(u32 p, u32 v, struct t10_pi_tuple *pi)
{
}
#endif

C
Christoph Hellwig 已提交
441
static bool nvme_setup_prps(struct nvme_dev *dev, struct request *req,
442
		int total_len)
M
Matthew Wilcox 已提交
443
{
C
Christoph Hellwig 已提交
444
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
445
	struct dma_pool *pool;
446 447
	int length = total_len;
	struct scatterlist *sg = iod->sg;
M
Matthew Wilcox 已提交
448 449
	int dma_len = sg_dma_len(sg);
	u64 dma_addr = sg_dma_address(sg);
450
	u32 page_size = dev->ctrl.page_size;
451
	int offset = dma_addr & (page_size - 1);
452
	__le64 *prp_list;
C
Christoph Hellwig 已提交
453
	__le64 **list = iod_list(req);
454
	dma_addr_t prp_dma;
455
	int nprps, i;
M
Matthew Wilcox 已提交
456

457
	length -= (page_size - offset);
M
Matthew Wilcox 已提交
458
	if (length <= 0)
459
		return true;
M
Matthew Wilcox 已提交
460

461
	dma_len -= (page_size - offset);
M
Matthew Wilcox 已提交
462
	if (dma_len) {
463
		dma_addr += (page_size - offset);
M
Matthew Wilcox 已提交
464 465 466 467 468 469
	} else {
		sg = sg_next(sg);
		dma_addr = sg_dma_address(sg);
		dma_len = sg_dma_len(sg);
	}

470
	if (length <= page_size) {
471
		iod->first_dma = dma_addr;
472
		return true;
473 474
	}

475
	nprps = DIV_ROUND_UP(length, page_size);
476 477
	if (nprps <= (256 / 8)) {
		pool = dev->prp_small_pool;
478
		iod->npages = 0;
479 480
	} else {
		pool = dev->prp_page_pool;
481
		iod->npages = 1;
482 483
	}

484
	prp_list = dma_pool_alloc(pool, GFP_ATOMIC, &prp_dma);
485
	if (!prp_list) {
486
		iod->first_dma = dma_addr;
487
		iod->npages = -1;
488
		return false;
489
	}
490 491
	list[0] = prp_list;
	iod->first_dma = prp_dma;
492 493
	i = 0;
	for (;;) {
494
		if (i == page_size >> 3) {
495
			__le64 *old_prp_list = prp_list;
496
			prp_list = dma_pool_alloc(pool, GFP_ATOMIC, &prp_dma);
497
			if (!prp_list)
498
				return false;
499
			list[iod->npages++] = prp_list;
500 501 502
			prp_list[0] = old_prp_list[i - 1];
			old_prp_list[i - 1] = cpu_to_le64(prp_dma);
			i = 1;
503 504
		}
		prp_list[i++] = cpu_to_le64(dma_addr);
505 506 507
		dma_len -= page_size;
		dma_addr += page_size;
		length -= page_size;
508 509 510 511 512 513 514 515
		if (length <= 0)
			break;
		if (dma_len > 0)
			continue;
		BUG_ON(dma_len < 0);
		sg = sg_next(sg);
		dma_addr = sg_dma_address(sg);
		dma_len = sg_dma_len(sg);
M
Matthew Wilcox 已提交
516 517
	}

518
	return true;
M
Matthew Wilcox 已提交
519 520
}

C
Christoph Hellwig 已提交
521
static int nvme_map_data(struct nvme_dev *dev, struct request *req,
C
Christoph Hellwig 已提交
522
		struct nvme_command *cmnd)
523
{
C
Christoph Hellwig 已提交
524
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
C
Christoph Hellwig 已提交
525 526 527 528
	struct request_queue *q = req->q;
	enum dma_data_direction dma_dir = rq_data_dir(req) ?
			DMA_TO_DEVICE : DMA_FROM_DEVICE;
	int ret = BLK_MQ_RQ_QUEUE_ERROR;
529

C
Christoph Hellwig 已提交
530 531 532 533
	sg_init_table(iod->sg, req->nr_phys_segments);
	iod->nents = blk_rq_map_sg(q, req, iod->sg);
	if (!iod->nents)
		goto out;
534

C
Christoph Hellwig 已提交
535 536 537
	ret = BLK_MQ_RQ_QUEUE_BUSY;
	if (!dma_map_sg(dev->dev, iod->sg, iod->nents, dma_dir))
		goto out;
538

C
Christoph Hellwig 已提交
539
	if (!nvme_setup_prps(dev, req, blk_rq_bytes(req)))
C
Christoph Hellwig 已提交
540
		goto out_unmap;
541

C
Christoph Hellwig 已提交
542 543 544 545
	ret = BLK_MQ_RQ_QUEUE_ERROR;
	if (blk_integrity_rq(req)) {
		if (blk_rq_count_integrity_sg(q, req->bio) != 1)
			goto out_unmap;
546

547 548
		sg_init_table(&iod->meta_sg, 1);
		if (blk_rq_map_integrity_sg(q, req->bio, &iod->meta_sg) != 1)
C
Christoph Hellwig 已提交
549
			goto out_unmap;
550

C
Christoph Hellwig 已提交
551 552
		if (rq_data_dir(req))
			nvme_dif_remap(req, nvme_dif_prep);
553

554
		if (!dma_map_sg(dev->dev, &iod->meta_sg, 1, dma_dir))
C
Christoph Hellwig 已提交
555
			goto out_unmap;
556
	}
M
Matthew Wilcox 已提交
557

C
Christoph Hellwig 已提交
558 559 560
	cmnd->rw.prp1 = cpu_to_le64(sg_dma_address(iod->sg));
	cmnd->rw.prp2 = cpu_to_le64(iod->first_dma);
	if (blk_integrity_rq(req))
561
		cmnd->rw.metadata = cpu_to_le64(sg_dma_address(&iod->meta_sg));
C
Christoph Hellwig 已提交
562
	return BLK_MQ_RQ_QUEUE_OK;
M
Matthew Wilcox 已提交
563

C
Christoph Hellwig 已提交
564 565 566 567
out_unmap:
	dma_unmap_sg(dev->dev, iod->sg, iod->nents, dma_dir);
out:
	return ret;
M
Matthew Wilcox 已提交
568 569
}

C
Christoph Hellwig 已提交
570
static void nvme_unmap_data(struct nvme_dev *dev, struct request *req)
M
Matthew Wilcox 已提交
571
{
C
Christoph Hellwig 已提交
572
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
573 574 575 576 577 578 579 580
	enum dma_data_direction dma_dir = rq_data_dir(req) ?
			DMA_TO_DEVICE : DMA_FROM_DEVICE;

	if (iod->nents) {
		dma_unmap_sg(dev->dev, iod->sg, iod->nents, dma_dir);
		if (blk_integrity_rq(req)) {
			if (!rq_data_dir(req))
				nvme_dif_remap(req, nvme_dif_complete);
581
			dma_unmap_sg(dev->dev, &iod->meta_sg, 1, dma_dir);
K
Keith Busch 已提交
582
		}
583
	}
K
Keith Busch 已提交
584

C
Christoph Hellwig 已提交
585
	nvme_free_iod(dev, req);
586
}
M
Matthew Wilcox 已提交
587

M
Matias Bjørling 已提交
588 589 590 591 592
/*
 * We reuse the small pool to allocate the 16-byte range here as it is not
 * worth having a special pool for these or additional cases to handle freeing
 * the iod.
 */
C
Christoph Hellwig 已提交
593
static int nvme_setup_discard(struct nvme_queue *nvmeq, struct nvme_ns *ns,
C
Christoph Hellwig 已提交
594
		struct request *req, struct nvme_command *cmnd)
595
{
C
Christoph Hellwig 已提交
596
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
C
Christoph Hellwig 已提交
597
	struct nvme_dsm_range *range;
M
Matthew Wilcox 已提交
598

C
Christoph Hellwig 已提交
599 600 601 602
	range = dma_pool_alloc(nvmeq->dev->prp_small_pool, GFP_ATOMIC,
						&iod->first_dma);
	if (!range)
		return BLK_MQ_RQ_QUEUE_BUSY;
C
Christoph Hellwig 已提交
603
	iod_list(req)[0] = (__le64 *)range;
C
Christoph Hellwig 已提交
604
	iod->npages = 0;
605 606

	range->cattr = cpu_to_le32(0);
M
Matias Bjørling 已提交
607 608
	range->nlb = cpu_to_le32(blk_rq_bytes(req) >> ns->lba_shift);
	range->slba = cpu_to_le64(nvme_block_nr(ns, blk_rq_pos(req)));
609

C
Christoph Hellwig 已提交
610 611 612 613 614 615 616
	memset(cmnd, 0, sizeof(*cmnd));
	cmnd->dsm.opcode = nvme_cmd_dsm;
	cmnd->dsm.nsid = cpu_to_le32(ns->ns_id);
	cmnd->dsm.prp1 = cpu_to_le64(iod->first_dma);
	cmnd->dsm.nr = 0;
	cmnd->dsm.attributes = cpu_to_le32(NVME_DSMGMT_AD);
	return BLK_MQ_RQ_QUEUE_OK;
617 618
}

619 620 621
/*
 * NOTE: ns is NULL when called on the admin queue.
 */
M
Matias Bjørling 已提交
622 623
static int nvme_queue_rq(struct blk_mq_hw_ctx *hctx,
			 const struct blk_mq_queue_data *bd)
624
{
M
Matias Bjørling 已提交
625 626
	struct nvme_ns *ns = hctx->queue->queuedata;
	struct nvme_queue *nvmeq = hctx->driver_data;
627
	struct nvme_dev *dev = nvmeq->dev;
M
Matias Bjørling 已提交
628
	struct request *req = bd->rq;
C
Christoph Hellwig 已提交
629 630
	struct nvme_command cmnd;
	int ret = BLK_MQ_RQ_QUEUE_OK;
631

K
Keith Busch 已提交
632 633 634 635 636
	/*
	 * If formated with metadata, require the block layer provide a buffer
	 * unless this namespace is formated such that the metadata can be
	 * stripped/generated by the controller with PRACT=1.
	 */
637
	if (ns && ns->ms && !blk_integrity_rq(req)) {
638 639
		if (!(ns->pi_type && ns->ms == 8) &&
					req->cmd_type != REQ_TYPE_DRV_PRIV) {
640
			blk_mq_end_request(req, -EFAULT);
K
Keith Busch 已提交
641 642 643 644
			return BLK_MQ_RQ_QUEUE_OK;
		}
	}

C
Christoph Hellwig 已提交
645 646 647
	ret = nvme_init_iod(req, dev);
	if (ret)
		return ret;
M
Matias Bjørling 已提交
648 649

	if (req->cmd_flags & REQ_DISCARD) {
C
Christoph Hellwig 已提交
650
		ret = nvme_setup_discard(nvmeq, ns, req, &cmnd);
C
Christoph Hellwig 已提交
651 652 653 654 655 656 657
	} else {
		if (req->cmd_type == REQ_TYPE_DRV_PRIV)
			memcpy(&cmnd, req->cmd, sizeof(cmnd));
		else if (req->cmd_flags & REQ_FLUSH)
			nvme_setup_flush(ns, &cmnd);
		else
			nvme_setup_rw(ns, req, &cmnd);
M
Matias Bjørling 已提交
658

C
Christoph Hellwig 已提交
659
		if (req->nr_phys_segments)
C
Christoph Hellwig 已提交
660
			ret = nvme_map_data(dev, req, &cmnd);
661
	}
M
Matias Bjørling 已提交
662

C
Christoph Hellwig 已提交
663 664
	if (ret)
		goto out;
M
Matias Bjørling 已提交
665

C
Christoph Hellwig 已提交
666
	cmnd.common.command_id = req->tag;
667
	blk_mq_start_request(req);
M
Matias Bjørling 已提交
668

C
Christoph Hellwig 已提交
669 670
	spin_lock_irq(&nvmeq->q_lock);
	__nvme_submit_cmd(nvmeq, &cmnd);
M
Matias Bjørling 已提交
671 672 673
	nvme_process_cq(nvmeq);
	spin_unlock_irq(&nvmeq->q_lock);
	return BLK_MQ_RQ_QUEUE_OK;
C
Christoph Hellwig 已提交
674
out:
C
Christoph Hellwig 已提交
675
	nvme_free_iod(dev, req);
C
Christoph Hellwig 已提交
676
	return ret;
M
Matthew Wilcox 已提交
677
}
K
Keith Busch 已提交
678

679 680
static void nvme_complete_rq(struct request *req)
{
C
Christoph Hellwig 已提交
681 682
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
	struct nvme_dev *dev = iod->nvmeq->dev;
683
	int error = 0;
K
Keith Busch 已提交
684

C
Christoph Hellwig 已提交
685
	nvme_unmap_data(dev, req);
K
Keith Busch 已提交
686

687 688 689 690
	if (unlikely(req->errors)) {
		if (nvme_req_needs_retry(req, req->errors)) {
			nvme_requeue_req(req);
			return;
K
Keith Busch 已提交
691
		}
692

693 694 695 696 697
		if (req->cmd_type == REQ_TYPE_DRV_PRIV)
			error = req->errors;
		else
			error = nvme_error_status(req->errors);
	}
M
Matias Bjørling 已提交
698

C
Christoph Hellwig 已提交
699
	if (unlikely(iod->aborted)) {
700
		dev_warn(dev->ctrl.device,
701 702 703
			"completing aborted command with status: %04x\n",
			req->errors);
	}
M
Matias Bjørling 已提交
704

705
	blk_mq_end_request(req, error);
M
Matthew Wilcox 已提交
706 707
}

J
Jens Axboe 已提交
708
static void __nvme_process_cq(struct nvme_queue *nvmeq, unsigned int *tag)
M
Matthew Wilcox 已提交
709
{
M
Matthew Wilcox 已提交
710
	u16 head, phase;
M
Matthew Wilcox 已提交
711 712

	head = nvmeq->cq_head;
M
Matthew Wilcox 已提交
713
	phase = nvmeq->cq_phase;
M
Matthew Wilcox 已提交
714 715 716

	for (;;) {
		struct nvme_completion cqe = nvmeq->cqes[head];
717
		u16 status = le16_to_cpu(cqe.status);
718
		struct request *req;
719 720

		if ((status & 1) != phase)
M
Matthew Wilcox 已提交
721 722 723 724
			break;
		nvmeq->sq_head = le16_to_cpu(cqe.sq_head);
		if (++head == nvmeq->q_depth) {
			head = 0;
M
Matthew Wilcox 已提交
725
			phase = !phase;
M
Matthew Wilcox 已提交
726
		}
727

J
Jens Axboe 已提交
728 729
		if (tag && *tag == cqe.command_id)
			*tag = -1;
730

731
		if (unlikely(cqe.command_id >= nvmeq->q_depth)) {
732
			dev_warn(nvmeq->dev->ctrl.device,
733 734 735 736 737
				"invalid id %d completed on queue %d\n",
				cqe.command_id, le16_to_cpu(cqe.sq_id));
			continue;
		}

738 739 740 741 742 743 744 745 746 747 748 749
		/*
		 * AEN requests are special as they don't time out and can
		 * survive any kind of queue freeze and often don't respond to
		 * aborts.  We don't even bother to allocate a struct request
		 * for them but rather special case them here.
		 */
		if (unlikely(nvmeq->qid == 0 &&
				cqe.command_id >= NVME_AQ_BLKMQ_DEPTH)) {
			nvme_complete_async_event(nvmeq->dev, &cqe);
			continue;
		}

750 751 752 753 754 755 756
		req = blk_mq_tag_to_rq(*nvmeq->tags, cqe.command_id);
		if (req->cmd_type == REQ_TYPE_DRV_PRIV) {
			u32 result = le32_to_cpu(cqe.result);
			req->special = (void *)(uintptr_t)result;
		}
		blk_mq_complete_request(req, status >> 1);

M
Matthew Wilcox 已提交
757 758 759 760 761 762 763 764
	}

	/* If the controller ignores the cq head doorbell and continuously
	 * writes to the queue, it is theoretically possible to wrap around
	 * the queue twice and mistakenly return IRQ_NONE.  Linux only
	 * requires that 0.1% of your interrupts are handled, so this isn't
	 * a big problem.
	 */
M
Matthew Wilcox 已提交
765
	if (head == nvmeq->cq_head && phase == nvmeq->cq_phase)
J
Jens Axboe 已提交
766
		return;
M
Matthew Wilcox 已提交
767

768 769
	if (likely(nvmeq->cq_vector >= 0))
		writel(head, nvmeq->q_db + nvmeq->dev->db_stride);
M
Matthew Wilcox 已提交
770
	nvmeq->cq_head = head;
M
Matthew Wilcox 已提交
771
	nvmeq->cq_phase = phase;
M
Matthew Wilcox 已提交
772

773
	nvmeq->cqe_seen = 1;
J
Jens Axboe 已提交
774 775 776 777 778
}

static void nvme_process_cq(struct nvme_queue *nvmeq)
{
	__nvme_process_cq(nvmeq, NULL);
M
Matthew Wilcox 已提交
779 780 781
}

static irqreturn_t nvme_irq(int irq, void *data)
782 783 784 785
{
	irqreturn_t result;
	struct nvme_queue *nvmeq = data;
	spin_lock(&nvmeq->q_lock);
786 787 788
	nvme_process_cq(nvmeq);
	result = nvmeq->cqe_seen ? IRQ_HANDLED : IRQ_NONE;
	nvmeq->cqe_seen = 0;
789 790 791 792 793 794 795 796 797 798 799 800 801
	spin_unlock(&nvmeq->q_lock);
	return result;
}

static irqreturn_t nvme_irq_check(int irq, void *data)
{
	struct nvme_queue *nvmeq = data;
	struct nvme_completion cqe = nvmeq->cqes[nvmeq->cq_head];
	if ((le16_to_cpu(cqe.status) & 1) != nvmeq->cq_phase)
		return IRQ_NONE;
	return IRQ_WAKE_THREAD;
}

J
Jens Axboe 已提交
802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818
static int nvme_poll(struct blk_mq_hw_ctx *hctx, unsigned int tag)
{
	struct nvme_queue *nvmeq = hctx->driver_data;

	if ((le16_to_cpu(nvmeq->cqes[nvmeq->cq_head].status) & 1) ==
	    nvmeq->cq_phase) {
		spin_lock_irq(&nvmeq->q_lock);
		__nvme_process_cq(nvmeq, &tag);
		spin_unlock_irq(&nvmeq->q_lock);

		if (tag == -1)
			return 1;
	}

	return 0;
}

819
static void nvme_async_event_work(struct work_struct *work)
M
Matthew Wilcox 已提交
820
{
821 822
	struct nvme_dev *dev = container_of(work, struct nvme_dev, async_work);
	struct nvme_queue *nvmeq = dev->queues[0];
M
Matias Bjørling 已提交
823
	struct nvme_command c;
M
Matthew Wilcox 已提交
824

M
Matias Bjørling 已提交
825 826
	memset(&c, 0, sizeof(c));
	c.common.opcode = nvme_admin_async_event;
827

828 829 830 831 832 833 834
	spin_lock_irq(&nvmeq->q_lock);
	while (dev->ctrl.event_limit > 0) {
		c.common.command_id = NVME_AQ_BLKMQ_DEPTH +
			--dev->ctrl.event_limit;
		__nvme_submit_cmd(nvmeq, &c);
	}
	spin_unlock_irq(&nvmeq->q_lock);
835 836
}

M
Matthew Wilcox 已提交
837
static int adapter_delete_queue(struct nvme_dev *dev, u8 opcode, u16 id)
838
{
M
Matthew Wilcox 已提交
839 840 841 842 843 844
	struct nvme_command c;

	memset(&c, 0, sizeof(c));
	c.delete_queue.opcode = opcode;
	c.delete_queue.qid = cpu_to_le16(id);

845
	return nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0);
M
Matthew Wilcox 已提交
846 847 848 849 850 851 852 853
}

static int adapter_alloc_cq(struct nvme_dev *dev, u16 qid,
						struct nvme_queue *nvmeq)
{
	struct nvme_command c;
	int flags = NVME_QUEUE_PHYS_CONTIG | NVME_CQ_IRQ_ENABLED;

854 855 856 857
	/*
	 * Note: we (ab)use the fact the the prp fields survive if no data
	 * is attached to the request.
	 */
M
Matthew Wilcox 已提交
858 859 860 861 862 863 864 865
	memset(&c, 0, sizeof(c));
	c.create_cq.opcode = nvme_admin_create_cq;
	c.create_cq.prp1 = cpu_to_le64(nvmeq->cq_dma_addr);
	c.create_cq.cqid = cpu_to_le16(qid);
	c.create_cq.qsize = cpu_to_le16(nvmeq->q_depth - 1);
	c.create_cq.cq_flags = cpu_to_le16(flags);
	c.create_cq.irq_vector = cpu_to_le16(nvmeq->cq_vector);

866
	return nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0);
M
Matthew Wilcox 已提交
867 868 869 870 871 872 873 874
}

static int adapter_alloc_sq(struct nvme_dev *dev, u16 qid,
						struct nvme_queue *nvmeq)
{
	struct nvme_command c;
	int flags = NVME_QUEUE_PHYS_CONTIG | NVME_SQ_PRIO_MEDIUM;

875 876 877 878
	/*
	 * Note: we (ab)use the fact the the prp fields survive if no data
	 * is attached to the request.
	 */
M
Matthew Wilcox 已提交
879 880 881 882 883 884 885 886
	memset(&c, 0, sizeof(c));
	c.create_sq.opcode = nvme_admin_create_sq;
	c.create_sq.prp1 = cpu_to_le64(nvmeq->sq_dma_addr);
	c.create_sq.sqid = cpu_to_le16(qid);
	c.create_sq.qsize = cpu_to_le16(nvmeq->q_depth - 1);
	c.create_sq.sq_flags = cpu_to_le16(flags);
	c.create_sq.cqid = cpu_to_le16(qid);

887
	return nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0);
M
Matthew Wilcox 已提交
888 889 890 891 892 893 894 895 896 897 898 899
}

static int adapter_delete_cq(struct nvme_dev *dev, u16 cqid)
{
	return adapter_delete_queue(dev, nvme_admin_delete_cq, cqid);
}

static int adapter_delete_sq(struct nvme_dev *dev, u16 sqid)
{
	return adapter_delete_queue(dev, nvme_admin_delete_sq, sqid);
}

900
static void abort_endio(struct request *req, int error)
901
{
C
Christoph Hellwig 已提交
902 903
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
	struct nvme_queue *nvmeq = iod->nvmeq;
904 905
	u32 result = (u32)(uintptr_t)req->special;
	u16 status = req->errors;
906

907 908
	dev_warn(nvmeq->dev->ctrl.device,
		"Abort status:%x result:%x", status, result);
909
	atomic_inc(&nvmeq->dev->ctrl.abort_limit);
910

911
	blk_mq_free_request(req);
912 913
}

914
static enum blk_eh_timer_return nvme_timeout(struct request *req, bool reserved)
K
Keith Busch 已提交
915
{
C
Christoph Hellwig 已提交
916 917
	struct nvme_iod *iod = blk_mq_rq_to_pdu(req);
	struct nvme_queue *nvmeq = iod->nvmeq;
K
Keith Busch 已提交
918
	struct nvme_dev *dev = nvmeq->dev;
M
Matias Bjørling 已提交
919 920
	struct request *abort_req;
	struct nvme_command cmd;
K
Keith Busch 已提交
921

922
	/*
923 924 925 926 927 928
	 * Shutdown immediately if controller times out while starting. The
	 * reset work will see the pci device disabled when it gets the forced
	 * cancellation error. All outstanding requests are completed on
	 * shutdown, so we return BLK_EH_HANDLED.
	 */
	if (test_bit(NVME_CTRL_RESETTING, &dev->flags)) {
929
		dev_warn(dev->ctrl.device,
930 931
			 "I/O %d QID %d timeout, disable controller\n",
			 req->tag, nvmeq->qid);
932
		nvme_dev_disable(dev, false);
933 934
		req->errors = NVME_SC_CANCELLED;
		return BLK_EH_HANDLED;
K
Keith Busch 已提交
935 936
	}

937 938 939 940
	/*
 	 * Shutdown the controller immediately and schedule a reset if the
 	 * command was already aborted once before and still hasn't been
 	 * returned to the driver, or if this is the admin queue.
941
	 */
C
Christoph Hellwig 已提交
942
	if (!nvmeq->qid || iod->aborted) {
943
		dev_warn(dev->ctrl.device,
944 945
			 "I/O %d QID %d timeout, reset controller\n",
			 req->tag, nvmeq->qid);
946
		nvme_dev_disable(dev, false);
947
		queue_work(nvme_workq, &dev->reset_work);
K
Keith Busch 已提交
948

949 950 951 952 953 954
		/*
		 * Mark the request as handled, since the inline shutdown
		 * forces all outstanding requests to complete.
		 */
		req->errors = NVME_SC_CANCELLED;
		return BLK_EH_HANDLED;
K
Keith Busch 已提交
955 956
	}

C
Christoph Hellwig 已提交
957
	iod->aborted = 1;
K
Keith Busch 已提交
958

959
	if (atomic_dec_return(&dev->ctrl.abort_limit) < 0) {
960
		atomic_inc(&dev->ctrl.abort_limit);
961
		return BLK_EH_RESET_TIMER;
962
	}
M
Matias Bjørling 已提交
963

K
Keith Busch 已提交
964 965
	memset(&cmd, 0, sizeof(cmd));
	cmd.abort.opcode = nvme_admin_abort_cmd;
M
Matias Bjørling 已提交
966
	cmd.abort.cid = req->tag;
K
Keith Busch 已提交
967 968
	cmd.abort.sqid = cpu_to_le16(nvmeq->qid);

969 970 971
	dev_warn(nvmeq->dev->ctrl.device,
		"I/O %d QID %d timeout, aborting\n",
		 req->tag, nvmeq->qid);
972 973 974 975 976 977 978 979 980 981 982

	abort_req = nvme_alloc_request(dev->ctrl.admin_q, &cmd,
			BLK_MQ_REQ_NOWAIT);
	if (IS_ERR(abort_req)) {
		atomic_inc(&dev->ctrl.abort_limit);
		return BLK_EH_RESET_TIMER;
	}

	abort_req->timeout = ADMIN_TIMEOUT;
	abort_req->end_io_data = NULL;
	blk_execute_rq_nowait(abort_req->q, NULL, abort_req, 0, abort_endio);
K
Keith Busch 已提交
983

984 985 986 987 988 989
	/*
	 * The aborted req will be completed on receiving the abort req.
	 * We enable the timer again. If hit twice, it'll cause a device reset,
	 * as the device then is in a faulty state.
	 */
	return BLK_EH_RESET_TIMER;
K
Keith Busch 已提交
990 991
}

992
static void nvme_cancel_queue_ios(struct request *req, void *data, bool reserved)
993
{
M
Matias Bjørling 已提交
994
	struct nvme_queue *nvmeq = data;
995
	int status;
K
Keith Busch 已提交
996 997 998

	if (!blk_mq_request_started(req))
		return;
999

1000
	dev_warn(nvmeq->dev->ctrl.device,
1001
		 "Cancelling I/O %d QID %d\n", req->tag, nvmeq->qid);
M
Matias Bjørling 已提交
1002

1003
	status = NVME_SC_ABORT_REQ;
K
Keith Busch 已提交
1004
	if (blk_queue_dying(req->q))
1005 1006
		status |= NVME_SC_DNR;
	blk_mq_complete_request(req, status);
M
Matias Bjørling 已提交
1007
}
1008

M
Matias Bjørling 已提交
1009 1010
static void nvme_free_queue(struct nvme_queue *nvmeq)
{
1011 1012
	dma_free_coherent(nvmeq->q_dmadev, CQ_SIZE(nvmeq->q_depth),
				(void *)nvmeq->cqes, nvmeq->cq_dma_addr);
1013 1014
	if (nvmeq->sq_cmds)
		dma_free_coherent(nvmeq->q_dmadev, SQ_SIZE(nvmeq->q_depth),
1015 1016 1017 1018
					nvmeq->sq_cmds, nvmeq->sq_dma_addr);
	kfree(nvmeq);
}

1019
static void nvme_free_queues(struct nvme_dev *dev, int lowest)
1020 1021 1022
{
	int i;

1023
	for (i = dev->queue_count - 1; i >= lowest; i--) {
M
Matias Bjørling 已提交
1024
		struct nvme_queue *nvmeq = dev->queues[i];
1025
		dev->queue_count--;
M
Matias Bjørling 已提交
1026
		dev->queues[i] = NULL;
K
Keith Busch 已提交
1027
		nvme_free_queue(nvmeq);
1028
	}
1029 1030
}

K
Keith Busch 已提交
1031 1032 1033 1034 1035
/**
 * nvme_suspend_queue - put queue into suspended state
 * @nvmeq - queue to suspend
 */
static int nvme_suspend_queue(struct nvme_queue *nvmeq)
M
Matthew Wilcox 已提交
1036
{
K
Keith Busch 已提交
1037
	int vector;
M
Matthew Wilcox 已提交
1038

1039
	spin_lock_irq(&nvmeq->q_lock);
K
Keith Busch 已提交
1040 1041 1042 1043 1044
	if (nvmeq->cq_vector == -1) {
		spin_unlock_irq(&nvmeq->q_lock);
		return 1;
	}
	vector = nvmeq->dev->entry[nvmeq->cq_vector].vector;
K
Keith Busch 已提交
1045
	nvmeq->dev->online_queues--;
K
Keith Busch 已提交
1046
	nvmeq->cq_vector = -1;
1047 1048
	spin_unlock_irq(&nvmeq->q_lock);

1049
	if (!nvmeq->qid && nvmeq->dev->ctrl.admin_q)
1050
		blk_mq_stop_hw_queues(nvmeq->dev->ctrl.admin_q);
1051

M
Matthew Wilcox 已提交
1052 1053
	irq_set_affinity_hint(vector, NULL);
	free_irq(vector, nvmeq);
M
Matthew Wilcox 已提交
1054

K
Keith Busch 已提交
1055 1056
	return 0;
}
M
Matthew Wilcox 已提交
1057

K
Keith Busch 已提交
1058 1059
static void nvme_clear_queue(struct nvme_queue *nvmeq)
{
1060
	spin_lock_irq(&nvmeq->q_lock);
1061 1062
	if (nvmeq->tags && *nvmeq->tags)
		blk_mq_all_tag_busy_iter(*nvmeq->tags, nvme_cancel_queue_ios, nvmeq);
1063
	spin_unlock_irq(&nvmeq->q_lock);
M
Matthew Wilcox 已提交
1064 1065
}

1066
static void nvme_disable_admin_queue(struct nvme_dev *dev, bool shutdown)
K
Keith Busch 已提交
1067
{
1068
	struct nvme_queue *nvmeq = dev->queues[0];
K
Keith Busch 已提交
1069 1070 1071 1072 1073 1074

	if (!nvmeq)
		return;
	if (nvme_suspend_queue(nvmeq))
		return;

1075 1076 1077 1078 1079
	if (shutdown)
		nvme_shutdown_ctrl(&dev->ctrl);
	else
		nvme_disable_ctrl(&dev->ctrl, lo_hi_readq(
						dev->bar + NVME_REG_CAP));
1080 1081 1082 1083

	spin_lock_irq(&nvmeq->q_lock);
	nvme_process_cq(nvmeq);
	spin_unlock_irq(&nvmeq->q_lock);
M
Matthew Wilcox 已提交
1084 1085
}

1086 1087 1088 1089
static int nvme_cmb_qdepth(struct nvme_dev *dev, int nr_io_queues,
				int entry_size)
{
	int q_depth = dev->q_depth;
1090 1091
	unsigned q_size_aligned = roundup(q_depth * entry_size,
					  dev->ctrl.page_size);
1092 1093

	if (q_size_aligned * nr_io_queues > dev->cmb_size) {
1094
		u64 mem_per_q = div_u64(dev->cmb_size, nr_io_queues);
1095
		mem_per_q = round_down(mem_per_q, dev->ctrl.page_size);
1096
		q_depth = div_u64(mem_per_q, entry_size);
1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113

		/*
		 * Ensure the reduced q_depth is above some threshold where it
		 * would be better to map queues in system memory with the
		 * original depth
		 */
		if (q_depth < 64)
			return -ENOMEM;
	}

	return q_depth;
}

static int nvme_alloc_sq_cmds(struct nvme_dev *dev, struct nvme_queue *nvmeq,
				int qid, int depth)
{
	if (qid && dev->cmb && use_cmb_sqes && NVME_CMB_SQS(dev->cmbsz)) {
1114 1115
		unsigned offset = (qid - 1) * roundup(SQ_SIZE(depth),
						      dev->ctrl.page_size);
1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127
		nvmeq->sq_dma_addr = dev->cmb_dma_addr + offset;
		nvmeq->sq_cmds_io = dev->cmb + offset;
	} else {
		nvmeq->sq_cmds = dma_alloc_coherent(dev->dev, SQ_SIZE(depth),
					&nvmeq->sq_dma_addr, GFP_KERNEL);
		if (!nvmeq->sq_cmds)
			return -ENOMEM;
	}

	return 0;
}

M
Matthew Wilcox 已提交
1128
static struct nvme_queue *nvme_alloc_queue(struct nvme_dev *dev, int qid,
K
Keith Busch 已提交
1129
							int depth)
M
Matthew Wilcox 已提交
1130
{
M
Matias Bjørling 已提交
1131
	struct nvme_queue *nvmeq = kzalloc(sizeof(*nvmeq), GFP_KERNEL);
M
Matthew Wilcox 已提交
1132 1133 1134
	if (!nvmeq)
		return NULL;

1135
	nvmeq->cqes = dma_zalloc_coherent(dev->dev, CQ_SIZE(depth),
J
Joe Perches 已提交
1136
					  &nvmeq->cq_dma_addr, GFP_KERNEL);
M
Matthew Wilcox 已提交
1137 1138 1139
	if (!nvmeq->cqes)
		goto free_nvmeq;

1140
	if (nvme_alloc_sq_cmds(dev, nvmeq, qid, depth))
M
Matthew Wilcox 已提交
1141 1142
		goto free_cqdma;

1143
	nvmeq->q_dmadev = dev->dev;
M
Matthew Wilcox 已提交
1144
	nvmeq->dev = dev;
1145
	snprintf(nvmeq->irqname, sizeof(nvmeq->irqname), "nvme%dq%d",
1146
			dev->ctrl.instance, qid);
M
Matthew Wilcox 已提交
1147 1148
	spin_lock_init(&nvmeq->q_lock);
	nvmeq->cq_head = 0;
M
Matthew Wilcox 已提交
1149
	nvmeq->cq_phase = 1;
1150
	nvmeq->q_db = &dev->dbs[qid * 2 * dev->db_stride];
M
Matthew Wilcox 已提交
1151
	nvmeq->q_depth = depth;
K
Keith Busch 已提交
1152
	nvmeq->qid = qid;
1153
	nvmeq->cq_vector = -1;
M
Matias Bjørling 已提交
1154
	dev->queues[qid] = nvmeq;
1155 1156
	dev->queue_count++;

M
Matthew Wilcox 已提交
1157 1158 1159
	return nvmeq;

 free_cqdma:
1160
	dma_free_coherent(dev->dev, CQ_SIZE(depth), (void *)nvmeq->cqes,
M
Matthew Wilcox 已提交
1161 1162 1163 1164 1165 1166
							nvmeq->cq_dma_addr);
 free_nvmeq:
	kfree(nvmeq);
	return NULL;
}

1167 1168 1169
static int queue_request_irq(struct nvme_dev *dev, struct nvme_queue *nvmeq,
							const char *name)
{
1170 1171
	if (use_threaded_interrupts)
		return request_threaded_irq(dev->entry[nvmeq->cq_vector].vector,
1172
					nvme_irq_check, nvme_irq, IRQF_SHARED,
1173
					name, nvmeq);
1174
	return request_irq(dev->entry[nvmeq->cq_vector].vector, nvme_irq,
1175
				IRQF_SHARED, name, nvmeq);
1176 1177
}

1178
static void nvme_init_queue(struct nvme_queue *nvmeq, u16 qid)
M
Matthew Wilcox 已提交
1179
{
1180
	struct nvme_dev *dev = nvmeq->dev;
M
Matthew Wilcox 已提交
1181

1182
	spin_lock_irq(&nvmeq->q_lock);
1183 1184 1185
	nvmeq->sq_tail = 0;
	nvmeq->cq_head = 0;
	nvmeq->cq_phase = 1;
1186
	nvmeq->q_db = &dev->dbs[qid * 2 * dev->db_stride];
1187
	memset((void *)nvmeq->cqes, 0, CQ_SIZE(nvmeq->q_depth));
K
Keith Busch 已提交
1188
	dev->online_queues++;
1189
	spin_unlock_irq(&nvmeq->q_lock);
1190 1191 1192 1193 1194 1195
}

static int nvme_create_queue(struct nvme_queue *nvmeq, int qid)
{
	struct nvme_dev *dev = nvmeq->dev;
	int result;
1196

K
Keith Busch 已提交
1197
	nvmeq->cq_vector = qid - 1;
M
Matthew Wilcox 已提交
1198 1199
	result = adapter_alloc_cq(dev, qid, nvmeq);
	if (result < 0)
1200
		return result;
M
Matthew Wilcox 已提交
1201 1202 1203 1204 1205

	result = adapter_alloc_sq(dev, qid, nvmeq);
	if (result < 0)
		goto release_cq;

1206
	result = queue_request_irq(dev, nvmeq, nvmeq->irqname);
M
Matthew Wilcox 已提交
1207 1208 1209
	if (result < 0)
		goto release_sq;

1210 1211
	nvme_init_queue(nvmeq, qid);
	return result;
M
Matthew Wilcox 已提交
1212 1213 1214 1215 1216

 release_sq:
	adapter_delete_sq(dev, qid);
 release_cq:
	adapter_delete_cq(dev, qid);
1217
	return result;
M
Matthew Wilcox 已提交
1218 1219
}

M
Matias Bjørling 已提交
1220
static struct blk_mq_ops nvme_mq_admin_ops = {
1221
	.queue_rq	= nvme_queue_rq,
1222
	.complete	= nvme_complete_rq,
M
Matias Bjørling 已提交
1223 1224
	.map_queue	= blk_mq_map_queue,
	.init_hctx	= nvme_admin_init_hctx,
1225
	.exit_hctx      = nvme_admin_exit_hctx,
M
Matias Bjørling 已提交
1226 1227 1228 1229 1230 1231
	.init_request	= nvme_admin_init_request,
	.timeout	= nvme_timeout,
};

static struct blk_mq_ops nvme_mq_ops = {
	.queue_rq	= nvme_queue_rq,
1232
	.complete	= nvme_complete_rq,
M
Matias Bjørling 已提交
1233 1234 1235 1236
	.map_queue	= blk_mq_map_queue,
	.init_hctx	= nvme_init_hctx,
	.init_request	= nvme_init_request,
	.timeout	= nvme_timeout,
J
Jens Axboe 已提交
1237
	.poll		= nvme_poll,
M
Matias Bjørling 已提交
1238 1239
};

1240 1241
static void nvme_dev_remove_admin(struct nvme_dev *dev)
{
1242 1243
	if (dev->ctrl.admin_q && !blk_queue_dying(dev->ctrl.admin_q)) {
		blk_cleanup_queue(dev->ctrl.admin_q);
1244 1245 1246 1247
		blk_mq_free_tag_set(&dev->admin_tagset);
	}
}

M
Matias Bjørling 已提交
1248 1249
static int nvme_alloc_admin_tags(struct nvme_dev *dev)
{
1250
	if (!dev->ctrl.admin_q) {
M
Matias Bjørling 已提交
1251 1252
		dev->admin_tagset.ops = &nvme_mq_admin_ops;
		dev->admin_tagset.nr_hw_queues = 1;
K
Keith Busch 已提交
1253 1254 1255 1256 1257 1258

		/*
		 * Subtract one to leave an empty queue entry for 'Full Queue'
		 * condition. See NVM-Express 1.2 specification, section 4.1.2.
		 */
		dev->admin_tagset.queue_depth = NVME_AQ_BLKMQ_DEPTH - 1;
M
Matias Bjørling 已提交
1259
		dev->admin_tagset.timeout = ADMIN_TIMEOUT;
1260
		dev->admin_tagset.numa_node = dev_to_node(dev->dev);
1261
		dev->admin_tagset.cmd_size = nvme_cmd_size(dev);
M
Matias Bjørling 已提交
1262 1263 1264 1265 1266
		dev->admin_tagset.driver_data = dev;

		if (blk_mq_alloc_tag_set(&dev->admin_tagset))
			return -ENOMEM;

1267 1268
		dev->ctrl.admin_q = blk_mq_init_queue(&dev->admin_tagset);
		if (IS_ERR(dev->ctrl.admin_q)) {
M
Matias Bjørling 已提交
1269 1270 1271
			blk_mq_free_tag_set(&dev->admin_tagset);
			return -ENOMEM;
		}
1272
		if (!blk_get_queue(dev->ctrl.admin_q)) {
1273
			nvme_dev_remove_admin(dev);
1274
			dev->ctrl.admin_q = NULL;
1275 1276
			return -ENODEV;
		}
K
Keith Busch 已提交
1277
	} else
1278
		blk_mq_start_stopped_hw_queues(dev->ctrl.admin_q, true);
M
Matias Bjørling 已提交
1279 1280 1281 1282

	return 0;
}

1283
static int nvme_configure_admin_queue(struct nvme_dev *dev)
M
Matthew Wilcox 已提交
1284
{
1285
	int result;
M
Matthew Wilcox 已提交
1286
	u32 aqa;
1287
	u64 cap = lo_hi_readq(dev->bar + NVME_REG_CAP);
M
Matthew Wilcox 已提交
1288 1289
	struct nvme_queue *nvmeq;

1290
	dev->subsystem = readl(dev->bar + NVME_REG_VS) >= NVME_VS(1, 1) ?
1291 1292
						NVME_CAP_NSSRC(cap) : 0;

1293 1294 1295
	if (dev->subsystem &&
	    (readl(dev->bar + NVME_REG_CSTS) & NVME_CSTS_NSSRO))
		writel(NVME_CSTS_NSSRO, dev->bar + NVME_REG_CSTS);
1296

1297
	result = nvme_disable_ctrl(&dev->ctrl, cap);
1298 1299
	if (result < 0)
		return result;
M
Matthew Wilcox 已提交
1300

M
Matias Bjørling 已提交
1301
	nvmeq = dev->queues[0];
1302
	if (!nvmeq) {
K
Keith Busch 已提交
1303
		nvmeq = nvme_alloc_queue(dev, 0, NVME_AQ_DEPTH);
1304 1305 1306
		if (!nvmeq)
			return -ENOMEM;
	}
M
Matthew Wilcox 已提交
1307 1308 1309 1310

	aqa = nvmeq->q_depth - 1;
	aqa |= aqa << 16;

1311 1312 1313
	writel(aqa, dev->bar + NVME_REG_AQA);
	lo_hi_writeq(nvmeq->sq_dma_addr, dev->bar + NVME_REG_ASQ);
	lo_hi_writeq(nvmeq->cq_dma_addr, dev->bar + NVME_REG_ACQ);
M
Matthew Wilcox 已提交
1314

1315
	result = nvme_enable_ctrl(&dev->ctrl, cap);
1316
	if (result)
M
Matias Bjørling 已提交
1317 1318
		goto free_nvmeq;

K
Keith Busch 已提交
1319
	nvmeq->cq_vector = 0;
1320
	result = queue_request_irq(dev, nvmeq, nvmeq->irqname);
1321 1322
	if (result) {
		nvmeq->cq_vector = -1;
K
Keith Busch 已提交
1323
		goto free_nvmeq;
1324
	}
1325

M
Matthew Wilcox 已提交
1326
	return result;
M
Matias Bjørling 已提交
1327 1328 1329 1330

 free_nvmeq:
	nvme_free_queues(dev, 0);
	return result;
M
Matthew Wilcox 已提交
1331 1332
}

1333
static void nvme_watchdog_timer(unsigned long data)
1334
{
1335 1336
	struct nvme_dev *dev = (struct nvme_dev *)data;
	u32 csts = readl(dev->bar + NVME_REG_CSTS);
1337

1338 1339 1340 1341 1342 1343 1344 1345 1346 1347
	/*
	 * Skip controllers currently under reset.
	 */
	if (!work_pending(&dev->reset_work) && !work_busy(&dev->reset_work) &&
	    ((csts & NVME_CSTS_CFS) ||
	     (dev->subsystem && (csts & NVME_CSTS_NSSRO)))) {
		if (queue_work(nvme_workq, &dev->reset_work)) {
			dev_warn(dev->dev,
				"Failed status: 0x%x, reset controller.\n",
				csts);
1348
		}
1349
		return;
1350
	}
1351 1352

	mod_timer(&dev->watchdog_timer, round_jiffies(jiffies + HZ));
1353 1354
}

1355
static int nvme_create_io_queues(struct nvme_dev *dev)
K
Keith Busch 已提交
1356
{
1357
	unsigned i, max;
1358
	int ret = 0;
K
Keith Busch 已提交
1359

1360 1361 1362
	for (i = dev->queue_count; i <= dev->max_qid; i++) {
		if (!nvme_alloc_queue(dev, i, dev->q_depth)) {
			ret = -ENOMEM;
K
Keith Busch 已提交
1363
			break;
1364 1365
		}
	}
K
Keith Busch 已提交
1366

1367 1368
	max = min(dev->max_qid, dev->queue_count - 1);
	for (i = dev->online_queues; i <= max; i++) {
1369 1370
		ret = nvme_create_queue(dev->queues[i], i);
		if (ret) {
1371
			nvme_free_queues(dev, i);
K
Keith Busch 已提交
1372
			break;
1373
		}
M
Matthew Wilcox 已提交
1374
	}
1375 1376 1377 1378 1379 1380 1381 1382

	/*
	 * Ignore failing Create SQ/CQ commands, we can continue with less
	 * than the desired aount of queues, and even a controller without
	 * I/O queues an still be used to issue admin commands.  This might
	 * be useful to upgrade a buggy firmware for example.
	 */
	return ret >= 0 ? 0 : ret;
M
Matthew Wilcox 已提交
1383 1384
}

1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396
static void __iomem *nvme_map_cmb(struct nvme_dev *dev)
{
	u64 szu, size, offset;
	u32 cmbloc;
	resource_size_t bar_size;
	struct pci_dev *pdev = to_pci_dev(dev->dev);
	void __iomem *cmb;
	dma_addr_t dma_addr;

	if (!use_cmb_sqes)
		return NULL;

1397
	dev->cmbsz = readl(dev->bar + NVME_REG_CMBSZ);
1398 1399 1400
	if (!(NVME_CMB_SZ(dev->cmbsz)))
		return NULL;

1401
	cmbloc = readl(dev->bar + NVME_REG_CMBLOC);
1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436

	szu = (u64)1 << (12 + 4 * NVME_CMB_SZU(dev->cmbsz));
	size = szu * NVME_CMB_SZ(dev->cmbsz);
	offset = szu * NVME_CMB_OFST(cmbloc);
	bar_size = pci_resource_len(pdev, NVME_CMB_BIR(cmbloc));

	if (offset > bar_size)
		return NULL;

	/*
	 * Controllers may support a CMB size larger than their BAR,
	 * for example, due to being behind a bridge. Reduce the CMB to
	 * the reported size of the BAR
	 */
	if (size > bar_size - offset)
		size = bar_size - offset;

	dma_addr = pci_resource_start(pdev, NVME_CMB_BIR(cmbloc)) + offset;
	cmb = ioremap_wc(dma_addr, size);
	if (!cmb)
		return NULL;

	dev->cmb_dma_addr = dma_addr;
	dev->cmb_size = size;
	return cmb;
}

static inline void nvme_release_cmb(struct nvme_dev *dev)
{
	if (dev->cmb) {
		iounmap(dev->cmb);
		dev->cmb = NULL;
	}
}

K
Keith Busch 已提交
1437 1438
static size_t db_bar_size(struct nvme_dev *dev, unsigned nr_io_queues)
{
1439
	return 4096 + ((nr_io_queues + 1) * 8 * dev->db_stride);
K
Keith Busch 已提交
1440 1441
}

1442
static int nvme_setup_io_queues(struct nvme_dev *dev)
M
Matthew Wilcox 已提交
1443
{
M
Matias Bjørling 已提交
1444
	struct nvme_queue *adminq = dev->queues[0];
1445
	struct pci_dev *pdev = to_pci_dev(dev->dev);
K
Keith Busch 已提交
1446
	int result, i, vecs, nr_io_queues, size;
M
Matthew Wilcox 已提交
1447

K
Keith Busch 已提交
1448
	nr_io_queues = num_possible_cpus();
C
Christoph Hellwig 已提交
1449 1450
	result = nvme_set_queue_count(&dev->ctrl, &nr_io_queues);
	if (result < 0)
M
Matthew Wilcox 已提交
1451
		return result;
C
Christoph Hellwig 已提交
1452 1453 1454 1455 1456 1457 1458

	/*
	 * Degraded controllers might return an error when setting the queue
	 * count.  We still want to be able to bring them online and offer
	 * access to the admin queue, as that might be only way to fix them up.
	 */
	if (result > 0) {
1459 1460
		dev_err(dev->ctrl.device,
			"Could not set queue count (%d)\n", result);
C
Christoph Hellwig 已提交
1461 1462 1463
		nr_io_queues = 0;
		result = 0;
	}
M
Matthew Wilcox 已提交
1464

1465 1466 1467 1468 1469 1470 1471 1472 1473
	if (dev->cmb && NVME_CMB_SQS(dev->cmbsz)) {
		result = nvme_cmb_qdepth(dev, nr_io_queues,
				sizeof(struct nvme_command));
		if (result > 0)
			dev->q_depth = result;
		else
			nvme_release_cmb(dev);
	}

K
Keith Busch 已提交
1474 1475
	size = db_bar_size(dev, nr_io_queues);
	if (size > 8192) {
1476
		iounmap(dev->bar);
K
Keith Busch 已提交
1477 1478 1479 1480 1481 1482 1483 1484
		do {
			dev->bar = ioremap(pci_resource_start(pdev, 0), size);
			if (dev->bar)
				break;
			if (!--nr_io_queues)
				return -ENOMEM;
			size = db_bar_size(dev, nr_io_queues);
		} while (1);
1485
		dev->dbs = dev->bar + 4096;
1486
		adminq->q_db = dev->dbs;
1487 1488
	}

K
Keith Busch 已提交
1489
	/* Deregister the admin queue's interrupt */
1490
	free_irq(dev->entry[0].vector, adminq);
K
Keith Busch 已提交
1491

1492 1493 1494 1495 1496 1497 1498
	/*
	 * If we enable msix early due to not intx, disable it again before
	 * setting up the full range we need.
	 */
	if (!pdev->irq)
		pci_disable_msix(pdev);

1499
	for (i = 0; i < nr_io_queues; i++)
M
Matthew Wilcox 已提交
1500
		dev->entry[i].entry = i;
1501 1502 1503 1504 1505 1506 1507 1508
	vecs = pci_enable_msix_range(pdev, dev->entry, 1, nr_io_queues);
	if (vecs < 0) {
		vecs = pci_enable_msi_range(pdev, 1, min(nr_io_queues, 32));
		if (vecs < 0) {
			vecs = 1;
		} else {
			for (i = 0; i < vecs; i++)
				dev->entry[i].vector = i + pdev->irq;
R
Ramachandra Rao Gajula 已提交
1509 1510 1511
		}
	}

1512 1513 1514 1515 1516 1517 1518
	/*
	 * Should investigate if there's a performance win from allocating
	 * more queues than interrupt vectors; it might allow the submission
	 * path to scale better, even if the receive path is limited by the
	 * number of interrupts.
	 */
	nr_io_queues = vecs;
K
Keith Busch 已提交
1519
	dev->max_qid = nr_io_queues;
1520

1521
	result = queue_request_irq(dev, adminq, adminq->irqname);
1522 1523
	if (result) {
		adminq->cq_vector = -1;
1524
		goto free_queues;
1525
	}
1526
	return nvme_create_io_queues(dev);
M
Matthew Wilcox 已提交
1527

1528
 free_queues:
1529
	nvme_free_queues(dev, 1);
1530
	return result;
M
Matthew Wilcox 已提交
1531 1532
}

1533
static void nvme_set_irq_hints(struct nvme_dev *dev)
K
Keith Busch 已提交
1534
{
1535 1536
	struct nvme_queue *nvmeq;
	int i;
K
Keith Busch 已提交
1537

1538 1539
	for (i = 0; i < dev->online_queues; i++) {
		nvmeq = dev->queues[i];
K
Keith Busch 已提交
1540

1541 1542
		if (!nvmeq->tags || !(*nvmeq->tags))
			continue;
K
Keith Busch 已提交
1543

1544 1545
		irq_set_affinity_hint(dev->entry[nvmeq->cq_vector].vector,
					blk_mq_tags_cpumask(*nvmeq->tags));
K
Keith Busch 已提交
1546 1547 1548 1549 1550 1551 1552 1553 1554
	}
}

static void nvme_dev_scan(struct work_struct *work)
{
	struct nvme_dev *dev = container_of(work, struct nvme_dev, scan_work);

	if (!dev->tagset.tags)
		return;
1555
	nvme_scan_namespaces(&dev->ctrl);
1556
	nvme_set_irq_hints(dev);
K
Keith Busch 已提交
1557 1558
}

K
Keith Busch 已提交
1559
static void nvme_del_queue_end(struct request *req, int error)
K
Keith Busch 已提交
1560
{
K
Keith Busch 已提交
1561
	struct nvme_queue *nvmeq = req->end_io_data;
1562

K
Keith Busch 已提交
1563 1564
	blk_mq_free_request(req);
	complete(&nvmeq->dev->ioq_wait);
K
Keith Busch 已提交
1565 1566
}

K
Keith Busch 已提交
1567
static void nvme_del_cq_end(struct request *req, int error)
K
Keith Busch 已提交
1568
{
K
Keith Busch 已提交
1569
	struct nvme_queue *nvmeq = req->end_io_data;
K
Keith Busch 已提交
1570

K
Keith Busch 已提交
1571 1572 1573 1574 1575 1576
	if (!error) {
		unsigned long flags;

		spin_lock_irqsave(&nvmeq->q_lock, flags);
		nvme_process_cq(nvmeq);
		spin_unlock_irqrestore(&nvmeq->q_lock, flags);
K
Keith Busch 已提交
1577
	}
K
Keith Busch 已提交
1578 1579

	nvme_del_queue_end(req, error);
K
Keith Busch 已提交
1580 1581
}

K
Keith Busch 已提交
1582
static int nvme_delete_queue(struct nvme_queue *nvmeq, u8 opcode)
1583
{
K
Keith Busch 已提交
1584 1585 1586
	struct request_queue *q = nvmeq->dev->ctrl.admin_q;
	struct request *req;
	struct nvme_command cmd;
1587

K
Keith Busch 已提交
1588 1589 1590
	memset(&cmd, 0, sizeof(cmd));
	cmd.delete_queue.opcode = opcode;
	cmd.delete_queue.qid = cpu_to_le16(nvmeq->qid);
1591

K
Keith Busch 已提交
1592 1593 1594
	req = nvme_alloc_request(q, &cmd, BLK_MQ_REQ_NOWAIT);
	if (IS_ERR(req))
		return PTR_ERR(req);
1595

K
Keith Busch 已提交
1596 1597 1598 1599 1600 1601 1602
	req->timeout = ADMIN_TIMEOUT;
	req->end_io_data = nvmeq;

	blk_execute_rq_nowait(q, NULL, req, false,
			opcode == nvme_admin_delete_cq ?
				nvme_del_cq_end : nvme_del_queue_end);
	return 0;
1603 1604
}

K
Keith Busch 已提交
1605
static void nvme_disable_io_queues(struct nvme_dev *dev)
K
Keith Busch 已提交
1606
{
K
Keith Busch 已提交
1607 1608 1609
	int pass;
	unsigned long timeout;
	u8 opcode = nvme_admin_delete_sq;
K
Keith Busch 已提交
1610

K
Keith Busch 已提交
1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634
	for (pass = 0; pass < 2; pass++) {
		int sent = 0, i = dev->queue_count - 1;

		reinit_completion(&dev->ioq_wait);
 retry:
		timeout = ADMIN_TIMEOUT;
		for (; i > 0; i--) {
			struct nvme_queue *nvmeq = dev->queues[i];

			if (!pass)
				nvme_suspend_queue(nvmeq);
			if (nvme_delete_queue(nvmeq, opcode))
				break;
			++sent;
		}
		while (sent--) {
			timeout = wait_for_completion_io_timeout(&dev->ioq_wait, timeout);
			if (timeout == 0)
				return;
			if (i)
				goto retry;
		}
		opcode = nvme_admin_delete_cq;
	}
K
Keith Busch 已提交
1635 1636
}

1637 1638 1639 1640 1641 1642
/*
 * Return: error value if an error occurred setting up the queues or calling
 * Identify Device.  0 if these succeeded, even if adding some of the
 * namespaces failed.  At the moment, these failures are silent.  TBD which
 * failures should be reported.
 */
1643
static int nvme_dev_add(struct nvme_dev *dev)
M
Matthew Wilcox 已提交
1644
{
1645
	if (!dev->ctrl.tagset) {
1646 1647 1648 1649 1650
		dev->tagset.ops = &nvme_mq_ops;
		dev->tagset.nr_hw_queues = dev->online_queues - 1;
		dev->tagset.timeout = NVME_IO_TIMEOUT;
		dev->tagset.numa_node = dev_to_node(dev->dev);
		dev->tagset.queue_depth =
M
Matias Bjørling 已提交
1651
				min_t(int, dev->q_depth, BLK_MQ_MAX_DEPTH) - 1;
1652 1653 1654
		dev->tagset.cmd_size = nvme_cmd_size(dev);
		dev->tagset.flags = BLK_MQ_F_SHOULD_MERGE;
		dev->tagset.driver_data = dev;
M
Matthew Wilcox 已提交
1655

1656 1657
		if (blk_mq_alloc_tag_set(&dev->tagset))
			return 0;
1658
		dev->ctrl.tagset = &dev->tagset;
1659 1660 1661 1662 1663
	} else {
		blk_mq_update_nr_hw_queues(&dev->tagset, dev->online_queues - 1);

		/* Free previously allocated queues that are no longer usable */
		nvme_free_queues(dev, dev->online_queues);
1664
	}
1665

1666
	queue_work(nvme_workq, &dev->scan_work);
K
Keith Busch 已提交
1667
	return 0;
M
Matthew Wilcox 已提交
1668 1669
}

1670 1671
static int nvme_dev_map(struct nvme_dev *dev)
{
K
Keith Busch 已提交
1672
	u64 cap;
1673
	int bars, result = -ENOMEM;
1674
	struct pci_dev *pdev = to_pci_dev(dev->dev);
1675 1676 1677 1678 1679 1680 1681

	if (pci_enable_device_mem(pdev))
		return result;

	dev->entry[0].vector = pdev->irq;
	pci_set_master(pdev);
	bars = pci_select_bars(pdev, IORESOURCE_MEM);
1682 1683 1684
	if (!bars)
		goto disable_pci;

1685 1686 1687
	if (pci_request_selected_regions(pdev, bars, "nvme"))
		goto disable_pci;

1688 1689
	if (dma_set_mask_and_coherent(dev->dev, DMA_BIT_MASK(64)) &&
	    dma_set_mask_and_coherent(dev->dev, DMA_BIT_MASK(32)))
1690
		goto disable;
1691 1692 1693 1694

	dev->bar = ioremap(pci_resource_start(pdev, 0), 8192);
	if (!dev->bar)
		goto disable;
1695

1696
	if (readl(dev->bar + NVME_REG_CSTS) == -1) {
K
Keith Busch 已提交
1697 1698 1699
		result = -ENODEV;
		goto unmap;
	}
1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710

	/*
	 * Some devices don't advertse INTx interrupts, pre-enable a single
	 * MSIX vec for setup. We'll adjust this later.
	 */
	if (!pdev->irq) {
		result = pci_enable_msix(pdev, dev->entry, 1);
		if (result < 0)
			goto unmap;
	}

1711 1712
	cap = lo_hi_readq(dev->bar + NVME_REG_CAP);

K
Keith Busch 已提交
1713 1714
	dev->q_depth = min_t(int, NVME_CAP_MQES(cap) + 1, NVME_Q_DEPTH);
	dev->db_stride = 1 << NVME_CAP_STRIDE(cap);
1715
	dev->dbs = dev->bar + 4096;
1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727

	/*
	 * Temporary fix for the Apple controller found in the MacBook8,1 and
	 * some MacBook7,1 to avoid controller resets and data loss.
	 */
	if (pdev->vendor == PCI_VENDOR_ID_APPLE && pdev->device == 0x2001) {
		dev->q_depth = 2;
		dev_warn(dev->dev, "detected Apple NVMe controller, set "
			"queue depth=%u to work around controller resets\n",
			dev->q_depth);
	}

1728
	if (readl(dev->bar + NVME_REG_VS) >= NVME_VS(1, 2))
1729
		dev->cmb = nvme_map_cmb(dev);
1730

K
Keith Busch 已提交
1731 1732
	pci_enable_pcie_error_reporting(pdev);
	pci_save_state(pdev);
1733 1734
	return 0;

K
Keith Busch 已提交
1735 1736 1737
 unmap:
	iounmap(dev->bar);
	dev->bar = NULL;
1738 1739 1740 1741 1742 1743 1744 1745 1746
 disable:
	pci_release_regions(pdev);
 disable_pci:
	pci_disable_device(pdev);
	return result;
}

static void nvme_dev_unmap(struct nvme_dev *dev)
{
1747 1748 1749 1750 1751 1752
	struct pci_dev *pdev = to_pci_dev(dev->dev);

	if (pdev->msi_enabled)
		pci_disable_msi(pdev);
	else if (pdev->msix_enabled)
		pci_disable_msix(pdev);
1753 1754 1755 1756

	if (dev->bar) {
		iounmap(dev->bar);
		dev->bar = NULL;
1757
		pci_release_regions(pdev);
1758 1759
	}

K
Keith Busch 已提交
1760 1761
	if (pci_is_enabled(pdev)) {
		pci_disable_pcie_error_reporting(pdev);
1762
		pci_disable_device(pdev);
K
Keith Busch 已提交
1763 1764 1765
	}
}

1766
static void nvme_dev_disable(struct nvme_dev *dev, bool shutdown)
M
Matthew Wilcox 已提交
1767
{
1768
	int i;
1769
	u32 csts = -1;
1770

1771
	del_timer_sync(&dev->watchdog_timer);
1772

1773
	mutex_lock(&dev->shutdown_lock);
1774
	if (dev->bar) {
1775
		nvme_stop_queues(&dev->ctrl);
1776
		csts = readl(dev->bar + NVME_REG_CSTS);
1777
	}
1778
	if (csts & NVME_CSTS_CFS || !(csts & NVME_CSTS_RDY)) {
K
Keith Busch 已提交
1779
		for (i = dev->queue_count - 1; i >= 0; i--) {
M
Matias Bjørling 已提交
1780
			struct nvme_queue *nvmeq = dev->queues[i];
K
Keith Busch 已提交
1781 1782 1783 1784
			nvme_suspend_queue(nvmeq);
		}
	} else {
		nvme_disable_io_queues(dev);
1785
		nvme_disable_admin_queue(dev, shutdown);
K
Keith Busch 已提交
1786
	}
1787
	nvme_dev_unmap(dev);
1788 1789 1790

	for (i = dev->queue_count - 1; i >= 0; i--)
		nvme_clear_queue(dev->queues[i]);
1791
	mutex_unlock(&dev->shutdown_lock);
M
Matthew Wilcox 已提交
1792 1793
}

M
Matthew Wilcox 已提交
1794 1795
static int nvme_setup_prp_pools(struct nvme_dev *dev)
{
1796
	dev->prp_page_pool = dma_pool_create("prp list page", dev->dev,
M
Matthew Wilcox 已提交
1797 1798 1799 1800
						PAGE_SIZE, PAGE_SIZE, 0);
	if (!dev->prp_page_pool)
		return -ENOMEM;

1801
	/* Optimisation for I/Os between 4k and 128k */
1802
	dev->prp_small_pool = dma_pool_create("prp list 256", dev->dev,
1803 1804 1805 1806 1807
						256, 256, 0);
	if (!dev->prp_small_pool) {
		dma_pool_destroy(dev->prp_page_pool);
		return -ENOMEM;
	}
M
Matthew Wilcox 已提交
1808 1809 1810 1811 1812 1813
	return 0;
}

static void nvme_release_prp_pools(struct nvme_dev *dev)
{
	dma_pool_destroy(dev->prp_page_pool);
1814
	dma_pool_destroy(dev->prp_small_pool);
M
Matthew Wilcox 已提交
1815 1816
}

1817
static void nvme_pci_free_ctrl(struct nvme_ctrl *ctrl)
1818
{
1819
	struct nvme_dev *dev = to_nvme_dev(ctrl);
1820

1821
	put_device(dev->dev);
1822 1823
	if (dev->tagset.tags)
		blk_mq_free_tag_set(&dev->tagset);
1824 1825
	if (dev->ctrl.admin_q)
		blk_put_queue(dev->ctrl.admin_q);
1826 1827 1828 1829 1830
	kfree(dev->queues);
	kfree(dev->entry);
	kfree(dev);
}

1831
static void nvme_reset_work(struct work_struct *work)
1832
{
1833
	struct nvme_dev *dev = container_of(work, struct nvme_dev, reset_work);
1834
	int result;
1835

1836 1837
	if (WARN_ON(test_bit(NVME_CTRL_RESETTING, &dev->flags)))
		goto out;
1838

1839 1840 1841 1842 1843
	/*
	 * If we're called to reset a live controller first shut it down before
	 * moving on.
	 */
	if (dev->bar)
1844
		nvme_dev_disable(dev, false);
1845

1846
	set_bit(NVME_CTRL_RESETTING, &dev->flags);
1847 1848 1849

	result = nvme_dev_map(dev);
	if (result)
1850
		goto out;
1851 1852 1853 1854 1855

	result = nvme_configure_admin_queue(dev);
	if (result)
		goto unmap;

M
Matias Bjørling 已提交
1856
	nvme_init_queue(dev->queues[0], 0);
K
Keith Busch 已提交
1857 1858 1859
	result = nvme_alloc_admin_tags(dev);
	if (result)
		goto disable;
1860

1861 1862 1863 1864
	result = nvme_init_identify(&dev->ctrl);
	if (result)
		goto free_tags;

1865
	result = nvme_setup_io_queues(dev);
1866
	if (result)
K
Keith Busch 已提交
1867
		goto free_tags;
1868

1869
	dev->ctrl.event_limit = NVME_NR_AEN_COMMANDS;
1870
	queue_work(nvme_workq, &dev->async_work);
1871

1872
	mod_timer(&dev->watchdog_timer, round_jiffies(jiffies + HZ));
1873

1874 1875 1876 1877
	/*
	 * Keep the controller around but remove all namespaces if we don't have
	 * any working I/O queue.
	 */
1878
	if (dev->online_queues < 2) {
1879
		dev_warn(dev->ctrl.device, "IO queues not created\n");
1880
		nvme_remove_namespaces(&dev->ctrl);
1881
	} else {
1882
		nvme_start_queues(&dev->ctrl);
1883 1884 1885
		nvme_dev_add(dev);
	}

1886
	clear_bit(NVME_CTRL_RESETTING, &dev->flags);
1887
	return;
1888

K
Keith Busch 已提交
1889 1890
 free_tags:
	nvme_dev_remove_admin(dev);
1891 1892
	blk_put_queue(dev->ctrl.admin_q);
	dev->ctrl.admin_q = NULL;
1893
	dev->queues[0]->tags = NULL;
1894
 disable:
1895
	nvme_disable_admin_queue(dev, false);
1896 1897
 unmap:
	nvme_dev_unmap(dev);
1898
 out:
1899
	nvme_remove_dead_ctrl(dev);
1900 1901
}

1902
static void nvme_remove_dead_ctrl_work(struct work_struct *work)
K
Keith Busch 已提交
1903
{
1904
	struct nvme_dev *dev = container_of(work, struct nvme_dev, remove_work);
1905
	struct pci_dev *pdev = to_pci_dev(dev->dev);
K
Keith Busch 已提交
1906 1907

	if (pci_get_drvdata(pdev))
1908
		pci_stop_and_remove_bus_device_locked(pdev);
1909
	nvme_put_ctrl(&dev->ctrl);
K
Keith Busch 已提交
1910 1911
}

1912
static void nvme_remove_dead_ctrl(struct nvme_dev *dev)
1913
{
1914
	dev_warn(dev->ctrl.device, "Removing after probe failure\n");
1915
	kref_get(&dev->ctrl.kref);
1916
	if (!schedule_work(&dev->remove_work))
1917
		nvme_put_ctrl(&dev->ctrl);
1918 1919
}

1920
static int nvme_reset(struct nvme_dev *dev)
K
Keith Busch 已提交
1921
{
1922
	if (!dev->ctrl.admin_q || blk_queue_dying(dev->ctrl.admin_q))
1923
		return -ENODEV;
1924

C
Christoph Hellwig 已提交
1925 1926
	if (!queue_work(nvme_workq, &dev->reset_work))
		return -EBUSY;
1927

C
Christoph Hellwig 已提交
1928 1929
	flush_work(&dev->reset_work);
	return 0;
K
Keith Busch 已提交
1930 1931
}

1932
static int nvme_pci_reg_read32(struct nvme_ctrl *ctrl, u32 off, u32 *val)
T
Tejun Heo 已提交
1933
{
1934
	*val = readl(to_nvme_dev(ctrl)->bar + off);
1935
	return 0;
T
Tejun Heo 已提交
1936 1937
}

1938
static int nvme_pci_reg_write32(struct nvme_ctrl *ctrl, u32 off, u32 val)
1939
{
1940 1941 1942
	writel(val, to_nvme_dev(ctrl)->bar + off);
	return 0;
}
1943

1944 1945 1946 1947
static int nvme_pci_reg_read64(struct nvme_ctrl *ctrl, u32 off, u64 *val)
{
	*val = readq(to_nvme_dev(ctrl)->bar + off);
	return 0;
1948 1949
}

1950
static bool nvme_pci_io_incapable(struct nvme_ctrl *ctrl)
1951
{
1952
	struct nvme_dev *dev = to_nvme_dev(ctrl);
1953

1954 1955
	return !dev->bar || dev->online_queues < 2;
}
1956

1957 1958 1959
static int nvme_pci_reset_ctrl(struct nvme_ctrl *ctrl)
{
	return nvme_reset(to_nvme_dev(ctrl));
1960
}
1961

1962
static const struct nvme_ctrl_ops nvme_pci_ctrl_ops = {
1963
	.module			= THIS_MODULE,
1964
	.reg_read32		= nvme_pci_reg_read32,
1965
	.reg_write32		= nvme_pci_reg_write32,
1966
	.reg_read64		= nvme_pci_reg_read64,
1967
	.io_incapable		= nvme_pci_io_incapable,
1968
	.reset_ctrl		= nvme_pci_reset_ctrl,
1969
	.free_ctrl		= nvme_pci_free_ctrl,
1970
};
1971

1972
static int nvme_probe(struct pci_dev *pdev, const struct pci_device_id *id)
M
Matthew Wilcox 已提交
1973
{
M
Matias Bjørling 已提交
1974
	int node, result = -ENOMEM;
M
Matthew Wilcox 已提交
1975 1976
	struct nvme_dev *dev;

M
Matias Bjørling 已提交
1977 1978 1979 1980 1981
	node = dev_to_node(&pdev->dev);
	if (node == NUMA_NO_NODE)
		set_dev_node(&pdev->dev, 0);

	dev = kzalloc_node(sizeof(*dev), GFP_KERNEL, node);
M
Matthew Wilcox 已提交
1982 1983
	if (!dev)
		return -ENOMEM;
M
Matias Bjørling 已提交
1984 1985
	dev->entry = kzalloc_node(num_possible_cpus() * sizeof(*dev->entry),
							GFP_KERNEL, node);
M
Matthew Wilcox 已提交
1986 1987
	if (!dev->entry)
		goto free;
M
Matias Bjørling 已提交
1988 1989
	dev->queues = kzalloc_node((num_possible_cpus() + 1) * sizeof(void *),
							GFP_KERNEL, node);
M
Matthew Wilcox 已提交
1990 1991 1992
	if (!dev->queues)
		goto free;

1993
	dev->dev = get_device(&pdev->dev);
K
Keith Busch 已提交
1994
	pci_set_drvdata(pdev, dev);
1995

1996 1997
	INIT_WORK(&dev->scan_work, nvme_dev_scan);
	INIT_WORK(&dev->reset_work, nvme_reset_work);
1998
	INIT_WORK(&dev->remove_work, nvme_remove_dead_ctrl_work);
1999
	INIT_WORK(&dev->async_work, nvme_async_event_work);
2000 2001
	setup_timer(&dev->watchdog_timer, nvme_watchdog_timer,
		(unsigned long)dev);
2002
	mutex_init(&dev->shutdown_lock);
K
Keith Busch 已提交
2003
	init_completion(&dev->ioq_wait);
M
Matthew Wilcox 已提交
2004

M
Matthew Wilcox 已提交
2005 2006
	result = nvme_setup_prp_pools(dev);
	if (result)
K
Keith Busch 已提交
2007
		goto put_pci;
2008

2009 2010
	result = nvme_init_ctrl(&dev->ctrl, &pdev->dev, &nvme_pci_ctrl_ops,
			id->driver_data);
2011
	if (result)
2012
		goto release_pools;
2013

2014 2015
	dev_info(dev->ctrl.device, "pci function %s\n", dev_name(&pdev->dev));

2016
	queue_work(nvme_workq, &dev->reset_work);
M
Matthew Wilcox 已提交
2017 2018
	return 0;

2019
 release_pools:
M
Matthew Wilcox 已提交
2020
	nvme_release_prp_pools(dev);
K
Keith Busch 已提交
2021
 put_pci:
2022
	put_device(dev->dev);
M
Matthew Wilcox 已提交
2023 2024 2025 2026 2027 2028 2029
 free:
	kfree(dev->queues);
	kfree(dev->entry);
	kfree(dev);
	return result;
}

2030 2031
static void nvme_reset_notify(struct pci_dev *pdev, bool prepare)
{
K
Keith Busch 已提交
2032
	struct nvme_dev *dev = pci_get_drvdata(pdev);
2033

K
Keith Busch 已提交
2034
	if (prepare)
2035
		nvme_dev_disable(dev, false);
K
Keith Busch 已提交
2036
	else
2037
		queue_work(nvme_workq, &dev->reset_work);
2038 2039
}

2040 2041 2042
static void nvme_shutdown(struct pci_dev *pdev)
{
	struct nvme_dev *dev = pci_get_drvdata(pdev);
2043
	nvme_dev_disable(dev, true);
2044 2045
}

2046
static void nvme_remove(struct pci_dev *pdev)
M
Matthew Wilcox 已提交
2047 2048
{
	struct nvme_dev *dev = pci_get_drvdata(pdev);
K
Keith Busch 已提交
2049

2050
	del_timer_sync(&dev->watchdog_timer);
K
Keith Busch 已提交
2051 2052

	pci_set_drvdata(pdev, NULL);
2053
	flush_work(&dev->async_work);
K
Keith Busch 已提交
2054
	flush_work(&dev->reset_work);
K
Keith Busch 已提交
2055
	flush_work(&dev->scan_work);
2056
	nvme_remove_namespaces(&dev->ctrl);
2057
	nvme_uninit_ctrl(&dev->ctrl);
2058
	nvme_dev_disable(dev, true);
M
Matias Bjørling 已提交
2059
	nvme_dev_remove_admin(dev);
2060
	nvme_free_queues(dev, 0);
2061
	nvme_release_cmb(dev);
K
Keith Busch 已提交
2062
	nvme_release_prp_pools(dev);
2063
	nvme_put_ctrl(&dev->ctrl);
M
Matthew Wilcox 已提交
2064 2065
}

2066
#ifdef CONFIG_PM_SLEEP
2067 2068 2069 2070 2071
static int nvme_suspend(struct device *dev)
{
	struct pci_dev *pdev = to_pci_dev(dev);
	struct nvme_dev *ndev = pci_get_drvdata(pdev);

2072
	nvme_dev_disable(ndev, true);
2073 2074 2075 2076 2077 2078 2079 2080
	return 0;
}

static int nvme_resume(struct device *dev)
{
	struct pci_dev *pdev = to_pci_dev(dev);
	struct nvme_dev *ndev = pci_get_drvdata(pdev);

2081
	queue_work(nvme_workq, &ndev->reset_work);
K
Keith Busch 已提交
2082
	return 0;
2083
}
2084
#endif
2085 2086

static SIMPLE_DEV_PM_OPS(nvme_dev_pm_ops, nvme_suspend, nvme_resume);
M
Matthew Wilcox 已提交
2087

K
Keith Busch 已提交
2088 2089 2090 2091 2092 2093 2094 2095 2096 2097
static pci_ers_result_t nvme_error_detected(struct pci_dev *pdev,
						pci_channel_state_t state)
{
	struct nvme_dev *dev = pci_get_drvdata(pdev);

	/*
	 * A frozen channel requires a reset. When detected, this method will
	 * shutdown the controller to quiesce. The controller will be restarted
	 * after the slot reset through driver's slot_reset callback.
	 */
2098
	dev_warn(dev->ctrl.device, "error detected: state:%d\n", state);
K
Keith Busch 已提交
2099 2100 2101 2102
	switch (state) {
	case pci_channel_io_normal:
		return PCI_ERS_RESULT_CAN_RECOVER;
	case pci_channel_io_frozen:
2103
		nvme_dev_disable(dev, false);
K
Keith Busch 已提交
2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114
		return PCI_ERS_RESULT_NEED_RESET;
	case pci_channel_io_perm_failure:
		return PCI_ERS_RESULT_DISCONNECT;
	}
	return PCI_ERS_RESULT_NEED_RESET;
}

static pci_ers_result_t nvme_slot_reset(struct pci_dev *pdev)
{
	struct nvme_dev *dev = pci_get_drvdata(pdev);

2115
	dev_info(dev->ctrl.device, "restart after slot reset\n");
K
Keith Busch 已提交
2116 2117 2118 2119 2120 2121 2122 2123 2124 2125
	pci_restore_state(pdev);
	queue_work(nvme_workq, &dev->reset_work);
	return PCI_ERS_RESULT_RECOVERED;
}

static void nvme_error_resume(struct pci_dev *pdev)
{
	pci_cleanup_aer_uncorrect_error_status(pdev);
}

2126
static const struct pci_error_handlers nvme_err_handler = {
M
Matthew Wilcox 已提交
2127 2128 2129
	.error_detected	= nvme_error_detected,
	.slot_reset	= nvme_slot_reset,
	.resume		= nvme_error_resume,
2130
	.reset_notify	= nvme_reset_notify,
M
Matthew Wilcox 已提交
2131 2132 2133 2134 2135
};

/* Move to pci_ids.h later */
#define PCI_CLASS_STORAGE_EXPRESS	0x010802

2136
static const struct pci_device_id nvme_id_table[] = {
2137 2138
	{ PCI_VDEVICE(INTEL, 0x0953),
		.driver_data = NVME_QUIRK_STRIPE_SIZE, },
2139 2140
	{ PCI_VDEVICE(INTEL, 0x5845),	/* Qemu emulated controller */
		.driver_data = NVME_QUIRK_IDENTIFY_CNS, },
M
Matthew Wilcox 已提交
2141
	{ PCI_DEVICE_CLASS(PCI_CLASS_STORAGE_EXPRESS, 0xffffff) },
2142
	{ PCI_DEVICE(PCI_VENDOR_ID_APPLE, 0x2001) },
M
Matthew Wilcox 已提交
2143 2144 2145 2146 2147 2148 2149 2150
	{ 0, }
};
MODULE_DEVICE_TABLE(pci, nvme_id_table);

static struct pci_driver nvme_driver = {
	.name		= "nvme",
	.id_table	= nvme_id_table,
	.probe		= nvme_probe,
2151
	.remove		= nvme_remove,
2152
	.shutdown	= nvme_shutdown,
2153 2154 2155
	.driver		= {
		.pm	= &nvme_dev_pm_ops,
	},
M
Matthew Wilcox 已提交
2156 2157 2158 2159 2160
	.err_handler	= &nvme_err_handler,
};

static int __init nvme_init(void)
{
2161
	int result;
2162

2163
	nvme_workq = alloc_workqueue("nvme", WQ_UNBOUND | WQ_MEM_RECLAIM, 0);
K
Keith Busch 已提交
2164
	if (!nvme_workq)
2165
		return -ENOMEM;
K
Keith Busch 已提交
2166

2167 2168
	result = pci_register_driver(&nvme_driver);
	if (result)
2169
		destroy_workqueue(nvme_workq);
M
Matthew Wilcox 已提交
2170 2171 2172 2173 2174 2175
	return result;
}

static void __exit nvme_exit(void)
{
	pci_unregister_driver(&nvme_driver);
K
Keith Busch 已提交
2176
	destroy_workqueue(nvme_workq);
2177
	_nvme_check_size();
M
Matthew Wilcox 已提交
2178 2179 2180 2181
}

MODULE_AUTHOR("Matthew Wilcox <willy@linux.intel.com>");
MODULE_LICENSE("GPL");
2182
MODULE_VERSION("1.0");
M
Matthew Wilcox 已提交
2183 2184
module_init(nvme_init);
module_exit(nvme_exit);