Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1 | /* |
| 2 | * NVM Express device driver |
Matthew Wilcox | 6eb0d69 | 2014-03-24 10:11:22 -0400 | [diff] [blame] | 3 | * Copyright (c) 2011-2014, Intel Corporation. |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 4 | * |
| 5 | * This program is free software; you can redistribute it and/or modify it |
| 6 | * under the terms and conditions of the GNU General Public License, |
| 7 | * version 2, as published by the Free Software Foundation. |
| 8 | * |
| 9 | * This program is distributed in the hope it will be useful, but WITHOUT |
| 10 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| 11 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| 12 | * more details. |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 13 | */ |
| 14 | |
Keith Busch | a0a3408 | 2015-12-07 15:30:31 -0700 | [diff] [blame] | 15 | #include <linux/aer.h> |
Keith Busch | 18119775 | 2018-04-27 13:42:52 -0600 | [diff] [blame] | 16 | #include <linux/async.h> |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 17 | #include <linux/blkdev.h> |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 18 | #include <linux/blk-mq.h> |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 19 | #include <linux/blk-mq-pci.h> |
Andy Lutomirski | ff5350a | 2017-04-20 13:37:55 -0700 | [diff] [blame] | 20 | #include <linux/dmi.h> |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 21 | #include <linux/init.h> |
| 22 | #include <linux/interrupt.h> |
| 23 | #include <linux/io.h> |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 24 | #include <linux/mm.h> |
| 25 | #include <linux/module.h> |
Keith Busch | 77bf25e | 2015-11-26 12:21:29 +0100 | [diff] [blame] | 26 | #include <linux/mutex.h> |
Keith Busch | d087747 | 2017-09-15 13:05:38 -0400 | [diff] [blame] | 27 | #include <linux/once.h> |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 28 | #include <linux/pci.h> |
Keith Busch | e1e5e56 | 2015-02-19 13:39:03 -0700 | [diff] [blame] | 29 | #include <linux/t10-pi.h> |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 30 | #include <linux/types.h> |
Linus Torvalds | 9cf5c09 | 2015-11-06 14:22:15 -0800 | [diff] [blame] | 31 | #include <linux/io-64-nonatomic-lo-hi.h> |
Scott Bauer | a98e58e5 | 2017-02-03 12:50:32 -0700 | [diff] [blame] | 32 | #include <linux/sed-opal.h> |
Hitoshi Mitake | 797a796 | 2012-02-07 11:45:33 +0900 | [diff] [blame] | 33 | |
Christoph Hellwig | f11bb3e | 2015-10-03 15:46:41 +0200 | [diff] [blame] | 34 | #include "nvme.h" |
| 35 | |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 36 | #define SQ_SIZE(depth) (depth * sizeof(struct nvme_command)) |
| 37 | #define CQ_SIZE(depth) (depth * sizeof(struct nvme_completion)) |
Stephen Bates | c965809 | 2016-12-16 11:54:50 -0700 | [diff] [blame] | 38 | |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 39 | #define SGES_PER_PAGE (PAGE_SIZE / sizeof(struct nvme_sgl_desc)) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 40 | |
Matthew Wilcox | 58ffacb | 2011-02-06 07:28:06 -0500 | [diff] [blame] | 41 | static int use_threaded_interrupts; |
| 42 | module_param(use_threaded_interrupts, int, 0); |
| 43 | |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 44 | static bool use_cmb_sqes = true; |
| 45 | module_param(use_cmb_sqes, bool, 0644); |
| 46 | MODULE_PARM_DESC(use_cmb_sqes, "use controller's memory buffer for I/O SQes"); |
| 47 | |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 48 | static unsigned int max_host_mem_size_mb = 128; |
| 49 | module_param(max_host_mem_size_mb, uint, 0444); |
| 50 | MODULE_PARM_DESC(max_host_mem_size_mb, |
| 51 | "Maximum Host Memory Buffer (HMB) size per controller (in MiB)"); |
Matthew Wilcox | 1fa6aea | 2011-03-02 18:37:18 -0500 | [diff] [blame] | 52 | |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 53 | static unsigned int sgl_threshold = SZ_32K; |
| 54 | module_param(sgl_threshold, uint, 0644); |
| 55 | MODULE_PARM_DESC(sgl_threshold, |
| 56 | "Use SGLs when average request segment size is larger or equal to " |
| 57 | "this size. Use 0 to disable SGLs."); |
| 58 | |
weiping zhang | b27c1e6 | 2017-07-10 16:46:59 +0800 | [diff] [blame] | 59 | static int io_queue_depth_set(const char *val, const struct kernel_param *kp); |
| 60 | static const struct kernel_param_ops io_queue_depth_ops = { |
| 61 | .set = io_queue_depth_set, |
| 62 | .get = param_get_int, |
| 63 | }; |
| 64 | |
| 65 | static int io_queue_depth = 1024; |
| 66 | module_param_cb(io_queue_depth, &io_queue_depth_ops, &io_queue_depth, 0644); |
| 67 | MODULE_PARM_DESC(io_queue_depth, "set io queue depth, should >= 2"); |
| 68 | |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 69 | struct nvme_dev; |
| 70 | struct nvme_queue; |
Keith Busch | b3fffde | 2015-02-03 11:21:42 -0700 | [diff] [blame] | 71 | |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 72 | static void nvme_dev_disable(struct nvme_dev *dev, bool shutdown); |
Keith Busch | d4b4ff8 | 2013-12-10 13:10:37 -0700 | [diff] [blame] | 73 | |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 74 | /* |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 75 | * Represents an NVM Express device. Each nvme_dev is a PCI function. |
| 76 | */ |
| 77 | struct nvme_dev { |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 78 | struct nvme_queue *queues; |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 79 | struct blk_mq_tag_set tagset; |
| 80 | struct blk_mq_tag_set admin_tagset; |
| 81 | u32 __iomem *dbs; |
| 82 | struct device *dev; |
| 83 | struct dma_pool *prp_page_pool; |
| 84 | struct dma_pool *prp_small_pool; |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 85 | unsigned online_queues; |
| 86 | unsigned max_qid; |
Keith Busch | 22b5560 | 2018-04-12 09:16:10 -0600 | [diff] [blame] | 87 | unsigned int num_vecs; |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 88 | int q_depth; |
| 89 | u32 db_stride; |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 90 | void __iomem *bar; |
Xu Yu | 97f6ef6 | 2017-05-24 16:39:55 +0800 | [diff] [blame] | 91 | unsigned long bar_mapped_size; |
Christoph Hellwig | 5c8809e | 2015-11-26 12:35:49 +0100 | [diff] [blame] | 92 | struct work_struct remove_work; |
Keith Busch | 77bf25e | 2015-11-26 12:21:29 +0100 | [diff] [blame] | 93 | struct mutex shutdown_lock; |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 94 | bool subsystem; |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 95 | void __iomem *cmb; |
Christoph Hellwig | 8969f1f | 2017-10-01 09:37:35 +0200 | [diff] [blame] | 96 | pci_bus_addr_t cmb_bus_addr; |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 97 | u64 cmb_size; |
| 98 | u32 cmbsz; |
Stephen Bates | 202021c | 2016-10-05 20:01:12 -0600 | [diff] [blame] | 99 | u32 cmbloc; |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 100 | struct nvme_ctrl ctrl; |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 101 | struct completion ioq_wait; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 102 | |
| 103 | /* shadow doorbell buffer support: */ |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 104 | u32 *dbbuf_dbs; |
| 105 | dma_addr_t dbbuf_dbs_dma_addr; |
| 106 | u32 *dbbuf_eis; |
| 107 | dma_addr_t dbbuf_eis_dma_addr; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 108 | |
| 109 | /* host memory buffer support: */ |
| 110 | u64 host_mem_size; |
| 111 | u32 nr_host_mem_descs; |
Christoph Hellwig | 4033f35 | 2017-08-28 10:47:18 +0200 | [diff] [blame] | 112 | dma_addr_t host_mem_descs_dma; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 113 | struct nvme_host_mem_buf_desc *host_mem_descs; |
| 114 | void **host_mem_desc_bufs; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 115 | }; |
| 116 | |
weiping zhang | b27c1e6 | 2017-07-10 16:46:59 +0800 | [diff] [blame] | 117 | static int io_queue_depth_set(const char *val, const struct kernel_param *kp) |
| 118 | { |
| 119 | int n = 0, ret; |
| 120 | |
| 121 | ret = kstrtoint(val, 10, &n); |
| 122 | if (ret != 0 || n < 2) |
| 123 | return -EINVAL; |
| 124 | |
| 125 | return param_set_int(val, kp); |
| 126 | } |
| 127 | |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 128 | static inline unsigned int sq_idx(unsigned int qid, u32 stride) |
| 129 | { |
| 130 | return qid * 2 * stride; |
| 131 | } |
| 132 | |
| 133 | static inline unsigned int cq_idx(unsigned int qid, u32 stride) |
| 134 | { |
| 135 | return (qid * 2 + 1) * stride; |
| 136 | } |
| 137 | |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 138 | static inline struct nvme_dev *to_nvme_dev(struct nvme_ctrl *ctrl) |
| 139 | { |
| 140 | return container_of(ctrl, struct nvme_dev, ctrl); |
| 141 | } |
| 142 | |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 143 | /* |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 144 | * An NVM Express queue. Each device has at least two (one for admin |
| 145 | * commands and one for I/O commands). |
| 146 | */ |
| 147 | struct nvme_queue { |
| 148 | struct device *q_dmadev; |
Matthew Wilcox | 091b609 | 2011-02-10 09:56:01 -0500 | [diff] [blame] | 149 | struct nvme_dev *dev; |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 150 | spinlock_t sq_lock; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 151 | struct nvme_command *sq_cmds; |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 152 | struct nvme_command __iomem *sq_cmds_io; |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 153 | spinlock_t cq_lock ____cacheline_aligned_in_smp; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 154 | volatile struct nvme_completion *cqes; |
Keith Busch | 4248322 | 2015-06-01 09:29:54 -0600 | [diff] [blame] | 155 | struct blk_mq_tags **tags; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 156 | dma_addr_t sq_dma_addr; |
| 157 | dma_addr_t cq_dma_addr; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 158 | u32 __iomem *q_db; |
| 159 | u16 q_depth; |
Jens Axboe | 6222d17 | 2015-01-15 15:19:10 -0700 | [diff] [blame] | 160 | s16 cq_vector; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 161 | u16 sq_tail; |
| 162 | u16 cq_head; |
Jens Axboe | 68fa9db | 2018-05-21 08:41:52 -0600 | [diff] [blame] | 163 | u16 last_cq_head; |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 164 | u16 qid; |
Matthew Wilcox | e9539f4 | 2013-06-24 11:47:34 -0400 | [diff] [blame] | 165 | u8 cq_phase; |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 166 | u32 *dbbuf_sq_db; |
| 167 | u32 *dbbuf_cq_db; |
| 168 | u32 *dbbuf_sq_ei; |
| 169 | u32 *dbbuf_cq_ei; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 170 | }; |
| 171 | |
| 172 | /* |
Christoph Hellwig | 71bd150 | 2015-10-16 07:58:32 +0200 | [diff] [blame] | 173 | * The nvme_iod describes the data in an I/O, including the list of PRP |
| 174 | * entries. You can't see it in this data structure because C doesn't let |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 175 | * me express that. Use nvme_init_iod to ensure there's enough space |
Christoph Hellwig | 71bd150 | 2015-10-16 07:58:32 +0200 | [diff] [blame] | 176 | * allocated to store the PRP list. |
| 177 | */ |
| 178 | struct nvme_iod { |
Christoph Hellwig | d49187e | 2016-11-10 07:32:33 -0800 | [diff] [blame] | 179 | struct nvme_request req; |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 180 | struct nvme_queue *nvmeq; |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 181 | bool use_sgl; |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 182 | int aborted; |
Christoph Hellwig | 71bd150 | 2015-10-16 07:58:32 +0200 | [diff] [blame] | 183 | int npages; /* In the PRP list. 0 means small pool in use */ |
Christoph Hellwig | 71bd150 | 2015-10-16 07:58:32 +0200 | [diff] [blame] | 184 | int nents; /* Used in scatterlist */ |
| 185 | int length; /* Of data, in bytes */ |
| 186 | dma_addr_t first_dma; |
Christoph Hellwig | bf68405 | 2015-10-26 17:12:51 +0900 | [diff] [blame] | 187 | struct scatterlist meta_sg; /* metadata requires single contiguous buffer */ |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 188 | struct scatterlist *sg; |
| 189 | struct scatterlist inline_sg[0]; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 190 | }; |
| 191 | |
| 192 | /* |
| 193 | * Check we didin't inadvertently grow the command struct |
| 194 | */ |
| 195 | static inline void _nvme_check_size(void) |
| 196 | { |
| 197 | BUILD_BUG_ON(sizeof(struct nvme_rw_command) != 64); |
| 198 | BUILD_BUG_ON(sizeof(struct nvme_create_cq) != 64); |
| 199 | BUILD_BUG_ON(sizeof(struct nvme_create_sq) != 64); |
| 200 | BUILD_BUG_ON(sizeof(struct nvme_delete_queue) != 64); |
| 201 | BUILD_BUG_ON(sizeof(struct nvme_features) != 64); |
Vishal Verma | f8ebf84 | 2013-03-27 07:13:41 -0400 | [diff] [blame] | 202 | BUILD_BUG_ON(sizeof(struct nvme_format_cmd) != 64); |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 203 | BUILD_BUG_ON(sizeof(struct nvme_abort_cmd) != 64); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 204 | BUILD_BUG_ON(sizeof(struct nvme_command) != 64); |
Johannes Thumshirn | 0add5e8 | 2017-06-07 11:45:29 +0200 | [diff] [blame] | 205 | BUILD_BUG_ON(sizeof(struct nvme_id_ctrl) != NVME_IDENTIFY_DATA_SIZE); |
| 206 | BUILD_BUG_ON(sizeof(struct nvme_id_ns) != NVME_IDENTIFY_DATA_SIZE); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 207 | BUILD_BUG_ON(sizeof(struct nvme_lba_range_type) != 64); |
Keith Busch | 6ecec74 | 2012-09-26 12:49:27 -0600 | [diff] [blame] | 208 | BUILD_BUG_ON(sizeof(struct nvme_smart_log) != 512); |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 209 | BUILD_BUG_ON(sizeof(struct nvme_dbbuf) != 64); |
| 210 | } |
| 211 | |
| 212 | static inline unsigned int nvme_dbbuf_size(u32 stride) |
| 213 | { |
| 214 | return ((num_possible_cpus() + 1) * 8 * stride); |
| 215 | } |
| 216 | |
| 217 | static int nvme_dbbuf_dma_alloc(struct nvme_dev *dev) |
| 218 | { |
| 219 | unsigned int mem_size = nvme_dbbuf_size(dev->db_stride); |
| 220 | |
| 221 | if (dev->dbbuf_dbs) |
| 222 | return 0; |
| 223 | |
| 224 | dev->dbbuf_dbs = dma_alloc_coherent(dev->dev, mem_size, |
| 225 | &dev->dbbuf_dbs_dma_addr, |
| 226 | GFP_KERNEL); |
| 227 | if (!dev->dbbuf_dbs) |
| 228 | return -ENOMEM; |
| 229 | dev->dbbuf_eis = dma_alloc_coherent(dev->dev, mem_size, |
| 230 | &dev->dbbuf_eis_dma_addr, |
| 231 | GFP_KERNEL); |
| 232 | if (!dev->dbbuf_eis) { |
| 233 | dma_free_coherent(dev->dev, mem_size, |
| 234 | dev->dbbuf_dbs, dev->dbbuf_dbs_dma_addr); |
| 235 | dev->dbbuf_dbs = NULL; |
| 236 | return -ENOMEM; |
| 237 | } |
| 238 | |
| 239 | return 0; |
| 240 | } |
| 241 | |
| 242 | static void nvme_dbbuf_dma_free(struct nvme_dev *dev) |
| 243 | { |
| 244 | unsigned int mem_size = nvme_dbbuf_size(dev->db_stride); |
| 245 | |
| 246 | if (dev->dbbuf_dbs) { |
| 247 | dma_free_coherent(dev->dev, mem_size, |
| 248 | dev->dbbuf_dbs, dev->dbbuf_dbs_dma_addr); |
| 249 | dev->dbbuf_dbs = NULL; |
| 250 | } |
| 251 | if (dev->dbbuf_eis) { |
| 252 | dma_free_coherent(dev->dev, mem_size, |
| 253 | dev->dbbuf_eis, dev->dbbuf_eis_dma_addr); |
| 254 | dev->dbbuf_eis = NULL; |
| 255 | } |
| 256 | } |
| 257 | |
| 258 | static void nvme_dbbuf_init(struct nvme_dev *dev, |
| 259 | struct nvme_queue *nvmeq, int qid) |
| 260 | { |
| 261 | if (!dev->dbbuf_dbs || !qid) |
| 262 | return; |
| 263 | |
| 264 | nvmeq->dbbuf_sq_db = &dev->dbbuf_dbs[sq_idx(qid, dev->db_stride)]; |
| 265 | nvmeq->dbbuf_cq_db = &dev->dbbuf_dbs[cq_idx(qid, dev->db_stride)]; |
| 266 | nvmeq->dbbuf_sq_ei = &dev->dbbuf_eis[sq_idx(qid, dev->db_stride)]; |
| 267 | nvmeq->dbbuf_cq_ei = &dev->dbbuf_eis[cq_idx(qid, dev->db_stride)]; |
| 268 | } |
| 269 | |
| 270 | static void nvme_dbbuf_set(struct nvme_dev *dev) |
| 271 | { |
| 272 | struct nvme_command c; |
| 273 | |
| 274 | if (!dev->dbbuf_dbs) |
| 275 | return; |
| 276 | |
| 277 | memset(&c, 0, sizeof(c)); |
| 278 | c.dbbuf.opcode = nvme_admin_dbbuf; |
| 279 | c.dbbuf.prp1 = cpu_to_le64(dev->dbbuf_dbs_dma_addr); |
| 280 | c.dbbuf.prp2 = cpu_to_le64(dev->dbbuf_eis_dma_addr); |
| 281 | |
| 282 | if (nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0)) { |
Christoph Hellwig | 9bdcfb1 | 2017-05-20 15:14:43 +0200 | [diff] [blame] | 283 | dev_warn(dev->ctrl.device, "unable to set dbbuf\n"); |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 284 | /* Free memory and continue on */ |
| 285 | nvme_dbbuf_dma_free(dev); |
| 286 | } |
| 287 | } |
| 288 | |
| 289 | static inline int nvme_dbbuf_need_event(u16 event_idx, u16 new_idx, u16 old) |
| 290 | { |
| 291 | return (u16)(new_idx - event_idx - 1) < (u16)(new_idx - old); |
| 292 | } |
| 293 | |
| 294 | /* Update dbbuf and return true if an MMIO is required */ |
| 295 | static bool nvme_dbbuf_update_and_check_event(u16 value, u32 *dbbuf_db, |
| 296 | volatile u32 *dbbuf_ei) |
| 297 | { |
| 298 | if (dbbuf_db) { |
| 299 | u16 old_value; |
| 300 | |
| 301 | /* |
| 302 | * Ensure that the queue is written before updating |
| 303 | * the doorbell in memory |
| 304 | */ |
| 305 | wmb(); |
| 306 | |
| 307 | old_value = *dbbuf_db; |
| 308 | *dbbuf_db = value; |
| 309 | |
| 310 | if (!nvme_dbbuf_need_event(*dbbuf_ei, value, old_value)) |
| 311 | return false; |
| 312 | } |
| 313 | |
| 314 | return true; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 315 | } |
| 316 | |
Jens Axboe | ac3dd5b | 2015-01-22 12:07:58 -0700 | [diff] [blame] | 317 | /* |
| 318 | * Max size of iod being embedded in the request payload |
| 319 | */ |
| 320 | #define NVME_INT_PAGES 2 |
Christoph Hellwig | 5fd4ce1 | 2015-11-28 15:03:49 +0100 | [diff] [blame] | 321 | #define NVME_INT_BYTES(dev) (NVME_INT_PAGES * (dev)->ctrl.page_size) |
Jens Axboe | ac3dd5b | 2015-01-22 12:07:58 -0700 | [diff] [blame] | 322 | |
| 323 | /* |
| 324 | * Will slightly overestimate the number of pages needed. This is OK |
| 325 | * as it only leads to a small amount of wasted memory for the lifetime of |
| 326 | * the I/O. |
| 327 | */ |
| 328 | static int nvme_npages(unsigned size, struct nvme_dev *dev) |
| 329 | { |
Christoph Hellwig | 5fd4ce1 | 2015-11-28 15:03:49 +0100 | [diff] [blame] | 330 | unsigned nprps = DIV_ROUND_UP(size + dev->ctrl.page_size, |
| 331 | dev->ctrl.page_size); |
Jens Axboe | ac3dd5b | 2015-01-22 12:07:58 -0700 | [diff] [blame] | 332 | return DIV_ROUND_UP(8 * nprps, PAGE_SIZE - 8); |
| 333 | } |
| 334 | |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 335 | /* |
| 336 | * Calculates the number of pages needed for the SGL segments. For example a 4k |
| 337 | * page can accommodate 256 SGL descriptors. |
| 338 | */ |
| 339 | static int nvme_pci_npages_sgl(unsigned int num_seg) |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 340 | { |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 341 | return DIV_ROUND_UP(num_seg * sizeof(struct nvme_sgl_desc), PAGE_SIZE); |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 342 | } |
| 343 | |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 344 | static unsigned int nvme_pci_iod_alloc_size(struct nvme_dev *dev, |
| 345 | unsigned int size, unsigned int nseg, bool use_sgl) |
Jens Axboe | ac3dd5b | 2015-01-22 12:07:58 -0700 | [diff] [blame] | 346 | { |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 347 | size_t alloc_size; |
| 348 | |
| 349 | if (use_sgl) |
| 350 | alloc_size = sizeof(__le64 *) * nvme_pci_npages_sgl(nseg); |
| 351 | else |
| 352 | alloc_size = sizeof(__le64 *) * nvme_npages(size, dev); |
| 353 | |
| 354 | return alloc_size + sizeof(struct scatterlist) * nseg; |
| 355 | } |
| 356 | |
| 357 | static unsigned int nvme_pci_cmd_size(struct nvme_dev *dev, bool use_sgl) |
| 358 | { |
| 359 | unsigned int alloc_size = nvme_pci_iod_alloc_size(dev, |
| 360 | NVME_INT_BYTES(dev), NVME_INT_PAGES, |
| 361 | use_sgl); |
| 362 | |
| 363 | return sizeof(struct nvme_iod) + alloc_size; |
Jens Axboe | ac3dd5b | 2015-01-22 12:07:58 -0700 | [diff] [blame] | 364 | } |
| 365 | |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 366 | static int nvme_admin_init_hctx(struct blk_mq_hw_ctx *hctx, void *data, |
| 367 | unsigned int hctx_idx) |
Matthew Wilcox | e85248e | 2011-02-06 18:30:16 -0500 | [diff] [blame] | 368 | { |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 369 | struct nvme_dev *dev = data; |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 370 | struct nvme_queue *nvmeq = &dev->queues[0]; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 371 | |
Keith Busch | 4248322 | 2015-06-01 09:29:54 -0600 | [diff] [blame] | 372 | WARN_ON(hctx_idx != 0); |
| 373 | WARN_ON(dev->admin_tagset.tags[0] != hctx->tags); |
| 374 | WARN_ON(nvmeq->tags); |
| 375 | |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 376 | hctx->driver_data = nvmeq; |
Keith Busch | 4248322 | 2015-06-01 09:29:54 -0600 | [diff] [blame] | 377 | nvmeq->tags = &dev->admin_tagset.tags[0]; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 378 | return 0; |
Matthew Wilcox | e85248e | 2011-02-06 18:30:16 -0500 | [diff] [blame] | 379 | } |
| 380 | |
Keith Busch | 4af0e21 | 2015-06-08 10:08:13 -0600 | [diff] [blame] | 381 | static void nvme_admin_exit_hctx(struct blk_mq_hw_ctx *hctx, unsigned int hctx_idx) |
| 382 | { |
| 383 | struct nvme_queue *nvmeq = hctx->driver_data; |
| 384 | |
| 385 | nvmeq->tags = NULL; |
| 386 | } |
| 387 | |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 388 | static int nvme_init_hctx(struct blk_mq_hw_ctx *hctx, void *data, |
| 389 | unsigned int hctx_idx) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 390 | { |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 391 | struct nvme_dev *dev = data; |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 392 | struct nvme_queue *nvmeq = &dev->queues[hctx_idx + 1]; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 393 | |
Keith Busch | 4248322 | 2015-06-01 09:29:54 -0600 | [diff] [blame] | 394 | if (!nvmeq->tags) |
| 395 | nvmeq->tags = &dev->tagset.tags[hctx_idx]; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 396 | |
Keith Busch | 4248322 | 2015-06-01 09:29:54 -0600 | [diff] [blame] | 397 | WARN_ON(dev->tagset.tags[hctx_idx] != hctx->tags); |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 398 | hctx->driver_data = nvmeq; |
| 399 | return 0; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 400 | } |
| 401 | |
Christoph Hellwig | d6296d39 | 2017-05-01 10:19:08 -0600 | [diff] [blame] | 402 | static int nvme_init_request(struct blk_mq_tag_set *set, struct request *req, |
| 403 | unsigned int hctx_idx, unsigned int numa_node) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 404 | { |
Christoph Hellwig | d6296d39 | 2017-05-01 10:19:08 -0600 | [diff] [blame] | 405 | struct nvme_dev *dev = set->driver_data; |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 406 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
Christoph Hellwig | 0350815 | 2017-06-13 09:15:18 +0200 | [diff] [blame] | 407 | int queue_idx = (set == &dev->tagset) ? hctx_idx + 1 : 0; |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 408 | struct nvme_queue *nvmeq = &dev->queues[queue_idx]; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 409 | |
| 410 | BUG_ON(!nvmeq); |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 411 | iod->nvmeq = nvmeq; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 412 | return 0; |
| 413 | } |
| 414 | |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 415 | static int nvme_pci_map_queues(struct blk_mq_tag_set *set) |
| 416 | { |
| 417 | struct nvme_dev *dev = set->driver_data; |
| 418 | |
Keith Busch | 22b5560 | 2018-04-12 09:16:10 -0600 | [diff] [blame] | 419 | return blk_mq_pci_map_queues(set, to_pci_dev(dev->dev), |
| 420 | dev->num_vecs > 1 ? 1 /* admin queue */ : 0); |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 421 | } |
| 422 | |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 423 | /** |
Christoph Hellwig | adf68f2 | 2015-11-28 15:42:28 +0100 | [diff] [blame] | 424 | * __nvme_submit_cmd() - Copy a command into a queue and ring the doorbell |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 425 | * @nvmeq: The queue to use |
| 426 | * @cmd: The command to send |
| 427 | * |
| 428 | * Safe to use from interrupt context |
| 429 | */ |
Sunad Bhandary | e3f879b | 2015-07-31 18:56:58 +0530 | [diff] [blame] | 430 | static void __nvme_submit_cmd(struct nvme_queue *nvmeq, |
| 431 | struct nvme_command *cmd) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 432 | { |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 433 | u16 tail = nvmeq->sq_tail; |
| 434 | |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 435 | if (nvmeq->sq_cmds_io) |
| 436 | memcpy_toio(&nvmeq->sq_cmds_io[tail], cmd, sizeof(*cmd)); |
| 437 | else |
| 438 | memcpy(&nvmeq->sq_cmds[tail], cmd, sizeof(*cmd)); |
| 439 | |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 440 | if (++tail == nvmeq->q_depth) |
| 441 | tail = 0; |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 442 | if (nvme_dbbuf_update_and_check_event(tail, nvmeq->dbbuf_sq_db, |
| 443 | nvmeq->dbbuf_sq_ei)) |
| 444 | writel(tail, nvmeq->q_db); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 445 | nvmeq->sq_tail = tail; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 446 | } |
| 447 | |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 448 | static void **nvme_pci_iod_list(struct request *req) |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 449 | { |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 450 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 451 | return (void **)(iod->sg + blk_rq_nr_phys_segments(req)); |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 452 | } |
| 453 | |
Minwoo Im | 955b1b5 | 2017-12-20 16:30:50 +0900 | [diff] [blame] | 454 | static inline bool nvme_pci_use_sgls(struct nvme_dev *dev, struct request *req) |
| 455 | { |
| 456 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
Keith Busch | 20469a3 | 2018-01-17 22:04:37 +0100 | [diff] [blame] | 457 | int nseg = blk_rq_nr_phys_segments(req); |
Minwoo Im | 955b1b5 | 2017-12-20 16:30:50 +0900 | [diff] [blame] | 458 | unsigned int avg_seg_size; |
| 459 | |
Keith Busch | 20469a3 | 2018-01-17 22:04:37 +0100 | [diff] [blame] | 460 | if (nseg == 0) |
| 461 | return false; |
| 462 | |
| 463 | avg_seg_size = DIV_ROUND_UP(blk_rq_payload_bytes(req), nseg); |
Minwoo Im | 955b1b5 | 2017-12-20 16:30:50 +0900 | [diff] [blame] | 464 | |
| 465 | if (!(dev->ctrl.sgls & ((1 << 0) | (1 << 1)))) |
| 466 | return false; |
| 467 | if (!iod->nvmeq->qid) |
| 468 | return false; |
| 469 | if (!sgl_threshold || avg_seg_size < sgl_threshold) |
| 470 | return false; |
| 471 | return true; |
| 472 | } |
| 473 | |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 474 | static blk_status_t nvme_init_iod(struct request *rq, struct nvme_dev *dev) |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 475 | { |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 476 | struct nvme_iod *iod = blk_mq_rq_to_pdu(rq); |
Christoph Hellwig | f9d03f9 | 2016-12-08 15:20:32 -0700 | [diff] [blame] | 477 | int nseg = blk_rq_nr_phys_segments(rq); |
Christoph Hellwig | b131c61 | 2017-01-13 12:29:12 +0100 | [diff] [blame] | 478 | unsigned int size = blk_rq_payload_bytes(rq); |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 479 | |
Minwoo Im | 955b1b5 | 2017-12-20 16:30:50 +0900 | [diff] [blame] | 480 | iod->use_sgl = nvme_pci_use_sgls(dev, rq); |
| 481 | |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 482 | if (nseg > NVME_INT_PAGES || size > NVME_INT_BYTES(dev)) { |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 483 | size_t alloc_size = nvme_pci_iod_alloc_size(dev, size, nseg, |
| 484 | iod->use_sgl); |
| 485 | |
| 486 | iod->sg = kmalloc(alloc_size, GFP_ATOMIC); |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 487 | if (!iod->sg) |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 488 | return BLK_STS_RESOURCE; |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 489 | } else { |
| 490 | iod->sg = iod->inline_sg; |
Jens Axboe | ac3dd5b | 2015-01-22 12:07:58 -0700 | [diff] [blame] | 491 | } |
| 492 | |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 493 | iod->aborted = 0; |
| 494 | iod->npages = -1; |
| 495 | iod->nents = 0; |
| 496 | iod->length = size; |
Keith Busch | f80ec96 | 2016-07-12 16:20:31 -0700 | [diff] [blame] | 497 | |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 498 | return BLK_STS_OK; |
Jens Axboe | ac3dd5b | 2015-01-22 12:07:58 -0700 | [diff] [blame] | 499 | } |
| 500 | |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 501 | static void nvme_free_iod(struct nvme_dev *dev, struct request *req) |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 502 | { |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 503 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 504 | const int last_prp = dev->ctrl.page_size / sizeof(__le64) - 1; |
| 505 | dma_addr_t dma_addr = iod->first_dma, next_dma_addr; |
| 506 | |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 507 | int i; |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 508 | |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 509 | if (iod->npages == 0) |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 510 | dma_pool_free(dev->prp_small_pool, nvme_pci_iod_list(req)[0], |
| 511 | dma_addr); |
| 512 | |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 513 | for (i = 0; i < iod->npages; i++) { |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 514 | void *addr = nvme_pci_iod_list(req)[i]; |
| 515 | |
| 516 | if (iod->use_sgl) { |
| 517 | struct nvme_sgl_desc *sg_list = addr; |
| 518 | |
| 519 | next_dma_addr = |
| 520 | le64_to_cpu((sg_list[SGES_PER_PAGE - 1]).addr); |
| 521 | } else { |
| 522 | __le64 *prp_list = addr; |
| 523 | |
| 524 | next_dma_addr = le64_to_cpu(prp_list[last_prp]); |
| 525 | } |
| 526 | |
| 527 | dma_pool_free(dev->prp_page_pool, addr, dma_addr); |
| 528 | dma_addr = next_dma_addr; |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 529 | } |
Jens Axboe | ac3dd5b | 2015-01-22 12:07:58 -0700 | [diff] [blame] | 530 | |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 531 | if (iod->sg != iod->inline_sg) |
| 532 | kfree(iod->sg); |
Keith Busch | b4ff9c8 | 2014-08-29 09:06:12 -0600 | [diff] [blame] | 533 | } |
| 534 | |
Keith Busch | 52b68d7 | 2015-02-23 09:16:21 -0700 | [diff] [blame] | 535 | #ifdef CONFIG_BLK_DEV_INTEGRITY |
Keith Busch | e1e5e56 | 2015-02-19 13:39:03 -0700 | [diff] [blame] | 536 | static void nvme_dif_prep(u32 p, u32 v, struct t10_pi_tuple *pi) |
| 537 | { |
| 538 | if (be32_to_cpu(pi->ref_tag) == v) |
| 539 | pi->ref_tag = cpu_to_be32(p); |
| 540 | } |
| 541 | |
| 542 | static void nvme_dif_complete(u32 p, u32 v, struct t10_pi_tuple *pi) |
| 543 | { |
| 544 | if (be32_to_cpu(pi->ref_tag) == p) |
| 545 | pi->ref_tag = cpu_to_be32(v); |
| 546 | } |
| 547 | |
| 548 | /** |
| 549 | * nvme_dif_remap - remaps ref tags to bip seed and physical lba |
| 550 | * |
| 551 | * The virtual start sector is the one that was originally submitted by the |
| 552 | * block layer. Due to partitioning, MD/DM cloning, etc. the actual physical |
| 553 | * start sector may be different. Remap protection information to match the |
| 554 | * physical LBA on writes, and back to the original seed on reads. |
| 555 | * |
| 556 | * Type 0 and 3 do not have a ref tag, so no remapping required. |
| 557 | */ |
| 558 | static void nvme_dif_remap(struct request *req, |
| 559 | void (*dif_swap)(u32 p, u32 v, struct t10_pi_tuple *pi)) |
| 560 | { |
| 561 | struct nvme_ns *ns = req->rq_disk->private_data; |
| 562 | struct bio_integrity_payload *bip; |
| 563 | struct t10_pi_tuple *pi; |
| 564 | void *p, *pmap; |
| 565 | u32 i, nlb, ts, phys, virt; |
| 566 | |
| 567 | if (!ns->pi_type || ns->pi_type == NVME_NS_DPS_PI_TYPE3) |
| 568 | return; |
| 569 | |
| 570 | bip = bio_integrity(req->bio); |
| 571 | if (!bip) |
| 572 | return; |
| 573 | |
| 574 | pmap = kmap_atomic(bip->bip_vec->bv_page) + bip->bip_vec->bv_offset; |
Keith Busch | e1e5e56 | 2015-02-19 13:39:03 -0700 | [diff] [blame] | 575 | |
| 576 | p = pmap; |
| 577 | virt = bip_get_seed(bip); |
| 578 | phys = nvme_block_nr(ns, blk_rq_pos(req)); |
| 579 | nlb = (blk_rq_bytes(req) >> ns->lba_shift); |
Dan Williams | ac6fc48 | 2015-10-21 13:20:18 -0400 | [diff] [blame] | 580 | ts = ns->disk->queue->integrity.tuple_size; |
Keith Busch | e1e5e56 | 2015-02-19 13:39:03 -0700 | [diff] [blame] | 581 | |
| 582 | for (i = 0; i < nlb; i++, virt++, phys++) { |
| 583 | pi = (struct t10_pi_tuple *)p; |
| 584 | dif_swap(phys, virt, pi); |
| 585 | p += ts; |
| 586 | } |
| 587 | kunmap_atomic(pmap); |
| 588 | } |
Keith Busch | 52b68d7 | 2015-02-23 09:16:21 -0700 | [diff] [blame] | 589 | #else /* CONFIG_BLK_DEV_INTEGRITY */ |
| 590 | static void nvme_dif_remap(struct request *req, |
| 591 | void (*dif_swap)(u32 p, u32 v, struct t10_pi_tuple *pi)) |
| 592 | { |
| 593 | } |
| 594 | static void nvme_dif_prep(u32 p, u32 v, struct t10_pi_tuple *pi) |
| 595 | { |
| 596 | } |
| 597 | static void nvme_dif_complete(u32 p, u32 v, struct t10_pi_tuple *pi) |
| 598 | { |
| 599 | } |
Keith Busch | 52b68d7 | 2015-02-23 09:16:21 -0700 | [diff] [blame] | 600 | #endif |
| 601 | |
Keith Busch | d087747 | 2017-09-15 13:05:38 -0400 | [diff] [blame] | 602 | static void nvme_print_sgl(struct scatterlist *sgl, int nents) |
| 603 | { |
| 604 | int i; |
| 605 | struct scatterlist *sg; |
| 606 | |
| 607 | for_each_sg(sgl, sg, nents, i) { |
| 608 | dma_addr_t phys = sg_phys(sg); |
| 609 | pr_warn("sg[%d] phys_addr:%pad offset:%d length:%d " |
| 610 | "dma_address:%pad dma_length:%d\n", |
| 611 | i, &phys, sg->offset, sg->length, &sg_dma_address(sg), |
| 612 | sg_dma_len(sg)); |
| 613 | } |
| 614 | } |
| 615 | |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 616 | static blk_status_t nvme_pci_setup_prps(struct nvme_dev *dev, |
| 617 | struct request *req, struct nvme_rw_command *cmnd) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 618 | { |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 619 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
Matthew Wilcox | 99802a7 | 2011-02-10 10:30:34 -0500 | [diff] [blame] | 620 | struct dma_pool *pool; |
Christoph Hellwig | b131c61 | 2017-01-13 12:29:12 +0100 | [diff] [blame] | 621 | int length = blk_rq_payload_bytes(req); |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 622 | struct scatterlist *sg = iod->sg; |
Matthew Wilcox | ff22b54 | 2011-01-26 10:02:29 -0500 | [diff] [blame] | 623 | int dma_len = sg_dma_len(sg); |
| 624 | u64 dma_addr = sg_dma_address(sg); |
Christoph Hellwig | 5fd4ce1 | 2015-11-28 15:03:49 +0100 | [diff] [blame] | 625 | u32 page_size = dev->ctrl.page_size; |
Murali Iyer | f137e0f | 2015-03-26 11:07:51 -0500 | [diff] [blame] | 626 | int offset = dma_addr & (page_size - 1); |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 627 | __le64 *prp_list; |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 628 | void **list = nvme_pci_iod_list(req); |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 629 | dma_addr_t prp_dma; |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 630 | int nprps, i; |
Matthew Wilcox | ff22b54 | 2011-01-26 10:02:29 -0500 | [diff] [blame] | 631 | |
Keith Busch | 1d09062 | 2014-06-23 11:34:01 -0600 | [diff] [blame] | 632 | length -= (page_size - offset); |
Jan H. Schönherr | 5228b32 | 2017-08-27 15:56:37 +0200 | [diff] [blame] | 633 | if (length <= 0) { |
| 634 | iod->first_dma = 0; |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 635 | goto done; |
Jan H. Schönherr | 5228b32 | 2017-08-27 15:56:37 +0200 | [diff] [blame] | 636 | } |
Matthew Wilcox | ff22b54 | 2011-01-26 10:02:29 -0500 | [diff] [blame] | 637 | |
Keith Busch | 1d09062 | 2014-06-23 11:34:01 -0600 | [diff] [blame] | 638 | dma_len -= (page_size - offset); |
Matthew Wilcox | ff22b54 | 2011-01-26 10:02:29 -0500 | [diff] [blame] | 639 | if (dma_len) { |
Keith Busch | 1d09062 | 2014-06-23 11:34:01 -0600 | [diff] [blame] | 640 | dma_addr += (page_size - offset); |
Matthew Wilcox | ff22b54 | 2011-01-26 10:02:29 -0500 | [diff] [blame] | 641 | } else { |
| 642 | sg = sg_next(sg); |
| 643 | dma_addr = sg_dma_address(sg); |
| 644 | dma_len = sg_dma_len(sg); |
| 645 | } |
| 646 | |
Keith Busch | 1d09062 | 2014-06-23 11:34:01 -0600 | [diff] [blame] | 647 | if (length <= page_size) { |
Keith Busch | edd10d3 | 2014-04-03 16:45:23 -0600 | [diff] [blame] | 648 | iod->first_dma = dma_addr; |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 649 | goto done; |
Matthew Wilcox | ff22b54 | 2011-01-26 10:02:29 -0500 | [diff] [blame] | 650 | } |
| 651 | |
Keith Busch | 1d09062 | 2014-06-23 11:34:01 -0600 | [diff] [blame] | 652 | nprps = DIV_ROUND_UP(length, page_size); |
Matthew Wilcox | 99802a7 | 2011-02-10 10:30:34 -0500 | [diff] [blame] | 653 | if (nprps <= (256 / 8)) { |
| 654 | pool = dev->prp_small_pool; |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 655 | iod->npages = 0; |
Matthew Wilcox | 99802a7 | 2011-02-10 10:30:34 -0500 | [diff] [blame] | 656 | } else { |
| 657 | pool = dev->prp_page_pool; |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 658 | iod->npages = 1; |
Matthew Wilcox | 99802a7 | 2011-02-10 10:30:34 -0500 | [diff] [blame] | 659 | } |
| 660 | |
Christoph Hellwig | 69d2b57 | 2015-10-16 07:58:37 +0200 | [diff] [blame] | 661 | prp_list = dma_pool_alloc(pool, GFP_ATOMIC, &prp_dma); |
Matthew Wilcox | b77954c | 2011-05-12 13:51:41 -0400 | [diff] [blame] | 662 | if (!prp_list) { |
Keith Busch | edd10d3 | 2014-04-03 16:45:23 -0600 | [diff] [blame] | 663 | iod->first_dma = dma_addr; |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 664 | iod->npages = -1; |
Keith Busch | 86eea28 | 2017-07-12 15:59:07 -0400 | [diff] [blame] | 665 | return BLK_STS_RESOURCE; |
Matthew Wilcox | b77954c | 2011-05-12 13:51:41 -0400 | [diff] [blame] | 666 | } |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 667 | list[0] = prp_list; |
| 668 | iod->first_dma = prp_dma; |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 669 | i = 0; |
| 670 | for (;;) { |
Keith Busch | 1d09062 | 2014-06-23 11:34:01 -0600 | [diff] [blame] | 671 | if (i == page_size >> 3) { |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 672 | __le64 *old_prp_list = prp_list; |
Christoph Hellwig | 69d2b57 | 2015-10-16 07:58:37 +0200 | [diff] [blame] | 673 | prp_list = dma_pool_alloc(pool, GFP_ATOMIC, &prp_dma); |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 674 | if (!prp_list) |
Keith Busch | 86eea28 | 2017-07-12 15:59:07 -0400 | [diff] [blame] | 675 | return BLK_STS_RESOURCE; |
Matthew Wilcox | eca18b2 | 2011-12-20 13:34:52 -0500 | [diff] [blame] | 676 | list[iod->npages++] = prp_list; |
Matthew Wilcox | 7523d83 | 2011-03-16 16:43:40 -0400 | [diff] [blame] | 677 | prp_list[0] = old_prp_list[i - 1]; |
| 678 | old_prp_list[i - 1] = cpu_to_le64(prp_dma); |
| 679 | i = 1; |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 680 | } |
| 681 | prp_list[i++] = cpu_to_le64(dma_addr); |
Keith Busch | 1d09062 | 2014-06-23 11:34:01 -0600 | [diff] [blame] | 682 | dma_len -= page_size; |
| 683 | dma_addr += page_size; |
| 684 | length -= page_size; |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 685 | if (length <= 0) |
| 686 | break; |
| 687 | if (dma_len > 0) |
| 688 | continue; |
Keith Busch | 86eea28 | 2017-07-12 15:59:07 -0400 | [diff] [blame] | 689 | if (unlikely(dma_len < 0)) |
| 690 | goto bad_sgl; |
Shane Michael Matthews | e025344c | 2011-02-10 08:51:24 -0500 | [diff] [blame] | 691 | sg = sg_next(sg); |
| 692 | dma_addr = sg_dma_address(sg); |
| 693 | dma_len = sg_dma_len(sg); |
| 694 | } |
| 695 | |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 696 | done: |
| 697 | cmnd->dptr.prp1 = cpu_to_le64(sg_dma_address(iod->sg)); |
| 698 | cmnd->dptr.prp2 = cpu_to_le64(iod->first_dma); |
| 699 | |
Keith Busch | 86eea28 | 2017-07-12 15:59:07 -0400 | [diff] [blame] | 700 | return BLK_STS_OK; |
| 701 | |
| 702 | bad_sgl: |
Keith Busch | d087747 | 2017-09-15 13:05:38 -0400 | [diff] [blame] | 703 | WARN(DO_ONCE(nvme_print_sgl, iod->sg, iod->nents), |
| 704 | "Invalid SGL for payload:%d nents:%d\n", |
| 705 | blk_rq_payload_bytes(req), iod->nents); |
Keith Busch | 86eea28 | 2017-07-12 15:59:07 -0400 | [diff] [blame] | 706 | return BLK_STS_IOERR; |
Matthew Wilcox | ff22b54 | 2011-01-26 10:02:29 -0500 | [diff] [blame] | 707 | } |
| 708 | |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 709 | static void nvme_pci_sgl_set_data(struct nvme_sgl_desc *sge, |
| 710 | struct scatterlist *sg) |
| 711 | { |
| 712 | sge->addr = cpu_to_le64(sg_dma_address(sg)); |
| 713 | sge->length = cpu_to_le32(sg_dma_len(sg)); |
| 714 | sge->type = NVME_SGL_FMT_DATA_DESC << 4; |
| 715 | } |
| 716 | |
| 717 | static void nvme_pci_sgl_set_seg(struct nvme_sgl_desc *sge, |
| 718 | dma_addr_t dma_addr, int entries) |
| 719 | { |
| 720 | sge->addr = cpu_to_le64(dma_addr); |
| 721 | if (entries < SGES_PER_PAGE) { |
| 722 | sge->length = cpu_to_le32(entries * sizeof(*sge)); |
| 723 | sge->type = NVME_SGL_FMT_LAST_SEG_DESC << 4; |
| 724 | } else { |
| 725 | sge->length = cpu_to_le32(PAGE_SIZE); |
| 726 | sge->type = NVME_SGL_FMT_SEG_DESC << 4; |
| 727 | } |
| 728 | } |
| 729 | |
| 730 | static blk_status_t nvme_pci_setup_sgls(struct nvme_dev *dev, |
Christoph Hellwig | b0f2853 | 2018-01-17 22:04:38 +0100 | [diff] [blame] | 731 | struct request *req, struct nvme_rw_command *cmd, int entries) |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 732 | { |
| 733 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 734 | struct dma_pool *pool; |
| 735 | struct nvme_sgl_desc *sg_list; |
| 736 | struct scatterlist *sg = iod->sg; |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 737 | dma_addr_t sgl_dma; |
Christoph Hellwig | b0f2853 | 2018-01-17 22:04:38 +0100 | [diff] [blame] | 738 | int i = 0; |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 739 | |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 740 | /* setting the transfer type as SGL */ |
| 741 | cmd->flags = NVME_CMD_SGL_METABUF; |
| 742 | |
Christoph Hellwig | b0f2853 | 2018-01-17 22:04:38 +0100 | [diff] [blame] | 743 | if (entries == 1) { |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 744 | nvme_pci_sgl_set_data(&cmd->dptr.sgl, sg); |
| 745 | return BLK_STS_OK; |
| 746 | } |
| 747 | |
| 748 | if (entries <= (256 / sizeof(struct nvme_sgl_desc))) { |
| 749 | pool = dev->prp_small_pool; |
| 750 | iod->npages = 0; |
| 751 | } else { |
| 752 | pool = dev->prp_page_pool; |
| 753 | iod->npages = 1; |
| 754 | } |
| 755 | |
| 756 | sg_list = dma_pool_alloc(pool, GFP_ATOMIC, &sgl_dma); |
| 757 | if (!sg_list) { |
| 758 | iod->npages = -1; |
| 759 | return BLK_STS_RESOURCE; |
| 760 | } |
| 761 | |
| 762 | nvme_pci_iod_list(req)[0] = sg_list; |
| 763 | iod->first_dma = sgl_dma; |
| 764 | |
| 765 | nvme_pci_sgl_set_seg(&cmd->dptr.sgl, sgl_dma, entries); |
| 766 | |
| 767 | do { |
| 768 | if (i == SGES_PER_PAGE) { |
| 769 | struct nvme_sgl_desc *old_sg_desc = sg_list; |
| 770 | struct nvme_sgl_desc *link = &old_sg_desc[i - 1]; |
| 771 | |
| 772 | sg_list = dma_pool_alloc(pool, GFP_ATOMIC, &sgl_dma); |
| 773 | if (!sg_list) |
| 774 | return BLK_STS_RESOURCE; |
| 775 | |
| 776 | i = 0; |
| 777 | nvme_pci_iod_list(req)[iod->npages++] = sg_list; |
| 778 | sg_list[i++] = *link; |
| 779 | nvme_pci_sgl_set_seg(link, sgl_dma, entries); |
| 780 | } |
| 781 | |
| 782 | nvme_pci_sgl_set_data(&sg_list[i++], sg); |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 783 | sg = sg_next(sg); |
Christoph Hellwig | b0f2853 | 2018-01-17 22:04:38 +0100 | [diff] [blame] | 784 | } while (--entries > 0); |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 785 | |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 786 | return BLK_STS_OK; |
| 787 | } |
| 788 | |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 789 | static blk_status_t nvme_map_data(struct nvme_dev *dev, struct request *req, |
Christoph Hellwig | b131c61 | 2017-01-13 12:29:12 +0100 | [diff] [blame] | 790 | struct nvme_command *cmnd) |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 791 | { |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 792 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 793 | struct request_queue *q = req->q; |
| 794 | enum dma_data_direction dma_dir = rq_data_dir(req) ? |
| 795 | DMA_TO_DEVICE : DMA_FROM_DEVICE; |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 796 | blk_status_t ret = BLK_STS_IOERR; |
Christoph Hellwig | b0f2853 | 2018-01-17 22:04:38 +0100 | [diff] [blame] | 797 | int nr_mapped; |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 798 | |
Christoph Hellwig | f9d03f9 | 2016-12-08 15:20:32 -0700 | [diff] [blame] | 799 | sg_init_table(iod->sg, blk_rq_nr_phys_segments(req)); |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 800 | iod->nents = blk_rq_map_sg(q, req, iod->sg); |
| 801 | if (!iod->nents) |
| 802 | goto out; |
| 803 | |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 804 | ret = BLK_STS_RESOURCE; |
Christoph Hellwig | b0f2853 | 2018-01-17 22:04:38 +0100 | [diff] [blame] | 805 | nr_mapped = dma_map_sg_attrs(dev->dev, iod->sg, iod->nents, dma_dir, |
| 806 | DMA_ATTR_NO_WARN); |
| 807 | if (!nr_mapped) |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 808 | goto out; |
| 809 | |
Minwoo Im | 955b1b5 | 2017-12-20 16:30:50 +0900 | [diff] [blame] | 810 | if (iod->use_sgl) |
Christoph Hellwig | b0f2853 | 2018-01-17 22:04:38 +0100 | [diff] [blame] | 811 | ret = nvme_pci_setup_sgls(dev, req, &cmnd->rw, nr_mapped); |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 812 | else |
| 813 | ret = nvme_pci_setup_prps(dev, req, &cmnd->rw); |
| 814 | |
Keith Busch | 86eea28 | 2017-07-12 15:59:07 -0400 | [diff] [blame] | 815 | if (ret != BLK_STS_OK) |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 816 | goto out_unmap; |
| 817 | |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 818 | ret = BLK_STS_IOERR; |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 819 | if (blk_integrity_rq(req)) { |
| 820 | if (blk_rq_count_integrity_sg(q, req->bio) != 1) |
| 821 | goto out_unmap; |
| 822 | |
Christoph Hellwig | bf68405 | 2015-10-26 17:12:51 +0900 | [diff] [blame] | 823 | sg_init_table(&iod->meta_sg, 1); |
| 824 | if (blk_rq_map_integrity_sg(q, req->bio, &iod->meta_sg) != 1) |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 825 | goto out_unmap; |
| 826 | |
Keith Busch | b5d8af5 | 2017-08-29 17:46:02 -0400 | [diff] [blame] | 827 | if (req_op(req) == REQ_OP_WRITE) |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 828 | nvme_dif_remap(req, nvme_dif_prep); |
| 829 | |
Christoph Hellwig | bf68405 | 2015-10-26 17:12:51 +0900 | [diff] [blame] | 830 | if (!dma_map_sg(dev->dev, &iod->meta_sg, 1, dma_dir)) |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 831 | goto out_unmap; |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 832 | } |
| 833 | |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 834 | if (blk_integrity_rq(req)) |
Christoph Hellwig | bf68405 | 2015-10-26 17:12:51 +0900 | [diff] [blame] | 835 | cmnd->rw.metadata = cpu_to_le64(sg_dma_address(&iod->meta_sg)); |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 836 | return BLK_STS_OK; |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 837 | |
| 838 | out_unmap: |
| 839 | dma_unmap_sg(dev->dev, iod->sg, iod->nents, dma_dir); |
| 840 | out: |
| 841 | return ret; |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 842 | } |
| 843 | |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 844 | static void nvme_unmap_data(struct nvme_dev *dev, struct request *req) |
Christoph Hellwig | d4f6c3a | 2015-11-26 10:51:23 +0100 | [diff] [blame] | 845 | { |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 846 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
Christoph Hellwig | d4f6c3a | 2015-11-26 10:51:23 +0100 | [diff] [blame] | 847 | enum dma_data_direction dma_dir = rq_data_dir(req) ? |
| 848 | DMA_TO_DEVICE : DMA_FROM_DEVICE; |
| 849 | |
| 850 | if (iod->nents) { |
| 851 | dma_unmap_sg(dev->dev, iod->sg, iod->nents, dma_dir); |
| 852 | if (blk_integrity_rq(req)) { |
Keith Busch | b5d8af5 | 2017-08-29 17:46:02 -0400 | [diff] [blame] | 853 | if (req_op(req) == REQ_OP_READ) |
Christoph Hellwig | d4f6c3a | 2015-11-26 10:51:23 +0100 | [diff] [blame] | 854 | nvme_dif_remap(req, nvme_dif_complete); |
Christoph Hellwig | bf68405 | 2015-10-26 17:12:51 +0900 | [diff] [blame] | 855 | dma_unmap_sg(dev->dev, &iod->meta_sg, 1, dma_dir); |
Christoph Hellwig | d4f6c3a | 2015-11-26 10:51:23 +0100 | [diff] [blame] | 856 | } |
| 857 | } |
| 858 | |
Christoph Hellwig | f9d03f9 | 2016-12-08 15:20:32 -0700 | [diff] [blame] | 859 | nvme_cleanup_cmd(req); |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 860 | nvme_free_iod(dev, req); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 861 | } |
| 862 | |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 863 | /* |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 864 | * NOTE: ns is NULL when called on the admin queue. |
| 865 | */ |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 866 | static blk_status_t nvme_queue_rq(struct blk_mq_hw_ctx *hctx, |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 867 | const struct blk_mq_queue_data *bd) |
Keith Busch | 53562be | 2014-04-29 11:41:29 -0600 | [diff] [blame] | 868 | { |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 869 | struct nvme_ns *ns = hctx->queue->queuedata; |
| 870 | struct nvme_queue *nvmeq = hctx->driver_data; |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 871 | struct nvme_dev *dev = nvmeq->dev; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 872 | struct request *req = bd->rq; |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 873 | struct nvme_command cmnd; |
Christoph Hellwig | ebe6d87 | 2017-06-12 18:36:32 +0200 | [diff] [blame] | 874 | blk_status_t ret; |
Keith Busch | e1e5e56 | 2015-02-19 13:39:03 -0700 | [diff] [blame] | 875 | |
Jens Axboe | d1f06f4 | 2018-05-17 18:31:49 +0200 | [diff] [blame] | 876 | /* |
| 877 | * We should not need to do this, but we're still using this to |
| 878 | * ensure we can drain requests on a dying queue. |
| 879 | */ |
| 880 | if (unlikely(nvmeq->cq_vector < 0)) |
| 881 | return BLK_STS_IOERR; |
| 882 | |
Christoph Hellwig | f9d03f9 | 2016-12-08 15:20:32 -0700 | [diff] [blame] | 883 | ret = nvme_setup_cmd(ns, req, &cmnd); |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 884 | if (ret) |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 885 | return ret; |
Keith Busch | edd10d3 | 2014-04-03 16:45:23 -0600 | [diff] [blame] | 886 | |
Christoph Hellwig | b131c61 | 2017-01-13 12:29:12 +0100 | [diff] [blame] | 887 | ret = nvme_init_iod(req, dev); |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 888 | if (ret) |
Christoph Hellwig | f9d03f9 | 2016-12-08 15:20:32 -0700 | [diff] [blame] | 889 | goto out_free_cmd; |
Keith Busch | edd10d3 | 2014-04-03 16:45:23 -0600 | [diff] [blame] | 890 | |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 891 | if (blk_rq_nr_phys_segments(req)) { |
Christoph Hellwig | b131c61 | 2017-01-13 12:29:12 +0100 | [diff] [blame] | 892 | ret = nvme_map_data(dev, req, &cmnd); |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 893 | if (ret) |
| 894 | goto out_cleanup_iod; |
| 895 | } |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 896 | |
Christoph Hellwig | aae239e | 2015-11-26 12:59:50 +0100 | [diff] [blame] | 897 | blk_mq_start_request(req); |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 898 | |
Jens Axboe | 1eae349 | 2018-05-17 18:31:52 +0200 | [diff] [blame] | 899 | spin_lock(&nvmeq->sq_lock); |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 900 | __nvme_submit_cmd(nvmeq, &cmnd); |
Jens Axboe | 1eae349 | 2018-05-17 18:31:52 +0200 | [diff] [blame] | 901 | spin_unlock(&nvmeq->sq_lock); |
Christoph Hellwig | fc17b65 | 2017-06-03 09:38:05 +0200 | [diff] [blame] | 902 | return BLK_STS_OK; |
Christoph Hellwig | f9d03f9 | 2016-12-08 15:20:32 -0700 | [diff] [blame] | 903 | out_cleanup_iod: |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 904 | nvme_free_iod(dev, req); |
Christoph Hellwig | f9d03f9 | 2016-12-08 15:20:32 -0700 | [diff] [blame] | 905 | out_free_cmd: |
| 906 | nvme_cleanup_cmd(req); |
Christoph Hellwig | ba1ca37 | 2015-10-16 07:58:38 +0200 | [diff] [blame] | 907 | return ret; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 908 | } |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 909 | |
Christoph Hellwig | 77f02a7 | 2017-03-30 13:41:32 +0200 | [diff] [blame] | 910 | static void nvme_pci_complete_rq(struct request *req) |
Christoph Hellwig | eee417b | 2015-11-26 13:03:13 +0100 | [diff] [blame] | 911 | { |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 912 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
Christoph Hellwig | eee417b | 2015-11-26 13:03:13 +0100 | [diff] [blame] | 913 | |
Christoph Hellwig | 77f02a7 | 2017-03-30 13:41:32 +0200 | [diff] [blame] | 914 | nvme_unmap_data(iod->nvmeq->dev, req); |
| 915 | nvme_complete_rq(req); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 916 | } |
| 917 | |
Marta Rybczynska | d783e0b | 2016-03-22 16:02:06 +0100 | [diff] [blame] | 918 | /* We read the CQE phase first to check if the rest of the entry is valid */ |
Christoph Hellwig | 750dde4 | 2018-05-18 08:37:04 -0600 | [diff] [blame] | 919 | static inline bool nvme_cqe_pending(struct nvme_queue *nvmeq) |
Marta Rybczynska | d783e0b | 2016-03-22 16:02:06 +0100 | [diff] [blame] | 920 | { |
Christoph Hellwig | 750dde4 | 2018-05-18 08:37:04 -0600 | [diff] [blame] | 921 | return (le16_to_cpu(nvmeq->cqes[nvmeq->cq_head].status) & 1) == |
| 922 | nvmeq->cq_phase; |
Marta Rybczynska | d783e0b | 2016-03-22 16:02:06 +0100 | [diff] [blame] | 923 | } |
| 924 | |
Sagi Grimberg | eb281c8 | 2017-06-18 17:28:07 +0300 | [diff] [blame] | 925 | static inline void nvme_ring_cq_doorbell(struct nvme_queue *nvmeq) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 926 | { |
Sagi Grimberg | eb281c8 | 2017-06-18 17:28:07 +0300 | [diff] [blame] | 927 | u16 head = nvmeq->cq_head; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 928 | |
Sagi Grimberg | eb281c8 | 2017-06-18 17:28:07 +0300 | [diff] [blame] | 929 | if (likely(nvmeq->cq_vector >= 0)) { |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 930 | if (nvme_dbbuf_update_and_check_event(head, nvmeq->dbbuf_cq_db, |
| 931 | nvmeq->dbbuf_cq_ei)) |
| 932 | writel(head, nvmeq->q_db + nvmeq->dev->db_stride); |
Sagi Grimberg | eb281c8 | 2017-06-18 17:28:07 +0300 | [diff] [blame] | 933 | } |
| 934 | } |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 935 | |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 936 | static inline void nvme_handle_cqe(struct nvme_queue *nvmeq, u16 idx) |
Sagi Grimberg | 83a12fb | 2017-06-18 17:28:08 +0300 | [diff] [blame] | 937 | { |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 938 | volatile struct nvme_completion *cqe = &nvmeq->cqes[idx]; |
Sagi Grimberg | 83a12fb | 2017-06-18 17:28:08 +0300 | [diff] [blame] | 939 | struct request *req; |
| 940 | |
| 941 | if (unlikely(cqe->command_id >= nvmeq->q_depth)) { |
| 942 | dev_warn(nvmeq->dev->ctrl.device, |
| 943 | "invalid id %d completed on queue %d\n", |
| 944 | cqe->command_id, le16_to_cpu(cqe->sq_id)); |
| 945 | return; |
| 946 | } |
| 947 | |
| 948 | /* |
| 949 | * AEN requests are special as they don't time out and can |
| 950 | * survive any kind of queue freeze and often don't respond to |
| 951 | * aborts. We don't even bother to allocate a struct request |
| 952 | * for them but rather special case them here. |
| 953 | */ |
| 954 | if (unlikely(nvmeq->qid == 0 && |
Keith Busch | 38dabe2 | 2017-11-07 15:13:10 -0700 | [diff] [blame] | 955 | cqe->command_id >= NVME_AQ_BLK_MQ_DEPTH)) { |
Sagi Grimberg | 83a12fb | 2017-06-18 17:28:08 +0300 | [diff] [blame] | 956 | nvme_complete_async_event(&nvmeq->dev->ctrl, |
| 957 | cqe->status, &cqe->result); |
| 958 | return; |
| 959 | } |
| 960 | |
| 961 | req = blk_mq_tag_to_rq(*nvmeq->tags, cqe->command_id); |
| 962 | nvme_end_request(req, cqe->status, cqe->result); |
| 963 | } |
| 964 | |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 965 | static void nvme_complete_cqes(struct nvme_queue *nvmeq, u16 start, u16 end) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 966 | { |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 967 | while (start != end) { |
| 968 | nvme_handle_cqe(nvmeq, start); |
| 969 | if (++start == nvmeq->q_depth) |
| 970 | start = 0; |
Sagi Grimberg | 920d13a | 2017-06-18 17:28:09 +0300 | [diff] [blame] | 971 | } |
Jens Axboe | a0fa964 | 2015-11-03 20:37:26 -0700 | [diff] [blame] | 972 | } |
| 973 | |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 974 | static inline void nvme_update_cq_head(struct nvme_queue *nvmeq) |
Jens Axboe | a0fa964 | 2015-11-03 20:37:26 -0700 | [diff] [blame] | 975 | { |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 976 | if (++nvmeq->cq_head == nvmeq->q_depth) { |
| 977 | nvmeq->cq_head = 0; |
| 978 | nvmeq->cq_phase = !nvmeq->cq_phase; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 979 | } |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 980 | } |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 981 | |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 982 | static inline bool nvme_process_cq(struct nvme_queue *nvmeq, u16 *start, |
| 983 | u16 *end, int tag) |
| 984 | { |
| 985 | bool found = false; |
| 986 | |
| 987 | *start = nvmeq->cq_head; |
| 988 | while (!found && nvme_cqe_pending(nvmeq)) { |
| 989 | if (nvmeq->cqes[nvmeq->cq_head].command_id == tag) |
| 990 | found = true; |
| 991 | nvme_update_cq_head(nvmeq); |
| 992 | } |
| 993 | *end = nvmeq->cq_head; |
| 994 | |
| 995 | if (*start != *end) |
Sagi Grimberg | 920d13a | 2017-06-18 17:28:09 +0300 | [diff] [blame] | 996 | nvme_ring_cq_doorbell(nvmeq); |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 997 | return found; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 998 | } |
| 999 | |
| 1000 | static irqreturn_t nvme_irq(int irq, void *data) |
| 1001 | { |
Matthew Wilcox | 58ffacb | 2011-02-06 07:28:06 -0500 | [diff] [blame] | 1002 | struct nvme_queue *nvmeq = data; |
Jens Axboe | 68fa9db | 2018-05-21 08:41:52 -0600 | [diff] [blame] | 1003 | irqreturn_t ret = IRQ_NONE; |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 1004 | u16 start, end; |
| 1005 | |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1006 | spin_lock(&nvmeq->cq_lock); |
Jens Axboe | 68fa9db | 2018-05-21 08:41:52 -0600 | [diff] [blame] | 1007 | if (nvmeq->cq_head != nvmeq->last_cq_head) |
| 1008 | ret = IRQ_HANDLED; |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 1009 | nvme_process_cq(nvmeq, &start, &end, -1); |
Jens Axboe | 68fa9db | 2018-05-21 08:41:52 -0600 | [diff] [blame] | 1010 | nvmeq->last_cq_head = nvmeq->cq_head; |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1011 | spin_unlock(&nvmeq->cq_lock); |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 1012 | |
Jens Axboe | 68fa9db | 2018-05-21 08:41:52 -0600 | [diff] [blame] | 1013 | if (start != end) { |
| 1014 | nvme_complete_cqes(nvmeq, start, end); |
| 1015 | return IRQ_HANDLED; |
| 1016 | } |
| 1017 | |
| 1018 | return ret; |
Matthew Wilcox | 58ffacb | 2011-02-06 07:28:06 -0500 | [diff] [blame] | 1019 | } |
| 1020 | |
| 1021 | static irqreturn_t nvme_irq_check(int irq, void *data) |
| 1022 | { |
| 1023 | struct nvme_queue *nvmeq = data; |
Christoph Hellwig | 750dde4 | 2018-05-18 08:37:04 -0600 | [diff] [blame] | 1024 | if (nvme_cqe_pending(nvmeq)) |
Marta Rybczynska | d783e0b | 2016-03-22 16:02:06 +0100 | [diff] [blame] | 1025 | return IRQ_WAKE_THREAD; |
| 1026 | return IRQ_NONE; |
Matthew Wilcox | 58ffacb | 2011-02-06 07:28:06 -0500 | [diff] [blame] | 1027 | } |
| 1028 | |
Keith Busch | 7776db1 | 2017-02-24 17:59:28 -0500 | [diff] [blame] | 1029 | static int __nvme_poll(struct nvme_queue *nvmeq, unsigned int tag) |
Jens Axboe | a0fa964 | 2015-11-03 20:37:26 -0700 | [diff] [blame] | 1030 | { |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 1031 | u16 start, end; |
| 1032 | bool found; |
Jens Axboe | a0fa964 | 2015-11-03 20:37:26 -0700 | [diff] [blame] | 1033 | |
Christoph Hellwig | 750dde4 | 2018-05-18 08:37:04 -0600 | [diff] [blame] | 1034 | if (!nvme_cqe_pending(nvmeq)) |
Sagi Grimberg | 442e19b | 2017-06-18 17:28:10 +0300 | [diff] [blame] | 1035 | return 0; |
Jens Axboe | a0fa964 | 2015-11-03 20:37:26 -0700 | [diff] [blame] | 1036 | |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1037 | spin_lock_irq(&nvmeq->cq_lock); |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 1038 | found = nvme_process_cq(nvmeq, &start, &end, tag); |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1039 | spin_unlock_irq(&nvmeq->cq_lock); |
Sagi Grimberg | 442e19b | 2017-06-18 17:28:10 +0300 | [diff] [blame] | 1040 | |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 1041 | nvme_complete_cqes(nvmeq, start, end); |
Sagi Grimberg | 442e19b | 2017-06-18 17:28:10 +0300 | [diff] [blame] | 1042 | return found; |
Jens Axboe | a0fa964 | 2015-11-03 20:37:26 -0700 | [diff] [blame] | 1043 | } |
| 1044 | |
Keith Busch | 7776db1 | 2017-02-24 17:59:28 -0500 | [diff] [blame] | 1045 | static int nvme_poll(struct blk_mq_hw_ctx *hctx, unsigned int tag) |
| 1046 | { |
| 1047 | struct nvme_queue *nvmeq = hctx->driver_data; |
| 1048 | |
| 1049 | return __nvme_poll(nvmeq, tag); |
| 1050 | } |
| 1051 | |
Keith Busch | ad22c35 | 2017-11-07 15:13:12 -0700 | [diff] [blame] | 1052 | static void nvme_pci_submit_async_event(struct nvme_ctrl *ctrl) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1053 | { |
Christoph Hellwig | f866fc42 | 2016-04-26 13:52:00 +0200 | [diff] [blame] | 1054 | struct nvme_dev *dev = to_nvme_dev(ctrl); |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 1055 | struct nvme_queue *nvmeq = &dev->queues[0]; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1056 | struct nvme_command c; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1057 | |
| 1058 | memset(&c, 0, sizeof(c)); |
| 1059 | c.common.opcode = nvme_admin_async_event; |
Keith Busch | ad22c35 | 2017-11-07 15:13:12 -0700 | [diff] [blame] | 1060 | c.common.command_id = NVME_AQ_BLK_MQ_DEPTH; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1061 | |
Jens Axboe | 1eae349 | 2018-05-17 18:31:52 +0200 | [diff] [blame] | 1062 | spin_lock(&nvmeq->sq_lock); |
Christoph Hellwig | f866fc42 | 2016-04-26 13:52:00 +0200 | [diff] [blame] | 1063 | __nvme_submit_cmd(nvmeq, &c); |
Jens Axboe | 1eae349 | 2018-05-17 18:31:52 +0200 | [diff] [blame] | 1064 | spin_unlock(&nvmeq->sq_lock); |
Keith Busch | 4d11542 | 2013-12-10 13:10:40 -0700 | [diff] [blame] | 1065 | } |
| 1066 | |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1067 | static int adapter_delete_queue(struct nvme_dev *dev, u8 opcode, u16 id) |
| 1068 | { |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1069 | struct nvme_command c; |
| 1070 | |
| 1071 | memset(&c, 0, sizeof(c)); |
| 1072 | c.delete_queue.opcode = opcode; |
| 1073 | c.delete_queue.qid = cpu_to_le16(id); |
| 1074 | |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 1075 | return nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1076 | } |
| 1077 | |
| 1078 | static int adapter_alloc_cq(struct nvme_dev *dev, u16 qid, |
Jianchao Wang | a8e3e0b | 2018-05-24 17:51:33 +0800 | [diff] [blame] | 1079 | struct nvme_queue *nvmeq, s16 vector) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1080 | { |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1081 | struct nvme_command c; |
| 1082 | int flags = NVME_QUEUE_PHYS_CONTIG | NVME_CQ_IRQ_ENABLED; |
| 1083 | |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 1084 | /* |
Minwoo Im | 16772ae | 2017-10-18 22:56:09 +0900 | [diff] [blame] | 1085 | * Note: we (ab)use the fact that the prp fields survive if no data |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 1086 | * is attached to the request. |
| 1087 | */ |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1088 | memset(&c, 0, sizeof(c)); |
| 1089 | c.create_cq.opcode = nvme_admin_create_cq; |
| 1090 | c.create_cq.prp1 = cpu_to_le64(nvmeq->cq_dma_addr); |
| 1091 | c.create_cq.cqid = cpu_to_le16(qid); |
| 1092 | c.create_cq.qsize = cpu_to_le16(nvmeq->q_depth - 1); |
| 1093 | c.create_cq.cq_flags = cpu_to_le16(flags); |
Jianchao Wang | a8e3e0b | 2018-05-24 17:51:33 +0800 | [diff] [blame] | 1094 | c.create_cq.irq_vector = cpu_to_le16(vector); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1095 | |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 1096 | return nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1097 | } |
| 1098 | |
| 1099 | static int adapter_alloc_sq(struct nvme_dev *dev, u16 qid, |
| 1100 | struct nvme_queue *nvmeq) |
| 1101 | { |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1102 | struct nvme_command c; |
Keith Busch | 81c1cd9 | 2017-04-04 18:18:12 -0400 | [diff] [blame] | 1103 | int flags = NVME_QUEUE_PHYS_CONTIG; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1104 | |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 1105 | /* |
Minwoo Im | 16772ae | 2017-10-18 22:56:09 +0900 | [diff] [blame] | 1106 | * Note: we (ab)use the fact that the prp fields survive if no data |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 1107 | * is attached to the request. |
| 1108 | */ |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1109 | memset(&c, 0, sizeof(c)); |
| 1110 | c.create_sq.opcode = nvme_admin_create_sq; |
| 1111 | c.create_sq.prp1 = cpu_to_le64(nvmeq->sq_dma_addr); |
| 1112 | c.create_sq.sqid = cpu_to_le16(qid); |
| 1113 | c.create_sq.qsize = cpu_to_le16(nvmeq->q_depth - 1); |
| 1114 | c.create_sq.sq_flags = cpu_to_le16(flags); |
| 1115 | c.create_sq.cqid = cpu_to_le16(qid); |
| 1116 | |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 1117 | return nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1118 | } |
| 1119 | |
| 1120 | static int adapter_delete_cq(struct nvme_dev *dev, u16 cqid) |
| 1121 | { |
| 1122 | return adapter_delete_queue(dev, nvme_admin_delete_cq, cqid); |
| 1123 | } |
| 1124 | |
| 1125 | static int adapter_delete_sq(struct nvme_dev *dev, u16 sqid) |
| 1126 | { |
| 1127 | return adapter_delete_queue(dev, nvme_admin_delete_sq, sqid); |
| 1128 | } |
| 1129 | |
Christoph Hellwig | 2a842ac | 2017-06-03 09:38:04 +0200 | [diff] [blame] | 1130 | static void abort_endio(struct request *req, blk_status_t error) |
Matthew Wilcox | bc5fc7e | 2011-09-19 17:08:14 -0400 | [diff] [blame] | 1131 | { |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 1132 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
| 1133 | struct nvme_queue *nvmeq = iod->nvmeq; |
Matthew Wilcox | bc5fc7e | 2011-09-19 17:08:14 -0400 | [diff] [blame] | 1134 | |
Christoph Hellwig | 27fa9bc | 2017-04-20 16:02:57 +0200 | [diff] [blame] | 1135 | dev_warn(nvmeq->dev->ctrl.device, |
| 1136 | "Abort status: 0x%x", nvme_req(req)->status); |
Christoph Hellwig | e7a2a87 | 2015-11-16 10:39:48 +0100 | [diff] [blame] | 1137 | atomic_inc(&nvmeq->dev->ctrl.abort_limit); |
Christoph Hellwig | e7a2a87 | 2015-11-16 10:39:48 +0100 | [diff] [blame] | 1138 | blk_mq_free_request(req); |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 1139 | } |
| 1140 | |
Keith Busch | b2a0eb1 | 2017-06-07 20:32:50 +0200 | [diff] [blame] | 1141 | static bool nvme_should_reset(struct nvme_dev *dev, u32 csts) |
| 1142 | { |
| 1143 | |
| 1144 | /* If true, indicates loss of adapter communication, possibly by a |
| 1145 | * NVMe Subsystem reset. |
| 1146 | */ |
| 1147 | bool nssro = dev->subsystem && (csts & NVME_CSTS_NSSRO); |
| 1148 | |
Jianchao Wang | ad70062 | 2018-01-22 22:03:16 +0800 | [diff] [blame] | 1149 | /* If there is a reset/reinit ongoing, we shouldn't reset again. */ |
| 1150 | switch (dev->ctrl.state) { |
| 1151 | case NVME_CTRL_RESETTING: |
Max Gurtovoy | ad6a0a5 | 2018-01-31 18:31:24 +0200 | [diff] [blame] | 1152 | case NVME_CTRL_CONNECTING: |
Keith Busch | b2a0eb1 | 2017-06-07 20:32:50 +0200 | [diff] [blame] | 1153 | return false; |
Jianchao Wang | ad70062 | 2018-01-22 22:03:16 +0800 | [diff] [blame] | 1154 | default: |
| 1155 | break; |
| 1156 | } |
Keith Busch | b2a0eb1 | 2017-06-07 20:32:50 +0200 | [diff] [blame] | 1157 | |
| 1158 | /* We shouldn't reset unless the controller is on fatal error state |
| 1159 | * _or_ if we lost the communication with it. |
| 1160 | */ |
| 1161 | if (!(csts & NVME_CSTS_CFS) && !nssro) |
| 1162 | return false; |
| 1163 | |
Keith Busch | b2a0eb1 | 2017-06-07 20:32:50 +0200 | [diff] [blame] | 1164 | return true; |
| 1165 | } |
| 1166 | |
| 1167 | static void nvme_warn_reset(struct nvme_dev *dev, u32 csts) |
| 1168 | { |
| 1169 | /* Read a config register to help see what died. */ |
| 1170 | u16 pci_status; |
| 1171 | int result; |
| 1172 | |
| 1173 | result = pci_read_config_word(to_pci_dev(dev->dev), PCI_STATUS, |
| 1174 | &pci_status); |
| 1175 | if (result == PCIBIOS_SUCCESSFUL) |
| 1176 | dev_warn(dev->ctrl.device, |
| 1177 | "controller is down; will reset: CSTS=0x%x, PCI_STATUS=0x%hx\n", |
| 1178 | csts, pci_status); |
| 1179 | else |
| 1180 | dev_warn(dev->ctrl.device, |
| 1181 | "controller is down; will reset: CSTS=0x%x, PCI_STATUS read failed (%d)\n", |
| 1182 | csts, result); |
| 1183 | } |
| 1184 | |
Christoph Hellwig | 31c7c7d | 2015-10-22 14:03:35 +0200 | [diff] [blame] | 1185 | static enum blk_eh_timer_return nvme_timeout(struct request *req, bool reserved) |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 1186 | { |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 1187 | struct nvme_iod *iod = blk_mq_rq_to_pdu(req); |
| 1188 | struct nvme_queue *nvmeq = iod->nvmeq; |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1189 | struct nvme_dev *dev = nvmeq->dev; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1190 | struct request *abort_req; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1191 | struct nvme_command cmd; |
Keith Busch | b2a0eb1 | 2017-06-07 20:32:50 +0200 | [diff] [blame] | 1192 | u32 csts = readl(dev->bar + NVME_REG_CSTS); |
| 1193 | |
Wen Xiong | 651438b | 2018-02-15 14:05:10 -0600 | [diff] [blame] | 1194 | /* If PCI error recovery process is happening, we cannot reset or |
| 1195 | * the recovery mechanism will surely fail. |
| 1196 | */ |
| 1197 | mb(); |
| 1198 | if (pci_channel_offline(to_pci_dev(dev->dev))) |
| 1199 | return BLK_EH_RESET_TIMER; |
| 1200 | |
Keith Busch | b2a0eb1 | 2017-06-07 20:32:50 +0200 | [diff] [blame] | 1201 | /* |
| 1202 | * Reset immediately if the controller is failed |
| 1203 | */ |
| 1204 | if (nvme_should_reset(dev, csts)) { |
| 1205 | nvme_warn_reset(dev, csts); |
| 1206 | nvme_dev_disable(dev, false); |
Christoph Hellwig | d86c4d8 | 2017-06-15 15:41:08 +0200 | [diff] [blame] | 1207 | nvme_reset_ctrl(&dev->ctrl); |
Keith Busch | b2a0eb1 | 2017-06-07 20:32:50 +0200 | [diff] [blame] | 1208 | return BLK_EH_HANDLED; |
| 1209 | } |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1210 | |
Christoph Hellwig | 31c7c7d | 2015-10-22 14:03:35 +0200 | [diff] [blame] | 1211 | /* |
Keith Busch | 7776db1 | 2017-02-24 17:59:28 -0500 | [diff] [blame] | 1212 | * Did we miss an interrupt? |
| 1213 | */ |
| 1214 | if (__nvme_poll(nvmeq, req->tag)) { |
| 1215 | dev_warn(dev->ctrl.device, |
| 1216 | "I/O %d QID %d timeout, completion polled\n", |
| 1217 | req->tag, nvmeq->qid); |
| 1218 | return BLK_EH_HANDLED; |
| 1219 | } |
| 1220 | |
| 1221 | /* |
Christoph Hellwig | fd634f41 | 2015-11-26 12:42:26 +0100 | [diff] [blame] | 1222 | * Shutdown immediately if controller times out while starting. The |
| 1223 | * reset work will see the pci device disabled when it gets the forced |
| 1224 | * cancellation error. All outstanding requests are completed on |
| 1225 | * shutdown, so we return BLK_EH_HANDLED. |
| 1226 | */ |
Keith Busch | 4244140 | 2018-02-08 08:55:34 -0700 | [diff] [blame] | 1227 | switch (dev->ctrl.state) { |
| 1228 | case NVME_CTRL_CONNECTING: |
| 1229 | case NVME_CTRL_RESETTING: |
Sagi Grimberg | 1b3c47c | 2016-02-10 08:51:15 -0700 | [diff] [blame] | 1230 | dev_warn(dev->ctrl.device, |
Christoph Hellwig | fd634f41 | 2015-11-26 12:42:26 +0100 | [diff] [blame] | 1231 | "I/O %d QID %d timeout, disable controller\n", |
| 1232 | req->tag, nvmeq->qid); |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 1233 | nvme_dev_disable(dev, false); |
Christoph Hellwig | 27fa9bc | 2017-04-20 16:02:57 +0200 | [diff] [blame] | 1234 | nvme_req(req)->flags |= NVME_REQ_CANCELLED; |
Christoph Hellwig | fd634f41 | 2015-11-26 12:42:26 +0100 | [diff] [blame] | 1235 | return BLK_EH_HANDLED; |
Keith Busch | 4244140 | 2018-02-08 08:55:34 -0700 | [diff] [blame] | 1236 | default: |
| 1237 | break; |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1238 | } |
| 1239 | |
Christoph Hellwig | fd634f41 | 2015-11-26 12:42:26 +0100 | [diff] [blame] | 1240 | /* |
| 1241 | * Shutdown the controller immediately and schedule a reset if the |
| 1242 | * command was already aborted once before and still hasn't been |
| 1243 | * returned to the driver, or if this is the admin queue. |
Christoph Hellwig | 31c7c7d | 2015-10-22 14:03:35 +0200 | [diff] [blame] | 1244 | */ |
Christoph Hellwig | f4800d6 | 2015-11-28 15:43:10 +0100 | [diff] [blame] | 1245 | if (!nvmeq->qid || iod->aborted) { |
Sagi Grimberg | 1b3c47c | 2016-02-10 08:51:15 -0700 | [diff] [blame] | 1246 | dev_warn(dev->ctrl.device, |
Keith Busch | e1569a1 | 2015-11-26 12:11:07 +0100 | [diff] [blame] | 1247 | "I/O %d QID %d timeout, reset controller\n", |
| 1248 | req->tag, nvmeq->qid); |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 1249 | nvme_dev_disable(dev, false); |
Christoph Hellwig | d86c4d8 | 2017-06-15 15:41:08 +0200 | [diff] [blame] | 1250 | nvme_reset_ctrl(&dev->ctrl); |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1251 | |
Keith Busch | e1569a1 | 2015-11-26 12:11:07 +0100 | [diff] [blame] | 1252 | /* |
| 1253 | * Mark the request as handled, since the inline shutdown |
| 1254 | * forces all outstanding requests to complete. |
| 1255 | */ |
Christoph Hellwig | 27fa9bc | 2017-04-20 16:02:57 +0200 | [diff] [blame] | 1256 | nvme_req(req)->flags |= NVME_REQ_CANCELLED; |
Keith Busch | e1569a1 | 2015-11-26 12:11:07 +0100 | [diff] [blame] | 1257 | return BLK_EH_HANDLED; |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1258 | } |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1259 | |
Christoph Hellwig | e7a2a87 | 2015-11-16 10:39:48 +0100 | [diff] [blame] | 1260 | if (atomic_dec_return(&dev->ctrl.abort_limit) < 0) { |
| 1261 | atomic_inc(&dev->ctrl.abort_limit); |
| 1262 | return BLK_EH_RESET_TIMER; |
| 1263 | } |
Keith Busch | 7bf7d77 | 2017-01-24 18:07:00 -0500 | [diff] [blame] | 1264 | iod->aborted = 1; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1265 | |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1266 | memset(&cmd, 0, sizeof(cmd)); |
| 1267 | cmd.abort.opcode = nvme_admin_abort_cmd; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1268 | cmd.abort.cid = req->tag; |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1269 | cmd.abort.sqid = cpu_to_le16(nvmeq->qid); |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1270 | |
Sagi Grimberg | 1b3c47c | 2016-02-10 08:51:15 -0700 | [diff] [blame] | 1271 | dev_warn(nvmeq->dev->ctrl.device, |
| 1272 | "I/O %d QID %d timeout, aborting\n", |
| 1273 | req->tag, nvmeq->qid); |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1274 | |
Christoph Hellwig | e7a2a87 | 2015-11-16 10:39:48 +0100 | [diff] [blame] | 1275 | abort_req = nvme_alloc_request(dev->ctrl.admin_q, &cmd, |
Christoph Hellwig | eb71f43 | 2016-06-13 16:45:23 +0200 | [diff] [blame] | 1276 | BLK_MQ_REQ_NOWAIT, NVME_QID_ANY); |
Christoph Hellwig | 6bf25d1 | 2015-11-20 09:36:44 +0100 | [diff] [blame] | 1277 | if (IS_ERR(abort_req)) { |
| 1278 | atomic_inc(&dev->ctrl.abort_limit); |
Christoph Hellwig | 31c7c7d | 2015-10-22 14:03:35 +0200 | [diff] [blame] | 1279 | return BLK_EH_RESET_TIMER; |
Christoph Hellwig | 6bf25d1 | 2015-11-20 09:36:44 +0100 | [diff] [blame] | 1280 | } |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1281 | |
Christoph Hellwig | e7a2a87 | 2015-11-16 10:39:48 +0100 | [diff] [blame] | 1282 | abort_req->timeout = ADMIN_TIMEOUT; |
| 1283 | abort_req->end_io_data = NULL; |
| 1284 | blk_execute_rq_nowait(abort_req->q, NULL, abort_req, 0, abort_endio); |
Keith Busch | 07836e6 | 2015-02-19 10:34:48 -0700 | [diff] [blame] | 1285 | |
Keith Busch | 7a509a6 | 2015-01-07 18:55:53 -0700 | [diff] [blame] | 1286 | /* |
| 1287 | * The aborted req will be completed on receiving the abort req. |
| 1288 | * We enable the timer again. If hit twice, it'll cause a device reset, |
| 1289 | * as the device then is in a faulty state. |
| 1290 | */ |
Keith Busch | 07836e6 | 2015-02-19 10:34:48 -0700 | [diff] [blame] | 1291 | return BLK_EH_RESET_TIMER; |
Matthew Wilcox | a09115b | 2012-08-07 15:56:23 -0400 | [diff] [blame] | 1292 | } |
| 1293 | |
Keith Busch | f435c28 | 2014-07-07 09:14:42 -0600 | [diff] [blame] | 1294 | static void nvme_free_queue(struct nvme_queue *nvmeq) |
Matthew Wilcox | 9e86677 | 2012-08-03 13:55:56 -0400 | [diff] [blame] | 1295 | { |
| 1296 | dma_free_coherent(nvmeq->q_dmadev, CQ_SIZE(nvmeq->q_depth), |
| 1297 | (void *)nvmeq->cqes, nvmeq->cq_dma_addr); |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1298 | if (nvmeq->sq_cmds) |
| 1299 | dma_free_coherent(nvmeq->q_dmadev, SQ_SIZE(nvmeq->q_depth), |
Matthew Wilcox | 9e86677 | 2012-08-03 13:55:56 -0400 | [diff] [blame] | 1300 | nvmeq->sq_cmds, nvmeq->sq_dma_addr); |
Matthew Wilcox | 9e86677 | 2012-08-03 13:55:56 -0400 | [diff] [blame] | 1301 | } |
| 1302 | |
Keith Busch | a1a5ef9 | 2013-12-16 13:50:00 -0500 | [diff] [blame] | 1303 | static void nvme_free_queues(struct nvme_dev *dev, int lowest) |
Keith Busch | 2240427 | 2013-07-15 15:02:20 -0600 | [diff] [blame] | 1304 | { |
| 1305 | int i; |
| 1306 | |
Sagi Grimberg | d858e5f | 2017-04-24 10:58:29 +0300 | [diff] [blame] | 1307 | for (i = dev->ctrl.queue_count - 1; i >= lowest; i--) { |
Sagi Grimberg | d858e5f | 2017-04-24 10:58:29 +0300 | [diff] [blame] | 1308 | dev->ctrl.queue_count--; |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 1309 | nvme_free_queue(&dev->queues[i]); |
kaoudis | 121c7ad | 2015-01-14 21:01:58 -0700 | [diff] [blame] | 1310 | } |
Keith Busch | 2240427 | 2013-07-15 15:02:20 -0600 | [diff] [blame] | 1311 | } |
| 1312 | |
Keith Busch | 4d11542 | 2013-12-10 13:10:40 -0700 | [diff] [blame] | 1313 | /** |
| 1314 | * nvme_suspend_queue - put queue into suspended state |
| 1315 | * @nvmeq - queue to suspend |
Keith Busch | 4d11542 | 2013-12-10 13:10:40 -0700 | [diff] [blame] | 1316 | */ |
| 1317 | static int nvme_suspend_queue(struct nvme_queue *nvmeq) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1318 | { |
Keith Busch | 2b25d98 | 2014-12-22 12:59:04 -0700 | [diff] [blame] | 1319 | int vector; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1320 | |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1321 | spin_lock_irq(&nvmeq->cq_lock); |
Keith Busch | 2b25d98 | 2014-12-22 12:59:04 -0700 | [diff] [blame] | 1322 | if (nvmeq->cq_vector == -1) { |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1323 | spin_unlock_irq(&nvmeq->cq_lock); |
Keith Busch | 2b25d98 | 2014-12-22 12:59:04 -0700 | [diff] [blame] | 1324 | return 1; |
| 1325 | } |
Christoph Hellwig | 0ff199c | 2017-04-13 09:06:43 +0200 | [diff] [blame] | 1326 | vector = nvmeq->cq_vector; |
Keith Busch | 42f6142 | 2014-03-24 10:46:25 -0600 | [diff] [blame] | 1327 | nvmeq->dev->online_queues--; |
Keith Busch | 2b25d98 | 2014-12-22 12:59:04 -0700 | [diff] [blame] | 1328 | nvmeq->cq_vector = -1; |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1329 | spin_unlock_irq(&nvmeq->cq_lock); |
Matthew Wilcox | a09115b | 2012-08-07 15:56:23 -0400 | [diff] [blame] | 1330 | |
Jens Axboe | d1f06f4 | 2018-05-17 18:31:49 +0200 | [diff] [blame] | 1331 | /* |
| 1332 | * Ensure that nvme_queue_rq() sees it ->cq_vector == -1 without |
| 1333 | * having to grab the lock. |
| 1334 | */ |
| 1335 | mb(); |
| 1336 | |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 1337 | if (!nvmeq->qid && nvmeq->dev->ctrl.admin_q) |
Sagi Grimberg | c81545f | 2017-07-02 15:53:27 +0300 | [diff] [blame] | 1338 | blk_mq_quiesce_queue(nvmeq->dev->ctrl.admin_q); |
Keith Busch | 6df3dbc | 2015-03-26 13:49:33 -0600 | [diff] [blame] | 1339 | |
Christoph Hellwig | 0ff199c | 2017-04-13 09:06:43 +0200 | [diff] [blame] | 1340 | pci_free_irq(to_pci_dev(nvmeq->dev->dev), vector, nvmeq); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1341 | |
Keith Busch | 4d11542 | 2013-12-10 13:10:40 -0700 | [diff] [blame] | 1342 | return 0; |
| 1343 | } |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1344 | |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 1345 | static void nvme_disable_admin_queue(struct nvme_dev *dev, bool shutdown) |
Keith Busch | 4d11542 | 2013-12-10 13:10:40 -0700 | [diff] [blame] | 1346 | { |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 1347 | struct nvme_queue *nvmeq = &dev->queues[0]; |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 1348 | u16 start, end; |
Keith Busch | 4d11542 | 2013-12-10 13:10:40 -0700 | [diff] [blame] | 1349 | |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 1350 | if (shutdown) |
| 1351 | nvme_shutdown_ctrl(&dev->ctrl); |
| 1352 | else |
Sagi Grimberg | 20d0dfe | 2017-06-27 22:16:38 +0300 | [diff] [blame] | 1353 | nvme_disable_ctrl(&dev->ctrl, dev->ctrl.cap); |
Keith Busch | 07836e6 | 2015-02-19 10:34:48 -0700 | [diff] [blame] | 1354 | |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1355 | spin_lock_irq(&nvmeq->cq_lock); |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 1356 | nvme_process_cq(nvmeq, &start, &end, -1); |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1357 | spin_unlock_irq(&nvmeq->cq_lock); |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 1358 | |
| 1359 | nvme_complete_cqes(nvmeq, start, end); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1360 | } |
| 1361 | |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1362 | static int nvme_cmb_qdepth(struct nvme_dev *dev, int nr_io_queues, |
| 1363 | int entry_size) |
| 1364 | { |
| 1365 | int q_depth = dev->q_depth; |
Christoph Hellwig | 5fd4ce1 | 2015-11-28 15:03:49 +0100 | [diff] [blame] | 1366 | unsigned q_size_aligned = roundup(q_depth * entry_size, |
| 1367 | dev->ctrl.page_size); |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1368 | |
| 1369 | if (q_size_aligned * nr_io_queues > dev->cmb_size) { |
Jon Derrick | c45f5c9 | 2015-07-21 15:08:13 -0600 | [diff] [blame] | 1370 | u64 mem_per_q = div_u64(dev->cmb_size, nr_io_queues); |
Christoph Hellwig | 5fd4ce1 | 2015-11-28 15:03:49 +0100 | [diff] [blame] | 1371 | mem_per_q = round_down(mem_per_q, dev->ctrl.page_size); |
Jon Derrick | c45f5c9 | 2015-07-21 15:08:13 -0600 | [diff] [blame] | 1372 | q_depth = div_u64(mem_per_q, entry_size); |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1373 | |
| 1374 | /* |
| 1375 | * Ensure the reduced q_depth is above some threshold where it |
| 1376 | * would be better to map queues in system memory with the |
| 1377 | * original depth |
| 1378 | */ |
| 1379 | if (q_depth < 64) |
| 1380 | return -ENOMEM; |
| 1381 | } |
| 1382 | |
| 1383 | return q_depth; |
| 1384 | } |
| 1385 | |
| 1386 | static int nvme_alloc_sq_cmds(struct nvme_dev *dev, struct nvme_queue *nvmeq, |
| 1387 | int qid, int depth) |
| 1388 | { |
Keith Busch | 815c670 | 2018-02-13 05:44:44 -0700 | [diff] [blame] | 1389 | /* CMB SQEs will be mapped before creation */ |
| 1390 | if (qid && dev->cmb && use_cmb_sqes && (dev->cmbsz & NVME_CMBSZ_SQS)) |
| 1391 | return 0; |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1392 | |
Keith Busch | 815c670 | 2018-02-13 05:44:44 -0700 | [diff] [blame] | 1393 | nvmeq->sq_cmds = dma_alloc_coherent(dev->dev, SQ_SIZE(depth), |
| 1394 | &nvmeq->sq_dma_addr, GFP_KERNEL); |
| 1395 | if (!nvmeq->sq_cmds) |
| 1396 | return -ENOMEM; |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1397 | return 0; |
| 1398 | } |
| 1399 | |
Keith Busch | a6ff726 | 2018-04-12 09:16:09 -0600 | [diff] [blame] | 1400 | static int nvme_alloc_queue(struct nvme_dev *dev, int qid, int depth) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1401 | { |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 1402 | struct nvme_queue *nvmeq = &dev->queues[qid]; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1403 | |
Keith Busch | 62314e4 | 2018-01-23 09:16:19 -0700 | [diff] [blame] | 1404 | if (dev->ctrl.queue_count > qid) |
| 1405 | return 0; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1406 | |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 1407 | nvmeq->cqes = dma_zalloc_coherent(dev->dev, CQ_SIZE(depth), |
Joe Perches | 4d51abf | 2014-06-15 13:37:33 -0700 | [diff] [blame] | 1408 | &nvmeq->cq_dma_addr, GFP_KERNEL); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1409 | if (!nvmeq->cqes) |
| 1410 | goto free_nvmeq; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1411 | |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1412 | if (nvme_alloc_sq_cmds(dev, nvmeq, qid, depth)) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1413 | goto free_cqdma; |
| 1414 | |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 1415 | nvmeq->q_dmadev = dev->dev; |
Matthew Wilcox | 091b609 | 2011-02-10 09:56:01 -0500 | [diff] [blame] | 1416 | nvmeq->dev = dev; |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1417 | spin_lock_init(&nvmeq->sq_lock); |
| 1418 | spin_lock_init(&nvmeq->cq_lock); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1419 | nvmeq->cq_head = 0; |
Matthew Wilcox | 8212346 | 2011-01-20 13:24:06 -0500 | [diff] [blame] | 1420 | nvmeq->cq_phase = 1; |
Haiyan Hu | b80d5cc | 2013-09-10 11:25:37 +0800 | [diff] [blame] | 1421 | nvmeq->q_db = &dev->dbs[qid * 2 * dev->db_stride]; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1422 | nvmeq->q_depth = depth; |
Keith Busch | c30341d | 2013-12-10 13:10:38 -0700 | [diff] [blame] | 1423 | nvmeq->qid = qid; |
Jon Derrick | 758dd7f | 2015-06-30 11:22:52 -0600 | [diff] [blame] | 1424 | nvmeq->cq_vector = -1; |
Sagi Grimberg | d858e5f | 2017-04-24 10:58:29 +0300 | [diff] [blame] | 1425 | dev->ctrl.queue_count++; |
Jon Derrick | 36a7e99 | 2015-05-27 12:26:23 -0600 | [diff] [blame] | 1426 | |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 1427 | return 0; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1428 | |
| 1429 | free_cqdma: |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 1430 | dma_free_coherent(dev->dev, CQ_SIZE(depth), (void *)nvmeq->cqes, |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1431 | nvmeq->cq_dma_addr); |
| 1432 | free_nvmeq: |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 1433 | return -ENOMEM; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1434 | } |
| 1435 | |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 1436 | static int queue_request_irq(struct nvme_queue *nvmeq) |
Matthew Wilcox | 3001082 | 2011-01-20 09:10:15 -0500 | [diff] [blame] | 1437 | { |
Christoph Hellwig | 0ff199c | 2017-04-13 09:06:43 +0200 | [diff] [blame] | 1438 | struct pci_dev *pdev = to_pci_dev(nvmeq->dev->dev); |
| 1439 | int nr = nvmeq->dev->ctrl.instance; |
| 1440 | |
| 1441 | if (use_threaded_interrupts) { |
| 1442 | return pci_request_irq(pdev, nvmeq->cq_vector, nvme_irq_check, |
| 1443 | nvme_irq, nvmeq, "nvme%dq%d", nr, nvmeq->qid); |
| 1444 | } else { |
| 1445 | return pci_request_irq(pdev, nvmeq->cq_vector, nvme_irq, |
| 1446 | NULL, nvmeq, "nvme%dq%d", nr, nvmeq->qid); |
| 1447 | } |
Matthew Wilcox | 3001082 | 2011-01-20 09:10:15 -0500 | [diff] [blame] | 1448 | } |
| 1449 | |
Keith Busch | 2240427 | 2013-07-15 15:02:20 -0600 | [diff] [blame] | 1450 | static void nvme_init_queue(struct nvme_queue *nvmeq, u16 qid) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1451 | { |
Keith Busch | 2240427 | 2013-07-15 15:02:20 -0600 | [diff] [blame] | 1452 | struct nvme_dev *dev = nvmeq->dev; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1453 | |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1454 | spin_lock_irq(&nvmeq->cq_lock); |
Keith Busch | 2240427 | 2013-07-15 15:02:20 -0600 | [diff] [blame] | 1455 | nvmeq->sq_tail = 0; |
| 1456 | nvmeq->cq_head = 0; |
| 1457 | nvmeq->cq_phase = 1; |
Haiyan Hu | b80d5cc | 2013-09-10 11:25:37 +0800 | [diff] [blame] | 1458 | nvmeq->q_db = &dev->dbs[qid * 2 * dev->db_stride]; |
Keith Busch | 2240427 | 2013-07-15 15:02:20 -0600 | [diff] [blame] | 1459 | memset((void *)nvmeq->cqes, 0, CQ_SIZE(nvmeq->q_depth)); |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 1460 | nvme_dbbuf_init(dev, nvmeq, qid); |
Keith Busch | 42f6142 | 2014-03-24 10:46:25 -0600 | [diff] [blame] | 1461 | dev->online_queues++; |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 1462 | spin_unlock_irq(&nvmeq->cq_lock); |
Keith Busch | 2240427 | 2013-07-15 15:02:20 -0600 | [diff] [blame] | 1463 | } |
| 1464 | |
| 1465 | static int nvme_create_queue(struct nvme_queue *nvmeq, int qid) |
| 1466 | { |
| 1467 | struct nvme_dev *dev = nvmeq->dev; |
| 1468 | int result; |
Jianchao Wang | a8e3e0b | 2018-05-24 17:51:33 +0800 | [diff] [blame] | 1469 | s16 vector; |
Matthew Wilcox | 3f85d50 | 2011-02-01 08:39:04 -0500 | [diff] [blame] | 1470 | |
Keith Busch | 815c670 | 2018-02-13 05:44:44 -0700 | [diff] [blame] | 1471 | if (dev->cmb && use_cmb_sqes && (dev->cmbsz & NVME_CMBSZ_SQS)) { |
| 1472 | unsigned offset = (qid - 1) * roundup(SQ_SIZE(nvmeq->q_depth), |
| 1473 | dev->ctrl.page_size); |
| 1474 | nvmeq->sq_dma_addr = dev->cmb_bus_addr + offset; |
| 1475 | nvmeq->sq_cmds_io = dev->cmb + offset; |
| 1476 | } |
| 1477 | |
Keith Busch | 22b5560 | 2018-04-12 09:16:10 -0600 | [diff] [blame] | 1478 | /* |
| 1479 | * A queue's vector matches the queue identifier unless the controller |
| 1480 | * has only one vector available. |
| 1481 | */ |
Jianchao Wang | a8e3e0b | 2018-05-24 17:51:33 +0800 | [diff] [blame] | 1482 | vector = dev->num_vecs == 1 ? 0 : qid; |
| 1483 | result = adapter_alloc_cq(dev, qid, nvmeq, vector); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1484 | if (result < 0) |
Jianchao Wang | a8e3e0b | 2018-05-24 17:51:33 +0800 | [diff] [blame] | 1485 | goto out; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1486 | |
| 1487 | result = adapter_alloc_sq(dev, qid, nvmeq); |
| 1488 | if (result < 0) |
| 1489 | goto release_cq; |
| 1490 | |
Jianchao Wang | a8e3e0b | 2018-05-24 17:51:33 +0800 | [diff] [blame] | 1491 | /* |
| 1492 | * Set cq_vector after alloc cq/sq, otherwise nvme_suspend_queue will |
| 1493 | * invoke free_irq for it and cause a 'Trying to free already-free IRQ |
| 1494 | * xxx' warning if the create CQ/SQ command times out. |
| 1495 | */ |
| 1496 | nvmeq->cq_vector = vector; |
Keith Busch | 161b8be | 2017-09-14 13:54:39 -0400 | [diff] [blame] | 1497 | nvme_init_queue(nvmeq, qid); |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 1498 | result = queue_request_irq(nvmeq); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1499 | if (result < 0) |
| 1500 | goto release_sq; |
| 1501 | |
Keith Busch | 2240427 | 2013-07-15 15:02:20 -0600 | [diff] [blame] | 1502 | return result; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1503 | |
Jianchao Wang | a8e3e0b | 2018-05-24 17:51:33 +0800 | [diff] [blame] | 1504 | release_sq: |
| 1505 | nvmeq->cq_vector = -1; |
Jianchao Wang | f25a2df | 2018-02-15 19:13:41 +0800 | [diff] [blame] | 1506 | dev->online_queues--; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1507 | adapter_delete_sq(dev, qid); |
Jianchao Wang | a8e3e0b | 2018-05-24 17:51:33 +0800 | [diff] [blame] | 1508 | release_cq: |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1509 | adapter_delete_cq(dev, qid); |
Jianchao Wang | a8e3e0b | 2018-05-24 17:51:33 +0800 | [diff] [blame] | 1510 | out: |
Keith Busch | 2240427 | 2013-07-15 15:02:20 -0600 | [diff] [blame] | 1511 | return result; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1512 | } |
| 1513 | |
Eric Biggers | f363b08 | 2017-03-30 13:39:16 -0700 | [diff] [blame] | 1514 | static const struct blk_mq_ops nvme_mq_admin_ops = { |
Christoph Hellwig | d29ec82 | 2015-05-22 11:12:46 +0200 | [diff] [blame] | 1515 | .queue_rq = nvme_queue_rq, |
Christoph Hellwig | 77f02a7 | 2017-03-30 13:41:32 +0200 | [diff] [blame] | 1516 | .complete = nvme_pci_complete_rq, |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1517 | .init_hctx = nvme_admin_init_hctx, |
Keith Busch | 4af0e21 | 2015-06-08 10:08:13 -0600 | [diff] [blame] | 1518 | .exit_hctx = nvme_admin_exit_hctx, |
Christoph Hellwig | 0350815 | 2017-06-13 09:15:18 +0200 | [diff] [blame] | 1519 | .init_request = nvme_init_request, |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1520 | .timeout = nvme_timeout, |
| 1521 | }; |
| 1522 | |
Eric Biggers | f363b08 | 2017-03-30 13:39:16 -0700 | [diff] [blame] | 1523 | static const struct blk_mq_ops nvme_mq_ops = { |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1524 | .queue_rq = nvme_queue_rq, |
Christoph Hellwig | 77f02a7 | 2017-03-30 13:41:32 +0200 | [diff] [blame] | 1525 | .complete = nvme_pci_complete_rq, |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1526 | .init_hctx = nvme_init_hctx, |
| 1527 | .init_request = nvme_init_request, |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 1528 | .map_queues = nvme_pci_map_queues, |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1529 | .timeout = nvme_timeout, |
Jens Axboe | a0fa964 | 2015-11-03 20:37:26 -0700 | [diff] [blame] | 1530 | .poll = nvme_poll, |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1531 | }; |
| 1532 | |
Keith Busch | ea191d2 | 2015-01-07 18:55:49 -0700 | [diff] [blame] | 1533 | static void nvme_dev_remove_admin(struct nvme_dev *dev) |
| 1534 | { |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 1535 | if (dev->ctrl.admin_q && !blk_queue_dying(dev->ctrl.admin_q)) { |
Keith Busch | 69d9a99 | 2016-02-24 09:15:56 -0700 | [diff] [blame] | 1536 | /* |
| 1537 | * If the controller was reset during removal, it's possible |
| 1538 | * user requests may be waiting on a stopped queue. Start the |
| 1539 | * queue to flush these to completion. |
| 1540 | */ |
Sagi Grimberg | c81545f | 2017-07-02 15:53:27 +0300 | [diff] [blame] | 1541 | blk_mq_unquiesce_queue(dev->ctrl.admin_q); |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 1542 | blk_cleanup_queue(dev->ctrl.admin_q); |
Keith Busch | ea191d2 | 2015-01-07 18:55:49 -0700 | [diff] [blame] | 1543 | blk_mq_free_tag_set(&dev->admin_tagset); |
| 1544 | } |
| 1545 | } |
| 1546 | |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1547 | static int nvme_alloc_admin_tags(struct nvme_dev *dev) |
| 1548 | { |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 1549 | if (!dev->ctrl.admin_q) { |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1550 | dev->admin_tagset.ops = &nvme_mq_admin_ops; |
| 1551 | dev->admin_tagset.nr_hw_queues = 1; |
Keith Busch | e3e9d50 | 2016-01-04 09:10:55 -0700 | [diff] [blame] | 1552 | |
Keith Busch | 38dabe2 | 2017-11-07 15:13:10 -0700 | [diff] [blame] | 1553 | dev->admin_tagset.queue_depth = NVME_AQ_MQ_TAG_DEPTH; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1554 | dev->admin_tagset.timeout = ADMIN_TIMEOUT; |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 1555 | dev->admin_tagset.numa_node = dev_to_node(dev->dev); |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 1556 | dev->admin_tagset.cmd_size = nvme_pci_cmd_size(dev, false); |
Jens Axboe | d348499 | 2017-01-13 14:43:58 -0700 | [diff] [blame] | 1557 | dev->admin_tagset.flags = BLK_MQ_F_NO_SCHED; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1558 | dev->admin_tagset.driver_data = dev; |
| 1559 | |
| 1560 | if (blk_mq_alloc_tag_set(&dev->admin_tagset)) |
| 1561 | return -ENOMEM; |
Sagi Grimberg | 34b6c23 | 2017-07-10 09:22:29 +0300 | [diff] [blame] | 1562 | dev->ctrl.admin_tagset = &dev->admin_tagset; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1563 | |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 1564 | dev->ctrl.admin_q = blk_mq_init_queue(&dev->admin_tagset); |
| 1565 | if (IS_ERR(dev->ctrl.admin_q)) { |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1566 | blk_mq_free_tag_set(&dev->admin_tagset); |
| 1567 | return -ENOMEM; |
| 1568 | } |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 1569 | if (!blk_get_queue(dev->ctrl.admin_q)) { |
Keith Busch | ea191d2 | 2015-01-07 18:55:49 -0700 | [diff] [blame] | 1570 | nvme_dev_remove_admin(dev); |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 1571 | dev->ctrl.admin_q = NULL; |
Keith Busch | ea191d2 | 2015-01-07 18:55:49 -0700 | [diff] [blame] | 1572 | return -ENODEV; |
| 1573 | } |
Keith Busch | 0fb59cb | 2015-01-07 18:55:50 -0700 | [diff] [blame] | 1574 | } else |
Sagi Grimberg | c81545f | 2017-07-02 15:53:27 +0300 | [diff] [blame] | 1575 | blk_mq_unquiesce_queue(dev->ctrl.admin_q); |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1576 | |
| 1577 | return 0; |
| 1578 | } |
| 1579 | |
Xu Yu | 97f6ef6 | 2017-05-24 16:39:55 +0800 | [diff] [blame] | 1580 | static unsigned long db_bar_size(struct nvme_dev *dev, unsigned nr_io_queues) |
| 1581 | { |
| 1582 | return NVME_REG_DBS + ((nr_io_queues + 1) * 8 * dev->db_stride); |
| 1583 | } |
| 1584 | |
| 1585 | static int nvme_remap_bar(struct nvme_dev *dev, unsigned long size) |
| 1586 | { |
| 1587 | struct pci_dev *pdev = to_pci_dev(dev->dev); |
| 1588 | |
| 1589 | if (size <= dev->bar_mapped_size) |
| 1590 | return 0; |
| 1591 | if (size > pci_resource_len(pdev, 0)) |
| 1592 | return -ENOMEM; |
| 1593 | if (dev->bar) |
| 1594 | iounmap(dev->bar); |
| 1595 | dev->bar = ioremap(pci_resource_start(pdev, 0), size); |
| 1596 | if (!dev->bar) { |
| 1597 | dev->bar_mapped_size = 0; |
| 1598 | return -ENOMEM; |
| 1599 | } |
| 1600 | dev->bar_mapped_size = size; |
| 1601 | dev->dbs = dev->bar + NVME_REG_DBS; |
| 1602 | |
| 1603 | return 0; |
| 1604 | } |
| 1605 | |
Sagi Grimberg | 01ad099 | 2017-05-01 00:27:17 +0300 | [diff] [blame] | 1606 | static int nvme_pci_configure_admin_queue(struct nvme_dev *dev) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1607 | { |
Matthew Wilcox | ba47e38 | 2013-05-04 06:43:16 -0400 | [diff] [blame] | 1608 | int result; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1609 | u32 aqa; |
| 1610 | struct nvme_queue *nvmeq; |
Keith Busch | 1d09062 | 2014-06-23 11:34:01 -0600 | [diff] [blame] | 1611 | |
Xu Yu | 97f6ef6 | 2017-05-24 16:39:55 +0800 | [diff] [blame] | 1612 | result = nvme_remap_bar(dev, db_bar_size(dev, 0)); |
| 1613 | if (result < 0) |
| 1614 | return result; |
| 1615 | |
Gabriel Krisman Bertazi | 8ef2074 | 2016-10-19 09:51:05 -0600 | [diff] [blame] | 1616 | dev->subsystem = readl(dev->bar + NVME_REG_VS) >= NVME_VS(1, 1, 0) ? |
Sagi Grimberg | 20d0dfe | 2017-06-27 22:16:38 +0300 | [diff] [blame] | 1617 | NVME_CAP_NSSRC(dev->ctrl.cap) : 0; |
Keith Busch | dfbac8c | 2015-08-10 15:20:40 -0600 | [diff] [blame] | 1618 | |
Christoph Hellwig | 7a67cbe | 2015-11-20 08:58:10 +0100 | [diff] [blame] | 1619 | if (dev->subsystem && |
| 1620 | (readl(dev->bar + NVME_REG_CSTS) & NVME_CSTS_NSSRO)) |
| 1621 | writel(NVME_CSTS_NSSRO, dev->bar + NVME_REG_CSTS); |
Keith Busch | dfbac8c | 2015-08-10 15:20:40 -0600 | [diff] [blame] | 1622 | |
Sagi Grimberg | 20d0dfe | 2017-06-27 22:16:38 +0300 | [diff] [blame] | 1623 | result = nvme_disable_ctrl(&dev->ctrl, dev->ctrl.cap); |
Matthew Wilcox | ba47e38 | 2013-05-04 06:43:16 -0400 | [diff] [blame] | 1624 | if (result < 0) |
| 1625 | return result; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1626 | |
Keith Busch | a6ff726 | 2018-04-12 09:16:09 -0600 | [diff] [blame] | 1627 | result = nvme_alloc_queue(dev, 0, NVME_AQ_DEPTH); |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 1628 | if (result) |
| 1629 | return result; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1630 | |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 1631 | nvmeq = &dev->queues[0]; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1632 | aqa = nvmeq->q_depth - 1; |
| 1633 | aqa |= aqa << 16; |
| 1634 | |
Christoph Hellwig | 7a67cbe | 2015-11-20 08:58:10 +0100 | [diff] [blame] | 1635 | writel(aqa, dev->bar + NVME_REG_AQA); |
| 1636 | lo_hi_writeq(nvmeq->sq_dma_addr, dev->bar + NVME_REG_ASQ); |
| 1637 | lo_hi_writeq(nvmeq->cq_dma_addr, dev->bar + NVME_REG_ACQ); |
Keith Busch | 1d09062 | 2014-06-23 11:34:01 -0600 | [diff] [blame] | 1638 | |
Sagi Grimberg | 20d0dfe | 2017-06-27 22:16:38 +0300 | [diff] [blame] | 1639 | result = nvme_enable_ctrl(&dev->ctrl, dev->ctrl.cap); |
Keith Busch | 025c557 | 2013-05-01 13:07:51 -0600 | [diff] [blame] | 1640 | if (result) |
Keith Busch | d487562 | 2016-11-15 15:56:26 -0500 | [diff] [blame] | 1641 | return result; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 1642 | |
Keith Busch | 2b25d98 | 2014-12-22 12:59:04 -0700 | [diff] [blame] | 1643 | nvmeq->cq_vector = 0; |
Keith Busch | 161b8be | 2017-09-14 13:54:39 -0400 | [diff] [blame] | 1644 | nvme_init_queue(nvmeq, 0); |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 1645 | result = queue_request_irq(nvmeq); |
Jon Derrick | 758dd7f | 2015-06-30 11:22:52 -0600 | [diff] [blame] | 1646 | if (result) { |
| 1647 | nvmeq->cq_vector = -1; |
Keith Busch | d487562 | 2016-11-15 15:56:26 -0500 | [diff] [blame] | 1648 | return result; |
Jon Derrick | 758dd7f | 2015-06-30 11:22:52 -0600 | [diff] [blame] | 1649 | } |
Keith Busch | 025c557 | 2013-05-01 13:07:51 -0600 | [diff] [blame] | 1650 | |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1651 | return result; |
| 1652 | } |
| 1653 | |
Christoph Hellwig | 749941f | 2015-11-26 11:46:39 +0100 | [diff] [blame] | 1654 | static int nvme_create_io_queues(struct nvme_dev *dev) |
Keith Busch | 42f6142 | 2014-03-24 10:46:25 -0600 | [diff] [blame] | 1655 | { |
Keith Busch | 949928c | 2015-12-17 17:08:15 -0700 | [diff] [blame] | 1656 | unsigned i, max; |
Christoph Hellwig | 749941f | 2015-11-26 11:46:39 +0100 | [diff] [blame] | 1657 | int ret = 0; |
Keith Busch | 42f6142 | 2014-03-24 10:46:25 -0600 | [diff] [blame] | 1658 | |
Sagi Grimberg | d858e5f | 2017-04-24 10:58:29 +0300 | [diff] [blame] | 1659 | for (i = dev->ctrl.queue_count; i <= dev->max_qid; i++) { |
Keith Busch | a6ff726 | 2018-04-12 09:16:09 -0600 | [diff] [blame] | 1660 | if (nvme_alloc_queue(dev, i, dev->q_depth)) { |
Christoph Hellwig | 749941f | 2015-11-26 11:46:39 +0100 | [diff] [blame] | 1661 | ret = -ENOMEM; |
Keith Busch | 42f6142 | 2014-03-24 10:46:25 -0600 | [diff] [blame] | 1662 | break; |
Christoph Hellwig | 749941f | 2015-11-26 11:46:39 +0100 | [diff] [blame] | 1663 | } |
| 1664 | } |
Keith Busch | 42f6142 | 2014-03-24 10:46:25 -0600 | [diff] [blame] | 1665 | |
Sagi Grimberg | d858e5f | 2017-04-24 10:58:29 +0300 | [diff] [blame] | 1666 | max = min(dev->max_qid, dev->ctrl.queue_count - 1); |
Keith Busch | 949928c | 2015-12-17 17:08:15 -0700 | [diff] [blame] | 1667 | for (i = dev->online_queues; i <= max; i++) { |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 1668 | ret = nvme_create_queue(&dev->queues[i], i); |
Keith Busch | d487562 | 2016-11-15 15:56:26 -0500 | [diff] [blame] | 1669 | if (ret) |
Keith Busch | 42f6142 | 2014-03-24 10:46:25 -0600 | [diff] [blame] | 1670 | break; |
Matthew Wilcox | 27e8166 | 2014-04-11 11:58:45 -0400 | [diff] [blame] | 1671 | } |
Christoph Hellwig | 749941f | 2015-11-26 11:46:39 +0100 | [diff] [blame] | 1672 | |
| 1673 | /* |
| 1674 | * Ignore failing Create SQ/CQ commands, we can continue with less |
Minwoo Im | 8adb8c1 | 2018-01-14 16:14:27 +0900 | [diff] [blame] | 1675 | * than the desired amount of queues, and even a controller without |
| 1676 | * I/O queues can still be used to issue admin commands. This might |
Christoph Hellwig | 749941f | 2015-11-26 11:46:39 +0100 | [diff] [blame] | 1677 | * be useful to upgrade a buggy firmware for example. |
| 1678 | */ |
| 1679 | return ret >= 0 ? 0 : ret; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1680 | } |
| 1681 | |
Stephen Bates | 202021c | 2016-10-05 20:01:12 -0600 | [diff] [blame] | 1682 | static ssize_t nvme_cmb_show(struct device *dev, |
| 1683 | struct device_attribute *attr, |
| 1684 | char *buf) |
| 1685 | { |
| 1686 | struct nvme_dev *ndev = to_nvme_dev(dev_get_drvdata(dev)); |
| 1687 | |
Stephen Bates | c965809 | 2016-12-16 11:54:50 -0700 | [diff] [blame] | 1688 | return scnprintf(buf, PAGE_SIZE, "cmbloc : x%08x\ncmbsz : x%08x\n", |
Stephen Bates | 202021c | 2016-10-05 20:01:12 -0600 | [diff] [blame] | 1689 | ndev->cmbloc, ndev->cmbsz); |
| 1690 | } |
| 1691 | static DEVICE_ATTR(cmb, S_IRUGO, nvme_cmb_show, NULL); |
| 1692 | |
Christoph Hellwig | 88de459 | 2017-12-20 14:50:00 +0100 | [diff] [blame] | 1693 | static u64 nvme_cmb_size_unit(struct nvme_dev *dev) |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1694 | { |
Christoph Hellwig | 88de459 | 2017-12-20 14:50:00 +0100 | [diff] [blame] | 1695 | u8 szu = (dev->cmbsz >> NVME_CMBSZ_SZU_SHIFT) & NVME_CMBSZ_SZU_MASK; |
| 1696 | |
| 1697 | return 1ULL << (12 + 4 * szu); |
| 1698 | } |
| 1699 | |
| 1700 | static u32 nvme_cmb_size(struct nvme_dev *dev) |
| 1701 | { |
| 1702 | return (dev->cmbsz >> NVME_CMBSZ_SZ_SHIFT) & NVME_CMBSZ_SZ_MASK; |
| 1703 | } |
| 1704 | |
Christoph Hellwig | f65efd6 | 2017-12-20 14:25:11 +0100 | [diff] [blame] | 1705 | static void nvme_map_cmb(struct nvme_dev *dev) |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1706 | { |
Christoph Hellwig | 88de459 | 2017-12-20 14:50:00 +0100 | [diff] [blame] | 1707 | u64 size, offset; |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1708 | resource_size_t bar_size; |
| 1709 | struct pci_dev *pdev = to_pci_dev(dev->dev); |
Christoph Hellwig | 8969f1f | 2017-10-01 09:37:35 +0200 | [diff] [blame] | 1710 | int bar; |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1711 | |
Christoph Hellwig | 7a67cbe | 2015-11-20 08:58:10 +0100 | [diff] [blame] | 1712 | dev->cmbsz = readl(dev->bar + NVME_REG_CMBSZ); |
Christoph Hellwig | f65efd6 | 2017-12-20 14:25:11 +0100 | [diff] [blame] | 1713 | if (!dev->cmbsz) |
| 1714 | return; |
Stephen Bates | 202021c | 2016-10-05 20:01:12 -0600 | [diff] [blame] | 1715 | dev->cmbloc = readl(dev->bar + NVME_REG_CMBLOC); |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1716 | |
Stephen Bates | 202021c | 2016-10-05 20:01:12 -0600 | [diff] [blame] | 1717 | if (!use_cmb_sqes) |
Christoph Hellwig | f65efd6 | 2017-12-20 14:25:11 +0100 | [diff] [blame] | 1718 | return; |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1719 | |
Christoph Hellwig | 88de459 | 2017-12-20 14:50:00 +0100 | [diff] [blame] | 1720 | size = nvme_cmb_size_unit(dev) * nvme_cmb_size(dev); |
| 1721 | offset = nvme_cmb_size_unit(dev) * NVME_CMB_OFST(dev->cmbloc); |
Christoph Hellwig | 8969f1f | 2017-10-01 09:37:35 +0200 | [diff] [blame] | 1722 | bar = NVME_CMB_BIR(dev->cmbloc); |
| 1723 | bar_size = pci_resource_len(pdev, bar); |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1724 | |
| 1725 | if (offset > bar_size) |
Christoph Hellwig | f65efd6 | 2017-12-20 14:25:11 +0100 | [diff] [blame] | 1726 | return; |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1727 | |
| 1728 | /* |
| 1729 | * Controllers may support a CMB size larger than their BAR, |
| 1730 | * for example, due to being behind a bridge. Reduce the CMB to |
| 1731 | * the reported size of the BAR |
| 1732 | */ |
| 1733 | if (size > bar_size - offset) |
| 1734 | size = bar_size - offset; |
| 1735 | |
Christoph Hellwig | f65efd6 | 2017-12-20 14:25:11 +0100 | [diff] [blame] | 1736 | dev->cmb = ioremap_wc(pci_resource_start(pdev, bar) + offset, size); |
| 1737 | if (!dev->cmb) |
| 1738 | return; |
Christoph Hellwig | 8969f1f | 2017-10-01 09:37:35 +0200 | [diff] [blame] | 1739 | dev->cmb_bus_addr = pci_bus_address(pdev, bar) + offset; |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1740 | dev->cmb_size = size; |
Christoph Hellwig | f65efd6 | 2017-12-20 14:25:11 +0100 | [diff] [blame] | 1741 | |
| 1742 | if (sysfs_add_file_to_group(&dev->ctrl.device->kobj, |
| 1743 | &dev_attr_cmb.attr, NULL)) |
| 1744 | dev_warn(dev->ctrl.device, |
| 1745 | "failed to add sysfs attribute for CMB\n"); |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1746 | } |
| 1747 | |
| 1748 | static inline void nvme_release_cmb(struct nvme_dev *dev) |
| 1749 | { |
| 1750 | if (dev->cmb) { |
| 1751 | iounmap(dev->cmb); |
| 1752 | dev->cmb = NULL; |
Max Gurtovoy | 1c78f77 | 2017-07-30 01:45:08 +0300 | [diff] [blame] | 1753 | sysfs_remove_file_from_group(&dev->ctrl.device->kobj, |
| 1754 | &dev_attr_cmb.attr, NULL); |
| 1755 | dev->cmbsz = 0; |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1756 | } |
| 1757 | } |
| 1758 | |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1759 | static int nvme_set_host_mem(struct nvme_dev *dev, u32 bits) |
Keith Busch | 9d713c2 | 2013-07-15 15:02:24 -0600 | [diff] [blame] | 1760 | { |
Christoph Hellwig | 4033f35 | 2017-08-28 10:47:18 +0200 | [diff] [blame] | 1761 | u64 dma_addr = dev->host_mem_descs_dma; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1762 | struct nvme_command c; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1763 | int ret; |
| 1764 | |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1765 | memset(&c, 0, sizeof(c)); |
| 1766 | c.features.opcode = nvme_admin_set_features; |
| 1767 | c.features.fid = cpu_to_le32(NVME_FEAT_HOST_MEM_BUF); |
| 1768 | c.features.dword11 = cpu_to_le32(bits); |
| 1769 | c.features.dword12 = cpu_to_le32(dev->host_mem_size >> |
| 1770 | ilog2(dev->ctrl.page_size)); |
| 1771 | c.features.dword13 = cpu_to_le32(lower_32_bits(dma_addr)); |
| 1772 | c.features.dword14 = cpu_to_le32(upper_32_bits(dma_addr)); |
| 1773 | c.features.dword15 = cpu_to_le32(dev->nr_host_mem_descs); |
| 1774 | |
| 1775 | ret = nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0); |
| 1776 | if (ret) { |
| 1777 | dev_warn(dev->ctrl.device, |
| 1778 | "failed to set host mem (err %d, flags %#x).\n", |
| 1779 | ret, bits); |
| 1780 | } |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1781 | return ret; |
| 1782 | } |
| 1783 | |
| 1784 | static void nvme_free_host_mem(struct nvme_dev *dev) |
| 1785 | { |
| 1786 | int i; |
| 1787 | |
| 1788 | for (i = 0; i < dev->nr_host_mem_descs; i++) { |
| 1789 | struct nvme_host_mem_buf_desc *desc = &dev->host_mem_descs[i]; |
| 1790 | size_t size = le32_to_cpu(desc->size) * dev->ctrl.page_size; |
| 1791 | |
| 1792 | dma_free_coherent(dev->dev, size, dev->host_mem_desc_bufs[i], |
| 1793 | le64_to_cpu(desc->addr)); |
| 1794 | } |
| 1795 | |
| 1796 | kfree(dev->host_mem_desc_bufs); |
| 1797 | dev->host_mem_desc_bufs = NULL; |
Christoph Hellwig | 4033f35 | 2017-08-28 10:47:18 +0200 | [diff] [blame] | 1798 | dma_free_coherent(dev->dev, |
| 1799 | dev->nr_host_mem_descs * sizeof(*dev->host_mem_descs), |
| 1800 | dev->host_mem_descs, dev->host_mem_descs_dma); |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1801 | dev->host_mem_descs = NULL; |
Minwoo Im | 7e5dd57 | 2017-11-25 03:03:00 +0900 | [diff] [blame] | 1802 | dev->nr_host_mem_descs = 0; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1803 | } |
| 1804 | |
Christoph Hellwig | 92dc689 | 2017-09-11 12:08:43 -0400 | [diff] [blame] | 1805 | static int __nvme_alloc_host_mem(struct nvme_dev *dev, u64 preferred, |
| 1806 | u32 chunk_size) |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1807 | { |
| 1808 | struct nvme_host_mem_buf_desc *descs; |
Christoph Hellwig | 92dc689 | 2017-09-11 12:08:43 -0400 | [diff] [blame] | 1809 | u32 max_entries, len; |
Christoph Hellwig | 4033f35 | 2017-08-28 10:47:18 +0200 | [diff] [blame] | 1810 | dma_addr_t descs_dma; |
Dan Carpenter | 2ee0e4e | 2017-07-06 12:26:52 +0300 | [diff] [blame] | 1811 | int i = 0; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1812 | void **bufs; |
Minwoo Im | 6fbcde6 | 2017-12-05 05:23:54 +0900 | [diff] [blame] | 1813 | u64 size, tmp; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1814 | |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1815 | tmp = (preferred + chunk_size - 1); |
| 1816 | do_div(tmp, chunk_size); |
| 1817 | max_entries = tmp; |
Christoph Hellwig | 044a9df | 2017-09-11 12:09:28 -0400 | [diff] [blame] | 1818 | |
| 1819 | if (dev->ctrl.hmmaxd && dev->ctrl.hmmaxd < max_entries) |
| 1820 | max_entries = dev->ctrl.hmmaxd; |
| 1821 | |
Christoph Hellwig | 4033f35 | 2017-08-28 10:47:18 +0200 | [diff] [blame] | 1822 | descs = dma_zalloc_coherent(dev->dev, max_entries * sizeof(*descs), |
| 1823 | &descs_dma, GFP_KERNEL); |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1824 | if (!descs) |
| 1825 | goto out; |
| 1826 | |
| 1827 | bufs = kcalloc(max_entries, sizeof(*bufs), GFP_KERNEL); |
| 1828 | if (!bufs) |
| 1829 | goto out_free_descs; |
| 1830 | |
Minwoo Im | 244a8fe | 2017-11-17 01:34:24 +0900 | [diff] [blame] | 1831 | for (size = 0; size < preferred && i < max_entries; size += len) { |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1832 | dma_addr_t dma_addr; |
| 1833 | |
Christoph Hellwig | 50cdb7c | 2017-07-25 17:39:07 +0200 | [diff] [blame] | 1834 | len = min_t(u64, chunk_size, preferred - size); |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1835 | bufs[i] = dma_alloc_attrs(dev->dev, len, &dma_addr, GFP_KERNEL, |
| 1836 | DMA_ATTR_NO_KERNEL_MAPPING | DMA_ATTR_NO_WARN); |
| 1837 | if (!bufs[i]) |
| 1838 | break; |
| 1839 | |
| 1840 | descs[i].addr = cpu_to_le64(dma_addr); |
| 1841 | descs[i].size = cpu_to_le32(len / dev->ctrl.page_size); |
| 1842 | i++; |
| 1843 | } |
| 1844 | |
Christoph Hellwig | 92dc689 | 2017-09-11 12:08:43 -0400 | [diff] [blame] | 1845 | if (!size) |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1846 | goto out_free_bufs; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1847 | |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1848 | dev->nr_host_mem_descs = i; |
| 1849 | dev->host_mem_size = size; |
| 1850 | dev->host_mem_descs = descs; |
Christoph Hellwig | 4033f35 | 2017-08-28 10:47:18 +0200 | [diff] [blame] | 1851 | dev->host_mem_descs_dma = descs_dma; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1852 | dev->host_mem_desc_bufs = bufs; |
| 1853 | return 0; |
| 1854 | |
| 1855 | out_free_bufs: |
| 1856 | while (--i >= 0) { |
| 1857 | size_t size = le32_to_cpu(descs[i].size) * dev->ctrl.page_size; |
| 1858 | |
| 1859 | dma_free_coherent(dev->dev, size, bufs[i], |
| 1860 | le64_to_cpu(descs[i].addr)); |
| 1861 | } |
| 1862 | |
| 1863 | kfree(bufs); |
| 1864 | out_free_descs: |
Christoph Hellwig | 4033f35 | 2017-08-28 10:47:18 +0200 | [diff] [blame] | 1865 | dma_free_coherent(dev->dev, max_entries * sizeof(*descs), descs, |
| 1866 | descs_dma); |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1867 | out: |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1868 | dev->host_mem_descs = NULL; |
| 1869 | return -ENOMEM; |
| 1870 | } |
| 1871 | |
Christoph Hellwig | 92dc689 | 2017-09-11 12:08:43 -0400 | [diff] [blame] | 1872 | static int nvme_alloc_host_mem(struct nvme_dev *dev, u64 min, u64 preferred) |
| 1873 | { |
| 1874 | u32 chunk_size; |
| 1875 | |
| 1876 | /* start big and work our way down */ |
Akinobu Mita | 30f92d6 | 2017-09-06 12:15:31 +0200 | [diff] [blame] | 1877 | for (chunk_size = min_t(u64, preferred, PAGE_SIZE * MAX_ORDER_NR_PAGES); |
Christoph Hellwig | 044a9df | 2017-09-11 12:09:28 -0400 | [diff] [blame] | 1878 | chunk_size >= max_t(u32, dev->ctrl.hmminds * 4096, PAGE_SIZE * 2); |
Christoph Hellwig | 92dc689 | 2017-09-11 12:08:43 -0400 | [diff] [blame] | 1879 | chunk_size /= 2) { |
| 1880 | if (!__nvme_alloc_host_mem(dev, preferred, chunk_size)) { |
| 1881 | if (!min || dev->host_mem_size >= min) |
| 1882 | return 0; |
| 1883 | nvme_free_host_mem(dev); |
| 1884 | } |
| 1885 | } |
| 1886 | |
| 1887 | return -ENOMEM; |
| 1888 | } |
| 1889 | |
Christoph Hellwig | 9620cfb | 2017-09-06 12:19:57 +0200 | [diff] [blame] | 1890 | static int nvme_setup_host_mem(struct nvme_dev *dev) |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1891 | { |
| 1892 | u64 max = (u64)max_host_mem_size_mb * SZ_1M; |
| 1893 | u64 preferred = (u64)dev->ctrl.hmpre * 4096; |
| 1894 | u64 min = (u64)dev->ctrl.hmmin * 4096; |
| 1895 | u32 enable_bits = NVME_HOST_MEM_ENABLE; |
Minwoo Im | 6fbcde6 | 2017-12-05 05:23:54 +0900 | [diff] [blame] | 1896 | int ret; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1897 | |
| 1898 | preferred = min(preferred, max); |
| 1899 | if (min > max) { |
| 1900 | dev_warn(dev->ctrl.device, |
| 1901 | "min host memory (%lld MiB) above limit (%d MiB).\n", |
| 1902 | min >> ilog2(SZ_1M), max_host_mem_size_mb); |
| 1903 | nvme_free_host_mem(dev); |
Christoph Hellwig | 9620cfb | 2017-09-06 12:19:57 +0200 | [diff] [blame] | 1904 | return 0; |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1905 | } |
| 1906 | |
| 1907 | /* |
| 1908 | * If we already have a buffer allocated check if we can reuse it. |
| 1909 | */ |
| 1910 | if (dev->host_mem_descs) { |
| 1911 | if (dev->host_mem_size >= min) |
| 1912 | enable_bits |= NVME_HOST_MEM_RETURN; |
| 1913 | else |
| 1914 | nvme_free_host_mem(dev); |
| 1915 | } |
| 1916 | |
| 1917 | if (!dev->host_mem_descs) { |
Christoph Hellwig | 92dc689 | 2017-09-11 12:08:43 -0400 | [diff] [blame] | 1918 | if (nvme_alloc_host_mem(dev, min, preferred)) { |
| 1919 | dev_warn(dev->ctrl.device, |
| 1920 | "failed to allocate host memory buffer.\n"); |
Christoph Hellwig | 9620cfb | 2017-09-06 12:19:57 +0200 | [diff] [blame] | 1921 | return 0; /* controller must work without HMB */ |
Christoph Hellwig | 92dc689 | 2017-09-11 12:08:43 -0400 | [diff] [blame] | 1922 | } |
| 1923 | |
| 1924 | dev_info(dev->ctrl.device, |
| 1925 | "allocated %lld MiB host memory buffer.\n", |
| 1926 | dev->host_mem_size >> ilog2(SZ_1M)); |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1927 | } |
| 1928 | |
Christoph Hellwig | 9620cfb | 2017-09-06 12:19:57 +0200 | [diff] [blame] | 1929 | ret = nvme_set_host_mem(dev, enable_bits); |
| 1930 | if (ret) |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 1931 | nvme_free_host_mem(dev); |
Christoph Hellwig | 9620cfb | 2017-09-06 12:19:57 +0200 | [diff] [blame] | 1932 | return ret; |
Keith Busch | 9d713c2 | 2013-07-15 15:02:24 -0600 | [diff] [blame] | 1933 | } |
| 1934 | |
Greg Kroah-Hartman | 8d85fce | 2012-12-21 15:13:49 -0800 | [diff] [blame] | 1935 | static int nvme_setup_io_queues(struct nvme_dev *dev) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1936 | { |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 1937 | struct nvme_queue *adminq = &dev->queues[0]; |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 1938 | struct pci_dev *pdev = to_pci_dev(dev->dev); |
Xu Yu | 97f6ef6 | 2017-05-24 16:39:55 +0800 | [diff] [blame] | 1939 | int result, nr_io_queues; |
| 1940 | unsigned long size; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1941 | |
Keith Busch | 22b5560 | 2018-04-12 09:16:10 -0600 | [diff] [blame] | 1942 | struct irq_affinity affd = { |
| 1943 | .pre_vectors = 1 |
| 1944 | }; |
| 1945 | |
Ming Lei | 16ccfff | 2018-02-06 20:17:42 +0800 | [diff] [blame] | 1946 | nr_io_queues = num_possible_cpus(); |
Christoph Hellwig | 9a0be7a | 2015-11-26 11:09:06 +0100 | [diff] [blame] | 1947 | result = nvme_set_queue_count(&dev->ctrl, &nr_io_queues); |
| 1948 | if (result < 0) |
Matthew Wilcox | 1b23484 | 2011-01-20 13:01:49 -0500 | [diff] [blame] | 1949 | return result; |
Christoph Hellwig | 9a0be7a | 2015-11-26 11:09:06 +0100 | [diff] [blame] | 1950 | |
Christoph Hellwig | f5fa90d | 2016-06-06 23:20:50 +0200 | [diff] [blame] | 1951 | if (nr_io_queues == 0) |
Keith Busch | a522905 | 2016-04-08 16:09:10 -0600 | [diff] [blame] | 1952 | return 0; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 1953 | |
Christoph Hellwig | 88de459 | 2017-12-20 14:50:00 +0100 | [diff] [blame] | 1954 | if (dev->cmb && (dev->cmbsz & NVME_CMBSZ_SQS)) { |
Jon Derrick | 8ffaadf | 2015-07-20 10:14:09 -0600 | [diff] [blame] | 1955 | result = nvme_cmb_qdepth(dev, nr_io_queues, |
| 1956 | sizeof(struct nvme_command)); |
| 1957 | if (result > 0) |
| 1958 | dev->q_depth = result; |
| 1959 | else |
| 1960 | nvme_release_cmb(dev); |
| 1961 | } |
| 1962 | |
Xu Yu | 97f6ef6 | 2017-05-24 16:39:55 +0800 | [diff] [blame] | 1963 | do { |
| 1964 | size = db_bar_size(dev, nr_io_queues); |
| 1965 | result = nvme_remap_bar(dev, size); |
| 1966 | if (!result) |
| 1967 | break; |
| 1968 | if (!--nr_io_queues) |
| 1969 | return -ENOMEM; |
| 1970 | } while (1); |
| 1971 | adminq->q_db = dev->dbs; |
Matthew Wilcox | f1938f6 | 2011-10-20 17:00:41 -0400 | [diff] [blame] | 1972 | |
Keith Busch | 9d713c2 | 2013-07-15 15:02:24 -0600 | [diff] [blame] | 1973 | /* Deregister the admin queue's interrupt */ |
Christoph Hellwig | 0ff199c | 2017-04-13 09:06:43 +0200 | [diff] [blame] | 1974 | pci_free_irq(pdev, 0, adminq); |
Keith Busch | 9d713c2 | 2013-07-15 15:02:24 -0600 | [diff] [blame] | 1975 | |
Jens Axboe | e32efbf | 2014-11-14 09:49:26 -0700 | [diff] [blame] | 1976 | /* |
| 1977 | * If we enable msix early due to not intx, disable it again before |
| 1978 | * setting up the full range we need. |
| 1979 | */ |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 1980 | pci_free_irq_vectors(pdev); |
Keith Busch | 22b5560 | 2018-04-12 09:16:10 -0600 | [diff] [blame] | 1981 | result = pci_alloc_irq_vectors_affinity(pdev, 1, nr_io_queues + 1, |
| 1982 | PCI_IRQ_ALL_TYPES | PCI_IRQ_AFFINITY, &affd); |
| 1983 | if (result <= 0) |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 1984 | return -EIO; |
Keith Busch | 22b5560 | 2018-04-12 09:16:10 -0600 | [diff] [blame] | 1985 | dev->num_vecs = result; |
| 1986 | dev->max_qid = max(result - 1, 1); |
Matthew Wilcox | 1b23484 | 2011-01-20 13:01:49 -0500 | [diff] [blame] | 1987 | |
Matthew Wilcox | 063a809 | 2013-06-20 10:53:48 -0400 | [diff] [blame] | 1988 | /* |
| 1989 | * Should investigate if there's a performance win from allocating |
| 1990 | * more queues than interrupt vectors; it might allow the submission |
| 1991 | * path to scale better, even if the receive path is limited by the |
| 1992 | * number of interrupts. |
| 1993 | */ |
Ramachandra Rao Gajula | fa08a39 | 2013-05-11 15:19:31 -0700 | [diff] [blame] | 1994 | |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 1995 | result = queue_request_irq(adminq); |
Jon Derrick | 758dd7f | 2015-06-30 11:22:52 -0600 | [diff] [blame] | 1996 | if (result) { |
| 1997 | adminq->cq_vector = -1; |
Keith Busch | d487562 | 2016-11-15 15:56:26 -0500 | [diff] [blame] | 1998 | return result; |
Jon Derrick | 758dd7f | 2015-06-30 11:22:52 -0600 | [diff] [blame] | 1999 | } |
Christoph Hellwig | 749941f | 2015-11-26 11:46:39 +0100 | [diff] [blame] | 2000 | return nvme_create_io_queues(dev); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2001 | } |
| 2002 | |
Christoph Hellwig | 2a842ac | 2017-06-03 09:38:04 +0200 | [diff] [blame] | 2003 | static void nvme_del_queue_end(struct request *req, blk_status_t error) |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2004 | { |
| 2005 | struct nvme_queue *nvmeq = req->end_io_data; |
| 2006 | |
| 2007 | blk_mq_free_request(req); |
| 2008 | complete(&nvmeq->dev->ioq_wait); |
| 2009 | } |
| 2010 | |
Christoph Hellwig | 2a842ac | 2017-06-03 09:38:04 +0200 | [diff] [blame] | 2011 | static void nvme_del_cq_end(struct request *req, blk_status_t error) |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2012 | { |
| 2013 | struct nvme_queue *nvmeq = req->end_io_data; |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 2014 | u16 start, end; |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2015 | |
| 2016 | if (!error) { |
| 2017 | unsigned long flags; |
| 2018 | |
Ming Lin | 2e39e0f | 2016-04-05 10:32:04 -0700 | [diff] [blame] | 2019 | /* |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 2020 | * We might be called with the AQ cq_lock held |
| 2021 | * and the I/O queue cq_lock should always |
Ming Lin | 2e39e0f | 2016-04-05 10:32:04 -0700 | [diff] [blame] | 2022 | * nest inside the AQ one. |
| 2023 | */ |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 2024 | spin_lock_irqsave_nested(&nvmeq->cq_lock, flags, |
Ming Lin | 2e39e0f | 2016-04-05 10:32:04 -0700 | [diff] [blame] | 2025 | SINGLE_DEPTH_NESTING); |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 2026 | nvme_process_cq(nvmeq, &start, &end, -1); |
Jens Axboe | 1ab0cd6 | 2018-05-17 18:31:51 +0200 | [diff] [blame] | 2027 | spin_unlock_irqrestore(&nvmeq->cq_lock, flags); |
Jens Axboe | 5cb525c | 2018-05-17 18:31:50 +0200 | [diff] [blame] | 2028 | |
| 2029 | nvme_complete_cqes(nvmeq, start, end); |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2030 | } |
| 2031 | |
| 2032 | nvme_del_queue_end(req, error); |
| 2033 | } |
| 2034 | |
| 2035 | static int nvme_delete_queue(struct nvme_queue *nvmeq, u8 opcode) |
| 2036 | { |
| 2037 | struct request_queue *q = nvmeq->dev->ctrl.admin_q; |
| 2038 | struct request *req; |
| 2039 | struct nvme_command cmd; |
| 2040 | |
| 2041 | memset(&cmd, 0, sizeof(cmd)); |
| 2042 | cmd.delete_queue.opcode = opcode; |
| 2043 | cmd.delete_queue.qid = cpu_to_le16(nvmeq->qid); |
| 2044 | |
Christoph Hellwig | eb71f43 | 2016-06-13 16:45:23 +0200 | [diff] [blame] | 2045 | req = nvme_alloc_request(q, &cmd, BLK_MQ_REQ_NOWAIT, NVME_QID_ANY); |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2046 | if (IS_ERR(req)) |
| 2047 | return PTR_ERR(req); |
| 2048 | |
| 2049 | req->timeout = ADMIN_TIMEOUT; |
| 2050 | req->end_io_data = nvmeq; |
| 2051 | |
| 2052 | blk_execute_rq_nowait(q, NULL, req, false, |
| 2053 | opcode == nvme_admin_delete_cq ? |
| 2054 | nvme_del_cq_end : nvme_del_queue_end); |
| 2055 | return 0; |
| 2056 | } |
| 2057 | |
Keith Busch | ee9aebb | 2018-01-24 14:55:12 -0700 | [diff] [blame] | 2058 | static void nvme_disable_io_queues(struct nvme_dev *dev) |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2059 | { |
Keith Busch | ee9aebb | 2018-01-24 14:55:12 -0700 | [diff] [blame] | 2060 | int pass, queues = dev->online_queues - 1; |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2061 | unsigned long timeout; |
| 2062 | u8 opcode = nvme_admin_delete_sq; |
| 2063 | |
| 2064 | for (pass = 0; pass < 2; pass++) { |
Keith Busch | 014a0d6 | 2016-05-06 11:50:52 -0600 | [diff] [blame] | 2065 | int sent = 0, i = queues; |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2066 | |
| 2067 | reinit_completion(&dev->ioq_wait); |
| 2068 | retry: |
| 2069 | timeout = ADMIN_TIMEOUT; |
Gabriel Krisman Bertazi | c21377f | 2016-08-11 09:35:57 -0600 | [diff] [blame] | 2070 | for (; i > 0; i--, sent++) |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 2071 | if (nvme_delete_queue(&dev->queues[i], opcode)) |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2072 | break; |
Gabriel Krisman Bertazi | c21377f | 2016-08-11 09:35:57 -0600 | [diff] [blame] | 2073 | |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2074 | while (sent--) { |
| 2075 | timeout = wait_for_completion_io_timeout(&dev->ioq_wait, timeout); |
| 2076 | if (timeout == 0) |
| 2077 | return; |
| 2078 | if (i) |
| 2079 | goto retry; |
| 2080 | } |
| 2081 | opcode = nvme_admin_delete_cq; |
| 2082 | } |
| 2083 | } |
| 2084 | |
Matthew Wilcox | 422ef0c | 2013-04-16 11:22:36 -0400 | [diff] [blame] | 2085 | /* |
Jianchao Wang | 2b1b7e7 | 2018-01-06 08:01:58 +0800 | [diff] [blame] | 2086 | * return error value only when tagset allocation failed |
Matthew Wilcox | 422ef0c | 2013-04-16 11:22:36 -0400 | [diff] [blame] | 2087 | */ |
Greg Kroah-Hartman | 8d85fce | 2012-12-21 15:13:49 -0800 | [diff] [blame] | 2088 | static int nvme_dev_add(struct nvme_dev *dev) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2089 | { |
Jianchao Wang | 2b1b7e7 | 2018-01-06 08:01:58 +0800 | [diff] [blame] | 2090 | int ret; |
| 2091 | |
Christoph Hellwig | 5bae7f7 | 2015-11-28 15:39:07 +0100 | [diff] [blame] | 2092 | if (!dev->ctrl.tagset) { |
Keith Busch | ffe7704 | 2015-06-08 10:08:15 -0600 | [diff] [blame] | 2093 | dev->tagset.ops = &nvme_mq_ops; |
| 2094 | dev->tagset.nr_hw_queues = dev->online_queues - 1; |
| 2095 | dev->tagset.timeout = NVME_IO_TIMEOUT; |
| 2096 | dev->tagset.numa_node = dev_to_node(dev->dev); |
| 2097 | dev->tagset.queue_depth = |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 2098 | min_t(int, dev->q_depth, BLK_MQ_MAX_DEPTH) - 1; |
Chaitanya Kulkarni | a7a7cbe | 2017-10-16 18:24:20 -0700 | [diff] [blame] | 2099 | dev->tagset.cmd_size = nvme_pci_cmd_size(dev, false); |
| 2100 | if ((dev->ctrl.sgls & ((1 << 0) | (1 << 1))) && sgl_threshold) { |
| 2101 | dev->tagset.cmd_size = max(dev->tagset.cmd_size, |
| 2102 | nvme_pci_cmd_size(dev, true)); |
| 2103 | } |
Keith Busch | ffe7704 | 2015-06-08 10:08:15 -0600 | [diff] [blame] | 2104 | dev->tagset.flags = BLK_MQ_F_SHOULD_MERGE; |
| 2105 | dev->tagset.driver_data = dev; |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 2106 | |
Jianchao Wang | 2b1b7e7 | 2018-01-06 08:01:58 +0800 | [diff] [blame] | 2107 | ret = blk_mq_alloc_tag_set(&dev->tagset); |
| 2108 | if (ret) { |
| 2109 | dev_warn(dev->ctrl.device, |
| 2110 | "IO queues tagset allocation failed %d\n", ret); |
| 2111 | return ret; |
| 2112 | } |
Christoph Hellwig | 5bae7f7 | 2015-11-28 15:39:07 +0100 | [diff] [blame] | 2113 | dev->ctrl.tagset = &dev->tagset; |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 2114 | |
| 2115 | nvme_dbbuf_set(dev); |
Keith Busch | 949928c | 2015-12-17 17:08:15 -0700 | [diff] [blame] | 2116 | } else { |
| 2117 | blk_mq_update_nr_hw_queues(&dev->tagset, dev->online_queues - 1); |
| 2118 | |
| 2119 | /* Free previously allocated queues that are no longer usable */ |
| 2120 | nvme_free_queues(dev, dev->online_queues); |
Keith Busch | ffe7704 | 2015-06-08 10:08:15 -0600 | [diff] [blame] | 2121 | } |
Keith Busch | 949928c | 2015-12-17 17:08:15 -0700 | [diff] [blame] | 2122 | |
Keith Busch | e1e5e56 | 2015-02-19 13:39:03 -0700 | [diff] [blame] | 2123 | return 0; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2124 | } |
| 2125 | |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2126 | static int nvme_pci_enable(struct nvme_dev *dev) |
Keith Busch | 0877cb0 | 2013-07-15 15:02:19 -0600 | [diff] [blame] | 2127 | { |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2128 | int result = -ENOMEM; |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 2129 | struct pci_dev *pdev = to_pci_dev(dev->dev); |
Keith Busch | 0877cb0 | 2013-07-15 15:02:19 -0600 | [diff] [blame] | 2130 | |
| 2131 | if (pci_enable_device_mem(pdev)) |
| 2132 | return result; |
| 2133 | |
Keith Busch | 0877cb0 | 2013-07-15 15:02:19 -0600 | [diff] [blame] | 2134 | pci_set_master(pdev); |
Keith Busch | 0877cb0 | 2013-07-15 15:02:19 -0600 | [diff] [blame] | 2135 | |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 2136 | if (dma_set_mask_and_coherent(dev->dev, DMA_BIT_MASK(64)) && |
| 2137 | dma_set_mask_and_coherent(dev->dev, DMA_BIT_MASK(32))) |
Russell King | 052d0ef | 2013-06-26 23:49:11 +0100 | [diff] [blame] | 2138 | goto disable; |
Keith Busch | 0877cb0 | 2013-07-15 15:02:19 -0600 | [diff] [blame] | 2139 | |
Christoph Hellwig | 7a67cbe | 2015-11-20 08:58:10 +0100 | [diff] [blame] | 2140 | if (readl(dev->bar + NVME_REG_CSTS) == -1) { |
Keith Busch | 0e53d18 | 2013-12-10 13:10:39 -0700 | [diff] [blame] | 2141 | result = -ENODEV; |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2142 | goto disable; |
Keith Busch | 0e53d18 | 2013-12-10 13:10:39 -0700 | [diff] [blame] | 2143 | } |
Jens Axboe | e32efbf | 2014-11-14 09:49:26 -0700 | [diff] [blame] | 2144 | |
| 2145 | /* |
Keith Busch | a522905 | 2016-04-08 16:09:10 -0600 | [diff] [blame] | 2146 | * Some devices and/or platforms don't advertise or work with INTx |
| 2147 | * interrupts. Pre-enable a single MSIX or MSI vec for setup. We'll |
| 2148 | * adjust this later. |
Jens Axboe | e32efbf | 2014-11-14 09:49:26 -0700 | [diff] [blame] | 2149 | */ |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 2150 | result = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_ALL_TYPES); |
| 2151 | if (result < 0) |
| 2152 | return result; |
Jens Axboe | e32efbf | 2014-11-14 09:49:26 -0700 | [diff] [blame] | 2153 | |
Sagi Grimberg | 20d0dfe | 2017-06-27 22:16:38 +0300 | [diff] [blame] | 2154 | dev->ctrl.cap = lo_hi_readq(dev->bar + NVME_REG_CAP); |
Christoph Hellwig | 7a67cbe | 2015-11-20 08:58:10 +0100 | [diff] [blame] | 2155 | |
Sagi Grimberg | 20d0dfe | 2017-06-27 22:16:38 +0300 | [diff] [blame] | 2156 | dev->q_depth = min_t(int, NVME_CAP_MQES(dev->ctrl.cap) + 1, |
weiping zhang | b27c1e6 | 2017-07-10 16:46:59 +0800 | [diff] [blame] | 2157 | io_queue_depth); |
Sagi Grimberg | 20d0dfe | 2017-06-27 22:16:38 +0300 | [diff] [blame] | 2158 | dev->db_stride = 1 << NVME_CAP_STRIDE(dev->ctrl.cap); |
Christoph Hellwig | 7a67cbe | 2015-11-20 08:58:10 +0100 | [diff] [blame] | 2159 | dev->dbs = dev->bar + 4096; |
Stephan Günther | 1f390c1 | 2015-12-01 13:23:22 -0700 | [diff] [blame] | 2160 | |
| 2161 | /* |
| 2162 | * Temporary fix for the Apple controller found in the MacBook8,1 and |
| 2163 | * some MacBook7,1 to avoid controller resets and data loss. |
| 2164 | */ |
| 2165 | if (pdev->vendor == PCI_VENDOR_ID_APPLE && pdev->device == 0x2001) { |
| 2166 | dev->q_depth = 2; |
Christoph Hellwig | 9bdcfb1 | 2017-05-20 15:14:43 +0200 | [diff] [blame] | 2167 | dev_warn(dev->ctrl.device, "detected Apple NVMe controller, " |
| 2168 | "set queue depth=%u to work around controller resets\n", |
Stephan Günther | 1f390c1 | 2015-12-01 13:23:22 -0700 | [diff] [blame] | 2169 | dev->q_depth); |
Martin K. Petersen | d554b5e | 2017-06-27 22:27:57 -0400 | [diff] [blame] | 2170 | } else if (pdev->vendor == PCI_VENDOR_ID_SAMSUNG && |
| 2171 | (pdev->device == 0xa821 || pdev->device == 0xa822) && |
Sagi Grimberg | 20d0dfe | 2017-06-27 22:16:38 +0300 | [diff] [blame] | 2172 | NVME_CAP_MQES(dev->ctrl.cap) == 0) { |
Martin K. Petersen | d554b5e | 2017-06-27 22:27:57 -0400 | [diff] [blame] | 2173 | dev->q_depth = 64; |
| 2174 | dev_err(dev->ctrl.device, "detected PM1725 NVMe controller, " |
| 2175 | "set queue depth=%u\n", dev->q_depth); |
Stephan Günther | 1f390c1 | 2015-12-01 13:23:22 -0700 | [diff] [blame] | 2176 | } |
| 2177 | |
Christoph Hellwig | f65efd6 | 2017-12-20 14:25:11 +0100 | [diff] [blame] | 2178 | nvme_map_cmb(dev); |
Stephen Bates | 202021c | 2016-10-05 20:01:12 -0600 | [diff] [blame] | 2179 | |
Keith Busch | a0a3408 | 2015-12-07 15:30:31 -0700 | [diff] [blame] | 2180 | pci_enable_pcie_error_reporting(pdev); |
| 2181 | pci_save_state(pdev); |
Keith Busch | 0877cb0 | 2013-07-15 15:02:19 -0600 | [diff] [blame] | 2182 | return 0; |
| 2183 | |
| 2184 | disable: |
Keith Busch | 0877cb0 | 2013-07-15 15:02:19 -0600 | [diff] [blame] | 2185 | pci_disable_device(pdev); |
| 2186 | return result; |
| 2187 | } |
| 2188 | |
| 2189 | static void nvme_dev_unmap(struct nvme_dev *dev) |
| 2190 | { |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2191 | if (dev->bar) |
| 2192 | iounmap(dev->bar); |
Johannes Thumshirn | a1f447b | 2016-06-07 09:44:02 +0200 | [diff] [blame] | 2193 | pci_release_mem_regions(to_pci_dev(dev->dev)); |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2194 | } |
| 2195 | |
| 2196 | static void nvme_pci_disable(struct nvme_dev *dev) |
| 2197 | { |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 2198 | struct pci_dev *pdev = to_pci_dev(dev->dev); |
| 2199 | |
Jon Derrick | f63572d | 2017-05-05 14:52:06 -0600 | [diff] [blame] | 2200 | nvme_release_cmb(dev); |
Christoph Hellwig | dca51e7 | 2016-09-14 16:18:57 +0200 | [diff] [blame] | 2201 | pci_free_irq_vectors(pdev); |
Keith Busch | 0877cb0 | 2013-07-15 15:02:19 -0600 | [diff] [blame] | 2202 | |
Keith Busch | a0a3408 | 2015-12-07 15:30:31 -0700 | [diff] [blame] | 2203 | if (pci_is_enabled(pdev)) { |
| 2204 | pci_disable_pcie_error_reporting(pdev); |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 2205 | pci_disable_device(pdev); |
Keith Busch | 4d11542 | 2013-12-10 13:10:40 -0700 | [diff] [blame] | 2206 | } |
Keith Busch | 4d11542 | 2013-12-10 13:10:40 -0700 | [diff] [blame] | 2207 | } |
| 2208 | |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 2209 | static void nvme_dev_disable(struct nvme_dev *dev, bool shutdown) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2210 | { |
Keith Busch | ee9aebb | 2018-01-24 14:55:12 -0700 | [diff] [blame] | 2211 | int i; |
Keith Busch | 302ad8c | 2017-03-01 14:22:12 -0500 | [diff] [blame] | 2212 | bool dead = true; |
| 2213 | struct pci_dev *pdev = to_pci_dev(dev->dev); |
Keith Busch | 2240427 | 2013-07-15 15:02:20 -0600 | [diff] [blame] | 2214 | |
Keith Busch | 77bf25e | 2015-11-26 12:21:29 +0100 | [diff] [blame] | 2215 | mutex_lock(&dev->shutdown_lock); |
Keith Busch | 302ad8c | 2017-03-01 14:22:12 -0500 | [diff] [blame] | 2216 | if (pci_is_enabled(pdev)) { |
| 2217 | u32 csts = readl(dev->bar + NVME_REG_CSTS); |
| 2218 | |
Keith Busch | ebef736 | 2017-06-27 17:44:05 -0600 | [diff] [blame] | 2219 | if (dev->ctrl.state == NVME_CTRL_LIVE || |
| 2220 | dev->ctrl.state == NVME_CTRL_RESETTING) |
Keith Busch | 302ad8c | 2017-03-01 14:22:12 -0500 | [diff] [blame] | 2221 | nvme_start_freeze(&dev->ctrl); |
| 2222 | dead = !!((csts & NVME_CSTS_CFS) || !(csts & NVME_CSTS_RDY) || |
| 2223 | pdev->error_state != pci_channel_io_normal); |
Keith Busch | c9d3bf8 | 2015-01-07 18:55:52 -0700 | [diff] [blame] | 2224 | } |
Gabriel Krisman Bertazi | c21377f | 2016-08-11 09:35:57 -0600 | [diff] [blame] | 2225 | |
Keith Busch | 302ad8c | 2017-03-01 14:22:12 -0500 | [diff] [blame] | 2226 | /* |
| 2227 | * Give the controller a chance to complete all entered requests if |
| 2228 | * doing a safe shutdown. |
| 2229 | */ |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 2230 | if (!dead) { |
| 2231 | if (shutdown) |
| 2232 | nvme_wait_freeze_timeout(&dev->ctrl, NVME_IO_TIMEOUT); |
Jianchao Wang | 9a915a5 | 2018-02-12 20:57:24 +0800 | [diff] [blame] | 2233 | } |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 2234 | |
Jianchao Wang | 9a915a5 | 2018-02-12 20:57:24 +0800 | [diff] [blame] | 2235 | nvme_stop_queues(&dev->ctrl); |
| 2236 | |
Keith Busch | 64ee0ac | 2018-04-12 09:16:08 -0600 | [diff] [blame] | 2237 | if (!dead && dev->ctrl.queue_count > 0) { |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 2238 | /* |
| 2239 | * If the controller is still alive tell it to stop using the |
| 2240 | * host memory buffer. In theory the shutdown / reset should |
| 2241 | * make sure that it doesn't access the host memoery anymore, |
| 2242 | * but I'd rather be safe than sorry.. |
| 2243 | */ |
| 2244 | if (dev->host_mem_descs) |
| 2245 | nvme_set_host_mem(dev, 0); |
Keith Busch | ee9aebb | 2018-01-24 14:55:12 -0700 | [diff] [blame] | 2246 | nvme_disable_io_queues(dev); |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 2247 | nvme_disable_admin_queue(dev, shutdown); |
Keith Busch | 4d11542 | 2013-12-10 13:10:40 -0700 | [diff] [blame] | 2248 | } |
Keith Busch | ee9aebb | 2018-01-24 14:55:12 -0700 | [diff] [blame] | 2249 | for (i = dev->ctrl.queue_count - 1; i >= 0; i--) |
| 2250 | nvme_suspend_queue(&dev->queues[i]); |
| 2251 | |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2252 | nvme_pci_disable(dev); |
Keith Busch | 07836e6 | 2015-02-19 10:34:48 -0700 | [diff] [blame] | 2253 | |
Ming Lin | e1958e6 | 2016-05-18 14:05:01 -0700 | [diff] [blame] | 2254 | blk_mq_tagset_busy_iter(&dev->tagset, nvme_cancel_request, &dev->ctrl); |
| 2255 | blk_mq_tagset_busy_iter(&dev->admin_tagset, nvme_cancel_request, &dev->ctrl); |
Keith Busch | 302ad8c | 2017-03-01 14:22:12 -0500 | [diff] [blame] | 2256 | |
| 2257 | /* |
| 2258 | * The driver will not be starting up queues again if shutting down so |
| 2259 | * must flush all entered requests to their failed completion to avoid |
| 2260 | * deadlocking blk-mq hot-cpu notifier. |
| 2261 | */ |
| 2262 | if (shutdown) |
| 2263 | nvme_start_queues(&dev->ctrl); |
Keith Busch | 77bf25e | 2015-11-26 12:21:29 +0100 | [diff] [blame] | 2264 | mutex_unlock(&dev->shutdown_lock); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2265 | } |
| 2266 | |
Matthew Wilcox | 091b609 | 2011-02-10 09:56:01 -0500 | [diff] [blame] | 2267 | static int nvme_setup_prp_pools(struct nvme_dev *dev) |
| 2268 | { |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 2269 | dev->prp_page_pool = dma_pool_create("prp list page", dev->dev, |
Matthew Wilcox | 091b609 | 2011-02-10 09:56:01 -0500 | [diff] [blame] | 2270 | PAGE_SIZE, PAGE_SIZE, 0); |
| 2271 | if (!dev->prp_page_pool) |
| 2272 | return -ENOMEM; |
| 2273 | |
Matthew Wilcox | 99802a7 | 2011-02-10 10:30:34 -0500 | [diff] [blame] | 2274 | /* Optimisation for I/Os between 4k and 128k */ |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 2275 | dev->prp_small_pool = dma_pool_create("prp list 256", dev->dev, |
Matthew Wilcox | 99802a7 | 2011-02-10 10:30:34 -0500 | [diff] [blame] | 2276 | 256, 256, 0); |
| 2277 | if (!dev->prp_small_pool) { |
| 2278 | dma_pool_destroy(dev->prp_page_pool); |
| 2279 | return -ENOMEM; |
| 2280 | } |
Matthew Wilcox | 091b609 | 2011-02-10 09:56:01 -0500 | [diff] [blame] | 2281 | return 0; |
| 2282 | } |
| 2283 | |
| 2284 | static void nvme_release_prp_pools(struct nvme_dev *dev) |
| 2285 | { |
| 2286 | dma_pool_destroy(dev->prp_page_pool); |
Matthew Wilcox | 99802a7 | 2011-02-10 10:30:34 -0500 | [diff] [blame] | 2287 | dma_pool_destroy(dev->prp_small_pool); |
Matthew Wilcox | 091b609 | 2011-02-10 09:56:01 -0500 | [diff] [blame] | 2288 | } |
| 2289 | |
Christoph Hellwig | 1673f1f | 2015-11-26 10:54:19 +0100 | [diff] [blame] | 2290 | static void nvme_pci_free_ctrl(struct nvme_ctrl *ctrl) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2291 | { |
Christoph Hellwig | 1673f1f | 2015-11-26 10:54:19 +0100 | [diff] [blame] | 2292 | struct nvme_dev *dev = to_nvme_dev(ctrl); |
Keith Busch | 9ac2709 | 2014-01-31 16:53:39 -0700 | [diff] [blame] | 2293 | |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 2294 | nvme_dbbuf_dma_free(dev); |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 2295 | put_device(dev->dev); |
Keith Busch | 4af0e21 | 2015-06-08 10:08:13 -0600 | [diff] [blame] | 2296 | if (dev->tagset.tags) |
| 2297 | blk_mq_free_tag_set(&dev->tagset); |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 2298 | if (dev->ctrl.admin_q) |
| 2299 | blk_put_queue(dev->ctrl.admin_q); |
Keith Busch | 5e82e95 | 2013-02-19 10:17:58 -0700 | [diff] [blame] | 2300 | kfree(dev->queues); |
Scott Bauer | e286bcf | 2017-02-22 10:15:07 -0700 | [diff] [blame] | 2301 | free_opal_dev(dev->ctrl.opal_dev); |
Keith Busch | 5e82e95 | 2013-02-19 10:17:58 -0700 | [diff] [blame] | 2302 | kfree(dev); |
| 2303 | } |
| 2304 | |
Keith Busch | f58944e | 2016-02-24 09:15:55 -0700 | [diff] [blame] | 2305 | static void nvme_remove_dead_ctrl(struct nvme_dev *dev, int status) |
| 2306 | { |
Linus Torvalds | 237045f | 2016-03-18 17:13:31 -0700 | [diff] [blame] | 2307 | dev_warn(dev->ctrl.device, "Removing after probe failure status: %d\n", status); |
Keith Busch | f58944e | 2016-02-24 09:15:55 -0700 | [diff] [blame] | 2308 | |
Christoph Hellwig | d22524a | 2017-10-18 13:25:42 +0200 | [diff] [blame] | 2309 | nvme_get_ctrl(&dev->ctrl); |
Keith Busch | 69d9a99 | 2016-02-24 09:15:56 -0700 | [diff] [blame] | 2310 | nvme_dev_disable(dev, false); |
Ming Lei | 03e0f3a | 2017-11-09 19:32:07 +0800 | [diff] [blame] | 2311 | if (!queue_work(nvme_wq, &dev->remove_work)) |
Keith Busch | f58944e | 2016-02-24 09:15:55 -0700 | [diff] [blame] | 2312 | nvme_put_ctrl(&dev->ctrl); |
| 2313 | } |
| 2314 | |
Christoph Hellwig | fd634f41 | 2015-11-26 12:42:26 +0100 | [diff] [blame] | 2315 | static void nvme_reset_work(struct work_struct *work) |
Keith Busch | 5e82e95 | 2013-02-19 10:17:58 -0700 | [diff] [blame] | 2316 | { |
Christoph Hellwig | d86c4d8 | 2017-06-15 15:41:08 +0200 | [diff] [blame] | 2317 | struct nvme_dev *dev = |
| 2318 | container_of(work, struct nvme_dev, ctrl.reset_work); |
Scott Bauer | a98e58e5 | 2017-02-03 12:50:32 -0700 | [diff] [blame] | 2319 | bool was_suspend = !!(dev->ctrl.ctrl_config & NVME_CC_SHN_NORMAL); |
Keith Busch | f58944e | 2016-02-24 09:15:55 -0700 | [diff] [blame] | 2320 | int result = -ENODEV; |
Jianchao Wang | 2b1b7e7 | 2018-01-06 08:01:58 +0800 | [diff] [blame] | 2321 | enum nvme_ctrl_state new_state = NVME_CTRL_LIVE; |
Keith Busch | f0b5073 | 2013-07-15 15:02:21 -0600 | [diff] [blame] | 2322 | |
Rakesh Pandit | 82b057c | 2017-06-05 14:43:11 +0300 | [diff] [blame] | 2323 | if (WARN_ON(dev->ctrl.state != NVME_CTRL_RESETTING)) |
Christoph Hellwig | fd634f41 | 2015-11-26 12:42:26 +0100 | [diff] [blame] | 2324 | goto out; |
| 2325 | |
| 2326 | /* |
| 2327 | * If we're called to reset a live controller first shut it down before |
| 2328 | * moving on. |
| 2329 | */ |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2330 | if (dev->ctrl.ctrl_config & NVME_CC_ENABLE) |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 2331 | nvme_dev_disable(dev, false); |
Christoph Hellwig | fd634f41 | 2015-11-26 12:42:26 +0100 | [diff] [blame] | 2332 | |
Jianchao Wang | ad70062 | 2018-01-22 22:03:16 +0800 | [diff] [blame] | 2333 | /* |
Max Gurtovoy | ad6a0a5 | 2018-01-31 18:31:24 +0200 | [diff] [blame] | 2334 | * Introduce CONNECTING state from nvme-fc/rdma transports to mark the |
Jianchao Wang | ad70062 | 2018-01-22 22:03:16 +0800 | [diff] [blame] | 2335 | * initializing procedure here. |
| 2336 | */ |
Max Gurtovoy | ad6a0a5 | 2018-01-31 18:31:24 +0200 | [diff] [blame] | 2337 | if (!nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_CONNECTING)) { |
Jianchao Wang | ad70062 | 2018-01-22 22:03:16 +0800 | [diff] [blame] | 2338 | dev_warn(dev->ctrl.device, |
Max Gurtovoy | ad6a0a5 | 2018-01-31 18:31:24 +0200 | [diff] [blame] | 2339 | "failed to mark controller CONNECTING\n"); |
Jianchao Wang | ad70062 | 2018-01-22 22:03:16 +0800 | [diff] [blame] | 2340 | goto out; |
| 2341 | } |
| 2342 | |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2343 | result = nvme_pci_enable(dev); |
Keith Busch | f0b5073 | 2013-07-15 15:02:21 -0600 | [diff] [blame] | 2344 | if (result) |
Christoph Hellwig | 3cf519b | 2015-10-03 09:49:23 +0200 | [diff] [blame] | 2345 | goto out; |
Keith Busch | f0b5073 | 2013-07-15 15:02:21 -0600 | [diff] [blame] | 2346 | |
Sagi Grimberg | 01ad099 | 2017-05-01 00:27:17 +0300 | [diff] [blame] | 2347 | result = nvme_pci_configure_admin_queue(dev); |
Keith Busch | f0b5073 | 2013-07-15 15:02:21 -0600 | [diff] [blame] | 2348 | if (result) |
Keith Busch | f58944e | 2016-02-24 09:15:55 -0700 | [diff] [blame] | 2349 | goto out; |
Keith Busch | f0b5073 | 2013-07-15 15:02:21 -0600 | [diff] [blame] | 2350 | |
Keith Busch | 0fb59cb | 2015-01-07 18:55:50 -0700 | [diff] [blame] | 2351 | result = nvme_alloc_admin_tags(dev); |
| 2352 | if (result) |
Keith Busch | f58944e | 2016-02-24 09:15:55 -0700 | [diff] [blame] | 2353 | goto out; |
Dan McLeran | b9afca3 | 2014-04-07 17:10:11 -0600 | [diff] [blame] | 2354 | |
Christoph Hellwig | ce4541f | 2015-10-16 07:58:46 +0200 | [diff] [blame] | 2355 | result = nvme_init_identify(&dev->ctrl); |
| 2356 | if (result) |
Keith Busch | f58944e | 2016-02-24 09:15:55 -0700 | [diff] [blame] | 2357 | goto out; |
Christoph Hellwig | ce4541f | 2015-10-16 07:58:46 +0200 | [diff] [blame] | 2358 | |
Scott Bauer | e286bcf | 2017-02-22 10:15:07 -0700 | [diff] [blame] | 2359 | if (dev->ctrl.oacs & NVME_CTRL_OACS_SEC_SUPP) { |
| 2360 | if (!dev->ctrl.opal_dev) |
| 2361 | dev->ctrl.opal_dev = |
| 2362 | init_opal_dev(&dev->ctrl, &nvme_sec_submit); |
| 2363 | else if (was_suspend) |
| 2364 | opal_unlock_from_suspend(dev->ctrl.opal_dev); |
| 2365 | } else { |
| 2366 | free_opal_dev(dev->ctrl.opal_dev); |
| 2367 | dev->ctrl.opal_dev = NULL; |
Christoph Hellwig | 4f1244c | 2017-02-17 13:59:39 +0100 | [diff] [blame] | 2368 | } |
Scott Bauer | a98e58e5 | 2017-02-03 12:50:32 -0700 | [diff] [blame] | 2369 | |
Helen Koike | f9f38e3 | 2017-04-10 12:51:07 -0300 | [diff] [blame] | 2370 | if (dev->ctrl.oacs & NVME_CTRL_OACS_DBBUF_SUPP) { |
| 2371 | result = nvme_dbbuf_dma_alloc(dev); |
| 2372 | if (result) |
| 2373 | dev_warn(dev->dev, |
| 2374 | "unable to allocate dma for dbbuf\n"); |
| 2375 | } |
| 2376 | |
Christoph Hellwig | 9620cfb | 2017-09-06 12:19:57 +0200 | [diff] [blame] | 2377 | if (dev->ctrl.hmpre) { |
| 2378 | result = nvme_setup_host_mem(dev); |
| 2379 | if (result < 0) |
| 2380 | goto out; |
| 2381 | } |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 2382 | |
Keith Busch | f0b5073 | 2013-07-15 15:02:21 -0600 | [diff] [blame] | 2383 | result = nvme_setup_io_queues(dev); |
Keith Busch | badc34d | 2014-06-23 14:25:35 -0600 | [diff] [blame] | 2384 | if (result) |
Keith Busch | f58944e | 2016-02-24 09:15:55 -0700 | [diff] [blame] | 2385 | goto out; |
Keith Busch | f0b5073 | 2013-07-15 15:02:21 -0600 | [diff] [blame] | 2386 | |
Keith Busch | 21f033f | 2016-04-12 11:13:11 -0600 | [diff] [blame] | 2387 | /* |
Christoph Hellwig | 2659e57 | 2015-10-02 18:51:31 +0200 | [diff] [blame] | 2388 | * Keep the controller around but remove all namespaces if we don't have |
| 2389 | * any working I/O queue. |
| 2390 | */ |
Christoph Hellwig | 3cf519b | 2015-10-03 09:49:23 +0200 | [diff] [blame] | 2391 | if (dev->online_queues < 2) { |
Sagi Grimberg | 1b3c47c | 2016-02-10 08:51:15 -0700 | [diff] [blame] | 2392 | dev_warn(dev->ctrl.device, "IO queues not created\n"); |
Keith Busch | 3b24774 | 2016-04-27 15:51:18 -0600 | [diff] [blame] | 2393 | nvme_kill_queues(&dev->ctrl); |
Christoph Hellwig | 5bae7f7 | 2015-11-28 15:39:07 +0100 | [diff] [blame] | 2394 | nvme_remove_namespaces(&dev->ctrl); |
Jianchao Wang | 2b1b7e7 | 2018-01-06 08:01:58 +0800 | [diff] [blame] | 2395 | new_state = NVME_CTRL_ADMIN_ONLY; |
Christoph Hellwig | 3cf519b | 2015-10-03 09:49:23 +0200 | [diff] [blame] | 2396 | } else { |
Keith Busch | 2564626 | 2016-01-04 09:10:57 -0700 | [diff] [blame] | 2397 | nvme_start_queues(&dev->ctrl); |
Keith Busch | 302ad8c | 2017-03-01 14:22:12 -0500 | [diff] [blame] | 2398 | nvme_wait_freeze(&dev->ctrl); |
Jianchao Wang | 2b1b7e7 | 2018-01-06 08:01:58 +0800 | [diff] [blame] | 2399 | /* hit this only when allocate tagset fails */ |
| 2400 | if (nvme_dev_add(dev)) |
| 2401 | new_state = NVME_CTRL_ADMIN_ONLY; |
Keith Busch | 302ad8c | 2017-03-01 14:22:12 -0500 | [diff] [blame] | 2402 | nvme_unfreeze(&dev->ctrl); |
Christoph Hellwig | 3cf519b | 2015-10-03 09:49:23 +0200 | [diff] [blame] | 2403 | } |
| 2404 | |
Jianchao Wang | 2b1b7e7 | 2018-01-06 08:01:58 +0800 | [diff] [blame] | 2405 | /* |
| 2406 | * If only admin queue live, keep it to do further investigation or |
| 2407 | * recovery. |
| 2408 | */ |
| 2409 | if (!nvme_change_ctrl_state(&dev->ctrl, new_state)) { |
| 2410 | dev_warn(dev->ctrl.device, |
| 2411 | "failed to mark controller state %d\n", new_state); |
Christoph Hellwig | bb8d261 | 2016-04-26 13:51:57 +0200 | [diff] [blame] | 2412 | goto out; |
| 2413 | } |
Christoph Hellwig | 92911a5 | 2016-04-26 13:51:58 +0200 | [diff] [blame] | 2414 | |
Sagi Grimberg | d09f2b4 | 2017-07-02 10:56:43 +0300 | [diff] [blame] | 2415 | nvme_start_ctrl(&dev->ctrl); |
Christoph Hellwig | 3cf519b | 2015-10-03 09:49:23 +0200 | [diff] [blame] | 2416 | return; |
Keith Busch | f0b5073 | 2013-07-15 15:02:21 -0600 | [diff] [blame] | 2417 | |
Christoph Hellwig | 3cf519b | 2015-10-03 09:49:23 +0200 | [diff] [blame] | 2418 | out: |
Keith Busch | f58944e | 2016-02-24 09:15:55 -0700 | [diff] [blame] | 2419 | nvme_remove_dead_ctrl(dev, result); |
Keith Busch | f0b5073 | 2013-07-15 15:02:21 -0600 | [diff] [blame] | 2420 | } |
| 2421 | |
Christoph Hellwig | 5c8809e | 2015-11-26 12:35:49 +0100 | [diff] [blame] | 2422 | static void nvme_remove_dead_ctrl_work(struct work_struct *work) |
Keith Busch | 9a6b945 | 2013-12-10 13:10:36 -0700 | [diff] [blame] | 2423 | { |
Christoph Hellwig | 5c8809e | 2015-11-26 12:35:49 +0100 | [diff] [blame] | 2424 | struct nvme_dev *dev = container_of(work, struct nvme_dev, remove_work); |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 2425 | struct pci_dev *pdev = to_pci_dev(dev->dev); |
Keith Busch | 9a6b945 | 2013-12-10 13:10:36 -0700 | [diff] [blame] | 2426 | |
Keith Busch | 69d9a99 | 2016-02-24 09:15:56 -0700 | [diff] [blame] | 2427 | nvme_kill_queues(&dev->ctrl); |
Keith Busch | 9a6b945 | 2013-12-10 13:10:36 -0700 | [diff] [blame] | 2428 | if (pci_get_drvdata(pdev)) |
Keith Busch | 921920a | 2016-03-28 16:03:21 -0600 | [diff] [blame] | 2429 | device_release_driver(&pdev->dev); |
Christoph Hellwig | 1673f1f | 2015-11-26 10:54:19 +0100 | [diff] [blame] | 2430 | nvme_put_ctrl(&dev->ctrl); |
Keith Busch | 9a6b945 | 2013-12-10 13:10:36 -0700 | [diff] [blame] | 2431 | } |
| 2432 | |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 2433 | static int nvme_pci_reg_read32(struct nvme_ctrl *ctrl, u32 off, u32 *val) |
Keith Busch | 4cc0652 | 2015-06-05 10:30:08 -0600 | [diff] [blame] | 2434 | { |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 2435 | *val = readl(to_nvme_dev(ctrl)->bar + off); |
| 2436 | return 0; |
Keith Busch | 4cc0652 | 2015-06-05 10:30:08 -0600 | [diff] [blame] | 2437 | } |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 2438 | |
Christoph Hellwig | 5fd4ce1 | 2015-11-28 15:03:49 +0100 | [diff] [blame] | 2439 | static int nvme_pci_reg_write32(struct nvme_ctrl *ctrl, u32 off, u32 val) |
| 2440 | { |
| 2441 | writel(val, to_nvme_dev(ctrl)->bar + off); |
| 2442 | return 0; |
| 2443 | } |
| 2444 | |
Christoph Hellwig | 7fd8930 | 2015-11-28 15:37:52 +0100 | [diff] [blame] | 2445 | static int nvme_pci_reg_read64(struct nvme_ctrl *ctrl, u32 off, u64 *val) |
| 2446 | { |
| 2447 | *val = readq(to_nvme_dev(ctrl)->bar + off); |
| 2448 | return 0; |
| 2449 | } |
| 2450 | |
Keith Busch | 97c1222 | 2018-03-08 14:50:32 -0700 | [diff] [blame] | 2451 | static int nvme_pci_get_address(struct nvme_ctrl *ctrl, char *buf, int size) |
| 2452 | { |
| 2453 | struct pci_dev *pdev = to_pci_dev(to_nvme_dev(ctrl)->dev); |
| 2454 | |
| 2455 | return snprintf(buf, size, "%s", dev_name(&pdev->dev)); |
| 2456 | } |
| 2457 | |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 2458 | static const struct nvme_ctrl_ops nvme_pci_ctrl_ops = { |
Ming Lin | 1a353d8 | 2016-06-13 16:45:24 +0200 | [diff] [blame] | 2459 | .name = "pcie", |
Sagi Grimberg | e439bb1 | 2016-02-10 10:03:29 -0800 | [diff] [blame] | 2460 | .module = THIS_MODULE, |
Christoph Hellwig | c81bfba | 2017-05-20 15:14:45 +0200 | [diff] [blame] | 2461 | .flags = NVME_F_METADATA_SUPPORTED, |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 2462 | .reg_read32 = nvme_pci_reg_read32, |
Christoph Hellwig | 5fd4ce1 | 2015-11-28 15:03:49 +0100 | [diff] [blame] | 2463 | .reg_write32 = nvme_pci_reg_write32, |
Christoph Hellwig | 7fd8930 | 2015-11-28 15:37:52 +0100 | [diff] [blame] | 2464 | .reg_read64 = nvme_pci_reg_read64, |
Christoph Hellwig | 1673f1f | 2015-11-26 10:54:19 +0100 | [diff] [blame] | 2465 | .free_ctrl = nvme_pci_free_ctrl, |
Christoph Hellwig | f866fc42 | 2016-04-26 13:52:00 +0200 | [diff] [blame] | 2466 | .submit_async_event = nvme_pci_submit_async_event, |
Keith Busch | 97c1222 | 2018-03-08 14:50:32 -0700 | [diff] [blame] | 2467 | .get_address = nvme_pci_get_address, |
Christoph Hellwig | 1c63dc6 | 2015-11-26 10:06:56 +0100 | [diff] [blame] | 2468 | }; |
Keith Busch | 4cc0652 | 2015-06-05 10:30:08 -0600 | [diff] [blame] | 2469 | |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2470 | static int nvme_dev_map(struct nvme_dev *dev) |
| 2471 | { |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2472 | struct pci_dev *pdev = to_pci_dev(dev->dev); |
| 2473 | |
Johannes Thumshirn | a1f447b | 2016-06-07 09:44:02 +0200 | [diff] [blame] | 2474 | if (pci_request_mem_regions(pdev, "nvme")) |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2475 | return -ENODEV; |
| 2476 | |
Xu Yu | 97f6ef6 | 2017-05-24 16:39:55 +0800 | [diff] [blame] | 2477 | if (nvme_remap_bar(dev, NVME_REG_DBS + 4096)) |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2478 | goto release; |
| 2479 | |
Max Gurtovoy | 9fa196e | 2016-12-19 16:18:24 +0200 | [diff] [blame] | 2480 | return 0; |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2481 | release: |
Max Gurtovoy | 9fa196e | 2016-12-19 16:18:24 +0200 | [diff] [blame] | 2482 | pci_release_mem_regions(pdev); |
| 2483 | return -ENODEV; |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2484 | } |
| 2485 | |
Kai-Heng Feng | 8427bbc | 2017-11-09 01:12:03 -0500 | [diff] [blame] | 2486 | static unsigned long check_vendor_combination_bug(struct pci_dev *pdev) |
Andy Lutomirski | ff5350a | 2017-04-20 13:37:55 -0700 | [diff] [blame] | 2487 | { |
| 2488 | if (pdev->vendor == 0x144d && pdev->device == 0xa802) { |
| 2489 | /* |
| 2490 | * Several Samsung devices seem to drop off the PCIe bus |
| 2491 | * randomly when APST is on and uses the deepest sleep state. |
| 2492 | * This has been observed on a Samsung "SM951 NVMe SAMSUNG |
| 2493 | * 256GB", a "PM951 NVMe SAMSUNG 512GB", and a "Samsung SSD |
| 2494 | * 950 PRO 256GB", but it seems to be restricted to two Dell |
| 2495 | * laptops. |
| 2496 | */ |
| 2497 | if (dmi_match(DMI_SYS_VENDOR, "Dell Inc.") && |
| 2498 | (dmi_match(DMI_PRODUCT_NAME, "XPS 15 9550") || |
| 2499 | dmi_match(DMI_PRODUCT_NAME, "Precision 5510"))) |
| 2500 | return NVME_QUIRK_NO_DEEPEST_PS; |
Kai-Heng Feng | 8427bbc | 2017-11-09 01:12:03 -0500 | [diff] [blame] | 2501 | } else if (pdev->vendor == 0x144d && pdev->device == 0xa804) { |
| 2502 | /* |
| 2503 | * Samsung SSD 960 EVO drops off the PCIe bus after system |
Jarosław Janik | 467c77d4 | 2018-03-11 19:51:56 +0100 | [diff] [blame] | 2504 | * suspend on a Ryzen board, ASUS PRIME B350M-A, as well as |
| 2505 | * within few minutes after bootup on a Coffee Lake board - |
| 2506 | * ASUS PRIME Z370-A |
Kai-Heng Feng | 8427bbc | 2017-11-09 01:12:03 -0500 | [diff] [blame] | 2507 | */ |
| 2508 | if (dmi_match(DMI_BOARD_VENDOR, "ASUSTeK COMPUTER INC.") && |
Jarosław Janik | 467c77d4 | 2018-03-11 19:51:56 +0100 | [diff] [blame] | 2509 | (dmi_match(DMI_BOARD_NAME, "PRIME B350M-A") || |
| 2510 | dmi_match(DMI_BOARD_NAME, "PRIME Z370-A"))) |
Kai-Heng Feng | 8427bbc | 2017-11-09 01:12:03 -0500 | [diff] [blame] | 2511 | return NVME_QUIRK_NO_APST; |
Andy Lutomirski | ff5350a | 2017-04-20 13:37:55 -0700 | [diff] [blame] | 2512 | } |
| 2513 | |
| 2514 | return 0; |
| 2515 | } |
| 2516 | |
Keith Busch | 18119775 | 2018-04-27 13:42:52 -0600 | [diff] [blame] | 2517 | static void nvme_async_probe(void *data, async_cookie_t cookie) |
| 2518 | { |
| 2519 | struct nvme_dev *dev = data; |
Keith Busch | 80f513b | 2018-05-07 08:30:24 -0600 | [diff] [blame] | 2520 | |
Keith Busch | 18119775 | 2018-04-27 13:42:52 -0600 | [diff] [blame] | 2521 | nvme_reset_ctrl_sync(&dev->ctrl); |
| 2522 | flush_work(&dev->ctrl.scan_work); |
Keith Busch | 80f513b | 2018-05-07 08:30:24 -0600 | [diff] [blame] | 2523 | nvme_put_ctrl(&dev->ctrl); |
Keith Busch | 18119775 | 2018-04-27 13:42:52 -0600 | [diff] [blame] | 2524 | } |
| 2525 | |
Greg Kroah-Hartman | 8d85fce | 2012-12-21 15:13:49 -0800 | [diff] [blame] | 2526 | static int nvme_probe(struct pci_dev *pdev, const struct pci_device_id *id) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2527 | { |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 2528 | int node, result = -ENOMEM; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2529 | struct nvme_dev *dev; |
Andy Lutomirski | ff5350a | 2017-04-20 13:37:55 -0700 | [diff] [blame] | 2530 | unsigned long quirks = id->driver_data; |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2531 | |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 2532 | node = dev_to_node(&pdev->dev); |
| 2533 | if (node == NUMA_NO_NODE) |
Masayoshi Mizuma | 2fa8435 | 2016-06-20 09:33:17 +0900 | [diff] [blame] | 2534 | set_dev_node(&pdev->dev, first_memory_node); |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 2535 | |
| 2536 | dev = kzalloc_node(sizeof(*dev), GFP_KERNEL, node); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2537 | if (!dev) |
| 2538 | return -ENOMEM; |
Sagi Grimberg | 147b27e | 2018-01-14 12:39:01 +0200 | [diff] [blame] | 2539 | |
| 2540 | dev->queues = kcalloc_node(num_possible_cpus() + 1, |
| 2541 | sizeof(struct nvme_queue), GFP_KERNEL, node); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2542 | if (!dev->queues) |
| 2543 | goto free; |
| 2544 | |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 2545 | dev->dev = get_device(&pdev->dev); |
Keith Busch | 9a6b945 | 2013-12-10 13:10:36 -0700 | [diff] [blame] | 2546 | pci_set_drvdata(pdev, dev); |
Keith Busch | b3fffde | 2015-02-03 11:21:42 -0700 | [diff] [blame] | 2547 | |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2548 | result = nvme_dev_map(dev); |
| 2549 | if (result) |
Christophe JAILLET | b00c9b7 | 2017-07-16 10:39:03 +0200 | [diff] [blame] | 2550 | goto put_pci; |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2551 | |
Christoph Hellwig | d86c4d8 | 2017-06-15 15:41:08 +0200 | [diff] [blame] | 2552 | INIT_WORK(&dev->ctrl.reset_work, nvme_reset_work); |
Christoph Hellwig | 5c8809e | 2015-11-26 12:35:49 +0100 | [diff] [blame] | 2553 | INIT_WORK(&dev->remove_work, nvme_remove_dead_ctrl_work); |
Keith Busch | 77bf25e | 2015-11-26 12:21:29 +0100 | [diff] [blame] | 2554 | mutex_init(&dev->shutdown_lock); |
Keith Busch | db3cbff | 2016-01-12 14:41:17 -0700 | [diff] [blame] | 2555 | init_completion(&dev->ioq_wait); |
Christoph Hellwig | f3ca80f | 2015-11-28 15:40:19 +0100 | [diff] [blame] | 2556 | |
| 2557 | result = nvme_setup_prp_pools(dev); |
| 2558 | if (result) |
Christophe JAILLET | b00c9b7 | 2017-07-16 10:39:03 +0200 | [diff] [blame] | 2559 | goto unmap; |
Christoph Hellwig | f3ca80f | 2015-11-28 15:40:19 +0100 | [diff] [blame] | 2560 | |
Kai-Heng Feng | 8427bbc | 2017-11-09 01:12:03 -0500 | [diff] [blame] | 2561 | quirks |= check_vendor_combination_bug(pdev); |
Andy Lutomirski | ff5350a | 2017-04-20 13:37:55 -0700 | [diff] [blame] | 2562 | |
Christoph Hellwig | f3ca80f | 2015-11-28 15:40:19 +0100 | [diff] [blame] | 2563 | result = nvme_init_ctrl(&dev->ctrl, &pdev->dev, &nvme_pci_ctrl_ops, |
Andy Lutomirski | ff5350a | 2017-04-20 13:37:55 -0700 | [diff] [blame] | 2564 | quirks); |
Christoph Hellwig | f3ca80f | 2015-11-28 15:40:19 +0100 | [diff] [blame] | 2565 | if (result) |
| 2566 | goto release_pools; |
| 2567 | |
Sagi Grimberg | 1b3c47c | 2016-02-10 08:51:15 -0700 | [diff] [blame] | 2568 | dev_info(dev->ctrl.device, "pci function %s\n", dev_name(&pdev->dev)); |
| 2569 | |
Keith Busch | 80f513b | 2018-05-07 08:30:24 -0600 | [diff] [blame] | 2570 | nvme_get_ctrl(&dev->ctrl); |
Keith Busch | 18119775 | 2018-04-27 13:42:52 -0600 | [diff] [blame] | 2571 | async_schedule(nvme_async_probe, dev); |
Sagi Grimberg | 4caff8f | 2017-12-31 14:01:19 +0200 | [diff] [blame] | 2572 | |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2573 | return 0; |
| 2574 | |
Keith Busch | 0877cb0 | 2013-07-15 15:02:19 -0600 | [diff] [blame] | 2575 | release_pools: |
Matthew Wilcox | 091b609 | 2011-02-10 09:56:01 -0500 | [diff] [blame] | 2576 | nvme_release_prp_pools(dev); |
Christophe JAILLET | b00c9b7 | 2017-07-16 10:39:03 +0200 | [diff] [blame] | 2577 | unmap: |
| 2578 | nvme_dev_unmap(dev); |
Keith Busch | a96d4f5 | 2014-08-19 19:15:59 -0600 | [diff] [blame] | 2579 | put_pci: |
Christoph Hellwig | e75ec75 | 2015-05-22 11:12:39 +0200 | [diff] [blame] | 2580 | put_device(dev->dev); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2581 | free: |
| 2582 | kfree(dev->queues); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2583 | kfree(dev); |
| 2584 | return result; |
| 2585 | } |
| 2586 | |
Christoph Hellwig | 775755e | 2017-06-01 13:10:38 +0200 | [diff] [blame] | 2587 | static void nvme_reset_prepare(struct pci_dev *pdev) |
Keith Busch | f0d54a5 | 2014-05-02 10:40:43 -0600 | [diff] [blame] | 2588 | { |
Keith Busch | a673947 | 2014-06-23 16:03:21 -0600 | [diff] [blame] | 2589 | struct nvme_dev *dev = pci_get_drvdata(pdev); |
Linus Torvalds | f263fbb | 2017-07-08 15:51:57 -0700 | [diff] [blame] | 2590 | nvme_dev_disable(dev, false); |
Christoph Hellwig | 775755e | 2017-06-01 13:10:38 +0200 | [diff] [blame] | 2591 | } |
Keith Busch | f0d54a5 | 2014-05-02 10:40:43 -0600 | [diff] [blame] | 2592 | |
Christoph Hellwig | 775755e | 2017-06-01 13:10:38 +0200 | [diff] [blame] | 2593 | static void nvme_reset_done(struct pci_dev *pdev) |
| 2594 | { |
Linus Torvalds | f263fbb | 2017-07-08 15:51:57 -0700 | [diff] [blame] | 2595 | struct nvme_dev *dev = pci_get_drvdata(pdev); |
Sagi Grimberg | 79c48cc | 2018-01-14 12:39:00 +0200 | [diff] [blame] | 2596 | nvme_reset_ctrl_sync(&dev->ctrl); |
Keith Busch | f0d54a5 | 2014-05-02 10:40:43 -0600 | [diff] [blame] | 2597 | } |
| 2598 | |
Keith Busch | 09ece14 | 2014-01-27 11:29:40 -0500 | [diff] [blame] | 2599 | static void nvme_shutdown(struct pci_dev *pdev) |
| 2600 | { |
| 2601 | struct nvme_dev *dev = pci_get_drvdata(pdev); |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 2602 | nvme_dev_disable(dev, true); |
Keith Busch | 09ece14 | 2014-01-27 11:29:40 -0500 | [diff] [blame] | 2603 | } |
| 2604 | |
Keith Busch | f58944e | 2016-02-24 09:15:55 -0700 | [diff] [blame] | 2605 | /* |
| 2606 | * The driver's remove may be called on a device in a partially initialized |
| 2607 | * state. This function must not have any dependencies on the device state in |
| 2608 | * order to proceed. |
| 2609 | */ |
Greg Kroah-Hartman | 8d85fce | 2012-12-21 15:13:49 -0800 | [diff] [blame] | 2610 | static void nvme_remove(struct pci_dev *pdev) |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2611 | { |
| 2612 | struct nvme_dev *dev = pci_get_drvdata(pdev); |
Keith Busch | 9a6b945 | 2013-12-10 13:10:36 -0700 | [diff] [blame] | 2613 | |
Christoph Hellwig | bb8d261 | 2016-04-26 13:51:57 +0200 | [diff] [blame] | 2614 | nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_DELETING); |
| 2615 | |
Christoph Hellwig | d86c4d8 | 2017-06-15 15:41:08 +0200 | [diff] [blame] | 2616 | cancel_work_sync(&dev->ctrl.reset_work); |
Keith Busch | 9a6b945 | 2013-12-10 13:10:36 -0700 | [diff] [blame] | 2617 | pci_set_drvdata(pdev, NULL); |
Keith Busch | 0ff9d4e | 2016-05-12 08:37:14 -0600 | [diff] [blame] | 2618 | |
Keith Busch | 6db28ed | 2017-02-10 18:15:49 -0500 | [diff] [blame] | 2619 | if (!pci_device_is_present(pdev)) { |
Keith Busch | 0ff9d4e | 2016-05-12 08:37:14 -0600 | [diff] [blame] | 2620 | nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_DEAD); |
Keith Busch | 6db28ed | 2017-02-10 18:15:49 -0500 | [diff] [blame] | 2621 | nvme_dev_disable(dev, false); |
| 2622 | } |
Keith Busch | 0ff9d4e | 2016-05-12 08:37:14 -0600 | [diff] [blame] | 2623 | |
Christoph Hellwig | d86c4d8 | 2017-06-15 15:41:08 +0200 | [diff] [blame] | 2624 | flush_work(&dev->ctrl.reset_work); |
Sagi Grimberg | d09f2b4 | 2017-07-02 10:56:43 +0300 | [diff] [blame] | 2625 | nvme_stop_ctrl(&dev->ctrl); |
| 2626 | nvme_remove_namespaces(&dev->ctrl); |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 2627 | nvme_dev_disable(dev, true); |
Christoph Hellwig | 87ad72a | 2017-05-12 17:02:58 +0200 | [diff] [blame] | 2628 | nvme_free_host_mem(dev); |
Matias Bjørling | a4aea56 | 2014-11-04 08:20:14 -0700 | [diff] [blame] | 2629 | nvme_dev_remove_admin(dev); |
| 2630 | nvme_free_queues(dev, 0); |
Sagi Grimberg | d09f2b4 | 2017-07-02 10:56:43 +0300 | [diff] [blame] | 2631 | nvme_uninit_ctrl(&dev->ctrl); |
Keith Busch | 9a6b945 | 2013-12-10 13:10:36 -0700 | [diff] [blame] | 2632 | nvme_release_prp_pools(dev); |
Keith Busch | b00a726 | 2016-02-24 09:15:52 -0700 | [diff] [blame] | 2633 | nvme_dev_unmap(dev); |
Christoph Hellwig | 1673f1f | 2015-11-26 10:54:19 +0100 | [diff] [blame] | 2634 | nvme_put_ctrl(&dev->ctrl); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2635 | } |
| 2636 | |
Keith Busch | 13880f5 | 2016-06-20 09:41:06 -0600 | [diff] [blame] | 2637 | static int nvme_pci_sriov_configure(struct pci_dev *pdev, int numvfs) |
| 2638 | { |
| 2639 | int ret = 0; |
| 2640 | |
| 2641 | if (numvfs == 0) { |
| 2642 | if (pci_vfs_assigned(pdev)) { |
| 2643 | dev_warn(&pdev->dev, |
| 2644 | "Cannot disable SR-IOV VFs while assigned\n"); |
| 2645 | return -EPERM; |
| 2646 | } |
| 2647 | pci_disable_sriov(pdev); |
| 2648 | return 0; |
| 2649 | } |
| 2650 | |
| 2651 | ret = pci_enable_sriov(pdev, numvfs); |
| 2652 | return ret ? ret : numvfs; |
| 2653 | } |
| 2654 | |
Jingoo Han | 671a601 | 2014-02-13 11:19:14 +0900 | [diff] [blame] | 2655 | #ifdef CONFIG_PM_SLEEP |
Keith Busch | cd63894 | 2013-07-15 15:02:23 -0600 | [diff] [blame] | 2656 | static int nvme_suspend(struct device *dev) |
| 2657 | { |
| 2658 | struct pci_dev *pdev = to_pci_dev(dev); |
| 2659 | struct nvme_dev *ndev = pci_get_drvdata(pdev); |
| 2660 | |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 2661 | nvme_dev_disable(ndev, true); |
Keith Busch | cd63894 | 2013-07-15 15:02:23 -0600 | [diff] [blame] | 2662 | return 0; |
| 2663 | } |
| 2664 | |
| 2665 | static int nvme_resume(struct device *dev) |
| 2666 | { |
| 2667 | struct pci_dev *pdev = to_pci_dev(dev); |
| 2668 | struct nvme_dev *ndev = pci_get_drvdata(pdev); |
Keith Busch | cd63894 | 2013-07-15 15:02:23 -0600 | [diff] [blame] | 2669 | |
Christoph Hellwig | d86c4d8 | 2017-06-15 15:41:08 +0200 | [diff] [blame] | 2670 | nvme_reset_ctrl(&ndev->ctrl); |
Keith Busch | 9a6b945 | 2013-12-10 13:10:36 -0700 | [diff] [blame] | 2671 | return 0; |
Keith Busch | cd63894 | 2013-07-15 15:02:23 -0600 | [diff] [blame] | 2672 | } |
Jingoo Han | 671a601 | 2014-02-13 11:19:14 +0900 | [diff] [blame] | 2673 | #endif |
Keith Busch | cd63894 | 2013-07-15 15:02:23 -0600 | [diff] [blame] | 2674 | |
| 2675 | static SIMPLE_DEV_PM_OPS(nvme_dev_pm_ops, nvme_suspend, nvme_resume); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2676 | |
Keith Busch | a0a3408 | 2015-12-07 15:30:31 -0700 | [diff] [blame] | 2677 | static pci_ers_result_t nvme_error_detected(struct pci_dev *pdev, |
| 2678 | pci_channel_state_t state) |
| 2679 | { |
| 2680 | struct nvme_dev *dev = pci_get_drvdata(pdev); |
| 2681 | |
| 2682 | /* |
| 2683 | * A frozen channel requires a reset. When detected, this method will |
| 2684 | * shutdown the controller to quiesce. The controller will be restarted |
| 2685 | * after the slot reset through driver's slot_reset callback. |
| 2686 | */ |
Keith Busch | a0a3408 | 2015-12-07 15:30:31 -0700 | [diff] [blame] | 2687 | switch (state) { |
| 2688 | case pci_channel_io_normal: |
| 2689 | return PCI_ERS_RESULT_CAN_RECOVER; |
| 2690 | case pci_channel_io_frozen: |
Keith Busch | d011fb3 | 2016-04-04 15:07:41 -0600 | [diff] [blame] | 2691 | dev_warn(dev->ctrl.device, |
| 2692 | "frozen state error detected, reset controller\n"); |
Keith Busch | a5cdb68 | 2016-01-12 14:41:18 -0700 | [diff] [blame] | 2693 | nvme_dev_disable(dev, false); |
Keith Busch | a0a3408 | 2015-12-07 15:30:31 -0700 | [diff] [blame] | 2694 | return PCI_ERS_RESULT_NEED_RESET; |
| 2695 | case pci_channel_io_perm_failure: |
Keith Busch | d011fb3 | 2016-04-04 15:07:41 -0600 | [diff] [blame] | 2696 | dev_warn(dev->ctrl.device, |
| 2697 | "failure state error detected, request disconnect\n"); |
Keith Busch | a0a3408 | 2015-12-07 15:30:31 -0700 | [diff] [blame] | 2698 | return PCI_ERS_RESULT_DISCONNECT; |
| 2699 | } |
| 2700 | return PCI_ERS_RESULT_NEED_RESET; |
| 2701 | } |
| 2702 | |
| 2703 | static pci_ers_result_t nvme_slot_reset(struct pci_dev *pdev) |
| 2704 | { |
| 2705 | struct nvme_dev *dev = pci_get_drvdata(pdev); |
| 2706 | |
Sagi Grimberg | 1b3c47c | 2016-02-10 08:51:15 -0700 | [diff] [blame] | 2707 | dev_info(dev->ctrl.device, "restart after slot reset\n"); |
Keith Busch | a0a3408 | 2015-12-07 15:30:31 -0700 | [diff] [blame] | 2708 | pci_restore_state(pdev); |
Keith Busch | 72cd4cc | 2018-05-24 16:16:04 -0600 | [diff] [blame^] | 2709 | nvme_reset_ctrl(&dev->ctrl); |
| 2710 | return PCI_ERS_RESULT_RECOVERED; |
Keith Busch | a0a3408 | 2015-12-07 15:30:31 -0700 | [diff] [blame] | 2711 | } |
| 2712 | |
| 2713 | static void nvme_error_resume(struct pci_dev *pdev) |
| 2714 | { |
Keith Busch | 72cd4cc | 2018-05-24 16:16:04 -0600 | [diff] [blame^] | 2715 | struct nvme_dev *dev = pci_get_drvdata(pdev); |
| 2716 | |
| 2717 | flush_work(&dev->ctrl.reset_work); |
Keith Busch | a0a3408 | 2015-12-07 15:30:31 -0700 | [diff] [blame] | 2718 | pci_cleanup_aer_uncorrect_error_status(pdev); |
| 2719 | } |
| 2720 | |
Stephen Hemminger | 1d35203 | 2012-09-07 09:33:17 -0700 | [diff] [blame] | 2721 | static const struct pci_error_handlers nvme_err_handler = { |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2722 | .error_detected = nvme_error_detected, |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2723 | .slot_reset = nvme_slot_reset, |
| 2724 | .resume = nvme_error_resume, |
Christoph Hellwig | 775755e | 2017-06-01 13:10:38 +0200 | [diff] [blame] | 2725 | .reset_prepare = nvme_reset_prepare, |
| 2726 | .reset_done = nvme_reset_done, |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2727 | }; |
| 2728 | |
Matthew Wilcox | 6eb0d69 | 2014-03-24 10:11:22 -0400 | [diff] [blame] | 2729 | static const struct pci_device_id nvme_id_table[] = { |
Christoph Hellwig | 106198e | 2015-11-26 10:07:41 +0100 | [diff] [blame] | 2730 | { PCI_VDEVICE(INTEL, 0x0953), |
Keith Busch | 08095e7 | 2016-03-04 13:15:17 -0700 | [diff] [blame] | 2731 | .driver_data = NVME_QUIRK_STRIPE_SIZE | |
Christoph Hellwig | e850fd1 | 2017-04-05 19:21:13 +0200 | [diff] [blame] | 2732 | NVME_QUIRK_DEALLOCATE_ZEROES, }, |
Keith Busch | 99466e7 | 2016-05-02 15:14:24 -0600 | [diff] [blame] | 2733 | { PCI_VDEVICE(INTEL, 0x0a53), |
| 2734 | .driver_data = NVME_QUIRK_STRIPE_SIZE | |
Christoph Hellwig | e850fd1 | 2017-04-05 19:21:13 +0200 | [diff] [blame] | 2735 | NVME_QUIRK_DEALLOCATE_ZEROES, }, |
Keith Busch | 99466e7 | 2016-05-02 15:14:24 -0600 | [diff] [blame] | 2736 | { PCI_VDEVICE(INTEL, 0x0a54), |
| 2737 | .driver_data = NVME_QUIRK_STRIPE_SIZE | |
Christoph Hellwig | e850fd1 | 2017-04-05 19:21:13 +0200 | [diff] [blame] | 2738 | NVME_QUIRK_DEALLOCATE_ZEROES, }, |
David Wayne Fugate | f99cb7af | 2017-07-10 12:39:59 -0600 | [diff] [blame] | 2739 | { PCI_VDEVICE(INTEL, 0x0a55), |
| 2740 | .driver_data = NVME_QUIRK_STRIPE_SIZE | |
| 2741 | NVME_QUIRK_DEALLOCATE_ZEROES, }, |
Andy Lutomirski | 50af47d | 2017-05-24 15:06:31 -0700 | [diff] [blame] | 2742 | { PCI_VDEVICE(INTEL, 0xf1a5), /* Intel 600P/P3100 */ |
| 2743 | .driver_data = NVME_QUIRK_NO_DEEPEST_PS }, |
Keith Busch | 540c801 | 2015-10-22 15:45:06 -0600 | [diff] [blame] | 2744 | { PCI_VDEVICE(INTEL, 0x5845), /* Qemu emulated controller */ |
| 2745 | .driver_data = NVME_QUIRK_IDENTIFY_CNS, }, |
Micah Parrish | 0302ae6 | 2018-04-12 13:25:25 -0600 | [diff] [blame] | 2746 | { PCI_DEVICE(0x1bb1, 0x0100), /* Seagate Nytro Flash Storage */ |
| 2747 | .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, |
Guilherme G. Piccoli | 54adc01 | 2016-06-14 18:22:41 -0300 | [diff] [blame] | 2748 | { PCI_DEVICE(0x1c58, 0x0003), /* HGST adapter */ |
| 2749 | .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, |
Jeff Lien | 8c97eec | 2017-11-21 10:44:37 -0600 | [diff] [blame] | 2750 | { PCI_DEVICE(0x1c58, 0x0023), /* WDC SN200 adapter */ |
| 2751 | .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, |
Wenbo Wang | 015282c | 2016-09-08 12:12:11 -0400 | [diff] [blame] | 2752 | { PCI_DEVICE(0x1c5f, 0x0540), /* Memblaze Pblaze4 adapter */ |
| 2753 | .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, |
Martin K. Petersen | d554b5e | 2017-06-27 22:27:57 -0400 | [diff] [blame] | 2754 | { PCI_DEVICE(0x144d, 0xa821), /* Samsung PM1725 */ |
| 2755 | .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, |
| 2756 | { PCI_DEVICE(0x144d, 0xa822), /* Samsung PM1725a */ |
| 2757 | .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, |
Christoph Hellwig | 608cc4b | 2017-09-06 11:45:24 +0200 | [diff] [blame] | 2758 | { PCI_DEVICE(0x1d1d, 0x1f1f), /* LighNVM qemu device */ |
| 2759 | .driver_data = NVME_QUIRK_LIGHTNVM, }, |
| 2760 | { PCI_DEVICE(0x1d1d, 0x2807), /* CNEX WL */ |
| 2761 | .driver_data = NVME_QUIRK_LIGHTNVM, }, |
Wei Xu | ea48e87 | 2018-04-26 14:59:19 -0600 | [diff] [blame] | 2762 | { PCI_DEVICE(0x1d1d, 0x2601), /* CNEX Granby */ |
| 2763 | .driver_data = NVME_QUIRK_LIGHTNVM, }, |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2764 | { PCI_DEVICE_CLASS(PCI_CLASS_STORAGE_EXPRESS, 0xffffff) }, |
Stephan Günther | c74dc78 | 2015-11-04 00:49:45 +0100 | [diff] [blame] | 2765 | { PCI_DEVICE(PCI_VENDOR_ID_APPLE, 0x2001) }, |
Daniel Roschka | 124298b | 2017-02-22 15:17:29 -0700 | [diff] [blame] | 2766 | { PCI_DEVICE(PCI_VENDOR_ID_APPLE, 0x2003) }, |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2767 | { 0, } |
| 2768 | }; |
| 2769 | MODULE_DEVICE_TABLE(pci, nvme_id_table); |
| 2770 | |
| 2771 | static struct pci_driver nvme_driver = { |
| 2772 | .name = "nvme", |
| 2773 | .id_table = nvme_id_table, |
| 2774 | .probe = nvme_probe, |
Greg Kroah-Hartman | 8d85fce | 2012-12-21 15:13:49 -0800 | [diff] [blame] | 2775 | .remove = nvme_remove, |
Keith Busch | 09ece14 | 2014-01-27 11:29:40 -0500 | [diff] [blame] | 2776 | .shutdown = nvme_shutdown, |
Keith Busch | cd63894 | 2013-07-15 15:02:23 -0600 | [diff] [blame] | 2777 | .driver = { |
| 2778 | .pm = &nvme_dev_pm_ops, |
| 2779 | }, |
Keith Busch | 13880f5 | 2016-06-20 09:41:06 -0600 | [diff] [blame] | 2780 | .sriov_configure = nvme_pci_sriov_configure, |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2781 | .err_handler = &nvme_err_handler, |
| 2782 | }; |
| 2783 | |
| 2784 | static int __init nvme_init(void) |
| 2785 | { |
Sagi Grimberg | 9a6327d | 2017-06-07 20:31:55 +0200 | [diff] [blame] | 2786 | return pci_register_driver(&nvme_driver); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2787 | } |
| 2788 | |
| 2789 | static void __exit nvme_exit(void) |
| 2790 | { |
| 2791 | pci_unregister_driver(&nvme_driver); |
Ming Lei | 03e0f3a | 2017-11-09 19:32:07 +0800 | [diff] [blame] | 2792 | flush_workqueue(nvme_wq); |
Matthew Wilcox | 21bd78b | 2014-05-09 22:42:26 -0400 | [diff] [blame] | 2793 | _nvme_check_size(); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2794 | } |
| 2795 | |
| 2796 | MODULE_AUTHOR("Matthew Wilcox <willy@linux.intel.com>"); |
| 2797 | MODULE_LICENSE("GPL"); |
Keith Busch | c78b4713 | 2014-11-21 15:16:32 -0700 | [diff] [blame] | 2798 | MODULE_VERSION("1.0"); |
Matthew Wilcox | b60503b | 2011-01-20 12:50:14 -0500 | [diff] [blame] | 2799 | module_init(nvme_init); |
| 2800 | module_exit(nvme_exit); |