1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * NVM Express device driver 4 * Copyright (c) 2011-2014, Intel Corporation. 5 */ 6 7 #include <linux/acpi.h> 8 #include <linux/async.h> 9 #include <linux/blkdev.h> 10 #include <linux/blk-mq-dma.h> 11 #include <linux/blk-integrity.h> 12 #include <linux/dmi.h> 13 #include <linux/init.h> 14 #include <linux/interrupt.h> 15 #include <linux/io.h> 16 #include <linux/kstrtox.h> 17 #include <linux/memremap.h> 18 #include <linux/mm.h> 19 #include <linux/module.h> 20 #include <linux/mutex.h> 21 #include <linux/nodemask.h> 22 #include <linux/once.h> 23 #include <linux/pci.h> 24 #include <linux/suspend.h> 25 #include <linux/t10-pi.h> 26 #include <linux/types.h> 27 #include <linux/io-64-nonatomic-lo-hi.h> 28 #include <linux/io-64-nonatomic-hi-lo.h> 29 #include <linux/sed-opal.h> 30 31 #include "trace.h" 32 #include "nvme.h" 33 34 #define SQ_SIZE(q) ((q)->q_depth << (q)->sqes) 35 #define CQ_SIZE(q) ((q)->q_depth * sizeof(struct nvme_completion)) 36 37 /* Optimisation for I/Os between 4k and 128k */ 38 #define NVME_SMALL_POOL_SIZE 256 39 40 /* 41 * Arbitrary upper bound. 42 */ 43 #define NVME_MAX_BYTES SZ_8M 44 #define NVME_MAX_NR_DESCRIPTORS 5 45 46 /* 47 * For data SGLs we support a single descriptors worth of SGL entries. 48 * For PRPs, segments don't matter at all. 49 */ 50 #define NVME_MAX_SEGS \ 51 (NVME_CTRL_PAGE_SIZE / sizeof(struct nvme_sgl_desc)) 52 53 /* 54 * For metadata SGLs, only the small descriptor is supported, and the first 55 * entry is the segment descriptor, which for the data pointer sits in the SQE. 56 */ 57 #define NVME_MAX_META_SEGS \ 58 ((NVME_SMALL_POOL_SIZE / sizeof(struct nvme_sgl_desc)) - 1) 59 60 /* 61 * The last entry is used to link to the next descriptor. 62 */ 63 #define PRPS_PER_PAGE \ 64 (((NVME_CTRL_PAGE_SIZE / sizeof(__le64))) - 1) 65 66 /* 67 * I/O could be non-aligned both at the beginning and end. 68 */ 69 #define MAX_PRP_RANGE \ 70 (NVME_MAX_BYTES + 2 * (NVME_CTRL_PAGE_SIZE - 1)) 71 72 static_assert(MAX_PRP_RANGE / NVME_CTRL_PAGE_SIZE <= 73 (1 /* prp1 */ + NVME_MAX_NR_DESCRIPTORS * PRPS_PER_PAGE)); 74 75 struct quirk_entry { 76 u16 vendor_id; 77 u16 dev_id; 78 u32 enabled_quirks; 79 u32 disabled_quirks; 80 }; 81 82 static int use_threaded_interrupts; 83 module_param(use_threaded_interrupts, int, 0444); 84 85 static bool use_cmb_sqes = true; 86 module_param(use_cmb_sqes, bool, 0444); 87 MODULE_PARM_DESC(use_cmb_sqes, "use controller's memory buffer for I/O SQes"); 88 89 static unsigned int max_host_mem_size_mb = 128; 90 module_param(max_host_mem_size_mb, uint, 0444); 91 MODULE_PARM_DESC(max_host_mem_size_mb, 92 "Maximum Host Memory Buffer (HMB) size per controller (in MiB)"); 93 94 static unsigned int sgl_threshold = SZ_32K; 95 module_param(sgl_threshold, uint, 0644); 96 MODULE_PARM_DESC(sgl_threshold, 97 "Use SGLs when average request segment size is larger or equal to " 98 "this size. Use 0 to disable SGLs."); 99 100 #define NVME_PCI_MIN_QUEUE_SIZE 2 101 #define NVME_PCI_MAX_QUEUE_SIZE 4095 102 static int io_queue_depth_set(const char *val, const struct kernel_param *kp); 103 static const struct kernel_param_ops io_queue_depth_ops = { 104 .set = io_queue_depth_set, 105 .get = param_get_uint, 106 }; 107 108 static unsigned int io_queue_depth = 1024; 109 module_param_cb(io_queue_depth, &io_queue_depth_ops, &io_queue_depth, 0644); 110 MODULE_PARM_DESC(io_queue_depth, "set io queue depth, should >= 2 and < 4096"); 111 112 static struct quirk_entry *nvme_pci_quirk_list; 113 static unsigned int nvme_pci_quirk_count; 114 115 /* Helper to parse individual quirk names */ 116 static int nvme_parse_quirk_names(char *quirk_str, struct quirk_entry *entry) 117 { 118 int i; 119 size_t field_len; 120 bool disabled, found; 121 char *p = quirk_str, *field; 122 123 while ((field = strsep(&p, ",")) && *field) { 124 disabled = false; 125 found = false; 126 127 if (*field == '^') { 128 /* Skip the '^' character */ 129 disabled = true; 130 field++; 131 } 132 133 field_len = strlen(field); 134 for (i = 0; i < 32; i++) { 135 unsigned int bit = 1U << i; 136 char *q_name = nvme_quirk_name(bit); 137 size_t q_len = strlen(q_name); 138 139 if (!strcmp(q_name, "unknown")) 140 break; 141 142 if (!strcmp(q_name, field) && 143 q_len == field_len) { 144 if (disabled) 145 entry->disabled_quirks |= bit; 146 else 147 entry->enabled_quirks |= bit; 148 found = true; 149 break; 150 } 151 } 152 153 if (!found) { 154 pr_err("nvme: unrecognized quirk %s\n", field); 155 return -EINVAL; 156 } 157 } 158 return 0; 159 } 160 161 /* Helper to parse a single VID:DID:quirk_names entry */ 162 static int nvme_parse_quirk_entry(char *s, struct quirk_entry *entry) 163 { 164 char *field; 165 166 field = strsep(&s, ":"); 167 if (!field || kstrtou16(field, 16, &entry->vendor_id)) 168 return -EINVAL; 169 170 field = strsep(&s, ":"); 171 if (!field || kstrtou16(field, 16, &entry->dev_id)) 172 return -EINVAL; 173 174 field = strsep(&s, ":"); 175 if (!field) 176 return -EINVAL; 177 178 return nvme_parse_quirk_names(field, entry); 179 } 180 181 static int quirks_param_set(const char *value, const struct kernel_param *kp) 182 { 183 int count, err, i; 184 struct quirk_entry *qlist; 185 char *field, *val, *sep_ptr; 186 187 err = param_set_copystring(value, kp); 188 if (err) 189 return err; 190 191 val = kstrdup(value, GFP_KERNEL); 192 if (!val) 193 return -ENOMEM; 194 195 if (!*val) 196 goto out_free_val; 197 198 count = 1; 199 for (i = 0; val[i]; i++) { 200 if (val[i] == '-') 201 count++; 202 } 203 204 qlist = kcalloc(count, sizeof(*qlist), GFP_KERNEL); 205 if (!qlist) { 206 err = -ENOMEM; 207 goto out_free_val; 208 } 209 210 i = 0; 211 sep_ptr = val; 212 while ((field = strsep(&sep_ptr, "-"))) { 213 if (nvme_parse_quirk_entry(field, &qlist[i])) { 214 pr_err("nvme: failed to parse quirk string %s\n", 215 value); 216 goto out_free_qlist; 217 } 218 219 i++; 220 } 221 222 kfree(nvme_pci_quirk_list); 223 nvme_pci_quirk_count = count; 224 nvme_pci_quirk_list = qlist; 225 goto out_free_val; 226 227 out_free_qlist: 228 kfree(qlist); 229 out_free_val: 230 kfree(val); 231 return err; 232 } 233 234 static char quirks_param[128]; 235 static const struct kernel_param_ops quirks_param_ops = { 236 .set = quirks_param_set, 237 .get = param_get_string, 238 }; 239 240 static struct kparam_string quirks_param_string = { 241 .maxlen = sizeof(quirks_param), 242 .string = quirks_param, 243 }; 244 245 module_param_cb(quirks, &quirks_param_ops, &quirks_param_string, 0444); 246 MODULE_PARM_DESC(quirks, "Enable/disable NVMe quirks by specifying " 247 "quirks=VID:DID:quirk_names"); 248 249 static int io_queue_count_set(const char *val, const struct kernel_param *kp) 250 { 251 unsigned int n; 252 int ret; 253 254 ret = kstrtouint(val, 10, &n); 255 if (ret != 0 || n > blk_mq_num_possible_queues(0)) 256 return -EINVAL; 257 return param_set_uint(val, kp); 258 } 259 260 static const struct kernel_param_ops io_queue_count_ops = { 261 .set = io_queue_count_set, 262 .get = param_get_uint, 263 }; 264 265 static unsigned int write_queues; 266 module_param_cb(write_queues, &io_queue_count_ops, &write_queues, 0644); 267 MODULE_PARM_DESC(write_queues, 268 "Number of queues to use for writes. If not set, reads and writes " 269 "will share a queue set."); 270 271 static unsigned int poll_queues; 272 module_param_cb(poll_queues, &io_queue_count_ops, &poll_queues, 0644); 273 MODULE_PARM_DESC(poll_queues, "Number of queues to use for polled IO."); 274 275 static bool noacpi; 276 module_param(noacpi, bool, 0444); 277 MODULE_PARM_DESC(noacpi, "disable acpi bios quirks"); 278 279 struct nvme_dev; 280 struct nvme_queue; 281 282 static void nvme_dev_disable(struct nvme_dev *dev, bool shutdown); 283 static void nvme_delete_io_queues(struct nvme_dev *dev); 284 static void nvme_update_attrs(struct nvme_dev *dev); 285 286 struct nvme_descriptor_pools { 287 struct dma_pool *large; 288 struct dma_pool *small; 289 }; 290 291 /* 292 * Represents an NVM Express device. Each nvme_dev is a PCI function. 293 */ 294 struct nvme_dev { 295 struct nvme_queue *queues; 296 struct blk_mq_tag_set tagset; 297 struct blk_mq_tag_set admin_tagset; 298 u32 __iomem *dbs; 299 struct device *dev; 300 unsigned online_queues; 301 unsigned max_qid; 302 unsigned io_queues[HCTX_MAX_TYPES]; 303 unsigned int num_vecs; 304 u32 q_depth; 305 int io_sqes; 306 u32 db_stride; 307 void __iomem *bar; 308 unsigned long bar_mapped_size; 309 struct mutex shutdown_lock; 310 bool subsystem; 311 u64 cmb_size; 312 bool cmb_use_sqes; 313 u32 cmbsz; 314 u32 cmbloc; 315 struct nvme_ctrl ctrl; 316 u32 last_ps; 317 bool hmb; 318 struct sg_table *hmb_sgt; 319 mempool_t *dmavec_mempool; 320 321 /* shadow doorbell buffer support: */ 322 __le32 *dbbuf_dbs; 323 dma_addr_t dbbuf_dbs_dma_addr; 324 __le32 *dbbuf_eis; 325 dma_addr_t dbbuf_eis_dma_addr; 326 327 /* host memory buffer support: */ 328 u64 host_mem_size; 329 u32 nr_host_mem_descs; 330 u32 host_mem_descs_size; 331 dma_addr_t host_mem_descs_dma; 332 struct nvme_host_mem_buf_desc *host_mem_descs; 333 void **host_mem_desc_bufs; 334 unsigned int nr_allocated_queues; 335 unsigned int nr_write_queues; 336 unsigned int nr_poll_queues; 337 struct nvme_descriptor_pools descriptor_pools[]; 338 }; 339 340 static int io_queue_depth_set(const char *val, const struct kernel_param *kp) 341 { 342 return param_set_uint_minmax(val, kp, NVME_PCI_MIN_QUEUE_SIZE, 343 NVME_PCI_MAX_QUEUE_SIZE); 344 } 345 346 static inline unsigned int sq_idx(unsigned int qid, u32 stride) 347 { 348 return qid * 2 * stride; 349 } 350 351 static inline unsigned int cq_idx(unsigned int qid, u32 stride) 352 { 353 return (qid * 2 + 1) * stride; 354 } 355 356 static inline struct nvme_dev *to_nvme_dev(struct nvme_ctrl *ctrl) 357 { 358 return container_of(ctrl, struct nvme_dev, ctrl); 359 } 360 361 /* 362 * An NVM Express queue. Each device has at least two (one for admin 363 * commands and one for I/O commands). 364 */ 365 struct nvme_queue { 366 struct nvme_dev *dev; 367 struct nvme_descriptor_pools descriptor_pools; 368 spinlock_t sq_lock; 369 void *sq_cmds; 370 /* only used for poll queues: */ 371 spinlock_t cq_poll_lock ____cacheline_aligned_in_smp; 372 struct nvme_completion *cqes; 373 dma_addr_t sq_dma_addr; 374 dma_addr_t cq_dma_addr; 375 u32 __iomem *q_db; 376 u32 q_depth; 377 u16 cq_vector; 378 u16 sq_tail; 379 u16 last_sq_tail; 380 u16 cq_head; 381 u16 qid; 382 u8 cq_phase; 383 u8 sqes; 384 unsigned long flags; 385 #define NVMEQ_ENABLED 0 386 #define NVMEQ_SQ_CMB 1 387 #define NVMEQ_DELETE_ERROR 2 388 #define NVMEQ_POLLED 3 389 __le32 *dbbuf_sq_db; 390 __le32 *dbbuf_cq_db; 391 __le32 *dbbuf_sq_ei; 392 __le32 *dbbuf_cq_ei; 393 struct completion delete_done; 394 }; 395 396 /* bits for iod->flags */ 397 enum nvme_iod_flags { 398 /* this command has been aborted by the timeout handler */ 399 IOD_ABORTED = 1U << 0, 400 401 /* uses the small descriptor pool */ 402 IOD_SMALL_DESCRIPTOR = 1U << 1, 403 404 /* single segment dma mapping */ 405 IOD_SINGLE_SEGMENT = 1U << 2, 406 407 /* Data payload contains p2p memory */ 408 IOD_DATA_P2P = 1U << 3, 409 410 /* Metadata contains p2p memory */ 411 IOD_META_P2P = 1U << 4, 412 413 /* Data payload contains MMIO memory */ 414 IOD_DATA_MMIO = 1U << 5, 415 416 /* Metadata contains MMIO memory */ 417 IOD_META_MMIO = 1U << 6, 418 419 /* Metadata using non-coalesced MPTR */ 420 IOD_SINGLE_META_SEGMENT = 1U << 7, 421 }; 422 423 struct nvme_dma_vec { 424 dma_addr_t addr; 425 unsigned int len; 426 }; 427 428 /* 429 * The nvme_iod describes the data in an I/O. 430 */ 431 struct nvme_iod { 432 struct nvme_request req; 433 struct nvme_command cmd; 434 u8 flags; 435 u8 nr_descriptors; 436 437 size_t total_len; 438 struct dma_iova_state dma_state; 439 void *descriptors[NVME_MAX_NR_DESCRIPTORS]; 440 struct nvme_dma_vec *dma_vecs; 441 unsigned int nr_dma_vecs; 442 443 dma_addr_t meta_dma; 444 size_t meta_total_len; 445 struct dma_iova_state meta_dma_state; 446 struct nvme_sgl_desc *meta_descriptor; 447 }; 448 449 static inline unsigned int nvme_dbbuf_size(struct nvme_dev *dev) 450 { 451 return dev->nr_allocated_queues * 8 * dev->db_stride; 452 } 453 454 static void nvme_dbbuf_dma_alloc(struct nvme_dev *dev) 455 { 456 unsigned int mem_size = nvme_dbbuf_size(dev); 457 458 if (!(dev->ctrl.oacs & NVME_CTRL_OACS_DBBUF_SUPP)) 459 return; 460 461 if (dev->dbbuf_dbs) { 462 /* 463 * Clear the dbbuf memory so the driver doesn't observe stale 464 * values from the previous instantiation. 465 */ 466 memset(dev->dbbuf_dbs, 0, mem_size); 467 memset(dev->dbbuf_eis, 0, mem_size); 468 return; 469 } 470 471 dev->dbbuf_dbs = dma_alloc_coherent(dev->dev, mem_size, 472 &dev->dbbuf_dbs_dma_addr, 473 GFP_KERNEL); 474 if (!dev->dbbuf_dbs) 475 goto fail; 476 dev->dbbuf_eis = dma_alloc_coherent(dev->dev, mem_size, 477 &dev->dbbuf_eis_dma_addr, 478 GFP_KERNEL); 479 if (!dev->dbbuf_eis) 480 goto fail_free_dbbuf_dbs; 481 return; 482 483 fail_free_dbbuf_dbs: 484 dma_free_coherent(dev->dev, mem_size, dev->dbbuf_dbs, 485 dev->dbbuf_dbs_dma_addr); 486 dev->dbbuf_dbs = NULL; 487 fail: 488 dev_warn(dev->dev, "unable to allocate dma for dbbuf\n"); 489 } 490 491 static void nvme_dbbuf_dma_free(struct nvme_dev *dev) 492 { 493 unsigned int mem_size = nvme_dbbuf_size(dev); 494 495 if (dev->dbbuf_dbs) { 496 dma_free_coherent(dev->dev, mem_size, 497 dev->dbbuf_dbs, dev->dbbuf_dbs_dma_addr); 498 dev->dbbuf_dbs = NULL; 499 } 500 if (dev->dbbuf_eis) { 501 dma_free_coherent(dev->dev, mem_size, 502 dev->dbbuf_eis, dev->dbbuf_eis_dma_addr); 503 dev->dbbuf_eis = NULL; 504 } 505 } 506 507 static void nvme_dbbuf_init(struct nvme_dev *dev, 508 struct nvme_queue *nvmeq, int qid) 509 { 510 if (!dev->dbbuf_dbs || !qid) 511 return; 512 513 nvmeq->dbbuf_sq_db = &dev->dbbuf_dbs[sq_idx(qid, dev->db_stride)]; 514 nvmeq->dbbuf_cq_db = &dev->dbbuf_dbs[cq_idx(qid, dev->db_stride)]; 515 nvmeq->dbbuf_sq_ei = &dev->dbbuf_eis[sq_idx(qid, dev->db_stride)]; 516 nvmeq->dbbuf_cq_ei = &dev->dbbuf_eis[cq_idx(qid, dev->db_stride)]; 517 } 518 519 static void nvme_dbbuf_free(struct nvme_queue *nvmeq) 520 { 521 if (!nvmeq->qid) 522 return; 523 524 nvmeq->dbbuf_sq_db = NULL; 525 nvmeq->dbbuf_cq_db = NULL; 526 nvmeq->dbbuf_sq_ei = NULL; 527 nvmeq->dbbuf_cq_ei = NULL; 528 } 529 530 static void nvme_dbbuf_set(struct nvme_dev *dev) 531 { 532 struct nvme_command c = { }; 533 unsigned int i; 534 535 if (!dev->dbbuf_dbs) 536 return; 537 538 c.dbbuf.opcode = nvme_admin_dbbuf; 539 c.dbbuf.prp1 = cpu_to_le64(dev->dbbuf_dbs_dma_addr); 540 c.dbbuf.prp2 = cpu_to_le64(dev->dbbuf_eis_dma_addr); 541 542 if (nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0)) { 543 dev_warn(dev->ctrl.device, "unable to set dbbuf\n"); 544 /* Free memory and continue on */ 545 nvme_dbbuf_dma_free(dev); 546 547 for (i = 1; i < dev->online_queues; i++) 548 nvme_dbbuf_free(&dev->queues[i]); 549 } 550 } 551 552 static inline int nvme_dbbuf_need_event(u16 event_idx, u16 new_idx, u16 old) 553 { 554 return (u16)(new_idx - event_idx - 1) < (u16)(new_idx - old); 555 } 556 557 /* Update dbbuf and return true if an MMIO is required */ 558 static bool nvme_dbbuf_update_and_check_event(u16 value, __le32 *dbbuf_db, 559 volatile __le32 *dbbuf_ei) 560 { 561 if (dbbuf_db) { 562 u16 old_value, event_idx; 563 564 /* 565 * Ensure that the queue is written before updating 566 * the doorbell in memory 567 */ 568 wmb(); 569 570 old_value = le32_to_cpu(*dbbuf_db); 571 *dbbuf_db = cpu_to_le32(value); 572 573 /* 574 * Ensure that the doorbell is updated before reading the event 575 * index from memory. The controller needs to provide similar 576 * ordering to ensure the event index is updated before reading 577 * the doorbell. 578 */ 579 mb(); 580 581 event_idx = le32_to_cpu(*dbbuf_ei); 582 if (!nvme_dbbuf_need_event(event_idx, value, old_value)) 583 return false; 584 } 585 586 return true; 587 } 588 589 static struct nvme_descriptor_pools * 590 nvme_setup_descriptor_pools(struct nvme_dev *dev, int numa_node) 591 { 592 struct nvme_descriptor_pools *pools; 593 size_t small_align = NVME_SMALL_POOL_SIZE; 594 595 if (numa_node == NUMA_NO_NODE) 596 numa_node = 0; 597 598 pools = &dev->descriptor_pools[numa_node]; 599 600 if (pools->small) 601 return pools; /* already initialized */ 602 603 pools->large = dma_pool_create_node("nvme descriptor page", dev->dev, 604 NVME_CTRL_PAGE_SIZE, NVME_CTRL_PAGE_SIZE, 0, numa_node); 605 if (!pools->large) 606 return ERR_PTR(-ENOMEM); 607 608 if (dev->ctrl.quirks & NVME_QUIRK_DMAPOOL_ALIGN_512) 609 small_align = 512; 610 611 pools->small = dma_pool_create_node("nvme descriptor small", dev->dev, 612 NVME_SMALL_POOL_SIZE, small_align, 0, numa_node); 613 if (!pools->small) { 614 dma_pool_destroy(pools->large); 615 pools->large = NULL; 616 return ERR_PTR(-ENOMEM); 617 } 618 619 return pools; 620 } 621 622 static void nvme_release_descriptor_pools(struct nvme_dev *dev) 623 { 624 unsigned i; 625 626 for (i = 0; i < nr_node_ids; i++) { 627 struct nvme_descriptor_pools *pools = &dev->descriptor_pools[i]; 628 629 dma_pool_destroy(pools->large); 630 dma_pool_destroy(pools->small); 631 } 632 } 633 634 static int nvme_init_hctx_common(struct blk_mq_hw_ctx *hctx, void *data, 635 unsigned qid) 636 { 637 struct nvme_dev *dev = to_nvme_dev(data); 638 struct nvme_queue *nvmeq = &dev->queues[qid]; 639 struct nvme_descriptor_pools *pools; 640 struct blk_mq_tags *tags; 641 642 tags = qid ? dev->tagset.tags[qid - 1] : dev->admin_tagset.tags[0]; 643 WARN_ON(tags != hctx->tags); 644 pools = nvme_setup_descriptor_pools(dev, hctx->numa_node); 645 if (IS_ERR(pools)) 646 return PTR_ERR(pools); 647 648 nvmeq->descriptor_pools = *pools; 649 hctx->driver_data = nvmeq; 650 return 0; 651 } 652 653 static int nvme_admin_init_hctx(struct blk_mq_hw_ctx *hctx, void *data, 654 unsigned int hctx_idx) 655 { 656 WARN_ON(hctx_idx != 0); 657 return nvme_init_hctx_common(hctx, data, 0); 658 } 659 660 static int nvme_init_hctx(struct blk_mq_hw_ctx *hctx, void *data, 661 unsigned int hctx_idx) 662 { 663 return nvme_init_hctx_common(hctx, data, hctx_idx + 1); 664 } 665 666 static int nvme_pci_init_request(struct blk_mq_tag_set *set, 667 struct request *req, unsigned int hctx_idx, 668 int numa_node) 669 { 670 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 671 672 nvme_req(req)->ctrl = set->driver_data; 673 nvme_req(req)->cmd = &iod->cmd; 674 return 0; 675 } 676 677 static int queue_irq_offset(struct nvme_dev *dev) 678 { 679 /* if we have more than 1 vec, admin queue offsets us by 1 */ 680 if (dev->num_vecs > 1) 681 return 1; 682 683 return 0; 684 } 685 686 static void nvme_pci_map_queues(struct blk_mq_tag_set *set) 687 { 688 struct nvme_dev *dev = to_nvme_dev(set->driver_data); 689 int i, qoff, offset; 690 691 offset = queue_irq_offset(dev); 692 for (i = 0, qoff = 0; i < set->nr_maps; i++) { 693 struct blk_mq_queue_map *map = &set->map[i]; 694 695 map->nr_queues = dev->io_queues[i]; 696 if (!map->nr_queues) { 697 BUG_ON(i == HCTX_TYPE_DEFAULT); 698 continue; 699 } 700 701 /* 702 * The poll queue(s) doesn't have an IRQ (and hence IRQ 703 * affinity), so use the regular blk-mq cpu mapping 704 */ 705 map->queue_offset = qoff; 706 if (i != HCTX_TYPE_POLL && offset) 707 blk_mq_map_hw_queues(map, dev->dev, offset); 708 else 709 blk_mq_map_queues(map); 710 qoff += map->nr_queues; 711 offset += map->nr_queues; 712 } 713 } 714 715 /* 716 * Write sq tail if we are asked to, or if the next command would wrap. 717 */ 718 static inline void nvme_write_sq_db(struct nvme_queue *nvmeq, bool write_sq) 719 { 720 if (!write_sq) { 721 u16 next_tail = nvmeq->sq_tail + 1; 722 723 if (next_tail == nvmeq->q_depth) 724 next_tail = 0; 725 if (next_tail != nvmeq->last_sq_tail) 726 return; 727 } 728 729 if (nvme_dbbuf_update_and_check_event(nvmeq->sq_tail, 730 nvmeq->dbbuf_sq_db, nvmeq->dbbuf_sq_ei)) 731 writel(nvmeq->sq_tail, nvmeq->q_db); 732 nvmeq->last_sq_tail = nvmeq->sq_tail; 733 } 734 735 static inline void nvme_sq_copy_cmd(struct nvme_queue *nvmeq, 736 struct nvme_command *cmd) 737 { 738 memcpy(nvmeq->sq_cmds + (nvmeq->sq_tail << nvmeq->sqes), 739 absolute_pointer(cmd), sizeof(*cmd)); 740 if (++nvmeq->sq_tail == nvmeq->q_depth) 741 nvmeq->sq_tail = 0; 742 } 743 744 static void nvme_commit_rqs(struct blk_mq_hw_ctx *hctx) 745 { 746 struct nvme_queue *nvmeq = hctx->driver_data; 747 748 spin_lock(&nvmeq->sq_lock); 749 if (nvmeq->sq_tail != nvmeq->last_sq_tail) 750 nvme_write_sq_db(nvmeq, true); 751 spin_unlock(&nvmeq->sq_lock); 752 } 753 754 enum nvme_use_sgl { 755 SGL_UNSUPPORTED, 756 SGL_SUPPORTED, 757 SGL_FORCED, 758 }; 759 760 static inline bool nvme_pci_metadata_use_sgls(struct request *req) 761 { 762 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 763 struct nvme_dev *dev = nvmeq->dev; 764 765 if (!nvme_ctrl_meta_sgl_supported(&dev->ctrl)) 766 return false; 767 return req->nr_integrity_segments > 1 || 768 nvme_req(req)->flags & NVME_REQ_USERCMD; 769 } 770 771 static inline enum nvme_use_sgl nvme_pci_use_sgls(struct nvme_dev *dev, 772 struct request *req) 773 { 774 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 775 776 if (nvmeq->qid && nvme_ctrl_sgl_supported(&dev->ctrl)) { 777 /* 778 * When the controller is capable of using SGL, there are 779 * several conditions that we force to use it: 780 * 781 * 1. A request containing page gaps within the controller's 782 * mask can not use the PRP format. 783 * 784 * 2. User commands use SGL because that lets the device 785 * validate the requested transfer lengths. 786 * 787 * 3. Multiple integrity segments must use SGL as that's the 788 * only way to describe such a command in NVMe. 789 */ 790 if (req_phys_gap_mask(req) & (NVME_CTRL_PAGE_SIZE - 1) || 791 nvme_req(req)->flags & NVME_REQ_USERCMD || 792 req->nr_integrity_segments > 1) 793 return SGL_FORCED; 794 return SGL_SUPPORTED; 795 } 796 797 return SGL_UNSUPPORTED; 798 } 799 800 static unsigned int nvme_pci_avg_seg_size(struct request *req) 801 { 802 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 803 unsigned int nseg; 804 805 if (blk_rq_dma_map_coalesce(&iod->dma_state)) 806 nseg = 1; 807 else 808 nseg = blk_rq_nr_phys_segments(req); 809 return DIV_ROUND_UP(blk_rq_payload_bytes(req), nseg); 810 } 811 812 static inline struct dma_pool *nvme_dma_pool(struct nvme_queue *nvmeq, 813 struct nvme_iod *iod) 814 { 815 if (iod->flags & IOD_SMALL_DESCRIPTOR) 816 return nvmeq->descriptor_pools.small; 817 return nvmeq->descriptor_pools.large; 818 } 819 820 static inline bool nvme_pci_cmd_use_meta_sgl(struct nvme_command *cmd) 821 { 822 return (cmd->common.flags & NVME_CMD_SGL_ALL) == NVME_CMD_SGL_METASEG; 823 } 824 825 static inline bool nvme_pci_cmd_use_sgl(struct nvme_command *cmd) 826 { 827 return cmd->common.flags & 828 (NVME_CMD_SGL_METABUF | NVME_CMD_SGL_METASEG); 829 } 830 831 static inline dma_addr_t nvme_pci_first_desc_dma_addr(struct nvme_command *cmd) 832 { 833 if (nvme_pci_cmd_use_sgl(cmd)) 834 return le64_to_cpu(cmd->common.dptr.sgl.addr); 835 return le64_to_cpu(cmd->common.dptr.prp2); 836 } 837 838 static void nvme_free_descriptors(struct request *req) 839 { 840 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 841 const int last_prp = NVME_CTRL_PAGE_SIZE / sizeof(__le64) - 1; 842 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 843 dma_addr_t dma_addr = nvme_pci_first_desc_dma_addr(&iod->cmd); 844 int i; 845 846 if (iod->nr_descriptors == 1) { 847 dma_pool_free(nvme_dma_pool(nvmeq, iod), iod->descriptors[0], 848 dma_addr); 849 return; 850 } 851 852 for (i = 0; i < iod->nr_descriptors; i++) { 853 __le64 *prp_list = iod->descriptors[i]; 854 dma_addr_t next_dma_addr = le64_to_cpu(prp_list[last_prp]); 855 856 dma_pool_free(nvmeq->descriptor_pools.large, prp_list, 857 dma_addr); 858 dma_addr = next_dma_addr; 859 } 860 } 861 862 static void nvme_free_prps(struct request *req, unsigned int attrs) 863 { 864 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 865 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 866 unsigned int i; 867 868 for (i = 0; i < iod->nr_dma_vecs; i++) 869 dma_unmap_phys(nvmeq->dev->dev, iod->dma_vecs[i].addr, 870 iod->dma_vecs[i].len, rq_dma_dir(req), attrs); 871 mempool_free(iod->dma_vecs, nvmeq->dev->dmavec_mempool); 872 } 873 874 static void nvme_free_sgls(struct request *req, struct nvme_sgl_desc *sge, 875 struct nvme_sgl_desc *sg_list, unsigned int attrs) 876 { 877 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 878 enum dma_data_direction dir = rq_dma_dir(req); 879 unsigned int len = le32_to_cpu(sge->length); 880 struct device *dma_dev = nvmeq->dev->dev; 881 unsigned int i; 882 883 if (sge->type == (NVME_SGL_FMT_DATA_DESC << 4)) { 884 dma_unmap_phys(dma_dev, le64_to_cpu(sge->addr), len, dir, 885 attrs); 886 return; 887 } 888 889 for (i = 0; i < len / sizeof(*sg_list); i++) 890 dma_unmap_phys(dma_dev, le64_to_cpu(sg_list[i].addr), 891 le32_to_cpu(sg_list[i].length), dir, attrs); 892 } 893 894 static void nvme_unmap_metadata(struct request *req) 895 { 896 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 897 enum pci_p2pdma_map_type map = PCI_P2PDMA_MAP_NONE; 898 enum dma_data_direction dir = rq_dma_dir(req); 899 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 900 struct device *dma_dev = nvmeq->dev->dev; 901 struct nvme_sgl_desc *sge = iod->meta_descriptor; 902 unsigned int attrs = 0; 903 904 if (iod->flags & IOD_SINGLE_META_SEGMENT) { 905 dma_unmap_page(dma_dev, iod->meta_dma, 906 rq_integrity_vec(req).bv_len, 907 rq_dma_dir(req)); 908 return; 909 } 910 911 if (iod->flags & IOD_META_P2P) 912 map = PCI_P2PDMA_MAP_BUS_ADDR; 913 else if (iod->flags & IOD_META_MMIO) { 914 map = PCI_P2PDMA_MAP_THRU_HOST_BRIDGE; 915 attrs |= DMA_ATTR_MMIO; 916 } 917 918 if (!blk_rq_dma_unmap(req, dma_dev, &iod->meta_dma_state, 919 iod->meta_total_len, map)) { 920 if (nvme_pci_cmd_use_meta_sgl(&iod->cmd)) 921 nvme_free_sgls(req, sge, &sge[1], attrs); 922 else 923 dma_unmap_phys(dma_dev, iod->meta_dma, 924 iod->meta_total_len, dir, attrs); 925 } 926 927 if (iod->meta_descriptor) 928 dma_pool_free(nvmeq->descriptor_pools.small, 929 iod->meta_descriptor, iod->meta_dma); 930 } 931 932 static void nvme_unmap_data(struct request *req) 933 { 934 enum pci_p2pdma_map_type map = PCI_P2PDMA_MAP_NONE; 935 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 936 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 937 struct device *dma_dev = nvmeq->dev->dev; 938 unsigned int attrs = 0; 939 940 if (iod->flags & IOD_SINGLE_SEGMENT) { 941 static_assert(offsetof(union nvme_data_ptr, prp1) == 942 offsetof(union nvme_data_ptr, sgl.addr)); 943 dma_unmap_page(dma_dev, le64_to_cpu(iod->cmd.common.dptr.prp1), 944 iod->total_len, rq_dma_dir(req)); 945 return; 946 } 947 948 if (iod->flags & IOD_DATA_P2P) 949 map = PCI_P2PDMA_MAP_BUS_ADDR; 950 else if (iod->flags & IOD_DATA_MMIO) { 951 map = PCI_P2PDMA_MAP_THRU_HOST_BRIDGE; 952 attrs |= DMA_ATTR_MMIO; 953 } 954 955 if (!blk_rq_dma_unmap(req, dma_dev, &iod->dma_state, iod->total_len, 956 map)) { 957 if (nvme_pci_cmd_use_sgl(&iod->cmd)) 958 nvme_free_sgls(req, &iod->cmd.common.dptr.sgl, 959 iod->descriptors[0], attrs); 960 else 961 nvme_free_prps(req, attrs); 962 } 963 964 if (iod->nr_descriptors) 965 nvme_free_descriptors(req); 966 } 967 968 static bool nvme_pci_prp_save_mapping(struct request *req, 969 struct device *dma_dev, 970 struct blk_dma_iter *iter) 971 { 972 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 973 974 if (dma_use_iova(&iod->dma_state) || !dma_need_unmap(dma_dev) || 975 (iod->flags & IOD_DATA_P2P)) 976 return true; 977 978 if (!iod->nr_dma_vecs) { 979 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 980 981 iod->dma_vecs = mempool_alloc(nvmeq->dev->dmavec_mempool, 982 GFP_ATOMIC); 983 if (!iod->dma_vecs) { 984 iter->status = BLK_STS_RESOURCE; 985 return false; 986 } 987 } 988 989 iod->dma_vecs[iod->nr_dma_vecs].addr = iter->addr; 990 iod->dma_vecs[iod->nr_dma_vecs].len = iter->len; 991 iod->nr_dma_vecs++; 992 return true; 993 } 994 995 static bool nvme_pci_prp_iter_next(struct request *req, struct device *dma_dev, 996 struct blk_dma_iter *iter) 997 { 998 if (iter->len) 999 return true; 1000 if (!blk_rq_dma_map_iter_next(req, dma_dev, iter)) 1001 return false; 1002 return nvme_pci_prp_save_mapping(req, dma_dev, iter); 1003 } 1004 1005 static void nvme_unmap_iter(struct request *req, struct blk_dma_iter *iter, 1006 struct dma_iova_state *state) 1007 { 1008 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 1009 struct device *dev = nvmeq->dev->dev; 1010 1011 if (!blk_rq_dma_unmap(req, dev, state, iter->len, iter->p2pdma.map)) { 1012 unsigned int attrs = 0; 1013 1014 if (iter->p2pdma.map == PCI_P2PDMA_MAP_THRU_HOST_BRIDGE) 1015 attrs |= DMA_ATTR_MMIO; 1016 1017 dma_unmap_phys(dev, iter->addr, iter->len, rq_dma_dir(req), 1018 attrs); 1019 } 1020 } 1021 1022 static blk_status_t nvme_pci_setup_data_prp(struct request *req, 1023 struct blk_dma_iter *iter) 1024 { 1025 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1026 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 1027 unsigned int length = blk_rq_payload_bytes(req); 1028 dma_addr_t prp1_dma, prp2_dma = 0; 1029 unsigned int prp_len, i; 1030 __le64 *prp_list; 1031 1032 if (!nvme_pci_prp_save_mapping(req, nvmeq->dev->dev, iter)) { 1033 nvme_unmap_iter(req, iter, &iod->dma_state); 1034 return iter->status; 1035 } 1036 1037 /* 1038 * PRP1 always points to the start of the DMA transfers. 1039 * 1040 * This is the only PRP (except for the list entries) that could be 1041 * non-aligned. 1042 */ 1043 prp1_dma = iter->addr; 1044 prp_len = min(length, NVME_CTRL_PAGE_SIZE - 1045 (iter->addr & (NVME_CTRL_PAGE_SIZE - 1))); 1046 iod->total_len += prp_len; 1047 iter->addr += prp_len; 1048 iter->len -= prp_len; 1049 length -= prp_len; 1050 if (!length) 1051 goto done; 1052 1053 if (!nvme_pci_prp_iter_next(req, nvmeq->dev->dev, iter)) { 1054 if (WARN_ON_ONCE(!iter->status)) 1055 goto bad_sgl; 1056 goto done; 1057 } 1058 1059 /* 1060 * PRP2 is usually a list, but can point to data if all data to be 1061 * transferred fits into PRP1 + PRP2: 1062 */ 1063 if (length <= NVME_CTRL_PAGE_SIZE) { 1064 prp2_dma = iter->addr; 1065 iod->total_len += length; 1066 goto done; 1067 } 1068 1069 if (DIV_ROUND_UP(length, NVME_CTRL_PAGE_SIZE) <= 1070 NVME_SMALL_POOL_SIZE / sizeof(__le64)) 1071 iod->flags |= IOD_SMALL_DESCRIPTOR; 1072 1073 prp_list = dma_pool_alloc(nvme_dma_pool(nvmeq, iod), GFP_ATOMIC, 1074 &prp2_dma); 1075 if (!prp_list) { 1076 iter->status = BLK_STS_RESOURCE; 1077 goto done; 1078 } 1079 iod->descriptors[iod->nr_descriptors++] = prp_list; 1080 1081 i = 0; 1082 for (;;) { 1083 prp_list[i++] = cpu_to_le64(iter->addr); 1084 prp_len = min(length, NVME_CTRL_PAGE_SIZE); 1085 if (WARN_ON_ONCE(iter->len < prp_len)) 1086 goto bad_sgl; 1087 1088 iod->total_len += prp_len; 1089 iter->addr += prp_len; 1090 iter->len -= prp_len; 1091 length -= prp_len; 1092 if (!length) 1093 break; 1094 1095 if (!nvme_pci_prp_iter_next(req, nvmeq->dev->dev, iter)) { 1096 if (WARN_ON_ONCE(!iter->status)) 1097 goto bad_sgl; 1098 goto done; 1099 } 1100 1101 /* 1102 * If we've filled the entire descriptor, allocate a new that is 1103 * pointed to be the last entry in the previous PRP list. To 1104 * accommodate for that move the last actual entry to the new 1105 * descriptor. 1106 */ 1107 if (i == NVME_CTRL_PAGE_SIZE >> 3) { 1108 __le64 *old_prp_list = prp_list; 1109 dma_addr_t prp_list_dma; 1110 1111 prp_list = dma_pool_alloc(nvmeq->descriptor_pools.large, 1112 GFP_ATOMIC, &prp_list_dma); 1113 if (!prp_list) { 1114 iter->status = BLK_STS_RESOURCE; 1115 goto done; 1116 } 1117 iod->descriptors[iod->nr_descriptors++] = prp_list; 1118 1119 prp_list[0] = old_prp_list[i - 1]; 1120 old_prp_list[i - 1] = cpu_to_le64(prp_list_dma); 1121 i = 1; 1122 } 1123 } 1124 1125 done: 1126 /* 1127 * nvme_unmap_data uses the DPT field in the SQE to tear down the 1128 * mapping, so initialize it even for failures. 1129 */ 1130 iod->cmd.common.dptr.prp1 = cpu_to_le64(prp1_dma); 1131 iod->cmd.common.dptr.prp2 = cpu_to_le64(prp2_dma); 1132 if (unlikely(iter->status)) 1133 nvme_unmap_data(req); 1134 return iter->status; 1135 1136 bad_sgl: 1137 dev_err_once(nvmeq->dev->dev, 1138 "Incorrectly formed request for payload:%d nents:%d\n", 1139 blk_rq_payload_bytes(req), blk_rq_nr_phys_segments(req)); 1140 nvme_unmap_data(req); 1141 return BLK_STS_IOERR; 1142 } 1143 1144 static void nvme_pci_sgl_set_data(struct nvme_sgl_desc *sge, 1145 struct blk_dma_iter *iter) 1146 { 1147 sge->addr = cpu_to_le64(iter->addr); 1148 sge->length = cpu_to_le32(iter->len); 1149 sge->type = NVME_SGL_FMT_DATA_DESC << 4; 1150 } 1151 1152 static void nvme_pci_sgl_set_seg(struct nvme_sgl_desc *sge, 1153 dma_addr_t dma_addr, int entries) 1154 { 1155 sge->addr = cpu_to_le64(dma_addr); 1156 sge->length = cpu_to_le32(entries * sizeof(*sge)); 1157 sge->type = NVME_SGL_FMT_LAST_SEG_DESC << 4; 1158 } 1159 1160 static blk_status_t nvme_pci_setup_data_sgl(struct request *req, 1161 struct blk_dma_iter *iter) 1162 { 1163 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1164 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 1165 unsigned int entries = blk_rq_nr_phys_segments(req); 1166 struct nvme_sgl_desc *sg_list; 1167 dma_addr_t sgl_dma; 1168 unsigned int mapped = 0; 1169 1170 /* set the transfer type as SGL */ 1171 iod->cmd.common.flags = NVME_CMD_SGL_METABUF; 1172 1173 if (entries == 1 || blk_rq_dma_map_coalesce(&iod->dma_state)) { 1174 nvme_pci_sgl_set_data(&iod->cmd.common.dptr.sgl, iter); 1175 iod->total_len += iter->len; 1176 return BLK_STS_OK; 1177 } 1178 1179 if (entries <= NVME_SMALL_POOL_SIZE / sizeof(*sg_list)) 1180 iod->flags |= IOD_SMALL_DESCRIPTOR; 1181 1182 sg_list = dma_pool_alloc(nvme_dma_pool(nvmeq, iod), GFP_ATOMIC, 1183 &sgl_dma); 1184 if (!sg_list) { 1185 nvme_unmap_iter(req, iter, &iod->dma_state); 1186 return BLK_STS_RESOURCE; 1187 } 1188 1189 iod->descriptors[iod->nr_descriptors++] = sg_list; 1190 1191 do { 1192 if (WARN_ON_ONCE(mapped == entries)) { 1193 iter->status = BLK_STS_IOERR; 1194 break; 1195 } 1196 nvme_pci_sgl_set_data(&sg_list[mapped++], iter); 1197 iod->total_len += iter->len; 1198 } while (blk_rq_dma_map_iter_next(req, nvmeq->dev->dev, iter)); 1199 1200 nvme_pci_sgl_set_seg(&iod->cmd.common.dptr.sgl, sgl_dma, mapped); 1201 if (unlikely(iter->status)) 1202 nvme_unmap_data(req); 1203 return iter->status; 1204 } 1205 1206 static blk_status_t nvme_pci_setup_data_simple(struct request *req, 1207 enum nvme_use_sgl use_sgl) 1208 { 1209 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1210 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 1211 struct bio_vec bv = req_bvec(req); 1212 unsigned int prp1_offset = bv.bv_offset & (NVME_CTRL_PAGE_SIZE - 1); 1213 bool prp_possible = prp1_offset + bv.bv_len <= NVME_CTRL_PAGE_SIZE * 2; 1214 dma_addr_t dma_addr; 1215 1216 if (!use_sgl && !prp_possible) 1217 return BLK_STS_AGAIN; 1218 if (is_pci_p2pdma_page(bv.bv_page)) 1219 return BLK_STS_AGAIN; 1220 1221 dma_addr = dma_map_bvec(nvmeq->dev->dev, &bv, rq_dma_dir(req), 0); 1222 if (dma_mapping_error(nvmeq->dev->dev, dma_addr)) 1223 return BLK_STS_RESOURCE; 1224 iod->total_len = bv.bv_len; 1225 iod->flags |= IOD_SINGLE_SEGMENT; 1226 1227 if (use_sgl == SGL_FORCED || !prp_possible) { 1228 iod->cmd.common.flags = NVME_CMD_SGL_METABUF; 1229 iod->cmd.common.dptr.sgl.addr = cpu_to_le64(dma_addr); 1230 iod->cmd.common.dptr.sgl.length = cpu_to_le32(bv.bv_len); 1231 iod->cmd.common.dptr.sgl.type = NVME_SGL_FMT_DATA_DESC << 4; 1232 } else { 1233 unsigned int first_prp_len = NVME_CTRL_PAGE_SIZE - prp1_offset; 1234 1235 iod->cmd.common.dptr.prp1 = cpu_to_le64(dma_addr); 1236 iod->cmd.common.dptr.prp2 = 0; 1237 if (bv.bv_len > first_prp_len) 1238 iod->cmd.common.dptr.prp2 = 1239 cpu_to_le64(dma_addr + first_prp_len); 1240 } 1241 1242 return BLK_STS_OK; 1243 } 1244 1245 static blk_status_t nvme_map_data(struct request *req) 1246 { 1247 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1248 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 1249 struct nvme_dev *dev = nvmeq->dev; 1250 enum nvme_use_sgl use_sgl = nvme_pci_use_sgls(dev, req); 1251 struct blk_dma_iter iter; 1252 blk_status_t ret; 1253 1254 /* 1255 * Try to skip the DMA iterator for single segment requests, as that 1256 * significantly improves performances for small I/O sizes. 1257 */ 1258 if (blk_rq_nr_phys_segments(req) == 1) { 1259 ret = nvme_pci_setup_data_simple(req, use_sgl); 1260 if (ret != BLK_STS_AGAIN) 1261 return ret; 1262 } 1263 1264 if (!blk_rq_dma_map_iter_start(req, dev->dev, &iod->dma_state, &iter)) 1265 return iter.status; 1266 1267 switch (iter.p2pdma.map) { 1268 case PCI_P2PDMA_MAP_BUS_ADDR: 1269 iod->flags |= IOD_DATA_P2P; 1270 break; 1271 case PCI_P2PDMA_MAP_THRU_HOST_BRIDGE: 1272 iod->flags |= IOD_DATA_MMIO; 1273 break; 1274 case PCI_P2PDMA_MAP_NONE: 1275 break; 1276 default: 1277 return BLK_STS_RESOURCE; 1278 } 1279 1280 if (use_sgl == SGL_FORCED || 1281 (use_sgl == SGL_SUPPORTED && 1282 (sgl_threshold && nvme_pci_avg_seg_size(req) >= sgl_threshold))) 1283 return nvme_pci_setup_data_sgl(req, &iter); 1284 return nvme_pci_setup_data_prp(req, &iter); 1285 } 1286 1287 static blk_status_t nvme_pci_setup_meta_iter(struct request *req) 1288 { 1289 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 1290 unsigned int entries = req->nr_integrity_segments; 1291 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1292 struct nvme_dev *dev = nvmeq->dev; 1293 struct nvme_sgl_desc *sg_list; 1294 struct blk_dma_iter iter; 1295 dma_addr_t sgl_dma; 1296 int i = 0; 1297 1298 if (!blk_rq_integrity_dma_map_iter_start(req, dev->dev, 1299 &iod->meta_dma_state, &iter)) 1300 return iter.status; 1301 1302 switch (iter.p2pdma.map) { 1303 case PCI_P2PDMA_MAP_BUS_ADDR: 1304 iod->flags |= IOD_META_P2P; 1305 break; 1306 case PCI_P2PDMA_MAP_THRU_HOST_BRIDGE: 1307 iod->flags |= IOD_META_MMIO; 1308 break; 1309 case PCI_P2PDMA_MAP_NONE: 1310 break; 1311 default: 1312 return BLK_STS_RESOURCE; 1313 } 1314 1315 if (blk_rq_dma_map_coalesce(&iod->meta_dma_state)) 1316 entries = 1; 1317 1318 /* 1319 * The NVMe MPTR descriptor has an implicit length that the host and 1320 * device must agree on to avoid data/memory corruption. We trust the 1321 * kernel allocated correctly based on the format's parameters, so use 1322 * the more efficient MPTR to avoid extra dma pool allocations for the 1323 * SGL indirection. 1324 * 1325 * But for user commands, we don't necessarily know what they do, so 1326 * the driver can't validate the metadata buffer size. The SGL 1327 * descriptor provides an explicit length, so we're relying on that 1328 * mechanism to catch any misunderstandings between the application and 1329 * device. 1330 * 1331 * P2P DMA also needs to use the blk_dma_iter method, so mptr setup 1332 * leverages this routine when that happens. 1333 */ 1334 if (!nvme_ctrl_meta_sgl_supported(&dev->ctrl) || 1335 (entries == 1 && !(nvme_req(req)->flags & NVME_REQ_USERCMD))) { 1336 iod->cmd.common.metadata = cpu_to_le64(iter.addr); 1337 iod->meta_total_len = iter.len; 1338 iod->meta_dma = iter.addr; 1339 iod->meta_descriptor = NULL; 1340 return BLK_STS_OK; 1341 } 1342 1343 sg_list = dma_pool_alloc(nvmeq->descriptor_pools.small, GFP_ATOMIC, 1344 &sgl_dma); 1345 if (!sg_list) { 1346 nvme_unmap_iter(req, &iter, &iod->meta_dma_state); 1347 return BLK_STS_RESOURCE; 1348 } 1349 1350 iod->meta_descriptor = sg_list; 1351 iod->meta_dma = sgl_dma; 1352 iod->cmd.common.flags = NVME_CMD_SGL_METASEG; 1353 iod->cmd.common.metadata = cpu_to_le64(sgl_dma); 1354 if (entries == 1) { 1355 iod->meta_total_len = iter.len; 1356 nvme_pci_sgl_set_data(sg_list, &iter); 1357 return BLK_STS_OK; 1358 } 1359 1360 sgl_dma += sizeof(*sg_list); 1361 do { 1362 nvme_pci_sgl_set_data(&sg_list[++i], &iter); 1363 iod->meta_total_len += iter.len; 1364 } while (blk_rq_integrity_dma_map_iter_next(req, dev->dev, &iter)); 1365 1366 nvme_pci_sgl_set_seg(sg_list, sgl_dma, i); 1367 if (unlikely(iter.status)) 1368 nvme_unmap_metadata(req); 1369 return iter.status; 1370 } 1371 1372 static blk_status_t nvme_pci_setup_meta_mptr(struct request *req) 1373 { 1374 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1375 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 1376 struct bio_vec bv = rq_integrity_vec(req); 1377 1378 if (is_pci_p2pdma_page(bv.bv_page)) 1379 return nvme_pci_setup_meta_iter(req); 1380 1381 iod->meta_dma = dma_map_bvec(nvmeq->dev->dev, &bv, rq_dma_dir(req), 0); 1382 if (dma_mapping_error(nvmeq->dev->dev, iod->meta_dma)) 1383 return BLK_STS_IOERR; 1384 iod->cmd.common.metadata = cpu_to_le64(iod->meta_dma); 1385 iod->flags |= IOD_SINGLE_META_SEGMENT; 1386 return BLK_STS_OK; 1387 } 1388 1389 static blk_status_t nvme_map_metadata(struct request *req) 1390 { 1391 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1392 1393 if ((iod->cmd.common.flags & NVME_CMD_SGL_METABUF) && 1394 nvme_pci_metadata_use_sgls(req)) 1395 return nvme_pci_setup_meta_iter(req); 1396 return nvme_pci_setup_meta_mptr(req); 1397 } 1398 1399 static blk_status_t nvme_prep_rq(struct request *req) 1400 { 1401 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1402 blk_status_t ret; 1403 1404 iod->flags = 0; 1405 iod->nr_descriptors = 0; 1406 iod->total_len = 0; 1407 iod->meta_total_len = 0; 1408 iod->nr_dma_vecs = 0; 1409 1410 ret = nvme_setup_cmd(req->q->queuedata, req); 1411 if (ret) 1412 return ret; 1413 1414 if (blk_rq_nr_phys_segments(req)) { 1415 ret = nvme_map_data(req); 1416 if (ret) 1417 goto out_free_cmd; 1418 } 1419 1420 if (blk_integrity_rq(req)) { 1421 ret = nvme_map_metadata(req); 1422 if (ret) 1423 goto out_unmap_data; 1424 } 1425 1426 nvme_start_request(req); 1427 return BLK_STS_OK; 1428 out_unmap_data: 1429 if (blk_rq_nr_phys_segments(req)) 1430 nvme_unmap_data(req); 1431 out_free_cmd: 1432 nvme_cleanup_cmd(req); 1433 return ret; 1434 } 1435 1436 static blk_status_t nvme_queue_rq(struct blk_mq_hw_ctx *hctx, 1437 const struct blk_mq_queue_data *bd) 1438 { 1439 struct nvme_queue *nvmeq = hctx->driver_data; 1440 struct nvme_dev *dev = nvmeq->dev; 1441 struct request *req = bd->rq; 1442 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1443 blk_status_t ret; 1444 1445 /* 1446 * We should not need to do this, but we're still using this to 1447 * ensure we can drain requests on a dying queue. 1448 */ 1449 if (unlikely(!test_bit(NVMEQ_ENABLED, &nvmeq->flags))) 1450 return BLK_STS_IOERR; 1451 1452 if (unlikely(!nvme_check_ready(&dev->ctrl, req, true))) 1453 return nvme_fail_nonready_command(&dev->ctrl, req); 1454 1455 ret = nvme_prep_rq(req); 1456 if (unlikely(ret)) 1457 return ret; 1458 spin_lock(&nvmeq->sq_lock); 1459 nvme_sq_copy_cmd(nvmeq, &iod->cmd); 1460 nvme_write_sq_db(nvmeq, bd->last); 1461 spin_unlock(&nvmeq->sq_lock); 1462 return BLK_STS_OK; 1463 } 1464 1465 static void nvme_submit_cmds(struct nvme_queue *nvmeq, struct rq_list *rqlist) 1466 { 1467 struct request *req; 1468 1469 if (rq_list_empty(rqlist)) 1470 return; 1471 1472 spin_lock(&nvmeq->sq_lock); 1473 while ((req = rq_list_pop(rqlist))) { 1474 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1475 1476 nvme_sq_copy_cmd(nvmeq, &iod->cmd); 1477 } 1478 nvme_write_sq_db(nvmeq, true); 1479 spin_unlock(&nvmeq->sq_lock); 1480 } 1481 1482 static bool nvme_prep_rq_batch(struct nvme_queue *nvmeq, struct request *req) 1483 { 1484 /* 1485 * We should not need to do this, but we're still using this to 1486 * ensure we can drain requests on a dying queue. 1487 */ 1488 if (unlikely(!test_bit(NVMEQ_ENABLED, &nvmeq->flags))) 1489 return false; 1490 if (unlikely(!nvme_check_ready(&nvmeq->dev->ctrl, req, true))) 1491 return false; 1492 1493 return nvme_prep_rq(req) == BLK_STS_OK; 1494 } 1495 1496 static void nvme_queue_rqs(struct rq_list *rqlist) 1497 { 1498 struct rq_list submit_list = { }; 1499 struct rq_list requeue_list = { }; 1500 struct nvme_queue *nvmeq = NULL; 1501 struct request *req; 1502 1503 while ((req = rq_list_pop(rqlist))) { 1504 if (nvmeq && nvmeq != req->mq_hctx->driver_data) 1505 nvme_submit_cmds(nvmeq, &submit_list); 1506 nvmeq = req->mq_hctx->driver_data; 1507 1508 if (nvme_prep_rq_batch(nvmeq, req)) 1509 rq_list_add_tail(&submit_list, req); 1510 else 1511 rq_list_add_tail(&requeue_list, req); 1512 } 1513 1514 if (nvmeq) 1515 nvme_submit_cmds(nvmeq, &submit_list); 1516 *rqlist = requeue_list; 1517 } 1518 1519 static __always_inline void nvme_pci_unmap_rq(struct request *req) 1520 { 1521 if (blk_integrity_rq(req)) 1522 nvme_unmap_metadata(req); 1523 if (blk_rq_nr_phys_segments(req)) 1524 nvme_unmap_data(req); 1525 } 1526 1527 static void nvme_pci_complete_rq(struct request *req) 1528 { 1529 nvme_pci_unmap_rq(req); 1530 nvme_complete_rq(req); 1531 } 1532 1533 static void nvme_pci_complete_batch(struct io_comp_batch *iob) 1534 { 1535 nvme_complete_batch(iob, nvme_pci_unmap_rq); 1536 } 1537 1538 /* We read the CQE phase first to check if the rest of the entry is valid */ 1539 static inline bool nvme_cqe_pending(struct nvme_queue *nvmeq) 1540 { 1541 struct nvme_completion *hcqe = &nvmeq->cqes[nvmeq->cq_head]; 1542 1543 return (le16_to_cpu(READ_ONCE(hcqe->status)) & 1) == nvmeq->cq_phase; 1544 } 1545 1546 static inline void nvme_ring_cq_doorbell(struct nvme_queue *nvmeq) 1547 { 1548 u16 head = nvmeq->cq_head; 1549 1550 if (nvme_dbbuf_update_and_check_event(head, nvmeq->dbbuf_cq_db, 1551 nvmeq->dbbuf_cq_ei)) 1552 writel(head, nvmeq->q_db + nvmeq->dev->db_stride); 1553 } 1554 1555 static inline struct blk_mq_tags *nvme_queue_tagset(struct nvme_queue *nvmeq) 1556 { 1557 if (!nvmeq->qid) 1558 return nvmeq->dev->admin_tagset.tags[0]; 1559 return nvmeq->dev->tagset.tags[nvmeq->qid - 1]; 1560 } 1561 1562 static inline void nvme_handle_cqe(struct nvme_queue *nvmeq, 1563 struct io_comp_batch *iob, u16 idx) 1564 { 1565 struct nvme_completion *cqe = &nvmeq->cqes[idx]; 1566 __u16 command_id = READ_ONCE(cqe->command_id); 1567 struct request *req; 1568 1569 /* 1570 * AEN requests are special as they don't time out and can 1571 * survive any kind of queue freeze and often don't respond to 1572 * aborts. We don't even bother to allocate a struct request 1573 * for them but rather special case them here. 1574 */ 1575 if (unlikely(nvme_is_aen_req(nvmeq->qid, command_id))) { 1576 nvme_complete_async_event(&nvmeq->dev->ctrl, 1577 cqe->status, &cqe->result); 1578 return; 1579 } 1580 1581 req = nvme_find_rq(nvme_queue_tagset(nvmeq), command_id); 1582 if (unlikely(!req)) { 1583 dev_warn(nvmeq->dev->ctrl.device, 1584 "invalid id %d completed on queue %d\n", 1585 command_id, le16_to_cpu(cqe->sq_id)); 1586 return; 1587 } 1588 1589 trace_nvme_sq(req, cqe->sq_head, nvmeq->sq_tail); 1590 if (!nvme_try_complete_req(req, cqe->status, cqe->result) && 1591 !blk_mq_add_to_batch(req, iob, 1592 nvme_req(req)->status != NVME_SC_SUCCESS, 1593 nvme_pci_complete_batch)) 1594 nvme_pci_complete_rq(req); 1595 } 1596 1597 static inline void nvme_update_cq_head(struct nvme_queue *nvmeq) 1598 { 1599 u32 tmp = nvmeq->cq_head + 1; 1600 1601 if (tmp == nvmeq->q_depth) { 1602 nvmeq->cq_head = 0; 1603 nvmeq->cq_phase ^= 1; 1604 } else { 1605 nvmeq->cq_head = tmp; 1606 } 1607 } 1608 1609 static inline bool nvme_poll_cq(struct nvme_queue *nvmeq, 1610 struct io_comp_batch *iob) 1611 { 1612 bool found = false; 1613 1614 while (nvme_cqe_pending(nvmeq)) { 1615 found = true; 1616 /* 1617 * load-load control dependency between phase and the rest of 1618 * the cqe requires a full read memory barrier 1619 */ 1620 dma_rmb(); 1621 nvme_handle_cqe(nvmeq, iob, nvmeq->cq_head); 1622 nvme_update_cq_head(nvmeq); 1623 } 1624 1625 if (found) 1626 nvme_ring_cq_doorbell(nvmeq); 1627 return found; 1628 } 1629 1630 static irqreturn_t nvme_irq(int irq, void *data) 1631 { 1632 struct nvme_queue *nvmeq = data; 1633 DEFINE_IO_COMP_BATCH(iob); 1634 1635 if (nvme_poll_cq(nvmeq, &iob)) { 1636 if (!rq_list_empty(&iob.req_list)) 1637 nvme_pci_complete_batch(&iob); 1638 return IRQ_HANDLED; 1639 } 1640 return IRQ_NONE; 1641 } 1642 1643 static irqreturn_t nvme_irq_check(int irq, void *data) 1644 { 1645 struct nvme_queue *nvmeq = data; 1646 1647 if (nvme_cqe_pending(nvmeq)) 1648 return IRQ_WAKE_THREAD; 1649 return IRQ_NONE; 1650 } 1651 1652 /* 1653 * Poll for completions for any interrupt driven queue 1654 * Can be called from any context. 1655 */ 1656 static void nvme_poll_irqdisable(struct nvme_queue *nvmeq) 1657 { 1658 struct pci_dev *pdev = to_pci_dev(nvmeq->dev->dev); 1659 int irq; 1660 1661 WARN_ON_ONCE(test_bit(NVMEQ_POLLED, &nvmeq->flags)); 1662 1663 irq = pci_irq_vector(pdev, nvmeq->cq_vector); 1664 disable_irq(irq); 1665 spin_lock(&nvmeq->cq_poll_lock); 1666 nvme_poll_cq(nvmeq, NULL); 1667 spin_unlock(&nvmeq->cq_poll_lock); 1668 enable_irq(irq); 1669 } 1670 1671 static int nvme_poll(struct blk_mq_hw_ctx *hctx, struct io_comp_batch *iob) 1672 { 1673 struct nvme_queue *nvmeq = hctx->driver_data; 1674 bool found; 1675 1676 if (!test_bit(NVMEQ_POLLED, &nvmeq->flags) || 1677 !nvme_cqe_pending(nvmeq)) 1678 return 0; 1679 1680 spin_lock(&nvmeq->cq_poll_lock); 1681 found = nvme_poll_cq(nvmeq, iob); 1682 spin_unlock(&nvmeq->cq_poll_lock); 1683 1684 return found; 1685 } 1686 1687 static void nvme_pci_submit_async_event(struct nvme_ctrl *ctrl) 1688 { 1689 struct nvme_dev *dev = to_nvme_dev(ctrl); 1690 struct nvme_queue *nvmeq = &dev->queues[0]; 1691 struct nvme_command c = { }; 1692 1693 c.common.opcode = nvme_admin_async_event; 1694 c.common.command_id = NVME_AQ_BLK_MQ_DEPTH; 1695 1696 spin_lock(&nvmeq->sq_lock); 1697 nvme_sq_copy_cmd(nvmeq, &c); 1698 nvme_write_sq_db(nvmeq, true); 1699 spin_unlock(&nvmeq->sq_lock); 1700 } 1701 1702 static int nvme_pci_subsystem_reset(struct nvme_ctrl *ctrl) 1703 { 1704 struct nvme_dev *dev = to_nvme_dev(ctrl); 1705 int ret = 0; 1706 1707 /* 1708 * Taking the shutdown_lock ensures the BAR mapping is not being 1709 * altered by reset_work. Holding this lock before the RESETTING state 1710 * change, if successful, also ensures nvme_remove won't be able to 1711 * proceed to iounmap until we're done. 1712 */ 1713 mutex_lock(&dev->shutdown_lock); 1714 if (!dev->bar_mapped_size) { 1715 ret = -ENODEV; 1716 goto unlock; 1717 } 1718 1719 if (!nvme_change_ctrl_state(ctrl, NVME_CTRL_RESETTING)) { 1720 ret = -EBUSY; 1721 goto unlock; 1722 } 1723 1724 writel(NVME_SUBSYS_RESET, dev->bar + NVME_REG_NSSR); 1725 1726 if (!nvme_change_ctrl_state(ctrl, NVME_CTRL_CONNECTING) || 1727 !nvme_change_ctrl_state(ctrl, NVME_CTRL_LIVE)) 1728 goto unlock; 1729 1730 /* 1731 * Read controller status to flush the previous write and trigger a 1732 * pcie read error. 1733 */ 1734 readl(dev->bar + NVME_REG_CSTS); 1735 unlock: 1736 mutex_unlock(&dev->shutdown_lock); 1737 return ret; 1738 } 1739 1740 static int adapter_delete_queue(struct nvme_dev *dev, u8 opcode, u16 id) 1741 { 1742 struct nvme_command c = { }; 1743 1744 c.delete_queue.opcode = opcode; 1745 c.delete_queue.qid = cpu_to_le16(id); 1746 1747 return nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0); 1748 } 1749 1750 static int adapter_alloc_cq(struct nvme_dev *dev, u16 qid, 1751 struct nvme_queue *nvmeq, s16 vector) 1752 { 1753 struct nvme_command c = { }; 1754 int flags = NVME_QUEUE_PHYS_CONTIG; 1755 1756 if (!test_bit(NVMEQ_POLLED, &nvmeq->flags)) 1757 flags |= NVME_CQ_IRQ_ENABLED; 1758 1759 /* 1760 * Note: we (ab)use the fact that the prp fields survive if no data 1761 * is attached to the request. 1762 */ 1763 c.create_cq.opcode = nvme_admin_create_cq; 1764 c.create_cq.prp1 = cpu_to_le64(nvmeq->cq_dma_addr); 1765 c.create_cq.cqid = cpu_to_le16(qid); 1766 c.create_cq.qsize = cpu_to_le16(nvmeq->q_depth - 1); 1767 c.create_cq.cq_flags = cpu_to_le16(flags); 1768 c.create_cq.irq_vector = cpu_to_le16(vector); 1769 1770 return nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0); 1771 } 1772 1773 static int adapter_alloc_sq(struct nvme_dev *dev, u16 qid, 1774 struct nvme_queue *nvmeq) 1775 { 1776 struct nvme_ctrl *ctrl = &dev->ctrl; 1777 struct nvme_command c = { }; 1778 int flags = NVME_QUEUE_PHYS_CONTIG; 1779 1780 /* 1781 * Some drives have a bug that auto-enables WRRU if MEDIUM isn't 1782 * set. Since URGENT priority is zeroes, it makes all queues 1783 * URGENT. 1784 */ 1785 if (ctrl->quirks & NVME_QUIRK_MEDIUM_PRIO_SQ) 1786 flags |= NVME_SQ_PRIO_MEDIUM; 1787 1788 /* 1789 * Note: we (ab)use the fact that the prp fields survive if no data 1790 * is attached to the request. 1791 */ 1792 c.create_sq.opcode = nvme_admin_create_sq; 1793 c.create_sq.prp1 = cpu_to_le64(nvmeq->sq_dma_addr); 1794 c.create_sq.sqid = cpu_to_le16(qid); 1795 c.create_sq.qsize = cpu_to_le16(nvmeq->q_depth - 1); 1796 c.create_sq.sq_flags = cpu_to_le16(flags); 1797 c.create_sq.cqid = cpu_to_le16(qid); 1798 1799 return nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0); 1800 } 1801 1802 static int adapter_delete_cq(struct nvme_dev *dev, u16 cqid) 1803 { 1804 return adapter_delete_queue(dev, nvme_admin_delete_cq, cqid); 1805 } 1806 1807 static int adapter_delete_sq(struct nvme_dev *dev, u16 sqid) 1808 { 1809 return adapter_delete_queue(dev, nvme_admin_delete_sq, sqid); 1810 } 1811 1812 static enum rq_end_io_ret abort_endio(struct request *req, blk_status_t error, 1813 const struct io_comp_batch *iob) 1814 { 1815 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 1816 1817 dev_warn(nvmeq->dev->ctrl.device, 1818 "Abort status: 0x%x", nvme_req(req)->status); 1819 atomic_inc(&nvmeq->dev->ctrl.abort_limit); 1820 blk_mq_free_request(req); 1821 return RQ_END_IO_NONE; 1822 } 1823 1824 static bool nvme_should_reset(struct nvme_dev *dev, u32 csts) 1825 { 1826 /* If true, indicates loss of adapter communication, possibly by a 1827 * NVMe Subsystem reset. 1828 */ 1829 bool nssro = dev->subsystem && (csts & NVME_CSTS_NSSRO); 1830 1831 /* If there is a reset/reinit ongoing, we shouldn't reset again. */ 1832 switch (nvme_ctrl_state(&dev->ctrl)) { 1833 case NVME_CTRL_RESETTING: 1834 case NVME_CTRL_CONNECTING: 1835 return false; 1836 default: 1837 break; 1838 } 1839 1840 /* We shouldn't reset unless the controller is on fatal error state 1841 * _or_ if we lost the communication with it. 1842 */ 1843 if (!(csts & NVME_CSTS_CFS) && !nssro) 1844 return false; 1845 1846 return true; 1847 } 1848 1849 static void nvme_warn_reset(struct nvme_dev *dev, u32 csts) 1850 { 1851 /* Read a config register to help see what died. */ 1852 u16 pci_status; 1853 int result; 1854 1855 result = pci_read_config_word(to_pci_dev(dev->dev), PCI_STATUS, 1856 &pci_status); 1857 if (result == PCIBIOS_SUCCESSFUL) 1858 dev_warn(dev->ctrl.device, 1859 "controller is down; will reset: CSTS=0x%x, PCI_STATUS=0x%hx\n", 1860 csts, pci_status); 1861 else 1862 dev_warn(dev->ctrl.device, 1863 "controller is down; will reset: CSTS=0x%x, PCI_STATUS read failed (%d)\n", 1864 csts, result); 1865 1866 if (csts != ~0) 1867 return; 1868 1869 dev_warn(dev->ctrl.device, 1870 "Does your device have a faulty power saving mode enabled?\n"); 1871 dev_warn(dev->ctrl.device, 1872 "Try \"nvme_core.default_ps_max_latency_us=0 pcie_aspm=off pcie_port_pm=off\" and report a bug\n"); 1873 } 1874 1875 static enum blk_eh_timer_return nvme_timeout(struct request *req) 1876 { 1877 struct nvme_iod *iod = blk_mq_rq_to_pdu(req); 1878 struct nvme_queue *nvmeq = req->mq_hctx->driver_data; 1879 struct nvme_dev *dev = nvmeq->dev; 1880 struct request *abort_req; 1881 struct nvme_command cmd = { }; 1882 struct pci_dev *pdev = to_pci_dev(dev->dev); 1883 u32 csts = readl(dev->bar + NVME_REG_CSTS); 1884 u8 opcode; 1885 1886 /* 1887 * Shutdown the device immediately if we see it is disconnected. This 1888 * unblocks PCIe error handling if the nvme driver is waiting in 1889 * error_resume for a device that has been removed. We can't unbind the 1890 * driver while the driver's error callback is waiting to complete, so 1891 * we're relying on a timeout to break that deadlock if a removal 1892 * occurs while reset work is running. 1893 */ 1894 if (pci_dev_is_disconnected(pdev)) 1895 nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_DELETING); 1896 if (nvme_state_terminal(&dev->ctrl)) 1897 goto disable; 1898 1899 /* If PCI error recovery process is happening, we cannot reset or 1900 * the recovery mechanism will surely fail. 1901 */ 1902 mb(); 1903 if (pci_channel_offline(pdev)) 1904 return BLK_EH_RESET_TIMER; 1905 1906 /* 1907 * Reset immediately if the controller is failed 1908 */ 1909 if (nvme_should_reset(dev, csts)) { 1910 nvme_warn_reset(dev, csts); 1911 goto disable; 1912 } 1913 1914 /* 1915 * Did we miss an interrupt? 1916 */ 1917 if (test_bit(NVMEQ_POLLED, &nvmeq->flags)) 1918 nvme_poll(req->mq_hctx, NULL); 1919 else 1920 nvme_poll_irqdisable(nvmeq); 1921 1922 if (blk_mq_rq_state(req) != MQ_RQ_IN_FLIGHT) { 1923 dev_warn(dev->ctrl.device, 1924 "I/O tag %d (%04x) QID %d timeout, completion polled\n", 1925 req->tag, nvme_cid(req), nvmeq->qid); 1926 return BLK_EH_DONE; 1927 } 1928 1929 /* 1930 * Shutdown immediately if controller times out while starting. The 1931 * reset work will see the pci device disabled when it gets the forced 1932 * cancellation error. All outstanding requests are completed on 1933 * shutdown, so we return BLK_EH_DONE. 1934 */ 1935 switch (nvme_ctrl_state(&dev->ctrl)) { 1936 case NVME_CTRL_CONNECTING: 1937 nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_DELETING); 1938 fallthrough; 1939 case NVME_CTRL_DELETING: 1940 dev_warn_ratelimited(dev->ctrl.device, 1941 "I/O tag %d (%04x) QID %d timeout, disable controller\n", 1942 req->tag, nvme_cid(req), nvmeq->qid); 1943 nvme_req(req)->flags |= NVME_REQ_CANCELLED; 1944 nvme_dev_disable(dev, true); 1945 return BLK_EH_DONE; 1946 case NVME_CTRL_RESETTING: 1947 return BLK_EH_RESET_TIMER; 1948 default: 1949 break; 1950 } 1951 1952 /* 1953 * Shutdown the controller immediately and schedule a reset if the 1954 * command was already aborted once before and still hasn't been 1955 * returned to the driver, or if this is the admin queue. 1956 */ 1957 opcode = nvme_req(req)->cmd->common.opcode; 1958 if (!nvmeq->qid || (iod->flags & IOD_ABORTED)) { 1959 dev_warn(dev->ctrl.device, 1960 "I/O tag %d (%04x) opcode %#x (%s) QID %d timeout, reset controller\n", 1961 req->tag, nvme_cid(req), opcode, 1962 nvme_opcode_str(nvmeq->qid, opcode), nvmeq->qid); 1963 nvme_req(req)->flags |= NVME_REQ_CANCELLED; 1964 goto disable; 1965 } 1966 1967 if (atomic_dec_return(&dev->ctrl.abort_limit) < 0) { 1968 atomic_inc(&dev->ctrl.abort_limit); 1969 return BLK_EH_RESET_TIMER; 1970 } 1971 iod->flags |= IOD_ABORTED; 1972 1973 cmd.abort.opcode = nvme_admin_abort_cmd; 1974 cmd.abort.cid = nvme_cid(req); 1975 cmd.abort.sqid = cpu_to_le16(nvmeq->qid); 1976 1977 dev_warn(nvmeq->dev->ctrl.device, 1978 "I/O tag %d (%04x) opcode %#x (%s) QID %d timeout, aborting req_op:%s(%u) size:%u\n", 1979 req->tag, nvme_cid(req), opcode, nvme_get_opcode_str(opcode), 1980 nvmeq->qid, blk_op_str(req_op(req)), req_op(req), 1981 blk_rq_bytes(req)); 1982 1983 abort_req = blk_mq_alloc_request(dev->ctrl.admin_q, nvme_req_op(&cmd), 1984 BLK_MQ_REQ_NOWAIT); 1985 if (IS_ERR(abort_req)) { 1986 atomic_inc(&dev->ctrl.abort_limit); 1987 return BLK_EH_RESET_TIMER; 1988 } 1989 nvme_init_request(abort_req, &cmd); 1990 1991 abort_req->end_io = abort_endio; 1992 abort_req->end_io_data = NULL; 1993 blk_execute_rq_nowait(abort_req, false); 1994 1995 /* 1996 * The aborted req will be completed on receiving the abort req. 1997 * We enable the timer again. If hit twice, it'll cause a device reset, 1998 * as the device then is in a faulty state. 1999 */ 2000 return BLK_EH_RESET_TIMER; 2001 2002 disable: 2003 if (!nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_RESETTING)) { 2004 if (nvme_state_terminal(&dev->ctrl)) 2005 nvme_dev_disable(dev, true); 2006 return BLK_EH_DONE; 2007 } 2008 2009 nvme_dev_disable(dev, false); 2010 if (nvme_try_sched_reset(&dev->ctrl)) 2011 nvme_unquiesce_io_queues(&dev->ctrl); 2012 return BLK_EH_DONE; 2013 } 2014 2015 static void nvme_free_queue(struct nvme_queue *nvmeq) 2016 { 2017 dma_free_coherent(nvmeq->dev->dev, CQ_SIZE(nvmeq), 2018 (void *)nvmeq->cqes, nvmeq->cq_dma_addr); 2019 if (!nvmeq->sq_cmds) 2020 return; 2021 2022 if (test_and_clear_bit(NVMEQ_SQ_CMB, &nvmeq->flags)) { 2023 pci_free_p2pmem(to_pci_dev(nvmeq->dev->dev), 2024 nvmeq->sq_cmds, SQ_SIZE(nvmeq)); 2025 } else { 2026 dma_free_coherent(nvmeq->dev->dev, SQ_SIZE(nvmeq), 2027 nvmeq->sq_cmds, nvmeq->sq_dma_addr); 2028 } 2029 } 2030 2031 static void nvme_free_queues(struct nvme_dev *dev, int lowest) 2032 { 2033 int i; 2034 2035 for (i = dev->ctrl.queue_count - 1; i >= lowest; i--) { 2036 dev->ctrl.queue_count--; 2037 nvme_free_queue(&dev->queues[i]); 2038 } 2039 } 2040 2041 static void nvme_suspend_queue(struct nvme_dev *dev, unsigned int qid) 2042 { 2043 struct nvme_queue *nvmeq = &dev->queues[qid]; 2044 2045 if (!test_and_clear_bit(NVMEQ_ENABLED, &nvmeq->flags)) 2046 return; 2047 2048 /* ensure that nvme_queue_rq() sees NVMEQ_ENABLED cleared */ 2049 mb(); 2050 2051 nvmeq->dev->online_queues--; 2052 if (!nvmeq->qid && nvmeq->dev->ctrl.admin_q) 2053 nvme_quiesce_admin_queue(&nvmeq->dev->ctrl); 2054 if (!test_and_clear_bit(NVMEQ_POLLED, &nvmeq->flags)) 2055 pci_free_irq(to_pci_dev(dev->dev), nvmeq->cq_vector, nvmeq); 2056 } 2057 2058 static void nvme_suspend_io_queues(struct nvme_dev *dev) 2059 { 2060 int i; 2061 2062 for (i = dev->ctrl.queue_count - 1; i > 0; i--) 2063 nvme_suspend_queue(dev, i); 2064 } 2065 2066 /* 2067 * Called only on a device that has been disabled and after all other threads 2068 * that can check this device's completion queues have synced, except 2069 * nvme_poll(). This is the last chance for the driver to see a natural 2070 * completion before nvme_cancel_request() terminates all incomplete requests. 2071 */ 2072 static void nvme_reap_pending_cqes(struct nvme_dev *dev) 2073 { 2074 int i; 2075 2076 for (i = dev->ctrl.queue_count - 1; i > 0; i--) { 2077 spin_lock(&dev->queues[i].cq_poll_lock); 2078 nvme_poll_cq(&dev->queues[i], NULL); 2079 spin_unlock(&dev->queues[i].cq_poll_lock); 2080 } 2081 } 2082 2083 static int nvme_cmb_qdepth(struct nvme_dev *dev, int nr_io_queues, 2084 int entry_size) 2085 { 2086 int q_depth = dev->q_depth; 2087 unsigned q_size_aligned = roundup(q_depth * entry_size, 2088 NVME_CTRL_PAGE_SIZE); 2089 2090 if (q_size_aligned * nr_io_queues > dev->cmb_size) { 2091 u64 mem_per_q = div_u64(dev->cmb_size, nr_io_queues); 2092 2093 mem_per_q = round_down(mem_per_q, NVME_CTRL_PAGE_SIZE); 2094 q_depth = div_u64(mem_per_q, entry_size); 2095 2096 /* 2097 * Ensure the reduced q_depth is above some threshold where it 2098 * would be better to map queues in system memory with the 2099 * original depth 2100 */ 2101 if (q_depth < 64) 2102 return -ENOMEM; 2103 } 2104 2105 return q_depth; 2106 } 2107 2108 static int nvme_alloc_sq_cmds(struct nvme_dev *dev, struct nvme_queue *nvmeq, 2109 int qid) 2110 { 2111 struct pci_dev *pdev = to_pci_dev(dev->dev); 2112 2113 if (qid && dev->cmb_use_sqes && (dev->cmbsz & NVME_CMBSZ_SQS)) { 2114 nvmeq->sq_cmds = pci_alloc_p2pmem(pdev, SQ_SIZE(nvmeq)); 2115 if (nvmeq->sq_cmds) { 2116 nvmeq->sq_dma_addr = pci_p2pmem_virt_to_bus(pdev, 2117 nvmeq->sq_cmds); 2118 if (nvmeq->sq_dma_addr) { 2119 set_bit(NVMEQ_SQ_CMB, &nvmeq->flags); 2120 return 0; 2121 } 2122 2123 pci_free_p2pmem(pdev, nvmeq->sq_cmds, SQ_SIZE(nvmeq)); 2124 } 2125 } 2126 2127 nvmeq->sq_cmds = dma_alloc_coherent(dev->dev, SQ_SIZE(nvmeq), 2128 &nvmeq->sq_dma_addr, GFP_KERNEL); 2129 if (!nvmeq->sq_cmds) 2130 return -ENOMEM; 2131 return 0; 2132 } 2133 2134 static int nvme_alloc_queue(struct nvme_dev *dev, int qid, int depth) 2135 { 2136 struct nvme_queue *nvmeq = &dev->queues[qid]; 2137 2138 if (dev->ctrl.queue_count > qid) 2139 return 0; 2140 2141 nvmeq->sqes = qid ? dev->io_sqes : NVME_ADM_SQES; 2142 nvmeq->q_depth = depth; 2143 nvmeq->cqes = dma_alloc_coherent(dev->dev, CQ_SIZE(nvmeq), 2144 &nvmeq->cq_dma_addr, GFP_KERNEL); 2145 if (!nvmeq->cqes) 2146 goto free_nvmeq; 2147 2148 if (nvme_alloc_sq_cmds(dev, nvmeq, qid)) 2149 goto free_cqdma; 2150 2151 nvmeq->dev = dev; 2152 spin_lock_init(&nvmeq->sq_lock); 2153 spin_lock_init(&nvmeq->cq_poll_lock); 2154 nvmeq->cq_head = 0; 2155 nvmeq->cq_phase = 1; 2156 nvmeq->q_db = &dev->dbs[qid * 2 * dev->db_stride]; 2157 nvmeq->qid = qid; 2158 dev->ctrl.queue_count++; 2159 2160 return 0; 2161 2162 free_cqdma: 2163 dma_free_coherent(dev->dev, CQ_SIZE(nvmeq), (void *)nvmeq->cqes, 2164 nvmeq->cq_dma_addr); 2165 free_nvmeq: 2166 return -ENOMEM; 2167 } 2168 2169 static int queue_request_irq(struct nvme_queue *nvmeq) 2170 { 2171 struct pci_dev *pdev = to_pci_dev(nvmeq->dev->dev); 2172 int nr = nvmeq->dev->ctrl.instance; 2173 2174 if (use_threaded_interrupts) { 2175 return pci_request_irq(pdev, nvmeq->cq_vector, nvme_irq_check, 2176 nvme_irq, nvmeq, "nvme%dq%d", nr, nvmeq->qid); 2177 } else { 2178 return pci_request_irq(pdev, nvmeq->cq_vector, nvme_irq, 2179 NULL, nvmeq, "nvme%dq%d", nr, nvmeq->qid); 2180 } 2181 } 2182 2183 static void nvme_init_queue(struct nvme_queue *nvmeq, u16 qid) 2184 { 2185 struct nvme_dev *dev = nvmeq->dev; 2186 2187 nvmeq->sq_tail = 0; 2188 nvmeq->last_sq_tail = 0; 2189 nvmeq->cq_head = 0; 2190 nvmeq->cq_phase = 1; 2191 nvmeq->q_db = &dev->dbs[qid * 2 * dev->db_stride]; 2192 memset((void *)nvmeq->cqes, 0, CQ_SIZE(nvmeq)); 2193 nvme_dbbuf_init(dev, nvmeq, qid); 2194 dev->online_queues++; 2195 wmb(); /* ensure the first interrupt sees the initialization */ 2196 } 2197 2198 /* 2199 * Try getting shutdown_lock while setting up IO queues. 2200 */ 2201 static int nvme_setup_io_queues_trylock(struct nvme_dev *dev) 2202 { 2203 /* 2204 * Give up if the lock is being held by nvme_dev_disable. 2205 */ 2206 if (!mutex_trylock(&dev->shutdown_lock)) 2207 return -ENODEV; 2208 2209 /* 2210 * Controller is in wrong state, fail early. 2211 */ 2212 if (nvme_ctrl_state(&dev->ctrl) != NVME_CTRL_CONNECTING) { 2213 mutex_unlock(&dev->shutdown_lock); 2214 return -ENODEV; 2215 } 2216 2217 return 0; 2218 } 2219 2220 static int nvme_create_queue(struct nvme_queue *nvmeq, int qid, bool polled) 2221 { 2222 struct nvme_dev *dev = nvmeq->dev; 2223 int result; 2224 u16 vector = 0; 2225 2226 clear_bit(NVMEQ_DELETE_ERROR, &nvmeq->flags); 2227 2228 /* 2229 * A queue's vector matches the queue identifier unless the controller 2230 * has only one vector available. 2231 */ 2232 if (!polled) 2233 vector = dev->num_vecs == 1 ? 0 : qid; 2234 else 2235 set_bit(NVMEQ_POLLED, &nvmeq->flags); 2236 2237 result = adapter_alloc_cq(dev, qid, nvmeq, vector); 2238 if (result) 2239 return result; 2240 2241 result = adapter_alloc_sq(dev, qid, nvmeq); 2242 if (result < 0) 2243 return result; 2244 if (result) 2245 goto release_cq; 2246 2247 nvmeq->cq_vector = vector; 2248 2249 result = nvme_setup_io_queues_trylock(dev); 2250 if (result) 2251 return result; 2252 nvme_init_queue(nvmeq, qid); 2253 if (!polled) { 2254 result = queue_request_irq(nvmeq); 2255 if (result < 0) 2256 goto release_sq; 2257 } 2258 2259 set_bit(NVMEQ_ENABLED, &nvmeq->flags); 2260 mutex_unlock(&dev->shutdown_lock); 2261 return result; 2262 2263 release_sq: 2264 dev->online_queues--; 2265 mutex_unlock(&dev->shutdown_lock); 2266 adapter_delete_sq(dev, qid); 2267 release_cq: 2268 adapter_delete_cq(dev, qid); 2269 return result; 2270 } 2271 2272 static const struct blk_mq_ops nvme_mq_admin_ops = { 2273 .queue_rq = nvme_queue_rq, 2274 .complete = nvme_pci_complete_rq, 2275 .commit_rqs = nvme_commit_rqs, 2276 .init_hctx = nvme_admin_init_hctx, 2277 .init_request = nvme_pci_init_request, 2278 .timeout = nvme_timeout, 2279 }; 2280 2281 static const struct blk_mq_ops nvme_mq_ops = { 2282 .queue_rq = nvme_queue_rq, 2283 .queue_rqs = nvme_queue_rqs, 2284 .complete = nvme_pci_complete_rq, 2285 .commit_rqs = nvme_commit_rqs, 2286 .init_hctx = nvme_init_hctx, 2287 .init_request = nvme_pci_init_request, 2288 .map_queues = nvme_pci_map_queues, 2289 .timeout = nvme_timeout, 2290 .poll = nvme_poll, 2291 }; 2292 2293 static void nvme_dev_remove_admin(struct nvme_dev *dev) 2294 { 2295 if (dev->ctrl.admin_q && !blk_queue_dying(dev->ctrl.admin_q)) { 2296 /* 2297 * If the controller was reset during removal, it's possible 2298 * user requests may be waiting on a stopped queue. Start the 2299 * queue to flush these to completion. 2300 */ 2301 nvme_unquiesce_admin_queue(&dev->ctrl); 2302 nvme_remove_admin_tag_set(&dev->ctrl); 2303 } 2304 } 2305 2306 static unsigned long db_bar_size(struct nvme_dev *dev, unsigned nr_io_queues) 2307 { 2308 return NVME_REG_DBS + ((nr_io_queues + 1) * 8 * dev->db_stride); 2309 } 2310 2311 static int nvme_remap_bar(struct nvme_dev *dev, unsigned long size) 2312 { 2313 struct pci_dev *pdev = to_pci_dev(dev->dev); 2314 2315 if (size <= dev->bar_mapped_size) 2316 return 0; 2317 if (size > pci_resource_len(pdev, 0)) 2318 return -ENOMEM; 2319 if (dev->bar) 2320 iounmap(dev->bar); 2321 dev->bar = ioremap(pci_resource_start(pdev, 0), size); 2322 if (!dev->bar) { 2323 dev->bar_mapped_size = 0; 2324 return -ENOMEM; 2325 } 2326 dev->bar_mapped_size = size; 2327 dev->dbs = dev->bar + NVME_REG_DBS; 2328 2329 return 0; 2330 } 2331 2332 static int nvme_pci_configure_admin_queue(struct nvme_dev *dev) 2333 { 2334 int result; 2335 u32 aqa; 2336 struct nvme_queue *nvmeq; 2337 2338 result = nvme_remap_bar(dev, db_bar_size(dev, 0)); 2339 if (result < 0) 2340 return result; 2341 2342 dev->subsystem = readl(dev->bar + NVME_REG_VS) >= NVME_VS(1, 1, 0) ? 2343 NVME_CAP_NSSRC(dev->ctrl.cap) : 0; 2344 2345 if (dev->subsystem && 2346 (readl(dev->bar + NVME_REG_CSTS) & NVME_CSTS_NSSRO)) 2347 writel(NVME_CSTS_NSSRO, dev->bar + NVME_REG_CSTS); 2348 2349 /* 2350 * If the device has been passed off to us in an enabled state, just 2351 * clear the enabled bit. The spec says we should set the 'shutdown 2352 * notification bits', but doing so may cause the device to complete 2353 * commands to the admin queue ... and we don't know what memory that 2354 * might be pointing at! 2355 */ 2356 result = nvme_disable_ctrl(&dev->ctrl, false); 2357 if (result < 0) { 2358 struct pci_dev *pdev = to_pci_dev(dev->dev); 2359 2360 /* 2361 * The NVMe Controller Reset method did not get an expected 2362 * CSTS.RDY transition, so something with the device appears to 2363 * be stuck. Use the lower level and bigger hammer PCIe 2364 * Function Level Reset to attempt restoring the device to its 2365 * initial state, and try again. 2366 */ 2367 result = pcie_reset_flr(pdev, false); 2368 if (result < 0) 2369 return result; 2370 2371 pci_restore_state(pdev); 2372 result = nvme_disable_ctrl(&dev->ctrl, false); 2373 if (result < 0) 2374 return result; 2375 2376 dev_info(dev->ctrl.device, 2377 "controller reset completed after pcie flr\n"); 2378 } 2379 2380 result = nvme_alloc_queue(dev, 0, NVME_AQ_DEPTH); 2381 if (result) 2382 return result; 2383 2384 dev->ctrl.numa_node = dev_to_node(dev->dev); 2385 2386 nvmeq = &dev->queues[0]; 2387 aqa = nvmeq->q_depth - 1; 2388 aqa |= aqa << 16; 2389 2390 writel(aqa, dev->bar + NVME_REG_AQA); 2391 lo_hi_writeq(nvmeq->sq_dma_addr, dev->bar + NVME_REG_ASQ); 2392 lo_hi_writeq(nvmeq->cq_dma_addr, dev->bar + NVME_REG_ACQ); 2393 2394 result = nvme_enable_ctrl(&dev->ctrl); 2395 if (result) 2396 return result; 2397 2398 nvmeq->cq_vector = 0; 2399 nvme_init_queue(nvmeq, 0); 2400 result = queue_request_irq(nvmeq); 2401 if (result) { 2402 dev->online_queues--; 2403 return result; 2404 } 2405 2406 set_bit(NVMEQ_ENABLED, &nvmeq->flags); 2407 return result; 2408 } 2409 2410 static int nvme_create_io_queues(struct nvme_dev *dev) 2411 { 2412 unsigned i, max, rw_queues; 2413 int ret = 0; 2414 2415 for (i = dev->ctrl.queue_count; i <= dev->max_qid; i++) { 2416 if (nvme_alloc_queue(dev, i, dev->q_depth)) { 2417 ret = -ENOMEM; 2418 break; 2419 } 2420 } 2421 2422 max = min(dev->max_qid, dev->ctrl.queue_count - 1); 2423 if (max != 1 && dev->io_queues[HCTX_TYPE_POLL]) { 2424 rw_queues = dev->io_queues[HCTX_TYPE_DEFAULT] + 2425 dev->io_queues[HCTX_TYPE_READ]; 2426 } else { 2427 rw_queues = max; 2428 } 2429 2430 for (i = dev->online_queues; i <= max; i++) { 2431 bool polled = i > rw_queues; 2432 2433 ret = nvme_create_queue(&dev->queues[i], i, polled); 2434 if (ret) 2435 break; 2436 } 2437 2438 /* 2439 * Ignore failing Create SQ/CQ commands, we can continue with less 2440 * than the desired amount of queues, and even a controller without 2441 * I/O queues can still be used to issue admin commands. This might 2442 * be useful to upgrade a buggy firmware for example. 2443 */ 2444 return ret >= 0 ? 0 : ret; 2445 } 2446 2447 static u64 nvme_cmb_size_unit(struct nvme_dev *dev) 2448 { 2449 u8 szu = (dev->cmbsz >> NVME_CMBSZ_SZU_SHIFT) & NVME_CMBSZ_SZU_MASK; 2450 2451 return 1ULL << (12 + 4 * szu); 2452 } 2453 2454 static u32 nvme_cmb_size(struct nvme_dev *dev) 2455 { 2456 return (dev->cmbsz >> NVME_CMBSZ_SZ_SHIFT) & NVME_CMBSZ_SZ_MASK; 2457 } 2458 2459 static void nvme_map_cmb(struct nvme_dev *dev) 2460 { 2461 u64 size, offset; 2462 resource_size_t bar_size; 2463 struct pci_dev *pdev = to_pci_dev(dev->dev); 2464 int bar; 2465 2466 if (dev->cmb_size) 2467 return; 2468 2469 if (NVME_CAP_CMBS(dev->ctrl.cap)) 2470 writel(NVME_CMBMSC_CRE, dev->bar + NVME_REG_CMBMSC); 2471 2472 dev->cmbsz = readl(dev->bar + NVME_REG_CMBSZ); 2473 if (!dev->cmbsz) 2474 return; 2475 dev->cmbloc = readl(dev->bar + NVME_REG_CMBLOC); 2476 2477 size = nvme_cmb_size_unit(dev) * nvme_cmb_size(dev); 2478 offset = nvme_cmb_size_unit(dev) * NVME_CMB_OFST(dev->cmbloc); 2479 bar = NVME_CMB_BIR(dev->cmbloc); 2480 bar_size = pci_resource_len(pdev, bar); 2481 2482 if (offset > bar_size) 2483 return; 2484 2485 /* 2486 * Controllers may support a CMB size larger than their BAR, for 2487 * example, due to being behind a bridge. Reduce the CMB to the 2488 * reported size of the BAR 2489 */ 2490 size = min(size, bar_size - offset); 2491 2492 if (!IS_ALIGNED(size, memremap_compat_align()) || 2493 !IS_ALIGNED(pci_resource_start(pdev, bar), 2494 memremap_compat_align())) 2495 return; 2496 2497 /* 2498 * Tell the controller about the host side address mapping the CMB, 2499 * and enable CMB decoding for the NVMe 1.4+ scheme: 2500 */ 2501 if (NVME_CAP_CMBS(dev->ctrl.cap)) { 2502 hi_lo_writeq(NVME_CMBMSC_CRE | NVME_CMBMSC_CMSE | 2503 (pci_bus_address(pdev, bar) + offset), 2504 dev->bar + NVME_REG_CMBMSC); 2505 } 2506 2507 if (pci_p2pdma_add_resource(pdev, bar, size, offset)) { 2508 dev_warn(dev->ctrl.device, 2509 "failed to register the CMB\n"); 2510 hi_lo_writeq(0, dev->bar + NVME_REG_CMBMSC); 2511 return; 2512 } 2513 2514 dev->cmb_size = size; 2515 dev->cmb_use_sqes = use_cmb_sqes && (dev->cmbsz & NVME_CMBSZ_SQS); 2516 2517 if ((dev->cmbsz & (NVME_CMBSZ_WDS | NVME_CMBSZ_RDS)) == 2518 (NVME_CMBSZ_WDS | NVME_CMBSZ_RDS)) 2519 pci_p2pmem_publish(pdev, true); 2520 } 2521 2522 static int nvme_set_host_mem(struct nvme_dev *dev, u32 bits) 2523 { 2524 u32 host_mem_size = dev->host_mem_size >> NVME_CTRL_PAGE_SHIFT; 2525 u64 dma_addr = dev->host_mem_descs_dma; 2526 struct nvme_command c = { }; 2527 int ret; 2528 2529 c.features.opcode = nvme_admin_set_features; 2530 c.features.fid = cpu_to_le32(NVME_FEAT_HOST_MEM_BUF); 2531 c.features.dword11 = cpu_to_le32(bits); 2532 c.features.dword12 = cpu_to_le32(host_mem_size); 2533 c.features.dword13 = cpu_to_le32(lower_32_bits(dma_addr)); 2534 c.features.dword14 = cpu_to_le32(upper_32_bits(dma_addr)); 2535 c.features.dword15 = cpu_to_le32(dev->nr_host_mem_descs); 2536 2537 ret = nvme_submit_sync_cmd(dev->ctrl.admin_q, &c, NULL, 0); 2538 if (ret) { 2539 dev_warn(dev->ctrl.device, 2540 "failed to set host mem (err %d, flags %#x).\n", 2541 ret, bits); 2542 } else 2543 dev->hmb = bits & NVME_HOST_MEM_ENABLE; 2544 2545 return ret; 2546 } 2547 2548 static void nvme_free_host_mem_multi(struct nvme_dev *dev) 2549 { 2550 int i; 2551 2552 for (i = 0; i < dev->nr_host_mem_descs; i++) { 2553 struct nvme_host_mem_buf_desc *desc = &dev->host_mem_descs[i]; 2554 size_t size = le32_to_cpu(desc->size) * NVME_CTRL_PAGE_SIZE; 2555 2556 dma_free_attrs(dev->dev, size, dev->host_mem_desc_bufs[i], 2557 le64_to_cpu(desc->addr), 2558 DMA_ATTR_NO_KERNEL_MAPPING | DMA_ATTR_NO_WARN); 2559 } 2560 2561 kfree(dev->host_mem_desc_bufs); 2562 dev->host_mem_desc_bufs = NULL; 2563 } 2564 2565 static void nvme_free_host_mem(struct nvme_dev *dev) 2566 { 2567 if (dev->hmb_sgt) { 2568 dma_free_noncontiguous(dev->dev, dev->host_mem_size, 2569 dev->hmb_sgt, DMA_BIDIRECTIONAL); 2570 dev->hmb_sgt = NULL; 2571 } else { 2572 nvme_free_host_mem_multi(dev); 2573 } 2574 2575 dma_free_coherent(dev->dev, dev->host_mem_descs_size, 2576 dev->host_mem_descs, dev->host_mem_descs_dma); 2577 dev->host_mem_descs = NULL; 2578 dev->host_mem_descs_size = 0; 2579 dev->nr_host_mem_descs = 0; 2580 } 2581 2582 static int nvme_alloc_host_mem_single(struct nvme_dev *dev, u64 size) 2583 { 2584 dev->hmb_sgt = dma_alloc_noncontiguous(dev->dev, size, 2585 DMA_BIDIRECTIONAL, GFP_KERNEL, 0); 2586 if (!dev->hmb_sgt) 2587 return -ENOMEM; 2588 2589 dev->host_mem_descs = dma_alloc_coherent(dev->dev, 2590 sizeof(*dev->host_mem_descs), &dev->host_mem_descs_dma, 2591 GFP_KERNEL); 2592 if (!dev->host_mem_descs) { 2593 dma_free_noncontiguous(dev->dev, size, dev->hmb_sgt, 2594 DMA_BIDIRECTIONAL); 2595 dev->hmb_sgt = NULL; 2596 return -ENOMEM; 2597 } 2598 dev->host_mem_size = size; 2599 dev->host_mem_descs_size = sizeof(*dev->host_mem_descs); 2600 dev->nr_host_mem_descs = 1; 2601 2602 dev->host_mem_descs[0].addr = 2603 cpu_to_le64(dev->hmb_sgt->sgl->dma_address); 2604 dev->host_mem_descs[0].size = cpu_to_le32(size / NVME_CTRL_PAGE_SIZE); 2605 return 0; 2606 } 2607 2608 static int nvme_alloc_host_mem_multi(struct nvme_dev *dev, u64 preferred, 2609 u32 chunk_size) 2610 { 2611 struct nvme_host_mem_buf_desc *descs; 2612 u32 max_entries, len, descs_size; 2613 dma_addr_t descs_dma; 2614 int i = 0; 2615 void **bufs; 2616 u64 size, tmp; 2617 2618 tmp = (preferred + chunk_size - 1); 2619 do_div(tmp, chunk_size); 2620 max_entries = tmp; 2621 2622 if (dev->ctrl.hmmaxd && dev->ctrl.hmmaxd < max_entries) 2623 max_entries = dev->ctrl.hmmaxd; 2624 2625 descs_size = max_entries * sizeof(*descs); 2626 descs = dma_alloc_coherent(dev->dev, descs_size, &descs_dma, 2627 GFP_KERNEL); 2628 if (!descs) 2629 goto out; 2630 2631 bufs = kzalloc_objs(*bufs, max_entries); 2632 if (!bufs) 2633 goto out_free_descs; 2634 2635 for (size = 0; size < preferred && i < max_entries; size += len) { 2636 dma_addr_t dma_addr; 2637 2638 len = min_t(u64, chunk_size, preferred - size); 2639 bufs[i] = dma_alloc_attrs(dev->dev, len, &dma_addr, GFP_KERNEL, 2640 DMA_ATTR_NO_KERNEL_MAPPING | DMA_ATTR_NO_WARN); 2641 if (!bufs[i]) 2642 break; 2643 2644 descs[i].addr = cpu_to_le64(dma_addr); 2645 descs[i].size = cpu_to_le32(len / NVME_CTRL_PAGE_SIZE); 2646 i++; 2647 } 2648 2649 if (!size) 2650 goto out_free_bufs; 2651 2652 dev->nr_host_mem_descs = i; 2653 dev->host_mem_size = size; 2654 dev->host_mem_descs = descs; 2655 dev->host_mem_descs_dma = descs_dma; 2656 dev->host_mem_descs_size = descs_size; 2657 dev->host_mem_desc_bufs = bufs; 2658 return 0; 2659 2660 out_free_bufs: 2661 kfree(bufs); 2662 out_free_descs: 2663 dma_free_coherent(dev->dev, descs_size, descs, descs_dma); 2664 out: 2665 dev->host_mem_descs = NULL; 2666 return -ENOMEM; 2667 } 2668 2669 static int nvme_alloc_host_mem(struct nvme_dev *dev, u64 min, u64 preferred) 2670 { 2671 unsigned long dma_merge_boundary = dma_get_merge_boundary(dev->dev); 2672 u64 min_chunk = min_t(u64, preferred, PAGE_SIZE * MAX_ORDER_NR_PAGES); 2673 u64 hmminds = max_t(u32, dev->ctrl.hmminds * 4096, PAGE_SIZE * 2); 2674 u64 chunk_size; 2675 2676 /* 2677 * If there is an IOMMU that can merge pages, try a virtually 2678 * non-contiguous allocation for a single segment first. 2679 */ 2680 if (dma_merge_boundary && (PAGE_SIZE & dma_merge_boundary) == 0) { 2681 if (!nvme_alloc_host_mem_single(dev, preferred)) 2682 return 0; 2683 } 2684 2685 /* start big and work our way down */ 2686 for (chunk_size = min_chunk; chunk_size >= hmminds; chunk_size /= 2) { 2687 if (!nvme_alloc_host_mem_multi(dev, preferred, chunk_size)) { 2688 if (!min || dev->host_mem_size >= min) 2689 return 0; 2690 nvme_free_host_mem(dev); 2691 } 2692 } 2693 2694 return -ENOMEM; 2695 } 2696 2697 static int nvme_setup_host_mem(struct nvme_dev *dev) 2698 { 2699 u64 max = (u64)max_host_mem_size_mb * SZ_1M; 2700 u64 preferred = (u64)dev->ctrl.hmpre * 4096; 2701 u64 min = (u64)dev->ctrl.hmmin * 4096; 2702 u32 enable_bits = NVME_HOST_MEM_ENABLE; 2703 int ret; 2704 2705 if (!dev->ctrl.hmpre) 2706 return 0; 2707 2708 preferred = min(preferred, max); 2709 if (min > max) { 2710 dev_warn(dev->ctrl.device, 2711 "min host memory (%lld MiB) above limit (%d MiB).\n", 2712 min >> ilog2(SZ_1M), max_host_mem_size_mb); 2713 nvme_free_host_mem(dev); 2714 return 0; 2715 } 2716 2717 /* 2718 * If we already have a buffer allocated check if we can reuse it. 2719 */ 2720 if (dev->host_mem_descs) { 2721 if (dev->host_mem_size >= min) 2722 enable_bits |= NVME_HOST_MEM_RETURN; 2723 else 2724 nvme_free_host_mem(dev); 2725 } 2726 2727 if (!dev->host_mem_descs) { 2728 if (nvme_alloc_host_mem(dev, min, preferred)) { 2729 dev_warn(dev->ctrl.device, 2730 "failed to allocate host memory buffer.\n"); 2731 return 0; /* controller must work without HMB */ 2732 } 2733 2734 dev_info(dev->ctrl.device, 2735 "allocated %lld MiB host memory buffer (%u segment%s).\n", 2736 dev->host_mem_size >> ilog2(SZ_1M), 2737 dev->nr_host_mem_descs, 2738 str_plural(dev->nr_host_mem_descs)); 2739 } 2740 2741 ret = nvme_set_host_mem(dev, enable_bits); 2742 if (ret) 2743 nvme_free_host_mem(dev); 2744 return ret; 2745 } 2746 2747 static ssize_t cmb_show(struct device *dev, struct device_attribute *attr, 2748 char *buf) 2749 { 2750 struct nvme_dev *ndev = to_nvme_dev(dev_get_drvdata(dev)); 2751 2752 return sysfs_emit(buf, "cmbloc : 0x%08x\ncmbsz : 0x%08x\n", 2753 ndev->cmbloc, ndev->cmbsz); 2754 } 2755 static DEVICE_ATTR_RO(cmb); 2756 2757 static ssize_t cmbloc_show(struct device *dev, struct device_attribute *attr, 2758 char *buf) 2759 { 2760 struct nvme_dev *ndev = to_nvme_dev(dev_get_drvdata(dev)); 2761 2762 return sysfs_emit(buf, "%u\n", ndev->cmbloc); 2763 } 2764 static DEVICE_ATTR_RO(cmbloc); 2765 2766 static ssize_t cmbsz_show(struct device *dev, struct device_attribute *attr, 2767 char *buf) 2768 { 2769 struct nvme_dev *ndev = to_nvme_dev(dev_get_drvdata(dev)); 2770 2771 return sysfs_emit(buf, "%u\n", ndev->cmbsz); 2772 } 2773 static DEVICE_ATTR_RO(cmbsz); 2774 2775 static ssize_t hmb_show(struct device *dev, struct device_attribute *attr, 2776 char *buf) 2777 { 2778 struct nvme_dev *ndev = to_nvme_dev(dev_get_drvdata(dev)); 2779 2780 return sysfs_emit(buf, "%d\n", ndev->hmb); 2781 } 2782 2783 static ssize_t hmb_store(struct device *dev, struct device_attribute *attr, 2784 const char *buf, size_t count) 2785 { 2786 struct nvme_dev *ndev = to_nvme_dev(dev_get_drvdata(dev)); 2787 bool new; 2788 int ret; 2789 2790 if (kstrtobool(buf, &new) < 0) 2791 return -EINVAL; 2792 2793 if (new == ndev->hmb) 2794 return count; 2795 2796 if (new) { 2797 ret = nvme_setup_host_mem(ndev); 2798 } else { 2799 ret = nvme_set_host_mem(ndev, 0); 2800 if (!ret) 2801 nvme_free_host_mem(ndev); 2802 } 2803 2804 if (ret < 0) 2805 return ret; 2806 2807 return count; 2808 } 2809 static DEVICE_ATTR_RW(hmb); 2810 2811 static umode_t nvme_pci_attrs_are_visible(struct kobject *kobj, 2812 struct attribute *a, int n) 2813 { 2814 struct nvme_ctrl *ctrl = 2815 dev_get_drvdata(container_of(kobj, struct device, kobj)); 2816 struct nvme_dev *dev = to_nvme_dev(ctrl); 2817 2818 if (a == &dev_attr_cmb.attr || 2819 a == &dev_attr_cmbloc.attr || 2820 a == &dev_attr_cmbsz.attr) { 2821 if (!dev->cmbsz) 2822 return 0; 2823 } 2824 if (a == &dev_attr_hmb.attr && !ctrl->hmpre) 2825 return 0; 2826 2827 return a->mode; 2828 } 2829 2830 static struct attribute *nvme_pci_attrs[] = { 2831 &dev_attr_cmb.attr, 2832 &dev_attr_cmbloc.attr, 2833 &dev_attr_cmbsz.attr, 2834 &dev_attr_hmb.attr, 2835 NULL, 2836 }; 2837 2838 static const struct attribute_group nvme_pci_dev_attrs_group = { 2839 .attrs = nvme_pci_attrs, 2840 .is_visible = nvme_pci_attrs_are_visible, 2841 }; 2842 2843 static const struct attribute_group *nvme_pci_dev_attr_groups[] = { 2844 &nvme_dev_attrs_group, 2845 &nvme_pci_dev_attrs_group, 2846 &nvme_dev_diag_attrs_group, 2847 NULL, 2848 }; 2849 2850 static void nvme_update_attrs(struct nvme_dev *dev) 2851 { 2852 sysfs_update_group(&dev->ctrl.device->kobj, &nvme_pci_dev_attrs_group); 2853 } 2854 2855 /* 2856 * nirqs is the number of interrupts available for write and read 2857 * queues. The core already reserved an interrupt for the admin queue. 2858 */ 2859 static void nvme_calc_irq_sets(struct irq_affinity *affd, unsigned int nrirqs) 2860 { 2861 struct nvme_dev *dev = affd->priv; 2862 unsigned int nr_read_queues, nr_write_queues = dev->nr_write_queues; 2863 2864 /* 2865 * If there is no interrupt available for queues, ensure that 2866 * the default queue is set to 1. The affinity set size is 2867 * also set to one, but the irq core ignores it for this case. 2868 * 2869 * If only one interrupt is available or 'write_queue' == 0, combine 2870 * write and read queues. 2871 * 2872 * If 'write_queues' > 0, ensure it leaves room for at least one read 2873 * queue. 2874 */ 2875 if (!nrirqs) { 2876 nrirqs = 1; 2877 nr_read_queues = 0; 2878 } else if (nrirqs == 1 || !nr_write_queues) { 2879 nr_read_queues = 0; 2880 } else if (nr_write_queues >= nrirqs) { 2881 nr_read_queues = 1; 2882 } else { 2883 nr_read_queues = nrirqs - nr_write_queues; 2884 } 2885 2886 dev->io_queues[HCTX_TYPE_DEFAULT] = nrirqs - nr_read_queues; 2887 affd->set_size[HCTX_TYPE_DEFAULT] = nrirqs - nr_read_queues; 2888 dev->io_queues[HCTX_TYPE_READ] = nr_read_queues; 2889 affd->set_size[HCTX_TYPE_READ] = nr_read_queues; 2890 affd->nr_sets = nr_read_queues ? 2 : 1; 2891 } 2892 2893 static int nvme_setup_irqs(struct nvme_dev *dev, unsigned int nr_io_queues) 2894 { 2895 struct pci_dev *pdev = to_pci_dev(dev->dev); 2896 struct irq_affinity affd = { 2897 .pre_vectors = 1, 2898 .calc_sets = nvme_calc_irq_sets, 2899 .priv = dev, 2900 }; 2901 unsigned int irq_queues, poll_queues; 2902 unsigned int flags = PCI_IRQ_ALL_TYPES | PCI_IRQ_AFFINITY; 2903 2904 /* 2905 * Poll queues don't need interrupts, but we need at least one I/O queue 2906 * left over for non-polled I/O. 2907 */ 2908 poll_queues = min(dev->nr_poll_queues, nr_io_queues - 1); 2909 dev->io_queues[HCTX_TYPE_POLL] = poll_queues; 2910 2911 /* 2912 * Initialize for the single interrupt case, will be updated in 2913 * nvme_calc_irq_sets(). 2914 */ 2915 dev->io_queues[HCTX_TYPE_DEFAULT] = 1; 2916 dev->io_queues[HCTX_TYPE_READ] = 0; 2917 2918 /* 2919 * We need interrupts for the admin queue and each non-polled I/O queue, 2920 * but some Apple controllers require all queues to use the first 2921 * vector. 2922 */ 2923 irq_queues = 1; 2924 if (!(dev->ctrl.quirks & NVME_QUIRK_SINGLE_VECTOR)) 2925 irq_queues += (nr_io_queues - poll_queues); 2926 if (dev->ctrl.quirks & NVME_QUIRK_BROKEN_MSI) 2927 flags &= ~PCI_IRQ_MSI; 2928 return pci_alloc_irq_vectors_affinity(pdev, 1, irq_queues, flags, 2929 &affd); 2930 } 2931 2932 static unsigned int nvme_max_io_queues(struct nvme_dev *dev) 2933 { 2934 /* 2935 * If tags are shared with admin queue (Apple bug), then 2936 * make sure we only use one IO queue. 2937 */ 2938 if (dev->ctrl.quirks & NVME_QUIRK_SHARED_TAGS) 2939 return 1; 2940 return blk_mq_num_possible_queues(0) + dev->nr_write_queues + 2941 dev->nr_poll_queues; 2942 } 2943 2944 static int nvme_setup_io_queues(struct nvme_dev *dev) 2945 { 2946 struct nvme_queue *adminq = &dev->queues[0]; 2947 struct pci_dev *pdev = to_pci_dev(dev->dev); 2948 unsigned int nr_io_queues; 2949 unsigned long size; 2950 int result; 2951 2952 /* 2953 * Sample the module parameters once at reset time so that we have 2954 * stable values to work with. 2955 */ 2956 dev->nr_write_queues = write_queues; 2957 dev->nr_poll_queues = poll_queues; 2958 2959 if (dev->ctrl.tagset) { 2960 /* 2961 * The set's maps are allocated only once at initialization 2962 * time. We can't add special queues later if their mq_map 2963 * wasn't preallocated. 2964 */ 2965 if (dev->ctrl.tagset->nr_maps < 3) 2966 dev->nr_poll_queues = 0; 2967 if (dev->ctrl.tagset->nr_maps < 2) 2968 dev->nr_write_queues = 0; 2969 } 2970 2971 /* 2972 * The initial number of allocated queue slots may be too large if the 2973 * user reduced the special queue parameters. Cap the value to the 2974 * number we need for this round. 2975 */ 2976 nr_io_queues = min(nvme_max_io_queues(dev), 2977 dev->nr_allocated_queues - 1); 2978 result = nvme_set_queue_count(&dev->ctrl, &nr_io_queues); 2979 if (result < 0) 2980 return result; 2981 2982 if (nr_io_queues == 0) 2983 return 0; 2984 2985 /* 2986 * Free IRQ resources as soon as NVMEQ_ENABLED bit transitions 2987 * from set to unset. If there is a window to it is truely freed, 2988 * pci_free_irq_vectors() jumping into this window will crash. 2989 * And take lock to avoid racing with pci_free_irq_vectors() in 2990 * nvme_dev_disable() path. 2991 */ 2992 result = nvme_setup_io_queues_trylock(dev); 2993 if (result) 2994 return result; 2995 if (test_and_clear_bit(NVMEQ_ENABLED, &adminq->flags)) 2996 pci_free_irq(pdev, 0, adminq); 2997 2998 if (dev->cmb_use_sqes) { 2999 result = nvme_cmb_qdepth(dev, nr_io_queues, 3000 sizeof(struct nvme_command)); 3001 if (result > 0) { 3002 dev->q_depth = result; 3003 dev->ctrl.sqsize = result - 1; 3004 } else { 3005 dev->cmb_use_sqes = false; 3006 } 3007 } 3008 3009 do { 3010 size = db_bar_size(dev, nr_io_queues); 3011 result = nvme_remap_bar(dev, size); 3012 if (!result) 3013 break; 3014 if (!--nr_io_queues) { 3015 result = -ENOMEM; 3016 goto out_unlock; 3017 } 3018 } while (1); 3019 adminq->q_db = dev->dbs; 3020 3021 retry: 3022 /* Deregister the admin queue's interrupt */ 3023 if (test_and_clear_bit(NVMEQ_ENABLED, &adminq->flags)) 3024 pci_free_irq(pdev, 0, adminq); 3025 3026 /* 3027 * If we enable msix early due to not intx, disable it again before 3028 * setting up the full range we need. 3029 */ 3030 pci_free_irq_vectors(pdev); 3031 3032 result = nvme_setup_irqs(dev, nr_io_queues); 3033 if (result <= 0) { 3034 result = -EIO; 3035 goto out_unlock; 3036 } 3037 3038 dev->num_vecs = result; 3039 result = max(result - 1, 1); 3040 dev->max_qid = result + dev->io_queues[HCTX_TYPE_POLL]; 3041 3042 /* 3043 * Should investigate if there's a performance win from allocating 3044 * more queues than interrupt vectors; it might allow the submission 3045 * path to scale better, even if the receive path is limited by the 3046 * number of interrupts. 3047 */ 3048 result = queue_request_irq(adminq); 3049 if (result) 3050 goto out_unlock; 3051 set_bit(NVMEQ_ENABLED, &adminq->flags); 3052 mutex_unlock(&dev->shutdown_lock); 3053 3054 result = nvme_create_io_queues(dev); 3055 if (result || dev->online_queues < 2) 3056 return result; 3057 3058 if (dev->online_queues - 1 < dev->max_qid) { 3059 nr_io_queues = dev->online_queues - 1; 3060 nvme_delete_io_queues(dev); 3061 result = nvme_setup_io_queues_trylock(dev); 3062 if (result) 3063 return result; 3064 nvme_suspend_io_queues(dev); 3065 goto retry; 3066 } 3067 dev_info(dev->ctrl.device, "%d/%d/%d default/read/poll queues\n", 3068 dev->io_queues[HCTX_TYPE_DEFAULT], 3069 dev->io_queues[HCTX_TYPE_READ], 3070 dev->io_queues[HCTX_TYPE_POLL]); 3071 return 0; 3072 out_unlock: 3073 mutex_unlock(&dev->shutdown_lock); 3074 return result; 3075 } 3076 3077 static enum rq_end_io_ret nvme_del_queue_end(struct request *req, 3078 blk_status_t error, 3079 const struct io_comp_batch *iob) 3080 { 3081 struct nvme_queue *nvmeq = req->end_io_data; 3082 3083 blk_mq_free_request(req); 3084 complete(&nvmeq->delete_done); 3085 return RQ_END_IO_NONE; 3086 } 3087 3088 static enum rq_end_io_ret nvme_del_cq_end(struct request *req, 3089 blk_status_t error, 3090 const struct io_comp_batch *iob) 3091 { 3092 struct nvme_queue *nvmeq = req->end_io_data; 3093 3094 if (error) 3095 set_bit(NVMEQ_DELETE_ERROR, &nvmeq->flags); 3096 3097 return nvme_del_queue_end(req, error, iob); 3098 } 3099 3100 static int nvme_delete_queue(struct nvme_queue *nvmeq, u8 opcode) 3101 { 3102 struct request_queue *q = nvmeq->dev->ctrl.admin_q; 3103 struct request *req; 3104 struct nvme_command cmd = { }; 3105 3106 cmd.delete_queue.opcode = opcode; 3107 cmd.delete_queue.qid = cpu_to_le16(nvmeq->qid); 3108 3109 req = blk_mq_alloc_request(q, nvme_req_op(&cmd), BLK_MQ_REQ_NOWAIT); 3110 if (IS_ERR(req)) 3111 return PTR_ERR(req); 3112 nvme_init_request(req, &cmd); 3113 3114 if (opcode == nvme_admin_delete_cq) 3115 req->end_io = nvme_del_cq_end; 3116 else 3117 req->end_io = nvme_del_queue_end; 3118 req->end_io_data = nvmeq; 3119 3120 init_completion(&nvmeq->delete_done); 3121 blk_execute_rq_nowait(req, false); 3122 return 0; 3123 } 3124 3125 static bool __nvme_delete_io_queues(struct nvme_dev *dev, u8 opcode) 3126 { 3127 int nr_queues = dev->online_queues - 1, sent = 0; 3128 unsigned long timeout; 3129 3130 retry: 3131 timeout = dev->ctrl.admin_timeout; 3132 while (nr_queues > 0) { 3133 if (nvme_delete_queue(&dev->queues[nr_queues], opcode)) 3134 break; 3135 nr_queues--; 3136 sent++; 3137 } 3138 while (sent) { 3139 struct nvme_queue *nvmeq = &dev->queues[nr_queues + sent]; 3140 3141 timeout = wait_for_completion_io_timeout(&nvmeq->delete_done, 3142 timeout); 3143 if (timeout == 0) 3144 return false; 3145 3146 sent--; 3147 if (nr_queues) 3148 goto retry; 3149 } 3150 return true; 3151 } 3152 3153 static void nvme_delete_io_queues(struct nvme_dev *dev) 3154 { 3155 if (__nvme_delete_io_queues(dev, nvme_admin_delete_sq)) 3156 __nvme_delete_io_queues(dev, nvme_admin_delete_cq); 3157 } 3158 3159 static unsigned int nvme_pci_nr_maps(struct nvme_dev *dev) 3160 { 3161 if (dev->io_queues[HCTX_TYPE_POLL]) 3162 return 3; 3163 if (dev->io_queues[HCTX_TYPE_READ]) 3164 return 2; 3165 return 1; 3166 } 3167 3168 static bool nvme_pci_update_nr_queues(struct nvme_dev *dev) 3169 { 3170 if (!dev->ctrl.tagset) { 3171 nvme_alloc_io_tag_set(&dev->ctrl, &dev->tagset, &nvme_mq_ops, 3172 nvme_pci_nr_maps(dev), sizeof(struct nvme_iod)); 3173 return true; 3174 } 3175 3176 /* Give up if we are racing with nvme_dev_disable() */ 3177 if (!mutex_trylock(&dev->shutdown_lock)) 3178 return false; 3179 3180 /* Check if nvme_dev_disable() has been executed already */ 3181 if (!dev->online_queues) { 3182 mutex_unlock(&dev->shutdown_lock); 3183 return false; 3184 } 3185 3186 blk_mq_update_nr_hw_queues(&dev->tagset, dev->online_queues - 1); 3187 /* free previously allocated queues that are no longer usable */ 3188 nvme_free_queues(dev, dev->online_queues); 3189 mutex_unlock(&dev->shutdown_lock); 3190 return true; 3191 } 3192 3193 static int nvme_pci_enable(struct nvme_dev *dev) 3194 { 3195 int result = -ENOMEM; 3196 struct pci_dev *pdev = to_pci_dev(dev->dev); 3197 unsigned int flags = PCI_IRQ_ALL_TYPES; 3198 3199 if (pci_enable_device_mem(pdev)) 3200 return result; 3201 3202 pci_set_master(pdev); 3203 3204 if (readl(dev->bar + NVME_REG_CSTS) == -1) { 3205 dev_dbg(dev->ctrl.device, "reading CSTS register failed\n"); 3206 result = -ENODEV; 3207 goto disable; 3208 } 3209 3210 /* 3211 * Some devices and/or platforms don't advertise or work with INTx 3212 * interrupts. Pre-enable a single MSIX or MSI vec for setup. We'll 3213 * adjust this later. 3214 */ 3215 if (dev->ctrl.quirks & NVME_QUIRK_BROKEN_MSI) 3216 flags &= ~PCI_IRQ_MSI; 3217 result = pci_alloc_irq_vectors(pdev, 1, 1, flags); 3218 if (result < 0) 3219 goto disable; 3220 3221 dev->ctrl.cap = lo_hi_readq(dev->bar + NVME_REG_CAP); 3222 3223 dev->q_depth = min_t(u32, NVME_CAP_MQES(dev->ctrl.cap) + 1, 3224 io_queue_depth); 3225 dev->db_stride = 1 << NVME_CAP_STRIDE(dev->ctrl.cap); 3226 dev->dbs = dev->bar + 4096; 3227 3228 /* 3229 * Some Apple controllers require a non-standard SQE size. 3230 * Interestingly they also seem to ignore the CC:IOSQES register 3231 * so we don't bother updating it here. 3232 */ 3233 if (dev->ctrl.quirks & NVME_QUIRK_128_BYTES_SQES) 3234 dev->io_sqes = 7; 3235 else 3236 dev->io_sqes = NVME_NVM_IOSQES; 3237 3238 if (dev->ctrl.quirks & NVME_QUIRK_QDEPTH_ONE) { 3239 dev->q_depth = 2; 3240 } else if (pdev->vendor == PCI_VENDOR_ID_SAMSUNG && 3241 (pdev->device == 0xa821 || pdev->device == 0xa822) && 3242 NVME_CAP_MQES(dev->ctrl.cap) == 0) { 3243 dev->q_depth = 64; 3244 dev_err(dev->ctrl.device, "detected PM1725 NVMe controller, " 3245 "set queue depth=%u\n", dev->q_depth); 3246 } 3247 3248 /* 3249 * Controllers with the shared tags quirk need the IO queue to be 3250 * big enough so that we get 32 tags for the admin queue 3251 */ 3252 if ((dev->ctrl.quirks & NVME_QUIRK_SHARED_TAGS) && 3253 (dev->q_depth < (NVME_AQ_DEPTH + 2))) { 3254 dev->q_depth = NVME_AQ_DEPTH + 2; 3255 dev_warn(dev->ctrl.device, "IO queue depth clamped to %d\n", 3256 dev->q_depth); 3257 } 3258 dev->ctrl.sqsize = dev->q_depth - 1; /* 0's based queue depth */ 3259 3260 nvme_map_cmb(dev); 3261 3262 pci_save_state(pdev); 3263 3264 result = nvme_pci_configure_admin_queue(dev); 3265 if (result) 3266 goto free_irq; 3267 return result; 3268 3269 free_irq: 3270 pci_free_irq_vectors(pdev); 3271 disable: 3272 pci_disable_device(pdev); 3273 return result; 3274 } 3275 3276 static void nvme_dev_unmap(struct nvme_dev *dev) 3277 { 3278 if (dev->bar) 3279 iounmap(dev->bar); 3280 pci_release_mem_regions(to_pci_dev(dev->dev)); 3281 } 3282 3283 static bool nvme_pci_ctrl_is_dead(struct nvme_dev *dev) 3284 { 3285 struct pci_dev *pdev = to_pci_dev(dev->dev); 3286 u32 csts; 3287 3288 if (!pci_is_enabled(pdev) || !pci_device_is_present(pdev)) 3289 return true; 3290 if (pdev->error_state != pci_channel_io_normal) 3291 return true; 3292 3293 csts = readl(dev->bar + NVME_REG_CSTS); 3294 return (csts & NVME_CSTS_CFS) || !(csts & NVME_CSTS_RDY); 3295 } 3296 3297 static void nvme_dev_disable(struct nvme_dev *dev, bool shutdown) 3298 { 3299 enum nvme_ctrl_state state = nvme_ctrl_state(&dev->ctrl); 3300 struct pci_dev *pdev = to_pci_dev(dev->dev); 3301 bool dead; 3302 3303 mutex_lock(&dev->shutdown_lock); 3304 dead = nvme_pci_ctrl_is_dead(dev); 3305 if (state == NVME_CTRL_LIVE || state == NVME_CTRL_RESETTING) { 3306 if (pci_is_enabled(pdev)) 3307 nvme_start_freeze(&dev->ctrl); 3308 /* 3309 * Give the controller a chance to complete all entered requests 3310 * if doing a safe shutdown. 3311 */ 3312 if (!dead && shutdown) 3313 nvme_wait_freeze_timeout(&dev->ctrl); 3314 } 3315 3316 nvme_quiesce_io_queues(&dev->ctrl); 3317 3318 if (!dead && dev->ctrl.queue_count > 0) { 3319 nvme_delete_io_queues(dev); 3320 nvme_disable_ctrl(&dev->ctrl, shutdown); 3321 nvme_poll_irqdisable(&dev->queues[0]); 3322 } 3323 nvme_suspend_io_queues(dev); 3324 nvme_suspend_queue(dev, 0); 3325 pci_free_irq_vectors(pdev); 3326 if (pci_is_enabled(pdev)) 3327 pci_disable_device(pdev); 3328 nvme_reap_pending_cqes(dev); 3329 3330 nvme_cancel_tagset(&dev->ctrl); 3331 nvme_cancel_admin_tagset(&dev->ctrl); 3332 3333 /* 3334 * The driver will not be starting up queues again if shutting down so 3335 * must flush all entered requests to their failed completion to avoid 3336 * deadlocking blk-mq hot-cpu notifier. 3337 */ 3338 if (shutdown) { 3339 nvme_unquiesce_io_queues(&dev->ctrl); 3340 if (dev->ctrl.admin_q && !blk_queue_dying(dev->ctrl.admin_q)) 3341 nvme_unquiesce_admin_queue(&dev->ctrl); 3342 } 3343 mutex_unlock(&dev->shutdown_lock); 3344 } 3345 3346 static int nvme_disable_prepare_reset(struct nvme_dev *dev, bool shutdown) 3347 { 3348 if (!nvme_wait_reset(&dev->ctrl)) 3349 return -EBUSY; 3350 nvme_dev_disable(dev, shutdown); 3351 return 0; 3352 } 3353 3354 static int nvme_pci_alloc_iod_mempool(struct nvme_dev *dev) 3355 { 3356 size_t alloc_size = sizeof(struct nvme_dma_vec) * NVME_MAX_SEGS; 3357 3358 dev->dmavec_mempool = mempool_create_node(1, 3359 mempool_kmalloc, mempool_kfree, 3360 (void *)alloc_size, GFP_KERNEL, 3361 dev_to_node(dev->dev)); 3362 if (!dev->dmavec_mempool) 3363 return -ENOMEM; 3364 return 0; 3365 } 3366 3367 static void nvme_free_tagset(struct nvme_dev *dev) 3368 { 3369 if (dev->tagset.tags) 3370 nvme_remove_io_tag_set(&dev->ctrl); 3371 dev->ctrl.tagset = NULL; 3372 } 3373 3374 /* pairs with nvme_pci_alloc_dev */ 3375 static void nvme_pci_free_ctrl(struct nvme_ctrl *ctrl) 3376 { 3377 struct nvme_dev *dev = to_nvme_dev(ctrl); 3378 3379 nvme_free_tagset(dev); 3380 put_device(dev->dev); 3381 kfree(dev->queues); 3382 kfree(dev); 3383 } 3384 3385 static void nvme_reset_work(struct work_struct *work) 3386 { 3387 struct nvme_dev *dev = 3388 container_of(work, struct nvme_dev, ctrl.reset_work); 3389 bool was_suspend = !!(dev->ctrl.ctrl_config & NVME_CC_SHN_NORMAL); 3390 int result; 3391 3392 if (nvme_ctrl_state(&dev->ctrl) != NVME_CTRL_RESETTING) { 3393 dev_warn(dev->ctrl.device, "ctrl state %d is not RESETTING\n", 3394 dev->ctrl.state); 3395 result = -ENODEV; 3396 goto out; 3397 } 3398 3399 /* 3400 * If we're called to reset a live controller first shut it down before 3401 * moving on. 3402 */ 3403 if (dev->ctrl.ctrl_config & NVME_CC_ENABLE) 3404 nvme_dev_disable(dev, false); 3405 nvme_sync_queues(&dev->ctrl); 3406 3407 mutex_lock(&dev->shutdown_lock); 3408 result = nvme_pci_enable(dev); 3409 if (result) 3410 goto out_unlock; 3411 nvme_unquiesce_admin_queue(&dev->ctrl); 3412 mutex_unlock(&dev->shutdown_lock); 3413 3414 /* 3415 * Introduce CONNECTING state from nvme-fc/rdma transports to mark the 3416 * initializing procedure here. 3417 */ 3418 if (!nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_CONNECTING)) { 3419 dev_warn(dev->ctrl.device, 3420 "failed to mark controller CONNECTING\n"); 3421 result = -EBUSY; 3422 goto out; 3423 } 3424 3425 result = nvme_init_ctrl_finish(&dev->ctrl, was_suspend); 3426 if (result) 3427 goto out; 3428 3429 if (nvme_ctrl_meta_sgl_supported(&dev->ctrl)) 3430 dev->ctrl.max_integrity_segments = NVME_MAX_META_SEGS; 3431 else 3432 dev->ctrl.max_integrity_segments = 1; 3433 3434 nvme_dbbuf_dma_alloc(dev); 3435 3436 result = nvme_setup_host_mem(dev); 3437 if (result < 0) 3438 goto out; 3439 3440 nvme_update_attrs(dev); 3441 3442 result = nvme_setup_io_queues(dev); 3443 if (result) 3444 goto out; 3445 3446 /* 3447 * Freeze and update the number of I/O queues as those might have 3448 * changed. If there are no I/O queues left after this reset, keep the 3449 * controller around but remove all namespaces. 3450 */ 3451 if (dev->online_queues > 1) { 3452 nvme_dbbuf_set(dev); 3453 nvme_unquiesce_io_queues(&dev->ctrl); 3454 nvme_wait_freeze(&dev->ctrl); 3455 if (!nvme_pci_update_nr_queues(dev)) 3456 goto out; 3457 nvme_unfreeze(&dev->ctrl); 3458 } else { 3459 dev_warn(dev->ctrl.device, "IO queues lost\n"); 3460 nvme_mark_namespaces_dead(&dev->ctrl); 3461 nvme_unquiesce_io_queues(&dev->ctrl); 3462 nvme_remove_namespaces(&dev->ctrl); 3463 nvme_free_tagset(dev); 3464 } 3465 3466 /* 3467 * If only admin queue live, keep it to do further investigation or 3468 * recovery. 3469 */ 3470 if (!nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_LIVE)) { 3471 dev_warn(dev->ctrl.device, 3472 "failed to mark controller live state\n"); 3473 result = -ENODEV; 3474 goto out; 3475 } 3476 3477 nvme_start_ctrl(&dev->ctrl); 3478 return; 3479 3480 out_unlock: 3481 mutex_unlock(&dev->shutdown_lock); 3482 out: 3483 /* 3484 * Set state to deleting now to avoid blocking nvme_wait_reset(), which 3485 * may be holding this pci_dev's device lock. 3486 */ 3487 dev_warn(dev->ctrl.device, "Disabling device after reset failure: %d\n", 3488 result); 3489 nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_DELETING); 3490 nvme_dev_disable(dev, true); 3491 nvme_sync_queues(&dev->ctrl); 3492 nvme_mark_namespaces_dead(&dev->ctrl); 3493 nvme_unquiesce_io_queues(&dev->ctrl); 3494 nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_DEAD); 3495 } 3496 3497 static int nvme_pci_reg_read32(struct nvme_ctrl *ctrl, u32 off, u32 *val) 3498 { 3499 *val = readl(to_nvme_dev(ctrl)->bar + off); 3500 return 0; 3501 } 3502 3503 static int nvme_pci_reg_write32(struct nvme_ctrl *ctrl, u32 off, u32 val) 3504 { 3505 writel(val, to_nvme_dev(ctrl)->bar + off); 3506 return 0; 3507 } 3508 3509 static int nvme_pci_reg_read64(struct nvme_ctrl *ctrl, u32 off, u64 *val) 3510 { 3511 *val = lo_hi_readq(to_nvme_dev(ctrl)->bar + off); 3512 return 0; 3513 } 3514 3515 static int nvme_pci_get_address(struct nvme_ctrl *ctrl, char *buf, int size) 3516 { 3517 struct pci_dev *pdev = to_pci_dev(to_nvme_dev(ctrl)->dev); 3518 3519 return snprintf(buf, size, "%s\n", dev_name(&pdev->dev)); 3520 } 3521 3522 static void nvme_pci_print_device_info(struct nvme_ctrl *ctrl) 3523 { 3524 struct pci_dev *pdev = to_pci_dev(to_nvme_dev(ctrl)->dev); 3525 struct nvme_subsystem *subsys = ctrl->subsys; 3526 3527 dev_err(ctrl->device, 3528 "VID:DID %04x:%04x model:%.*s firmware:%.*s\n", 3529 pdev->vendor, pdev->device, 3530 nvme_strlen(subsys->model, sizeof(subsys->model)), 3531 subsys->model, nvme_strlen(subsys->firmware_rev, 3532 sizeof(subsys->firmware_rev)), 3533 subsys->firmware_rev); 3534 } 3535 3536 static bool nvme_pci_supports_pci_p2pdma(struct nvme_ctrl *ctrl) 3537 { 3538 struct nvme_dev *dev = to_nvme_dev(ctrl); 3539 3540 return dma_pci_p2pdma_supported(dev->dev); 3541 } 3542 3543 static unsigned long nvme_pci_get_virt_boundary(struct nvme_ctrl *ctrl, 3544 bool is_admin) 3545 { 3546 if (!nvme_ctrl_sgl_supported(ctrl) || is_admin) 3547 return NVME_CTRL_PAGE_SIZE - 1; 3548 return 0; 3549 } 3550 3551 static const struct nvme_ctrl_ops nvme_pci_ctrl_ops = { 3552 .name = "pcie", 3553 .module = THIS_MODULE, 3554 .flags = NVME_F_METADATA_SUPPORTED, 3555 .dev_attr_groups = nvme_pci_dev_attr_groups, 3556 .reg_read32 = nvme_pci_reg_read32, 3557 .reg_write32 = nvme_pci_reg_write32, 3558 .reg_read64 = nvme_pci_reg_read64, 3559 .free_ctrl = nvme_pci_free_ctrl, 3560 .submit_async_event = nvme_pci_submit_async_event, 3561 .subsystem_reset = nvme_pci_subsystem_reset, 3562 .get_address = nvme_pci_get_address, 3563 .print_device_info = nvme_pci_print_device_info, 3564 .supports_pci_p2pdma = nvme_pci_supports_pci_p2pdma, 3565 .get_virt_boundary = nvme_pci_get_virt_boundary, 3566 }; 3567 3568 static int nvme_dev_map(struct nvme_dev *dev) 3569 { 3570 struct pci_dev *pdev = to_pci_dev(dev->dev); 3571 3572 if (pci_request_mem_regions(pdev, "nvme")) 3573 return -ENODEV; 3574 3575 if (nvme_remap_bar(dev, NVME_REG_DBS + 4096)) 3576 goto release; 3577 3578 return 0; 3579 release: 3580 pci_release_mem_regions(pdev); 3581 return -ENODEV; 3582 } 3583 3584 static unsigned long check_vendor_combination_bug(struct pci_dev *pdev) 3585 { 3586 if (pdev->vendor == 0x144d && pdev->device == 0xa802) { 3587 /* 3588 * Several Samsung devices seem to drop off the PCIe bus 3589 * randomly when APST is on and uses the deepest sleep state. 3590 * This has been observed on a Samsung "SM951 NVMe SAMSUNG 3591 * 256GB", a "PM951 NVMe SAMSUNG 512GB", and a "Samsung SSD 3592 * 950 PRO 256GB", but it seems to be restricted to two Dell 3593 * laptops. 3594 */ 3595 if (dmi_match(DMI_SYS_VENDOR, "Dell Inc.") && 3596 (dmi_match(DMI_PRODUCT_NAME, "XPS 15 9550") || 3597 dmi_match(DMI_PRODUCT_NAME, "Precision 5510"))) 3598 return NVME_QUIRK_NO_DEEPEST_PS; 3599 } else if (pdev->vendor == 0x144d && pdev->device == 0xa804) { 3600 /* 3601 * Samsung SSD 960 EVO drops off the PCIe bus after system 3602 * suspend on a Ryzen board, ASUS PRIME B350M-A, as well as 3603 * within few minutes after bootup on a Coffee Lake board - 3604 * ASUS PRIME Z370-A 3605 */ 3606 if (dmi_match(DMI_BOARD_VENDOR, "ASUSTeK COMPUTER INC.") && 3607 (dmi_match(DMI_BOARD_NAME, "PRIME B350M-A") || 3608 dmi_match(DMI_BOARD_NAME, "PRIME Z370-A"))) 3609 return NVME_QUIRK_NO_APST; 3610 } else if ((pdev->vendor == 0x144d && (pdev->device == 0xa801 || 3611 pdev->device == 0xa808 || pdev->device == 0xa809)) || 3612 (pdev->vendor == 0x1e0f && pdev->device == 0x0001)) { 3613 /* 3614 * Forcing to use host managed nvme power settings for 3615 * lowest idle power with quick resume latency on 3616 * Samsung and Toshiba SSDs based on suspend behavior 3617 * on Coffee Lake board for LENOVO C640 3618 */ 3619 if ((dmi_match(DMI_BOARD_VENDOR, "LENOVO")) && 3620 dmi_match(DMI_BOARD_NAME, "LNVNB161216")) 3621 return NVME_QUIRK_SIMPLE_SUSPEND; 3622 } else if (pdev->vendor == 0x2646 && (pdev->device == 0x2263 || 3623 pdev->device == 0x500f)) { 3624 /* 3625 * Exclude some Kingston NV1 and A2000 devices from 3626 * NVME_QUIRK_SIMPLE_SUSPEND. Do a full suspend to save a 3627 * lot of energy with s2idle sleep on some TUXEDO platforms. 3628 */ 3629 if (dmi_match(DMI_BOARD_NAME, "NS5X_NS7XAU") || 3630 dmi_match(DMI_BOARD_NAME, "NS5x_7xAU") || 3631 dmi_match(DMI_BOARD_NAME, "NS5x_7xPU") || 3632 dmi_match(DMI_BOARD_NAME, "PH4PRX1_PH6PRX1")) 3633 return NVME_QUIRK_FORCE_NO_SIMPLE_SUSPEND; 3634 } else if (pdev->vendor == 0x144d && pdev->device == 0xa80d) { 3635 /* 3636 * Exclude Samsung 990 Evo from NVME_QUIRK_SIMPLE_SUSPEND 3637 * because of high power consumption (> 2 Watt) in s2idle 3638 * sleep. Only some boards with Intel CPU are affected. 3639 * (Note for testing: Samsung 990 Evo Plus has same PCI ID) 3640 */ 3641 if (dmi_match(DMI_BOARD_NAME, "DN50Z-140HC-YD") || 3642 dmi_match(DMI_BOARD_NAME, "GMxPXxx") || 3643 dmi_match(DMI_BOARD_NAME, "GXxMRXx") || 3644 dmi_match(DMI_BOARD_NAME, "NS5X_NS7XAU") || 3645 dmi_match(DMI_BOARD_NAME, "PH4PG31") || 3646 dmi_match(DMI_BOARD_NAME, "PH4PRX1_PH6PRX1") || 3647 dmi_match(DMI_BOARD_NAME, "PH6PG01_PH6PG71")) 3648 return NVME_QUIRK_FORCE_NO_SIMPLE_SUSPEND; 3649 } 3650 3651 /* 3652 * NVMe SSD drops off the PCIe bus after system idle 3653 * for 10 hours on a Lenovo N60z board. 3654 */ 3655 if (dmi_match(DMI_BOARD_NAME, "LXKT-ZXEG-N6")) 3656 return NVME_QUIRK_NO_APST; 3657 3658 return 0; 3659 } 3660 3661 static struct quirk_entry *detect_dynamic_quirks(struct pci_dev *pdev) 3662 { 3663 int i; 3664 3665 for (i = 0; i < nvme_pci_quirk_count; i++) 3666 if (pdev->vendor == nvme_pci_quirk_list[i].vendor_id && 3667 pdev->device == nvme_pci_quirk_list[i].dev_id) 3668 return &nvme_pci_quirk_list[i]; 3669 3670 return NULL; 3671 } 3672 3673 static struct nvme_dev *nvme_pci_alloc_dev(struct pci_dev *pdev, 3674 const struct pci_device_id *id) 3675 { 3676 unsigned long quirks = id->driver_data; 3677 int node = dev_to_node(&pdev->dev); 3678 struct nvme_dev *dev; 3679 struct quirk_entry *qentry; 3680 int ret = -ENOMEM; 3681 3682 dev = kzalloc_node(struct_size(dev, descriptor_pools, nr_node_ids), 3683 GFP_KERNEL, node); 3684 if (!dev) 3685 return ERR_PTR(-ENOMEM); 3686 INIT_WORK(&dev->ctrl.reset_work, nvme_reset_work); 3687 mutex_init(&dev->shutdown_lock); 3688 3689 dev->nr_write_queues = write_queues; 3690 dev->nr_poll_queues = poll_queues; 3691 dev->nr_allocated_queues = nvme_max_io_queues(dev) + 1; 3692 dev->queues = kcalloc_node(dev->nr_allocated_queues, 3693 sizeof(struct nvme_queue), GFP_KERNEL, node); 3694 if (!dev->queues) 3695 goto out_free_dev; 3696 3697 dev->dev = get_device(&pdev->dev); 3698 3699 quirks |= check_vendor_combination_bug(pdev); 3700 if (!noacpi && 3701 !(quirks & NVME_QUIRK_FORCE_NO_SIMPLE_SUSPEND) && 3702 acpi_storage_d3(&pdev->dev)) { 3703 /* 3704 * Some systems use a bios work around to ask for D3 on 3705 * platforms that support kernel managed suspend. 3706 */ 3707 dev_info(&pdev->dev, 3708 "platform quirk: setting simple suspend\n"); 3709 quirks |= NVME_QUIRK_SIMPLE_SUSPEND; 3710 } 3711 qentry = detect_dynamic_quirks(pdev); 3712 if (qentry) { 3713 quirks |= qentry->enabled_quirks; 3714 quirks &= ~qentry->disabled_quirks; 3715 } 3716 ret = nvme_init_ctrl(&dev->ctrl, &pdev->dev, &nvme_pci_ctrl_ops, 3717 quirks); 3718 if (ret) 3719 goto out_put_device; 3720 3721 if (dev->ctrl.quirks & NVME_QUIRK_DMA_ADDRESS_BITS_48) 3722 dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(48)); 3723 else 3724 dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64)); 3725 dma_set_min_align_mask(&pdev->dev, NVME_CTRL_PAGE_SIZE - 1); 3726 dma_set_max_seg_size(&pdev->dev, 0xffffffff); 3727 3728 /* 3729 * Limit the max command size to prevent iod->sg allocations going 3730 * over a single page. 3731 */ 3732 dev->ctrl.max_hw_sectors = min_t(u32, 3733 NVME_MAX_BYTES >> SECTOR_SHIFT, 3734 dma_opt_mapping_size(&pdev->dev) >> 9); 3735 dev->ctrl.max_segments = NVME_MAX_SEGS; 3736 dev->ctrl.max_integrity_segments = 1; 3737 return dev; 3738 3739 out_put_device: 3740 put_device(dev->dev); 3741 kfree(dev->queues); 3742 out_free_dev: 3743 kfree(dev); 3744 return ERR_PTR(ret); 3745 } 3746 3747 static int nvme_probe(struct pci_dev *pdev, const struct pci_device_id *id) 3748 { 3749 struct nvme_dev *dev; 3750 int result = -ENOMEM; 3751 3752 dev = nvme_pci_alloc_dev(pdev, id); 3753 if (IS_ERR(dev)) 3754 return PTR_ERR(dev); 3755 3756 result = nvme_add_ctrl(&dev->ctrl); 3757 if (result) 3758 goto out_put_ctrl; 3759 3760 result = nvme_dev_map(dev); 3761 if (result) 3762 goto out_uninit_ctrl; 3763 3764 result = nvme_pci_alloc_iod_mempool(dev); 3765 if (result) 3766 goto out_dev_unmap; 3767 3768 dev_info(dev->ctrl.device, "pci function %s\n", dev_name(&pdev->dev)); 3769 3770 result = nvme_pci_enable(dev); 3771 if (result) 3772 goto out_release_iod_mempool; 3773 3774 result = nvme_alloc_admin_tag_set(&dev->ctrl, &dev->admin_tagset, 3775 &nvme_mq_admin_ops, sizeof(struct nvme_iod)); 3776 if (result) 3777 goto out_disable; 3778 3779 /* 3780 * Mark the controller as connecting before sending admin commands to 3781 * allow the timeout handler to do the right thing. 3782 */ 3783 if (!nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_CONNECTING)) { 3784 dev_warn(dev->ctrl.device, 3785 "failed to mark controller CONNECTING\n"); 3786 result = -EBUSY; 3787 goto out_disable; 3788 } 3789 3790 result = nvme_init_ctrl_finish(&dev->ctrl, false); 3791 if (result) 3792 goto out_disable; 3793 3794 if (nvme_ctrl_meta_sgl_supported(&dev->ctrl)) 3795 dev->ctrl.max_integrity_segments = NVME_MAX_META_SEGS; 3796 else 3797 dev->ctrl.max_integrity_segments = 1; 3798 3799 nvme_dbbuf_dma_alloc(dev); 3800 3801 result = nvme_setup_host_mem(dev); 3802 if (result < 0) 3803 goto out_disable; 3804 3805 nvme_update_attrs(dev); 3806 3807 result = nvme_setup_io_queues(dev); 3808 if (result) 3809 goto out_disable; 3810 3811 if (dev->online_queues > 1) { 3812 nvme_alloc_io_tag_set(&dev->ctrl, &dev->tagset, &nvme_mq_ops, 3813 nvme_pci_nr_maps(dev), sizeof(struct nvme_iod)); 3814 nvme_dbbuf_set(dev); 3815 } 3816 3817 if (!dev->ctrl.tagset) 3818 dev_warn(dev->ctrl.device, "IO queues not created\n"); 3819 3820 if (!nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_LIVE)) { 3821 dev_warn(dev->ctrl.device, 3822 "failed to mark controller live state\n"); 3823 result = -ENODEV; 3824 goto out_disable; 3825 } 3826 3827 pci_set_drvdata(pdev, dev); 3828 3829 nvme_start_ctrl(&dev->ctrl); 3830 nvme_put_ctrl(&dev->ctrl); 3831 flush_work(&dev->ctrl.scan_work); 3832 return 0; 3833 3834 out_disable: 3835 nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_DELETING); 3836 nvme_dev_disable(dev, true); 3837 nvme_free_host_mem(dev); 3838 nvme_dev_remove_admin(dev); 3839 nvme_dbbuf_dma_free(dev); 3840 nvme_free_queues(dev, 0); 3841 out_release_iod_mempool: 3842 mempool_destroy(dev->dmavec_mempool); 3843 out_dev_unmap: 3844 nvme_dev_unmap(dev); 3845 out_uninit_ctrl: 3846 nvme_uninit_ctrl(&dev->ctrl); 3847 out_put_ctrl: 3848 nvme_put_ctrl(&dev->ctrl); 3849 dev_err_probe(&pdev->dev, result, "probe failed\n"); 3850 return result; 3851 } 3852 3853 static void nvme_reset_prepare(struct pci_dev *pdev) 3854 { 3855 struct nvme_dev *dev = pci_get_drvdata(pdev); 3856 3857 /* 3858 * We don't need to check the return value from waiting for the reset 3859 * state as pci_dev device lock is held, making it impossible to race 3860 * with ->remove(). 3861 */ 3862 nvme_disable_prepare_reset(dev, false); 3863 nvme_sync_queues(&dev->ctrl); 3864 } 3865 3866 static void nvme_reset_done(struct pci_dev *pdev) 3867 { 3868 struct nvme_dev *dev = pci_get_drvdata(pdev); 3869 3870 if (!nvme_try_sched_reset(&dev->ctrl)) 3871 flush_work(&dev->ctrl.reset_work); 3872 } 3873 3874 static void nvme_shutdown(struct pci_dev *pdev) 3875 { 3876 struct nvme_dev *dev = pci_get_drvdata(pdev); 3877 3878 nvme_disable_prepare_reset(dev, true); 3879 } 3880 3881 /* 3882 * The driver's remove may be called on a device in a partially initialized 3883 * state. This function must not have any dependencies on the device state in 3884 * order to proceed. 3885 */ 3886 static void nvme_remove(struct pci_dev *pdev) 3887 { 3888 struct nvme_dev *dev = pci_get_drvdata(pdev); 3889 3890 nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_DELETING); 3891 pci_set_drvdata(pdev, NULL); 3892 3893 if (!pci_device_is_present(pdev)) { 3894 nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_DEAD); 3895 nvme_dev_disable(dev, true); 3896 } 3897 3898 flush_work(&dev->ctrl.reset_work); 3899 nvme_stop_ctrl(&dev->ctrl); 3900 nvme_remove_namespaces(&dev->ctrl); 3901 nvme_dev_disable(dev, true); 3902 nvme_free_host_mem(dev); 3903 nvme_dev_remove_admin(dev); 3904 nvme_dbbuf_dma_free(dev); 3905 nvme_free_queues(dev, 0); 3906 mempool_destroy(dev->dmavec_mempool); 3907 nvme_release_descriptor_pools(dev); 3908 nvme_dev_unmap(dev); 3909 nvme_uninit_ctrl(&dev->ctrl); 3910 } 3911 3912 #ifdef CONFIG_PM_SLEEP 3913 static int nvme_get_power_state(struct nvme_ctrl *ctrl, u32 *ps) 3914 { 3915 return nvme_get_features(ctrl, NVME_FEAT_POWER_MGMT, 0, NULL, 0, ps); 3916 } 3917 3918 static int nvme_set_power_state(struct nvme_ctrl *ctrl, u32 ps) 3919 { 3920 return nvme_set_features(ctrl, NVME_FEAT_POWER_MGMT, ps, NULL, 0, NULL); 3921 } 3922 3923 static int nvme_resume(struct device *dev) 3924 { 3925 struct nvme_dev *ndev = pci_get_drvdata(to_pci_dev(dev)); 3926 struct nvme_ctrl *ctrl = &ndev->ctrl; 3927 3928 if (ndev->last_ps == U32_MAX || 3929 nvme_set_power_state(ctrl, ndev->last_ps) != 0) 3930 goto reset; 3931 if (ctrl->hmpre && nvme_setup_host_mem(ndev)) 3932 goto reset; 3933 3934 return 0; 3935 reset: 3936 return nvme_try_sched_reset(ctrl); 3937 } 3938 3939 static int nvme_suspend(struct device *dev) 3940 { 3941 struct pci_dev *pdev = to_pci_dev(dev); 3942 struct nvme_dev *ndev = pci_get_drvdata(pdev); 3943 struct nvme_ctrl *ctrl = &ndev->ctrl; 3944 int ret = -EBUSY; 3945 3946 ndev->last_ps = U32_MAX; 3947 3948 /* 3949 * The platform does not remove power for a kernel managed suspend so 3950 * use host managed nvme power settings for lowest idle power if 3951 * possible. This should have quicker resume latency than a full device 3952 * shutdown. But if the firmware is involved after the suspend or the 3953 * device does not support any non-default power states, shut down the 3954 * device fully. 3955 * 3956 * If ASPM is not enabled for the device, shut down the device and allow 3957 * the PCI bus layer to put it into D3 in order to take the PCIe link 3958 * down, so as to allow the platform to achieve its minimum low-power 3959 * state (which may not be possible if the link is up). 3960 */ 3961 if (pm_suspend_via_firmware() || !ctrl->npss || 3962 !pcie_aspm_enabled(pdev) || 3963 (ndev->ctrl.quirks & NVME_QUIRK_SIMPLE_SUSPEND)) 3964 return nvme_disable_prepare_reset(ndev, true); 3965 3966 nvme_start_freeze(ctrl); 3967 nvme_wait_freeze(ctrl); 3968 nvme_sync_queues(ctrl); 3969 3970 if (nvme_ctrl_state(ctrl) != NVME_CTRL_LIVE) 3971 goto unfreeze; 3972 3973 /* 3974 * Host memory access may not be successful in a system suspend state, 3975 * but the specification allows the controller to access memory in a 3976 * non-operational power state. 3977 */ 3978 if (ndev->hmb) { 3979 ret = nvme_set_host_mem(ndev, 0); 3980 if (ret < 0) 3981 goto unfreeze; 3982 } 3983 3984 ret = nvme_get_power_state(ctrl, &ndev->last_ps); 3985 if (ret < 0) 3986 goto unfreeze; 3987 3988 /* 3989 * A saved state prevents pci pm from generically controlling the 3990 * device's power. If we're using protocol specific settings, we don't 3991 * want pci interfering. 3992 */ 3993 pci_save_state(pdev); 3994 3995 ret = nvme_set_power_state(ctrl, ctrl->npss); 3996 if (ret < 0) 3997 goto unfreeze; 3998 3999 if (ret) { 4000 /* discard the saved state */ 4001 pci_load_saved_state(pdev, NULL); 4002 4003 /* 4004 * Clearing npss forces a controller reset on resume. The 4005 * correct value will be rediscovered then. 4006 */ 4007 ret = nvme_disable_prepare_reset(ndev, true); 4008 ctrl->npss = 0; 4009 } 4010 unfreeze: 4011 nvme_unfreeze(ctrl); 4012 return ret; 4013 } 4014 4015 static int nvme_simple_suspend(struct device *dev) 4016 { 4017 struct nvme_dev *ndev = pci_get_drvdata(to_pci_dev(dev)); 4018 4019 return nvme_disable_prepare_reset(ndev, true); 4020 } 4021 4022 static int nvme_simple_resume(struct device *dev) 4023 { 4024 struct pci_dev *pdev = to_pci_dev(dev); 4025 struct nvme_dev *ndev = pci_get_drvdata(pdev); 4026 4027 return nvme_try_sched_reset(&ndev->ctrl); 4028 } 4029 4030 static const struct dev_pm_ops nvme_dev_pm_ops = { 4031 .suspend = nvme_suspend, 4032 .resume = nvme_resume, 4033 .freeze = nvme_simple_suspend, 4034 .thaw = nvme_simple_resume, 4035 .poweroff = nvme_simple_suspend, 4036 .restore = nvme_simple_resume, 4037 }; 4038 #endif /* CONFIG_PM_SLEEP */ 4039 4040 static pci_ers_result_t nvme_error_detected(struct pci_dev *pdev, 4041 pci_channel_state_t state) 4042 { 4043 struct nvme_dev *dev = pci_get_drvdata(pdev); 4044 4045 /* 4046 * A frozen channel requires a reset. When detected, this method will 4047 * shutdown the controller to quiesce. The controller will be restarted 4048 * after the slot reset through driver's slot_reset callback. 4049 */ 4050 switch (state) { 4051 case pci_channel_io_normal: 4052 return PCI_ERS_RESULT_CAN_RECOVER; 4053 case pci_channel_io_frozen: 4054 dev_warn(dev->ctrl.device, 4055 "frozen state error detected, reset controller\n"); 4056 if (!nvme_change_ctrl_state(&dev->ctrl, NVME_CTRL_RESETTING)) { 4057 nvme_dev_disable(dev, true); 4058 return PCI_ERS_RESULT_DISCONNECT; 4059 } 4060 nvme_dev_disable(dev, false); 4061 return PCI_ERS_RESULT_NEED_RESET; 4062 case pci_channel_io_perm_failure: 4063 dev_warn(dev->ctrl.device, 4064 "failure state error detected, request disconnect\n"); 4065 return PCI_ERS_RESULT_DISCONNECT; 4066 } 4067 return PCI_ERS_RESULT_NEED_RESET; 4068 } 4069 4070 static pci_ers_result_t nvme_slot_reset(struct pci_dev *pdev) 4071 { 4072 struct nvme_dev *dev = pci_get_drvdata(pdev); 4073 4074 dev_info(dev->ctrl.device, "restart after slot reset\n"); 4075 pci_restore_state(pdev); 4076 if (nvme_try_sched_reset(&dev->ctrl)) 4077 nvme_unquiesce_io_queues(&dev->ctrl); 4078 return PCI_ERS_RESULT_RECOVERED; 4079 } 4080 4081 static void nvme_error_resume(struct pci_dev *pdev) 4082 { 4083 struct nvme_dev *dev = pci_get_drvdata(pdev); 4084 4085 flush_work(&dev->ctrl.reset_work); 4086 } 4087 4088 static const struct pci_error_handlers nvme_err_handler = { 4089 .error_detected = nvme_error_detected, 4090 .slot_reset = nvme_slot_reset, 4091 .resume = nvme_error_resume, 4092 .reset_prepare = nvme_reset_prepare, 4093 .reset_done = nvme_reset_done, 4094 }; 4095 4096 static const struct pci_device_id nvme_id_table[] = { 4097 { PCI_VDEVICE(INTEL, 0x0953), /* Intel 750/P3500/P3600/P3700 */ 4098 .driver_data = NVME_QUIRK_STRIPE_SIZE | 4099 NVME_QUIRK_DEALLOCATE_ZEROES, }, 4100 { PCI_VDEVICE(INTEL, 0x0a53), /* Intel P3520 */ 4101 .driver_data = NVME_QUIRK_STRIPE_SIZE | 4102 NVME_QUIRK_DEALLOCATE_ZEROES, }, 4103 { PCI_VDEVICE(INTEL, 0x0a54), /* Intel P4500/P4600 */ 4104 .driver_data = NVME_QUIRK_STRIPE_SIZE | 4105 NVME_QUIRK_IGNORE_DEV_SUBNQN | 4106 NVME_QUIRK_BOGUS_NID, }, 4107 { PCI_VDEVICE(INTEL, 0x0a55), /* Dell Express Flash P4600 */ 4108 .driver_data = NVME_QUIRK_STRIPE_SIZE, }, 4109 { PCI_VDEVICE(INTEL, 0xf1a5), /* Intel 600P/P3100 */ 4110 .driver_data = NVME_QUIRK_NO_DEEPEST_PS | 4111 NVME_QUIRK_MEDIUM_PRIO_SQ | 4112 NVME_QUIRK_NO_TEMP_THRESH_CHANGE | 4113 NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4114 { PCI_VDEVICE(INTEL, 0xf1a6), /* Intel 760p/Pro 7600p */ 4115 .driver_data = NVME_QUIRK_IGNORE_DEV_SUBNQN, }, 4116 { PCI_VDEVICE(INTEL, 0x5845), /* Qemu emulated controller */ 4117 .driver_data = NVME_QUIRK_IDENTIFY_CNS | 4118 NVME_QUIRK_DISABLE_WRITE_ZEROES | 4119 NVME_QUIRK_BOGUS_NID, }, 4120 { PCI_VDEVICE(REDHAT, 0x0010), /* Qemu emulated controller */ 4121 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4122 { PCI_DEVICE(0x1217, 0x8760), /* O2 Micro 64GB Steam Deck */ 4123 .driver_data = NVME_QUIRK_DMAPOOL_ALIGN_512, }, 4124 { PCI_DEVICE(0x126f, 0x1001), /* Silicon Motion generic */ 4125 .driver_data = NVME_QUIRK_NO_DEEPEST_PS | 4126 NVME_QUIRK_IGNORE_DEV_SUBNQN, }, 4127 { PCI_DEVICE(0x126f, 0x2262), /* Silicon Motion generic */ 4128 .driver_data = NVME_QUIRK_NO_DEEPEST_PS | 4129 NVME_QUIRK_BOGUS_NID, }, 4130 { PCI_DEVICE(0x126f, 0x2263), /* Silicon Motion unidentified */ 4131 .driver_data = NVME_QUIRK_NO_NS_DESC_LIST | 4132 NVME_QUIRK_BOGUS_NID, }, 4133 { PCI_DEVICE(0x1bb1, 0x0100), /* Seagate Nytro Flash Storage */ 4134 .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY | 4135 NVME_QUIRK_NO_NS_DESC_LIST, }, 4136 { PCI_DEVICE(0x1c58, 0x0003), /* HGST adapter */ 4137 .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, 4138 { PCI_DEVICE(0x1c58, 0x0023), /* WDC SN200 adapter */ 4139 .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, 4140 { PCI_DEVICE(0x1c5f, 0x0540), /* Memblaze Pblaze4 adapter */ 4141 .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, 4142 { PCI_DEVICE(0x1c5f, 0x0555), /* Memblaze Pblaze5 adapter */ 4143 .driver_data = NVME_QUIRK_NO_NS_DESC_LIST, }, 4144 { PCI_DEVICE(0x144d, 0xa821), /* Samsung PM1725 */ 4145 .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY, }, 4146 { PCI_DEVICE(0x144d, 0xa822), /* Samsung PM1725a */ 4147 .driver_data = NVME_QUIRK_DELAY_BEFORE_CHK_RDY | 4148 NVME_QUIRK_DISABLE_WRITE_ZEROES| 4149 NVME_QUIRK_IGNORE_DEV_SUBNQN, }, 4150 { PCI_DEVICE(0x15b7, 0x5008), /* Sandisk SN530 */ 4151 .driver_data = NVME_QUIRK_BROKEN_MSI }, 4152 { PCI_DEVICE(0x15b7, 0x5009), /* Sandisk SN550 */ 4153 .driver_data = NVME_QUIRK_BROKEN_MSI | 4154 NVME_QUIRK_NO_DEEPEST_PS }, 4155 { PCI_DEVICE(0x1987, 0x5012), /* Phison E12 */ 4156 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4157 { PCI_DEVICE(0x1987, 0x5016), /* Phison E16 */ 4158 .driver_data = NVME_QUIRK_IGNORE_DEV_SUBNQN | 4159 NVME_QUIRK_BOGUS_NID, }, 4160 { PCI_DEVICE(0x1987, 0x5019), /* phison E19 */ 4161 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4162 { PCI_DEVICE(0x1987, 0x5021), /* Phison E21 */ 4163 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4164 { PCI_DEVICE(0x1b4b, 0x1092), /* Lexar 256 GB SSD */ 4165 .driver_data = NVME_QUIRK_NO_NS_DESC_LIST | 4166 NVME_QUIRK_IGNORE_DEV_SUBNQN, }, 4167 { PCI_DEVICE(0x1cc1, 0x33f8), /* ADATA IM2P33F8ABR1 1 TB */ 4168 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4169 { PCI_DEVICE(0x10ec, 0x5762), /* ADATA SX6000LNP */ 4170 .driver_data = NVME_QUIRK_IGNORE_DEV_SUBNQN | 4171 NVME_QUIRK_BOGUS_NID, }, 4172 { PCI_DEVICE(0x10ec, 0x5763), /* ADATA SX6000PNP */ 4173 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4174 { PCI_DEVICE(0x1cc1, 0x8201), /* ADATA SX8200PNP 512GB */ 4175 .driver_data = NVME_QUIRK_NO_DEEPEST_PS | 4176 NVME_QUIRK_IGNORE_DEV_SUBNQN, }, 4177 { PCI_DEVICE(0x1344, 0x5407), /* Micron Technology Inc NVMe SSD */ 4178 .driver_data = NVME_QUIRK_IGNORE_DEV_SUBNQN }, 4179 { PCI_DEVICE(0x1344, 0x6001), /* Micron Nitro NVMe */ 4180 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4181 { PCI_DEVICE(0x1c5c, 0x1504), /* SK Hynix PC400 */ 4182 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4183 { PCI_DEVICE(0x1c5c, 0x174a), /* SK Hynix P31 SSD */ 4184 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4185 { PCI_DEVICE(0x1c5c, 0x1D59), /* SK Hynix BC901 */ 4186 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4187 { PCI_DEVICE(0x15b7, 0x2001), /* Sandisk Skyhawk */ 4188 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4189 { PCI_DEVICE(0x1d97, 0x2263), /* SPCC */ 4190 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4191 { PCI_DEVICE(0x144d, 0xa80b), /* Samsung PM9B1 256G and 512G */ 4192 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES | 4193 NVME_QUIRK_BOGUS_NID, }, 4194 { PCI_DEVICE(0x144d, 0xa809), /* Samsung MZALQ256HBJD 256G */ 4195 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4196 { PCI_DEVICE(0x144d, 0xa802), /* Samsung SM953 */ 4197 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4198 { PCI_DEVICE(0x1cc4, 0x6303), /* UMIS RPJTJ512MGE1QDY 512G */ 4199 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4200 { PCI_DEVICE(0x1cc4, 0x6302), /* UMIS RPJTJ256MGE1QDY 256G */ 4201 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4202 { PCI_DEVICE(0x2646, 0x2262), /* KINGSTON SKC2000 NVMe SSD */ 4203 .driver_data = NVME_QUIRK_NO_DEEPEST_PS, }, 4204 { PCI_DEVICE(0x2646, 0x2263), /* KINGSTON A2000 NVMe SSD */ 4205 .driver_data = NVME_QUIRK_NO_DEEPEST_PS, }, 4206 { PCI_DEVICE(0x2646, 0x5013), /* Kingston KC3000, Kingston FURY Renegade */ 4207 .driver_data = NVME_QUIRK_NO_SECONDARY_TEMP_THRESH, }, 4208 { PCI_DEVICE(0x2646, 0x5018), /* KINGSTON OM8SFP4xxxxP OS21012 NVMe SSD */ 4209 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4210 { PCI_DEVICE(0x2646, 0x5016), /* KINGSTON OM3PGP4xxxxP OS21011 NVMe SSD */ 4211 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4212 { PCI_DEVICE(0x2646, 0x501A), /* KINGSTON OM8PGP4xxxxP OS21005 NVMe SSD */ 4213 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4214 { PCI_DEVICE(0x2646, 0x501B), /* KINGSTON OM8PGP4xxxxQ OS21005 NVMe SSD */ 4215 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4216 { PCI_DEVICE(0x2646, 0x501E), /* KINGSTON OM3PGP4xxxxQ OS21011 NVMe SSD */ 4217 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4218 { PCI_DEVICE(0x2646, 0x502F), /* KINGSTON OM3SGP4xxxxK NVMe SSD */ 4219 .driver_data = NVME_QUIRK_DISABLE_WRITE_ZEROES, }, 4220 { PCI_DEVICE(0x1f40, 0x1202), /* Netac Technologies Co. NV3000 NVMe SSD */ 4221 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4222 { PCI_DEVICE(0x1f40, 0x5236), /* Netac Technologies Co. NV7000 NVMe SSD */ 4223 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4224 { PCI_DEVICE(0x1e4B, 0x1001), /* MAXIO MAP1001 */ 4225 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4226 { PCI_DEVICE(0x1e4B, 0x1002), /* MAXIO MAP1002 */ 4227 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4228 { PCI_DEVICE(0x1e4B, 0x1202), /* MAXIO MAP1202 */ 4229 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4230 { PCI_DEVICE(0x1e4B, 0x1602), /* MAXIO MAP1602 */ 4231 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4232 { PCI_DEVICE(0x1cc1, 0x5350), /* ADATA XPG GAMMIX S50 */ 4233 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4234 { PCI_DEVICE(0x1dbe, 0x5216), /* Acer/INNOGRIT FA100/5216 NVMe SSD */ 4235 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4236 { PCI_DEVICE(0x1dbe, 0x5236), /* ADATA XPG GAMMIX S70 */ 4237 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4238 { PCI_DEVICE(0x1e49, 0x0021), /* ZHITAI TiPro5000 NVMe SSD */ 4239 .driver_data = NVME_QUIRK_NO_DEEPEST_PS, }, 4240 { PCI_DEVICE(0x1e49, 0x0041), /* ZHITAI TiPro7000 NVMe SSD */ 4241 .driver_data = NVME_QUIRK_NO_DEEPEST_PS, }, 4242 { PCI_DEVICE(0x1fa0, 0x2283), /* Wodposit WPBSNM8-256GTP */ 4243 .driver_data = NVME_QUIRK_NO_SECONDARY_TEMP_THRESH, }, 4244 { PCI_DEVICE(0x025e, 0xf1ac), /* SOLIDIGM P44 pro SSDPFKKW020X7 */ 4245 .driver_data = NVME_QUIRK_NO_DEEPEST_PS, }, 4246 { PCI_DEVICE(0xc0a9, 0x540a), /* Crucial P2 */ 4247 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4248 { PCI_DEVICE(0x1d97, 0x2263), /* Lexar NM610 */ 4249 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4250 { PCI_DEVICE(0x1d97, 0x1d97), /* Lexar NM620 */ 4251 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4252 { PCI_DEVICE(0x1d97, 0x2269), /* Lexar NM760 */ 4253 .driver_data = NVME_QUIRK_BOGUS_NID | 4254 NVME_QUIRK_IGNORE_DEV_SUBNQN, }, 4255 { PCI_DEVICE(0x10ec, 0x5763), /* TEAMGROUP T-FORCE CARDEA ZERO Z330 SSD */ 4256 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4257 { PCI_DEVICE(0x1e4b, 0x1602), /* HS-SSD-FUTURE 2048G */ 4258 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4259 { PCI_DEVICE(0x10ec, 0x5765), /* TEAMGROUP MP33 2TB SSD */ 4260 .driver_data = NVME_QUIRK_BOGUS_NID, }, 4261 { PCI_DEVICE(PCI_VENDOR_ID_AMAZON, 0x0061), 4262 .driver_data = NVME_QUIRK_DMA_ADDRESS_BITS_48, }, 4263 { PCI_DEVICE(PCI_VENDOR_ID_AMAZON, 0x0065), 4264 .driver_data = NVME_QUIRK_DMA_ADDRESS_BITS_48, }, 4265 { PCI_DEVICE(PCI_VENDOR_ID_AMAZON, 0x8061), 4266 .driver_data = NVME_QUIRK_DMA_ADDRESS_BITS_48, }, 4267 { PCI_DEVICE(PCI_VENDOR_ID_AMAZON, 0xcd00), 4268 .driver_data = NVME_QUIRK_DMA_ADDRESS_BITS_48, }, 4269 { PCI_DEVICE(PCI_VENDOR_ID_AMAZON, 0xcd01), 4270 .driver_data = NVME_QUIRK_DMA_ADDRESS_BITS_48, }, 4271 { PCI_DEVICE(PCI_VENDOR_ID_AMAZON, 0xcd02), 4272 .driver_data = NVME_QUIRK_DMA_ADDRESS_BITS_48, }, 4273 { PCI_DEVICE(PCI_VENDOR_ID_APPLE, 0x2001), 4274 /* 4275 * Fix for the Apple controller found in the MacBook8,1 and 4276 * some MacBook7,1 to avoid controller resets and data loss. 4277 */ 4278 .driver_data = NVME_QUIRK_SINGLE_VECTOR | 4279 NVME_QUIRK_QDEPTH_ONE }, 4280 { PCI_DEVICE(PCI_VENDOR_ID_APPLE, 0x2003) }, 4281 { PCI_DEVICE(PCI_VENDOR_ID_APPLE, 0x2005), 4282 .driver_data = NVME_QUIRK_SINGLE_VECTOR | 4283 NVME_QUIRK_128_BYTES_SQES | 4284 NVME_QUIRK_SHARED_TAGS | 4285 NVME_QUIRK_SKIP_CID_GEN | 4286 NVME_QUIRK_IDENTIFY_CNS }, 4287 { PCI_DEVICE_CLASS(PCI_CLASS_STORAGE_EXPRESS, 0xffffff) }, 4288 { 0, } 4289 }; 4290 MODULE_DEVICE_TABLE(pci, nvme_id_table); 4291 4292 static struct pci_driver nvme_driver = { 4293 .name = "nvme", 4294 .id_table = nvme_id_table, 4295 .probe = nvme_probe, 4296 .remove = nvme_remove, 4297 .shutdown = nvme_shutdown, 4298 .driver = { 4299 .probe_type = PROBE_PREFER_ASYNCHRONOUS, 4300 #ifdef CONFIG_PM_SLEEP 4301 .pm = &nvme_dev_pm_ops, 4302 #endif 4303 }, 4304 .sriov_configure = pci_sriov_configure_simple, 4305 .err_handler = &nvme_err_handler, 4306 }; 4307 4308 static int __init nvme_init(void) 4309 { 4310 BUILD_BUG_ON(sizeof(struct nvme_create_cq) != 64); 4311 BUILD_BUG_ON(sizeof(struct nvme_create_sq) != 64); 4312 BUILD_BUG_ON(sizeof(struct nvme_delete_queue) != 64); 4313 BUILD_BUG_ON(IRQ_AFFINITY_MAX_SETS < 2); 4314 4315 return pci_register_driver(&nvme_driver); 4316 } 4317 4318 static void __exit nvme_exit(void) 4319 { 4320 kfree(nvme_pci_quirk_list); 4321 pci_unregister_driver(&nvme_driver); 4322 flush_workqueue(nvme_wq); 4323 } 4324 4325 MODULE_AUTHOR("Matthew Wilcox <willy@linux.intel.com>"); 4326 MODULE_LICENSE("GPL"); 4327 MODULE_VERSION("1.0"); 4328 MODULE_DESCRIPTION("NVMe host PCIe transport driver"); 4329 module_init(nvme_init); 4330 module_exit(nvme_exit); 4331