| // SPDX-License-Identifier: GPL-2.0 |
| /* Copyright(c) 2019 Intel Corporation. All rights rsvd. */ |
| #include <linux/init.h> |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/slab.h> |
| #include <linux/pci.h> |
| #include <linux/interrupt.h> |
| #include <linux/delay.h> |
| #include <linux/dma-mapping.h> |
| #include <linux/workqueue.h> |
| #include <linux/aer.h> |
| #include <linux/fs.h> |
| #include <linux/io-64-nonatomic-lo-hi.h> |
| #include <linux/device.h> |
| #include <linux/idr.h> |
| #include <linux/intel-svm.h> |
| #include <linux/iommu.h> |
| #include <uapi/linux/idxd.h> |
| #include <linux/dmaengine.h> |
| #include "../dmaengine.h" |
| #include "registers.h" |
| #include "idxd.h" |
| #include "perfmon.h" |
| |
| MODULE_VERSION(IDXD_DRIVER_VERSION); |
| MODULE_LICENSE("GPL v2"); |
| MODULE_AUTHOR("Intel Corporation"); |
| MODULE_IMPORT_NS(IDXD); |
| |
| static bool sva = true; |
| module_param(sva, bool, 0644); |
| MODULE_PARM_DESC(sva, "Toggle SVA support on/off"); |
| |
| bool tc_override; |
| module_param(tc_override, bool, 0644); |
| MODULE_PARM_DESC(tc_override, "Override traffic class defaults"); |
| |
| #define DRV_NAME "idxd" |
| |
| bool support_enqcmd; |
| DEFINE_IDA(idxd_ida); |
| |
| static struct idxd_driver_data idxd_driver_data[] = { |
| [IDXD_TYPE_DSA] = { |
| .name_prefix = "dsa", |
| .type = IDXD_TYPE_DSA, |
| .compl_size = sizeof(struct dsa_completion_record), |
| .align = 32, |
| .dev_type = &dsa_device_type, |
| }, |
| [IDXD_TYPE_IAX] = { |
| .name_prefix = "iax", |
| .type = IDXD_TYPE_IAX, |
| .compl_size = sizeof(struct iax_completion_record), |
| .align = 64, |
| .dev_type = &iax_device_type, |
| }, |
| }; |
| |
| static struct pci_device_id idxd_pci_tbl[] = { |
| /* DSA ver 1.0 platforms */ |
| { PCI_DEVICE_DATA(INTEL, DSA_SPR0, &idxd_driver_data[IDXD_TYPE_DSA]) }, |
| |
| /* IAX ver 1.0 platforms */ |
| { PCI_DEVICE_DATA(INTEL, IAX_SPR0, &idxd_driver_data[IDXD_TYPE_IAX]) }, |
| { 0, } |
| }; |
| MODULE_DEVICE_TABLE(pci, idxd_pci_tbl); |
| |
| static int idxd_setup_interrupts(struct idxd_device *idxd) |
| { |
| struct pci_dev *pdev = idxd->pdev; |
| struct device *dev = &pdev->dev; |
| struct idxd_irq_entry *ie; |
| int i, msixcnt; |
| int rc = 0; |
| |
| msixcnt = pci_msix_vec_count(pdev); |
| if (msixcnt < 0) { |
| dev_err(dev, "Not MSI-X interrupt capable.\n"); |
| return -ENOSPC; |
| } |
| idxd->irq_cnt = msixcnt; |
| |
| rc = pci_alloc_irq_vectors(pdev, msixcnt, msixcnt, PCI_IRQ_MSIX); |
| if (rc != msixcnt) { |
| dev_err(dev, "Failed enabling %d MSIX entries: %d\n", msixcnt, rc); |
| return -ENOSPC; |
| } |
| dev_dbg(dev, "Enabled %d msix vectors\n", msixcnt); |
| |
| |
| ie = idxd_get_ie(idxd, 0); |
| ie->vector = pci_irq_vector(pdev, 0); |
| rc = request_threaded_irq(ie->vector, NULL, idxd_misc_thread, 0, "idxd-misc", ie); |
| if (rc < 0) { |
| dev_err(dev, "Failed to allocate misc interrupt.\n"); |
| goto err_misc_irq; |
| } |
| dev_dbg(dev, "Requested idxd-misc handler on msix vector %d\n", ie->vector); |
| |
| for (i = 0; i < idxd->max_wqs; i++) { |
| int msix_idx = i + 1; |
| |
| ie = idxd_get_ie(idxd, msix_idx); |
| ie->id = msix_idx; |
| ie->int_handle = INVALID_INT_HANDLE; |
| ie->pasid = INVALID_IOASID; |
| |
| spin_lock_init(&ie->list_lock); |
| init_llist_head(&ie->pending_llist); |
| INIT_LIST_HEAD(&ie->work_list); |
| } |
| |
| idxd_unmask_error_interrupts(idxd); |
| return 0; |
| |
| err_misc_irq: |
| idxd_mask_error_interrupts(idxd); |
| pci_free_irq_vectors(pdev); |
| dev_err(dev, "No usable interrupts\n"); |
| return rc; |
| } |
| |
| static void idxd_cleanup_interrupts(struct idxd_device *idxd) |
| { |
| struct pci_dev *pdev = idxd->pdev; |
| struct idxd_irq_entry *ie; |
| int msixcnt; |
| |
| msixcnt = pci_msix_vec_count(pdev); |
| if (msixcnt <= 0) |
| return; |
| |
| ie = idxd_get_ie(idxd, 0); |
| idxd_mask_error_interrupts(idxd); |
| free_irq(ie->vector, ie); |
| pci_free_irq_vectors(pdev); |
| } |
| |
| static int idxd_setup_wqs(struct idxd_device *idxd) |
| { |
| struct device *dev = &idxd->pdev->dev; |
| struct idxd_wq *wq; |
| struct device *conf_dev; |
| int i, rc; |
| |
| idxd->wqs = kcalloc_node(idxd->max_wqs, sizeof(struct idxd_wq *), |
| GFP_KERNEL, dev_to_node(dev)); |
| if (!idxd->wqs) |
| return -ENOMEM; |
| |
| for (i = 0; i < idxd->max_wqs; i++) { |
| wq = kzalloc_node(sizeof(*wq), GFP_KERNEL, dev_to_node(dev)); |
| if (!wq) { |
| rc = -ENOMEM; |
| goto err; |
| } |
| |
| idxd_dev_set_type(&wq->idxd_dev, IDXD_DEV_WQ); |
| conf_dev = wq_confdev(wq); |
| wq->id = i; |
| wq->idxd = idxd; |
| device_initialize(wq_confdev(wq)); |
| conf_dev->parent = idxd_confdev(idxd); |
| conf_dev->bus = &dsa_bus_type; |
| conf_dev->type = &idxd_wq_device_type; |
| rc = dev_set_name(conf_dev, "wq%d.%d", idxd->id, wq->id); |
| if (rc < 0) { |
| put_device(conf_dev); |
| goto err; |
| } |
| |
| mutex_init(&wq->wq_lock); |
| init_waitqueue_head(&wq->err_queue); |
| init_completion(&wq->wq_dead); |
| init_completion(&wq->wq_resurrect); |
| wq->max_xfer_bytes = WQ_DEFAULT_MAX_XFER; |
| wq->max_batch_size = WQ_DEFAULT_MAX_BATCH; |
| wq->enqcmds_retries = IDXD_ENQCMDS_RETRIES; |
| wq->wqcfg = kzalloc_node(idxd->wqcfg_size, GFP_KERNEL, dev_to_node(dev)); |
| if (!wq->wqcfg) { |
| put_device(conf_dev); |
| rc = -ENOMEM; |
| goto err; |
| } |
| idxd->wqs[i] = wq; |
| } |
| |
| return 0; |
| |
| err: |
| while (--i >= 0) { |
| wq = idxd->wqs[i]; |
| conf_dev = wq_confdev(wq); |
| put_device(conf_dev); |
| } |
| return rc; |
| } |
| |
| static int idxd_setup_engines(struct idxd_device *idxd) |
| { |
| struct idxd_engine *engine; |
| struct device *dev = &idxd->pdev->dev; |
| struct device *conf_dev; |
| int i, rc; |
| |
| idxd->engines = kcalloc_node(idxd->max_engines, sizeof(struct idxd_engine *), |
| GFP_KERNEL, dev_to_node(dev)); |
| if (!idxd->engines) |
| return -ENOMEM; |
| |
| for (i = 0; i < idxd->max_engines; i++) { |
| engine = kzalloc_node(sizeof(*engine), GFP_KERNEL, dev_to_node(dev)); |
| if (!engine) { |
| rc = -ENOMEM; |
| goto err; |
| } |
| |
| idxd_dev_set_type(&engine->idxd_dev, IDXD_DEV_ENGINE); |
| conf_dev = engine_confdev(engine); |
| engine->id = i; |
| engine->idxd = idxd; |
| device_initialize(conf_dev); |
| conf_dev->parent = idxd_confdev(idxd); |
| conf_dev->bus = &dsa_bus_type; |
| conf_dev->type = &idxd_engine_device_type; |
| rc = dev_set_name(conf_dev, "engine%d.%d", idxd->id, engine->id); |
| if (rc < 0) { |
| put_device(conf_dev); |
| goto err; |
| } |
| |
| idxd->engines[i] = engine; |
| } |
| |
| return 0; |
| |
| err: |
| while (--i >= 0) { |
| engine = idxd->engines[i]; |
| conf_dev = engine_confdev(engine); |
| put_device(conf_dev); |
| } |
| return rc; |
| } |
| |
| static int idxd_setup_groups(struct idxd_device *idxd) |
| { |
| struct device *dev = &idxd->pdev->dev; |
| struct device *conf_dev; |
| struct idxd_group *group; |
| int i, rc; |
| |
| idxd->groups = kcalloc_node(idxd->max_groups, sizeof(struct idxd_group *), |
| GFP_KERNEL, dev_to_node(dev)); |
| if (!idxd->groups) |
| return -ENOMEM; |
| |
| for (i = 0; i < idxd->max_groups; i++) { |
| group = kzalloc_node(sizeof(*group), GFP_KERNEL, dev_to_node(dev)); |
| if (!group) { |
| rc = -ENOMEM; |
| goto err; |
| } |
| |
| idxd_dev_set_type(&group->idxd_dev, IDXD_DEV_GROUP); |
| conf_dev = group_confdev(group); |
| group->id = i; |
| group->idxd = idxd; |
| device_initialize(conf_dev); |
| conf_dev->parent = idxd_confdev(idxd); |
| conf_dev->bus = &dsa_bus_type; |
| conf_dev->type = &idxd_group_device_type; |
| rc = dev_set_name(conf_dev, "group%d.%d", idxd->id, group->id); |
| if (rc < 0) { |
| put_device(conf_dev); |
| goto err; |
| } |
| |
| idxd->groups[i] = group; |
| if (idxd->hw.version < DEVICE_VERSION_2 && !tc_override) { |
| group->tc_a = 1; |
| group->tc_b = 1; |
| } else { |
| group->tc_a = -1; |
| group->tc_b = -1; |
| } |
| } |
| |
| return 0; |
| |
| err: |
| while (--i >= 0) { |
| group = idxd->groups[i]; |
| put_device(group_confdev(group)); |
| } |
| return rc; |
| } |
| |
| static void idxd_cleanup_internals(struct idxd_device *idxd) |
| { |
| int i; |
| |
| for (i = 0; i < idxd->max_groups; i++) |
| put_device(group_confdev(idxd->groups[i])); |
| for (i = 0; i < idxd->max_engines; i++) |
| put_device(engine_confdev(idxd->engines[i])); |
| for (i = 0; i < idxd->max_wqs; i++) |
| put_device(wq_confdev(idxd->wqs[i])); |
| destroy_workqueue(idxd->wq); |
| } |
| |
| static int idxd_setup_internals(struct idxd_device *idxd) |
| { |
| struct device *dev = &idxd->pdev->dev; |
| int rc, i; |
| |
| init_waitqueue_head(&idxd->cmd_waitq); |
| |
| rc = idxd_setup_wqs(idxd); |
| if (rc < 0) |
| goto err_wqs; |
| |
| rc = idxd_setup_engines(idxd); |
| if (rc < 0) |
| goto err_engine; |
| |
| rc = idxd_setup_groups(idxd); |
| if (rc < 0) |
| goto err_group; |
| |
| idxd->wq = create_workqueue(dev_name(dev)); |
| if (!idxd->wq) { |
| rc = -ENOMEM; |
| goto err_wkq_create; |
| } |
| |
| return 0; |
| |
| err_wkq_create: |
| for (i = 0; i < idxd->max_groups; i++) |
| put_device(group_confdev(idxd->groups[i])); |
| err_group: |
| for (i = 0; i < idxd->max_engines; i++) |
| put_device(engine_confdev(idxd->engines[i])); |
| err_engine: |
| for (i = 0; i < idxd->max_wqs; i++) |
| put_device(wq_confdev(idxd->wqs[i])); |
| err_wqs: |
| return rc; |
| } |
| |
| static void idxd_read_table_offsets(struct idxd_device *idxd) |
| { |
| union offsets_reg offsets; |
| struct device *dev = &idxd->pdev->dev; |
| |
| offsets.bits[0] = ioread64(idxd->reg_base + IDXD_TABLE_OFFSET); |
| offsets.bits[1] = ioread64(idxd->reg_base + IDXD_TABLE_OFFSET + sizeof(u64)); |
| idxd->grpcfg_offset = offsets.grpcfg * IDXD_TABLE_MULT; |
| dev_dbg(dev, "IDXD Group Config Offset: %#x\n", idxd->grpcfg_offset); |
| idxd->wqcfg_offset = offsets.wqcfg * IDXD_TABLE_MULT; |
| dev_dbg(dev, "IDXD Work Queue Config Offset: %#x\n", idxd->wqcfg_offset); |
| idxd->msix_perm_offset = offsets.msix_perm * IDXD_TABLE_MULT; |
| dev_dbg(dev, "IDXD MSIX Permission Offset: %#x\n", idxd->msix_perm_offset); |
| idxd->perfmon_offset = offsets.perfmon * IDXD_TABLE_MULT; |
| dev_dbg(dev, "IDXD Perfmon Offset: %#x\n", idxd->perfmon_offset); |
| } |
| |
| static void idxd_read_caps(struct idxd_device *idxd) |
| { |
| struct device *dev = &idxd->pdev->dev; |
| int i; |
| |
| /* reading generic capabilities */ |
| idxd->hw.gen_cap.bits = ioread64(idxd->reg_base + IDXD_GENCAP_OFFSET); |
| dev_dbg(dev, "gen_cap: %#llx\n", idxd->hw.gen_cap.bits); |
| |
| if (idxd->hw.gen_cap.cmd_cap) { |
| idxd->hw.cmd_cap = ioread32(idxd->reg_base + IDXD_CMDCAP_OFFSET); |
| dev_dbg(dev, "cmd_cap: %#x\n", idxd->hw.cmd_cap); |
| } |
| |
| /* reading command capabilities */ |
| if (idxd->hw.cmd_cap & BIT(IDXD_CMD_REQUEST_INT_HANDLE)) |
| idxd->request_int_handles = true; |
| |
| idxd->max_xfer_bytes = 1ULL << idxd->hw.gen_cap.max_xfer_shift; |
| dev_dbg(dev, "max xfer size: %llu bytes\n", idxd->max_xfer_bytes); |
| idxd->max_batch_size = 1U << idxd->hw.gen_cap.max_batch_shift; |
| dev_dbg(dev, "max batch size: %u\n", idxd->max_batch_size); |
| if (idxd->hw.gen_cap.config_en) |
| set_bit(IDXD_FLAG_CONFIGURABLE, &idxd->flags); |
| |
| /* reading group capabilities */ |
| idxd->hw.group_cap.bits = |
| ioread64(idxd->reg_base + IDXD_GRPCAP_OFFSET); |
| dev_dbg(dev, "group_cap: %#llx\n", idxd->hw.group_cap.bits); |
| idxd->max_groups = idxd->hw.group_cap.num_groups; |
| dev_dbg(dev, "max groups: %u\n", idxd->max_groups); |
| idxd->max_rdbufs = idxd->hw.group_cap.total_rdbufs; |
| dev_dbg(dev, "max read buffers: %u\n", idxd->max_rdbufs); |
| idxd->nr_rdbufs = idxd->max_rdbufs; |
| |
| /* read engine capabilities */ |
| idxd->hw.engine_cap.bits = |
| ioread64(idxd->reg_base + IDXD_ENGCAP_OFFSET); |
| dev_dbg(dev, "engine_cap: %#llx\n", idxd->hw.engine_cap.bits); |
| idxd->max_engines = idxd->hw.engine_cap.num_engines; |
| dev_dbg(dev, "max engines: %u\n", idxd->max_engines); |
| |
| /* read workqueue capabilities */ |
| idxd->hw.wq_cap.bits = ioread64(idxd->reg_base + IDXD_WQCAP_OFFSET); |
| dev_dbg(dev, "wq_cap: %#llx\n", idxd->hw.wq_cap.bits); |
| idxd->max_wq_size = idxd->hw.wq_cap.total_wq_size; |
| dev_dbg(dev, "total workqueue size: %u\n", idxd->max_wq_size); |
| idxd->max_wqs = idxd->hw.wq_cap.num_wqs; |
| dev_dbg(dev, "max workqueues: %u\n", idxd->max_wqs); |
| idxd->wqcfg_size = 1 << (idxd->hw.wq_cap.wqcfg_size + IDXD_WQCFG_MIN); |
| dev_dbg(dev, "wqcfg size: %u\n", idxd->wqcfg_size); |
| |
| /* reading operation capabilities */ |
| for (i = 0; i < 4; i++) { |
| idxd->hw.opcap.bits[i] = ioread64(idxd->reg_base + |
| IDXD_OPCAP_OFFSET + i * sizeof(u64)); |
| dev_dbg(dev, "opcap[%d]: %#llx\n", i, idxd->hw.opcap.bits[i]); |
| } |
| } |
| |
| static struct idxd_device *idxd_alloc(struct pci_dev *pdev, struct idxd_driver_data *data) |
| { |
| struct device *dev = &pdev->dev; |
| struct device *conf_dev; |
| struct idxd_device *idxd; |
| int rc; |
| |
| idxd = kzalloc_node(sizeof(*idxd), GFP_KERNEL, dev_to_node(dev)); |
| if (!idxd) |
| return NULL; |
| |
| conf_dev = idxd_confdev(idxd); |
| idxd->pdev = pdev; |
| idxd->data = data; |
| idxd_dev_set_type(&idxd->idxd_dev, idxd->data->type); |
| idxd->id = ida_alloc(&idxd_ida, GFP_KERNEL); |
| if (idxd->id < 0) |
| return NULL; |
| |
| device_initialize(conf_dev); |
| conf_dev->parent = dev; |
| conf_dev->bus = &dsa_bus_type; |
| conf_dev->type = idxd->data->dev_type; |
| rc = dev_set_name(conf_dev, "%s%d", idxd->data->name_prefix, idxd->id); |
| if (rc < 0) { |
| put_device(conf_dev); |
| return NULL; |
| } |
| |
| spin_lock_init(&idxd->dev_lock); |
| spin_lock_init(&idxd->cmd_lock); |
| |
| return idxd; |
| } |
| |
| static int idxd_enable_system_pasid(struct idxd_device *idxd) |
| { |
| int flags; |
| unsigned int pasid; |
| struct iommu_sva *sva; |
| |
| flags = SVM_FLAG_SUPERVISOR_MODE; |
| |
| sva = iommu_sva_bind_device(&idxd->pdev->dev, NULL, &flags); |
| if (IS_ERR(sva)) { |
| dev_warn(&idxd->pdev->dev, |
| "iommu sva bind failed: %ld\n", PTR_ERR(sva)); |
| return PTR_ERR(sva); |
| } |
| |
| pasid = iommu_sva_get_pasid(sva); |
| if (pasid == IOMMU_PASID_INVALID) { |
| iommu_sva_unbind_device(sva); |
| return -ENODEV; |
| } |
| |
| idxd->sva = sva; |
| idxd->pasid = pasid; |
| dev_dbg(&idxd->pdev->dev, "system pasid: %u\n", pasid); |
| return 0; |
| } |
| |
| static void idxd_disable_system_pasid(struct idxd_device *idxd) |
| { |
| |
| iommu_sva_unbind_device(idxd->sva); |
| idxd->sva = NULL; |
| } |
| |
| static int idxd_probe(struct idxd_device *idxd) |
| { |
| struct pci_dev *pdev = idxd->pdev; |
| struct device *dev = &pdev->dev; |
| int rc; |
| |
| dev_dbg(dev, "%s entered and resetting device\n", __func__); |
| rc = idxd_device_init_reset(idxd); |
| if (rc < 0) |
| return rc; |
| |
| dev_dbg(dev, "IDXD reset complete\n"); |
| |
| if (IS_ENABLED(CONFIG_INTEL_IDXD_SVM) && sva) { |
| rc = iommu_dev_enable_feature(dev, IOMMU_DEV_FEAT_SVA); |
| if (rc == 0) { |
| rc = idxd_enable_system_pasid(idxd); |
| if (rc < 0) { |
| iommu_dev_disable_feature(dev, IOMMU_DEV_FEAT_SVA); |
| dev_warn(dev, "Failed to enable PASID. No SVA support: %d\n", rc); |
| } else { |
| set_bit(IDXD_FLAG_PASID_ENABLED, &idxd->flags); |
| } |
| } else { |
| dev_warn(dev, "Unable to turn on SVA feature.\n"); |
| } |
| } else if (!sva) { |
| dev_warn(dev, "User forced SVA off via module param.\n"); |
| } |
| |
| idxd_read_caps(idxd); |
| idxd_read_table_offsets(idxd); |
| |
| rc = idxd_setup_internals(idxd); |
| if (rc) |
| goto err; |
| |
| /* If the configs are readonly, then load them from device */ |
| if (!test_bit(IDXD_FLAG_CONFIGURABLE, &idxd->flags)) { |
| dev_dbg(dev, "Loading RO device config\n"); |
| rc = idxd_device_load_config(idxd); |
| if (rc < 0) |
| goto err_config; |
| } |
| |
| rc = idxd_setup_interrupts(idxd); |
| if (rc) |
| goto err_config; |
| |
| idxd->major = idxd_cdev_get_major(idxd); |
| |
| rc = perfmon_pmu_init(idxd); |
| if (rc < 0) |
| dev_warn(dev, "Failed to initialize perfmon. No PMU support: %d\n", rc); |
| |
| dev_dbg(dev, "IDXD device %d probed successfully\n", idxd->id); |
| return 0; |
| |
| err_config: |
| idxd_cleanup_internals(idxd); |
| err: |
| if (device_pasid_enabled(idxd)) |
| idxd_disable_system_pasid(idxd); |
| iommu_dev_disable_feature(dev, IOMMU_DEV_FEAT_SVA); |
| return rc; |
| } |
| |
| static void idxd_cleanup(struct idxd_device *idxd) |
| { |
| struct device *dev = &idxd->pdev->dev; |
| |
| perfmon_pmu_remove(idxd); |
| idxd_cleanup_interrupts(idxd); |
| idxd_cleanup_internals(idxd); |
| if (device_pasid_enabled(idxd)) |
| idxd_disable_system_pasid(idxd); |
| iommu_dev_disable_feature(dev, IOMMU_DEV_FEAT_SVA); |
| } |
| |
| static int idxd_pci_probe(struct pci_dev *pdev, const struct pci_device_id *id) |
| { |
| struct device *dev = &pdev->dev; |
| struct idxd_device *idxd; |
| struct idxd_driver_data *data = (struct idxd_driver_data *)id->driver_data; |
| int rc; |
| |
| rc = pci_enable_device(pdev); |
| if (rc) |
| return rc; |
| |
| dev_dbg(dev, "Alloc IDXD context\n"); |
| idxd = idxd_alloc(pdev, data); |
| if (!idxd) { |
| rc = -ENOMEM; |
| goto err_idxd_alloc; |
| } |
| |
| dev_dbg(dev, "Mapping BARs\n"); |
| idxd->reg_base = pci_iomap(pdev, IDXD_MMIO_BAR, 0); |
| if (!idxd->reg_base) { |
| rc = -ENOMEM; |
| goto err_iomap; |
| } |
| |
| dev_dbg(dev, "Set DMA masks\n"); |
| rc = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64)); |
| if (rc) |
| rc = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32)); |
| if (rc) |
| goto err; |
| |
| dev_dbg(dev, "Set PCI master\n"); |
| pci_set_master(pdev); |
| pci_set_drvdata(pdev, idxd); |
| |
| idxd->hw.version = ioread32(idxd->reg_base + IDXD_VER_OFFSET); |
| rc = idxd_probe(idxd); |
| if (rc) { |
| dev_err(dev, "Intel(R) IDXD DMA Engine init failed\n"); |
| goto err; |
| } |
| |
| rc = idxd_register_devices(idxd); |
| if (rc) { |
| dev_err(dev, "IDXD sysfs setup failed\n"); |
| goto err_dev_register; |
| } |
| |
| dev_info(&pdev->dev, "Intel(R) Accelerator Device (v%x)\n", |
| idxd->hw.version); |
| |
| return 0; |
| |
| err_dev_register: |
| idxd_cleanup(idxd); |
| err: |
| pci_iounmap(pdev, idxd->reg_base); |
| err_iomap: |
| put_device(idxd_confdev(idxd)); |
| err_idxd_alloc: |
| pci_disable_device(pdev); |
| return rc; |
| } |
| |
| void idxd_wqs_quiesce(struct idxd_device *idxd) |
| { |
| struct idxd_wq *wq; |
| int i; |
| |
| for (i = 0; i < idxd->max_wqs; i++) { |
| wq = idxd->wqs[i]; |
| if (wq->state == IDXD_WQ_ENABLED && wq->type == IDXD_WQT_KERNEL) |
| idxd_wq_quiesce(wq); |
| } |
| } |
| |
| static void idxd_shutdown(struct pci_dev *pdev) |
| { |
| struct idxd_device *idxd = pci_get_drvdata(pdev); |
| struct idxd_irq_entry *irq_entry; |
| int rc; |
| |
| rc = idxd_device_disable(idxd); |
| if (rc) |
| dev_err(&pdev->dev, "Disabling device failed\n"); |
| |
| irq_entry = &idxd->ie; |
| synchronize_irq(irq_entry->vector); |
| idxd_mask_error_interrupts(idxd); |
| flush_workqueue(idxd->wq); |
| } |
| |
| static void idxd_remove(struct pci_dev *pdev) |
| { |
| struct idxd_device *idxd = pci_get_drvdata(pdev); |
| struct idxd_irq_entry *irq_entry; |
| |
| idxd_unregister_devices(idxd); |
| /* |
| * When ->release() is called for the idxd->conf_dev, it frees all the memory related |
| * to the idxd context. The driver still needs those bits in order to do the rest of |
| * the cleanup. However, we do need to unbound the idxd sub-driver. So take a ref |
| * on the device here to hold off the freeing while allowing the idxd sub-driver |
| * to unbind. |
| */ |
| get_device(idxd_confdev(idxd)); |
| device_unregister(idxd_confdev(idxd)); |
| idxd_shutdown(pdev); |
| if (device_pasid_enabled(idxd)) |
| idxd_disable_system_pasid(idxd); |
| |
| irq_entry = idxd_get_ie(idxd, 0); |
| free_irq(irq_entry->vector, irq_entry); |
| pci_free_irq_vectors(pdev); |
| pci_iounmap(pdev, idxd->reg_base); |
| iommu_dev_disable_feature(&pdev->dev, IOMMU_DEV_FEAT_SVA); |
| pci_disable_device(pdev); |
| destroy_workqueue(idxd->wq); |
| perfmon_pmu_remove(idxd); |
| put_device(idxd_confdev(idxd)); |
| } |
| |
| static struct pci_driver idxd_pci_driver = { |
| .name = DRV_NAME, |
| .id_table = idxd_pci_tbl, |
| .probe = idxd_pci_probe, |
| .remove = idxd_remove, |
| .shutdown = idxd_shutdown, |
| }; |
| |
| static int __init idxd_init_module(void) |
| { |
| int err; |
| |
| /* |
| * If the CPU does not support MOVDIR64B or ENQCMDS, there's no point in |
| * enumerating the device. We can not utilize it. |
| */ |
| if (!cpu_feature_enabled(X86_FEATURE_MOVDIR64B)) { |
| pr_warn("idxd driver failed to load without MOVDIR64B.\n"); |
| return -ENODEV; |
| } |
| |
| if (!cpu_feature_enabled(X86_FEATURE_ENQCMD)) |
| pr_warn("Platform does not have ENQCMD(S) support.\n"); |
| else |
| support_enqcmd = true; |
| |
| perfmon_init(); |
| |
| err = idxd_driver_register(&idxd_drv); |
| if (err < 0) |
| goto err_idxd_driver_register; |
| |
| err = idxd_driver_register(&idxd_dmaengine_drv); |
| if (err < 0) |
| goto err_idxd_dmaengine_driver_register; |
| |
| err = idxd_driver_register(&idxd_user_drv); |
| if (err < 0) |
| goto err_idxd_user_driver_register; |
| |
| err = idxd_cdev_register(); |
| if (err) |
| goto err_cdev_register; |
| |
| err = pci_register_driver(&idxd_pci_driver); |
| if (err) |
| goto err_pci_register; |
| |
| return 0; |
| |
| err_pci_register: |
| idxd_cdev_remove(); |
| err_cdev_register: |
| idxd_driver_unregister(&idxd_user_drv); |
| err_idxd_user_driver_register: |
| idxd_driver_unregister(&idxd_dmaengine_drv); |
| err_idxd_dmaengine_driver_register: |
| idxd_driver_unregister(&idxd_drv); |
| err_idxd_driver_register: |
| return err; |
| } |
| module_init(idxd_init_module); |
| |
| static void __exit idxd_exit_module(void) |
| { |
| idxd_driver_unregister(&idxd_user_drv); |
| idxd_driver_unregister(&idxd_dmaengine_drv); |
| idxd_driver_unregister(&idxd_drv); |
| pci_unregister_driver(&idxd_pci_driver); |
| idxd_cdev_remove(); |
| perfmon_exit(); |
| } |
| module_exit(idxd_exit_module); |