| // SPDX-License-Identifier: GPL-2.0-only |
| /* Copyright(c) 2020 Intel Corporation. All rights reserved. */ |
| #include <linux/platform_device.h> |
| #include <linux/memregion.h> |
| #include <linux/workqueue.h> |
| #include <linux/debugfs.h> |
| #include <linux/device.h> |
| #include <linux/module.h> |
| #include <linux/pci.h> |
| #include <linux/slab.h> |
| #include <linux/idr.h> |
| #include <linux/node.h> |
| #include <cxl/einj.h> |
| #include <cxlmem.h> |
| #include <cxlpci.h> |
| #include <cxl.h> |
| #include "core.h" |
| |
| /** |
| * DOC: cxl core |
| * |
| * The CXL core provides a set of interfaces that can be consumed by CXL aware |
| * drivers. The interfaces allow for creation, modification, and destruction of |
| * regions, memory devices, ports, and decoders. CXL aware drivers must register |
| * with the CXL core via these interfaces in order to be able to participate in |
| * cross-device interleave coordination. The CXL core also establishes and |
| * maintains the bridge to the nvdimm subsystem. |
| * |
| * CXL core introduces sysfs hierarchy to control the devices that are |
| * instantiated by the core. |
| */ |
| |
| /* |
| * All changes to the interleave configuration occur with this lock held |
| * for write. |
| */ |
| DECLARE_RWSEM(cxl_region_rwsem); |
| |
| static DEFINE_IDA(cxl_port_ida); |
| static DEFINE_XARRAY(cxl_root_buses); |
| |
| int cxl_num_decoders_committed(struct cxl_port *port) |
| { |
| lockdep_assert_held(&cxl_region_rwsem); |
| |
| return port->commit_end + 1; |
| } |
| |
| static ssize_t devtype_show(struct device *dev, struct device_attribute *attr, |
| char *buf) |
| { |
| return sysfs_emit(buf, "%s\n", dev->type->name); |
| } |
| static DEVICE_ATTR_RO(devtype); |
| |
| static int cxl_device_id(const struct device *dev) |
| { |
| if (dev->type == &cxl_nvdimm_bridge_type) |
| return CXL_DEVICE_NVDIMM_BRIDGE; |
| if (dev->type == &cxl_nvdimm_type) |
| return CXL_DEVICE_NVDIMM; |
| if (dev->type == CXL_PMEM_REGION_TYPE()) |
| return CXL_DEVICE_PMEM_REGION; |
| if (dev->type == CXL_DAX_REGION_TYPE()) |
| return CXL_DEVICE_DAX_REGION; |
| if (is_cxl_port(dev)) { |
| if (is_cxl_root(to_cxl_port(dev))) |
| return CXL_DEVICE_ROOT; |
| return CXL_DEVICE_PORT; |
| } |
| if (is_cxl_memdev(dev)) |
| return CXL_DEVICE_MEMORY_EXPANDER; |
| if (dev->type == CXL_REGION_TYPE()) |
| return CXL_DEVICE_REGION; |
| if (dev->type == &cxl_pmu_type) |
| return CXL_DEVICE_PMU; |
| return 0; |
| } |
| |
| static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, |
| char *buf) |
| { |
| return sysfs_emit(buf, CXL_MODALIAS_FMT "\n", cxl_device_id(dev)); |
| } |
| static DEVICE_ATTR_RO(modalias); |
| |
| static struct attribute *cxl_base_attributes[] = { |
| &dev_attr_devtype.attr, |
| &dev_attr_modalias.attr, |
| NULL, |
| }; |
| |
| struct attribute_group cxl_base_attribute_group = { |
| .attrs = cxl_base_attributes, |
| }; |
| |
| static ssize_t start_show(struct device *dev, struct device_attribute *attr, |
| char *buf) |
| { |
| struct cxl_decoder *cxld = to_cxl_decoder(dev); |
| |
| return sysfs_emit(buf, "%#llx\n", cxld->hpa_range.start); |
| } |
| static DEVICE_ATTR_ADMIN_RO(start); |
| |
| static ssize_t size_show(struct device *dev, struct device_attribute *attr, |
| char *buf) |
| { |
| struct cxl_decoder *cxld = to_cxl_decoder(dev); |
| |
| return sysfs_emit(buf, "%#llx\n", range_len(&cxld->hpa_range)); |
| } |
| static DEVICE_ATTR_RO(size); |
| |
| #define CXL_DECODER_FLAG_ATTR(name, flag) \ |
| static ssize_t name##_show(struct device *dev, \ |
| struct device_attribute *attr, char *buf) \ |
| { \ |
| struct cxl_decoder *cxld = to_cxl_decoder(dev); \ |
| \ |
| return sysfs_emit(buf, "%s\n", \ |
| (cxld->flags & (flag)) ? "1" : "0"); \ |
| } \ |
| static DEVICE_ATTR_RO(name) |
| |
| CXL_DECODER_FLAG_ATTR(cap_pmem, CXL_DECODER_F_PMEM); |
| CXL_DECODER_FLAG_ATTR(cap_ram, CXL_DECODER_F_RAM); |
| CXL_DECODER_FLAG_ATTR(cap_type2, CXL_DECODER_F_TYPE2); |
| CXL_DECODER_FLAG_ATTR(cap_type3, CXL_DECODER_F_TYPE3); |
| CXL_DECODER_FLAG_ATTR(locked, CXL_DECODER_F_LOCK); |
| |
| static ssize_t target_type_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct cxl_decoder *cxld = to_cxl_decoder(dev); |
| |
| switch (cxld->target_type) { |
| case CXL_DECODER_DEVMEM: |
| return sysfs_emit(buf, "accelerator\n"); |
| case CXL_DECODER_HOSTONLYMEM: |
| return sysfs_emit(buf, "expander\n"); |
| } |
| return -ENXIO; |
| } |
| static DEVICE_ATTR_RO(target_type); |
| |
| static ssize_t emit_target_list(struct cxl_switch_decoder *cxlsd, char *buf) |
| { |
| struct cxl_decoder *cxld = &cxlsd->cxld; |
| ssize_t offset = 0; |
| int i, rc = 0; |
| |
| for (i = 0; i < cxld->interleave_ways; i++) { |
| struct cxl_dport *dport = cxlsd->target[i]; |
| struct cxl_dport *next = NULL; |
| |
| if (!dport) |
| break; |
| |
| if (i + 1 < cxld->interleave_ways) |
| next = cxlsd->target[i + 1]; |
| rc = sysfs_emit_at(buf, offset, "%d%s", dport->port_id, |
| next ? "," : ""); |
| if (rc < 0) |
| return rc; |
| offset += rc; |
| } |
| |
| return offset; |
| } |
| |
| static ssize_t target_list_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct cxl_switch_decoder *cxlsd = to_cxl_switch_decoder(dev); |
| ssize_t offset; |
| int rc; |
| |
| guard(rwsem_read)(&cxl_region_rwsem); |
| rc = emit_target_list(cxlsd, buf); |
| if (rc < 0) |
| return rc; |
| offset = rc; |
| |
| rc = sysfs_emit_at(buf, offset, "\n"); |
| if (rc < 0) |
| return rc; |
| |
| return offset + rc; |
| } |
| static DEVICE_ATTR_RO(target_list); |
| |
| static ssize_t mode_show(struct device *dev, struct device_attribute *attr, |
| char *buf) |
| { |
| struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev); |
| |
| return sysfs_emit(buf, "%s\n", cxl_decoder_mode_name(cxled->mode)); |
| } |
| |
| static ssize_t mode_store(struct device *dev, struct device_attribute *attr, |
| const char *buf, size_t len) |
| { |
| struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev); |
| enum cxl_decoder_mode mode; |
| ssize_t rc; |
| |
| if (sysfs_streq(buf, "pmem")) |
| mode = CXL_DECODER_PMEM; |
| else if (sysfs_streq(buf, "ram")) |
| mode = CXL_DECODER_RAM; |
| else |
| return -EINVAL; |
| |
| rc = cxl_dpa_set_mode(cxled, mode); |
| if (rc) |
| return rc; |
| |
| return len; |
| } |
| static DEVICE_ATTR_RW(mode); |
| |
| static ssize_t dpa_resource_show(struct device *dev, struct device_attribute *attr, |
| char *buf) |
| { |
| struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev); |
| |
| guard(rwsem_read)(&cxl_dpa_rwsem); |
| return sysfs_emit(buf, "%#llx\n", (u64)cxl_dpa_resource_start(cxled)); |
| } |
| static DEVICE_ATTR_RO(dpa_resource); |
| |
| static ssize_t dpa_size_show(struct device *dev, struct device_attribute *attr, |
| char *buf) |
| { |
| struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev); |
| resource_size_t size = cxl_dpa_size(cxled); |
| |
| return sysfs_emit(buf, "%pa\n", &size); |
| } |
| |
| static ssize_t dpa_size_store(struct device *dev, struct device_attribute *attr, |
| const char *buf, size_t len) |
| { |
| struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev); |
| unsigned long long size; |
| ssize_t rc; |
| |
| rc = kstrtoull(buf, 0, &size); |
| if (rc) |
| return rc; |
| |
| if (!IS_ALIGNED(size, SZ_256M)) |
| return -EINVAL; |
| |
| rc = cxl_dpa_free(cxled); |
| if (rc) |
| return rc; |
| |
| if (size == 0) |
| return len; |
| |
| rc = cxl_dpa_alloc(cxled, size); |
| if (rc) |
| return rc; |
| |
| return len; |
| } |
| static DEVICE_ATTR_RW(dpa_size); |
| |
| static ssize_t interleave_granularity_show(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct cxl_decoder *cxld = to_cxl_decoder(dev); |
| |
| return sysfs_emit(buf, "%d\n", cxld->interleave_granularity); |
| } |
| |
| static DEVICE_ATTR_RO(interleave_granularity); |
| |
| static ssize_t interleave_ways_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct cxl_decoder *cxld = to_cxl_decoder(dev); |
| |
| return sysfs_emit(buf, "%d\n", cxld->interleave_ways); |
| } |
| |
| static DEVICE_ATTR_RO(interleave_ways); |
| |
| static ssize_t qos_class_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct cxl_root_decoder *cxlrd = to_cxl_root_decoder(dev); |
| |
| return sysfs_emit(buf, "%d\n", cxlrd->qos_class); |
| } |
| static DEVICE_ATTR_RO(qos_class); |
| |
| static struct attribute *cxl_decoder_base_attrs[] = { |
| &dev_attr_start.attr, |
| &dev_attr_size.attr, |
| &dev_attr_locked.attr, |
| &dev_attr_interleave_granularity.attr, |
| &dev_attr_interleave_ways.attr, |
| NULL, |
| }; |
| |
| static struct attribute_group cxl_decoder_base_attribute_group = { |
| .attrs = cxl_decoder_base_attrs, |
| }; |
| |
| static struct attribute *cxl_decoder_root_attrs[] = { |
| &dev_attr_cap_pmem.attr, |
| &dev_attr_cap_ram.attr, |
| &dev_attr_cap_type2.attr, |
| &dev_attr_cap_type3.attr, |
| &dev_attr_target_list.attr, |
| &dev_attr_qos_class.attr, |
| SET_CXL_REGION_ATTR(create_pmem_region) |
| SET_CXL_REGION_ATTR(create_ram_region) |
| SET_CXL_REGION_ATTR(delete_region) |
| NULL, |
| }; |
| |
| static bool can_create_pmem(struct cxl_root_decoder *cxlrd) |
| { |
| unsigned long flags = CXL_DECODER_F_TYPE3 | CXL_DECODER_F_PMEM; |
| |
| return (cxlrd->cxlsd.cxld.flags & flags) == flags; |
| } |
| |
| static bool can_create_ram(struct cxl_root_decoder *cxlrd) |
| { |
| unsigned long flags = CXL_DECODER_F_TYPE3 | CXL_DECODER_F_RAM; |
| |
| return (cxlrd->cxlsd.cxld.flags & flags) == flags; |
| } |
| |
| static umode_t cxl_root_decoder_visible(struct kobject *kobj, struct attribute *a, int n) |
| { |
| struct device *dev = kobj_to_dev(kobj); |
| struct cxl_root_decoder *cxlrd = to_cxl_root_decoder(dev); |
| |
| if (a == CXL_REGION_ATTR(create_pmem_region) && !can_create_pmem(cxlrd)) |
| return 0; |
| |
| if (a == CXL_REGION_ATTR(create_ram_region) && !can_create_ram(cxlrd)) |
| return 0; |
| |
| if (a == CXL_REGION_ATTR(delete_region) && |
| !(can_create_pmem(cxlrd) || can_create_ram(cxlrd))) |
| return 0; |
| |
| return a->mode; |
| } |
| |
| static struct attribute_group cxl_decoder_root_attribute_group = { |
| .attrs = cxl_decoder_root_attrs, |
| .is_visible = cxl_root_decoder_visible, |
| }; |
| |
| static const struct attribute_group *cxl_decoder_root_attribute_groups[] = { |
| &cxl_decoder_root_attribute_group, |
| &cxl_decoder_base_attribute_group, |
| &cxl_base_attribute_group, |
| NULL, |
| }; |
| |
| static struct attribute *cxl_decoder_switch_attrs[] = { |
| &dev_attr_target_type.attr, |
| &dev_attr_target_list.attr, |
| SET_CXL_REGION_ATTR(region) |
| NULL, |
| }; |
| |
| static struct attribute_group cxl_decoder_switch_attribute_group = { |
| .attrs = cxl_decoder_switch_attrs, |
| }; |
| |
| static const struct attribute_group *cxl_decoder_switch_attribute_groups[] = { |
| &cxl_decoder_switch_attribute_group, |
| &cxl_decoder_base_attribute_group, |
| &cxl_base_attribute_group, |
| NULL, |
| }; |
| |
| static struct attribute *cxl_decoder_endpoint_attrs[] = { |
| &dev_attr_target_type.attr, |
| &dev_attr_mode.attr, |
| &dev_attr_dpa_size.attr, |
| &dev_attr_dpa_resource.attr, |
| SET_CXL_REGION_ATTR(region) |
| NULL, |
| }; |
| |
| static struct attribute_group cxl_decoder_endpoint_attribute_group = { |
| .attrs = cxl_decoder_endpoint_attrs, |
| }; |
| |
| static const struct attribute_group *cxl_decoder_endpoint_attribute_groups[] = { |
| &cxl_decoder_base_attribute_group, |
| &cxl_decoder_endpoint_attribute_group, |
| &cxl_base_attribute_group, |
| NULL, |
| }; |
| |
| static void __cxl_decoder_release(struct cxl_decoder *cxld) |
| { |
| struct cxl_port *port = to_cxl_port(cxld->dev.parent); |
| |
| ida_free(&port->decoder_ida, cxld->id); |
| put_device(&port->dev); |
| } |
| |
| static void cxl_endpoint_decoder_release(struct device *dev) |
| { |
| struct cxl_endpoint_decoder *cxled = to_cxl_endpoint_decoder(dev); |
| |
| __cxl_decoder_release(&cxled->cxld); |
| kfree(cxled); |
| } |
| |
| static void cxl_switch_decoder_release(struct device *dev) |
| { |
| struct cxl_switch_decoder *cxlsd = to_cxl_switch_decoder(dev); |
| |
| __cxl_decoder_release(&cxlsd->cxld); |
| kfree(cxlsd); |
| } |
| |
| struct cxl_root_decoder *to_cxl_root_decoder(struct device *dev) |
| { |
| if (dev_WARN_ONCE(dev, !is_root_decoder(dev), |
| "not a cxl_root_decoder device\n")) |
| return NULL; |
| return container_of(dev, struct cxl_root_decoder, cxlsd.cxld.dev); |
| } |
| EXPORT_SYMBOL_NS_GPL(to_cxl_root_decoder, CXL); |
| |
| static void cxl_root_decoder_release(struct device *dev) |
| { |
| struct cxl_root_decoder *cxlrd = to_cxl_root_decoder(dev); |
| |
| if (atomic_read(&cxlrd->region_id) >= 0) |
| memregion_free(atomic_read(&cxlrd->region_id)); |
| __cxl_decoder_release(&cxlrd->cxlsd.cxld); |
| kfree(cxlrd); |
| } |
| |
| static const struct device_type cxl_decoder_endpoint_type = { |
| .name = "cxl_decoder_endpoint", |
| .release = cxl_endpoint_decoder_release, |
| .groups = cxl_decoder_endpoint_attribute_groups, |
| }; |
| |
| static const struct device_type cxl_decoder_switch_type = { |
| .name = "cxl_decoder_switch", |
| .release = cxl_switch_decoder_release, |
| .groups = cxl_decoder_switch_attribute_groups, |
| }; |
| |
| static const struct device_type cxl_decoder_root_type = { |
| .name = "cxl_decoder_root", |
| .release = cxl_root_decoder_release, |
| .groups = cxl_decoder_root_attribute_groups, |
| }; |
| |
| bool is_endpoint_decoder(struct device *dev) |
| { |
| return dev->type == &cxl_decoder_endpoint_type; |
| } |
| EXPORT_SYMBOL_NS_GPL(is_endpoint_decoder, CXL); |
| |
| bool is_root_decoder(struct device *dev) |
| { |
| return dev->type == &cxl_decoder_root_type; |
| } |
| EXPORT_SYMBOL_NS_GPL(is_root_decoder, CXL); |
| |
| bool is_switch_decoder(struct device *dev) |
| { |
| return is_root_decoder(dev) || dev->type == &cxl_decoder_switch_type; |
| } |
| EXPORT_SYMBOL_NS_GPL(is_switch_decoder, CXL); |
| |
| struct cxl_decoder *to_cxl_decoder(struct device *dev) |
| { |
| if (dev_WARN_ONCE(dev, |
| !is_switch_decoder(dev) && !is_endpoint_decoder(dev), |
| "not a cxl_decoder device\n")) |
| return NULL; |
| return container_of(dev, struct cxl_decoder, dev); |
| } |
| EXPORT_SYMBOL_NS_GPL(to_cxl_decoder, CXL); |
| |
| struct cxl_endpoint_decoder *to_cxl_endpoint_decoder(struct device *dev) |
| { |
| if (dev_WARN_ONCE(dev, !is_endpoint_decoder(dev), |
| "not a cxl_endpoint_decoder device\n")) |
| return NULL; |
| return container_of(dev, struct cxl_endpoint_decoder, cxld.dev); |
| } |
| EXPORT_SYMBOL_NS_GPL(to_cxl_endpoint_decoder, CXL); |
| |
| struct cxl_switch_decoder *to_cxl_switch_decoder(struct device *dev) |
| { |
| if (dev_WARN_ONCE(dev, !is_switch_decoder(dev), |
| "not a cxl_switch_decoder device\n")) |
| return NULL; |
| return container_of(dev, struct cxl_switch_decoder, cxld.dev); |
| } |
| EXPORT_SYMBOL_NS_GPL(to_cxl_switch_decoder, CXL); |
| |
| static void cxl_ep_release(struct cxl_ep *ep) |
| { |
| put_device(ep->ep); |
| kfree(ep); |
| } |
| |
| static void cxl_ep_remove(struct cxl_port *port, struct cxl_ep *ep) |
| { |
| if (!ep) |
| return; |
| xa_erase(&port->endpoints, (unsigned long) ep->ep); |
| cxl_ep_release(ep); |
| } |
| |
| static void cxl_port_release(struct device *dev) |
| { |
| struct cxl_port *port = to_cxl_port(dev); |
| unsigned long index; |
| struct cxl_ep *ep; |
| |
| xa_for_each(&port->endpoints, index, ep) |
| cxl_ep_remove(port, ep); |
| xa_destroy(&port->endpoints); |
| xa_destroy(&port->dports); |
| xa_destroy(&port->regions); |
| ida_free(&cxl_port_ida, port->id); |
| if (is_cxl_root(port)) |
| kfree(to_cxl_root(port)); |
| else |
| kfree(port); |
| } |
| |
| static ssize_t decoders_committed_show(struct device *dev, |
| struct device_attribute *attr, char *buf) |
| { |
| struct cxl_port *port = to_cxl_port(dev); |
| int rc; |
| |
| down_read(&cxl_region_rwsem); |
| rc = sysfs_emit(buf, "%d\n", cxl_num_decoders_committed(port)); |
| up_read(&cxl_region_rwsem); |
| |
| return rc; |
| } |
| |
| static DEVICE_ATTR_RO(decoders_committed); |
| |
| static struct attribute *cxl_port_attrs[] = { |
| &dev_attr_decoders_committed.attr, |
| NULL, |
| }; |
| |
| static struct attribute_group cxl_port_attribute_group = { |
| .attrs = cxl_port_attrs, |
| }; |
| |
| static const struct attribute_group *cxl_port_attribute_groups[] = { |
| &cxl_base_attribute_group, |
| &cxl_port_attribute_group, |
| NULL, |
| }; |
| |
| static const struct device_type cxl_port_type = { |
| .name = "cxl_port", |
| .release = cxl_port_release, |
| .groups = cxl_port_attribute_groups, |
| }; |
| |
| bool is_cxl_port(const struct device *dev) |
| { |
| return dev->type == &cxl_port_type; |
| } |
| EXPORT_SYMBOL_NS_GPL(is_cxl_port, CXL); |
| |
| struct cxl_port *to_cxl_port(const struct device *dev) |
| { |
| if (dev_WARN_ONCE(dev, dev->type != &cxl_port_type, |
| "not a cxl_port device\n")) |
| return NULL; |
| return container_of(dev, struct cxl_port, dev); |
| } |
| EXPORT_SYMBOL_NS_GPL(to_cxl_port, CXL); |
| |
| static void unregister_port(void *_port) |
| { |
| struct cxl_port *port = _port; |
| struct cxl_port *parent; |
| struct device *lock_dev; |
| |
| if (is_cxl_root(port)) |
| parent = NULL; |
| else |
| parent = to_cxl_port(port->dev.parent); |
| |
| /* |
| * CXL root port's and the first level of ports are unregistered |
| * under the platform firmware device lock, all other ports are |
| * unregistered while holding their parent port lock. |
| */ |
| if (!parent) |
| lock_dev = port->uport_dev; |
| else if (is_cxl_root(parent)) |
| lock_dev = parent->uport_dev; |
| else |
| lock_dev = &parent->dev; |
| |
| device_lock_assert(lock_dev); |
| port->dead = true; |
| device_unregister(&port->dev); |
| } |
| |
| static void cxl_unlink_uport(void *_port) |
| { |
| struct cxl_port *port = _port; |
| |
| sysfs_remove_link(&port->dev.kobj, "uport"); |
| } |
| |
| static int devm_cxl_link_uport(struct device *host, struct cxl_port *port) |
| { |
| int rc; |
| |
| rc = sysfs_create_link(&port->dev.kobj, &port->uport_dev->kobj, |
| "uport"); |
| if (rc) |
| return rc; |
| return devm_add_action_or_reset(host, cxl_unlink_uport, port); |
| } |
| |
| static void cxl_unlink_parent_dport(void *_port) |
| { |
| struct cxl_port *port = _port; |
| |
| sysfs_remove_link(&port->dev.kobj, "parent_dport"); |
| } |
| |
| static int devm_cxl_link_parent_dport(struct device *host, |
| struct cxl_port *port, |
| struct cxl_dport *parent_dport) |
| { |
| int rc; |
| |
| if (!parent_dport) |
| return 0; |
| |
| rc = sysfs_create_link(&port->dev.kobj, &parent_dport->dport_dev->kobj, |
| "parent_dport"); |
| if (rc) |
| return rc; |
| return devm_add_action_or_reset(host, cxl_unlink_parent_dport, port); |
| } |
| |
| static struct lock_class_key cxl_port_key; |
| |
| static struct cxl_port *cxl_port_alloc(struct device *uport_dev, |
| struct cxl_dport *parent_dport) |
| { |
| struct cxl_root *cxl_root __free(kfree) = NULL; |
| struct cxl_port *port, *_port __free(kfree) = NULL; |
| struct device *dev; |
| int rc; |
| |
| /* No parent_dport, root cxl_port */ |
| if (!parent_dport) { |
| cxl_root = kzalloc(sizeof(*cxl_root), GFP_KERNEL); |
| if (!cxl_root) |
| return ERR_PTR(-ENOMEM); |
| } else { |
| _port = kzalloc(sizeof(*port), GFP_KERNEL); |
| if (!_port) |
| return ERR_PTR(-ENOMEM); |
| } |
| |
| rc = ida_alloc(&cxl_port_ida, GFP_KERNEL); |
| if (rc < 0) |
| return ERR_PTR(rc); |
| |
| if (cxl_root) |
| port = &no_free_ptr(cxl_root)->port; |
| else |
| port = no_free_ptr(_port); |
| |
| port->id = rc; |
| port->uport_dev = uport_dev; |
| |
| /* |
| * The top-level cxl_port "cxl_root" does not have a cxl_port as |
| * its parent and it does not have any corresponding component |
| * registers as its decode is described by a fixed platform |
| * description. |
| */ |
| dev = &port->dev; |
| if (parent_dport) { |
| struct cxl_port *parent_port = parent_dport->port; |
| struct cxl_port *iter; |
| |
| dev->parent = &parent_port->dev; |
| port->depth = parent_port->depth + 1; |
| port->parent_dport = parent_dport; |
| |
| /* |
| * walk to the host bridge, or the first ancestor that knows |
| * the host bridge |
| */ |
| iter = port; |
| while (!iter->host_bridge && |
| !is_cxl_root(to_cxl_port(iter->dev.parent))) |
| iter = to_cxl_port(iter->dev.parent); |
| if (iter->host_bridge) |
| port->host_bridge = iter->host_bridge; |
| else if (parent_dport->rch) |
| port->host_bridge = parent_dport->dport_dev; |
| else |
| port->host_bridge = iter->uport_dev; |
| dev_dbg(uport_dev, "host-bridge: %s\n", |
| dev_name(port->host_bridge)); |
| } else |
| dev->parent = uport_dev; |
| |
| ida_init(&port->decoder_ida); |
| port->hdm_end = -1; |
| port->commit_end = -1; |
| xa_init(&port->dports); |
| xa_init(&port->endpoints); |
| xa_init(&port->regions); |
| |
| device_initialize(dev); |
| lockdep_set_class_and_subclass(&dev->mutex, &cxl_port_key, port->depth); |
| device_set_pm_not_required(dev); |
| dev->bus = &cxl_bus_type; |
| dev->type = &cxl_port_type; |
| |
| return port; |
| } |
| |
| static int cxl_setup_comp_regs(struct device *host, struct cxl_register_map *map, |
| resource_size_t component_reg_phys) |
| { |
| *map = (struct cxl_register_map) { |
| .host = host, |
| .reg_type = CXL_REGLOC_RBI_EMPTY, |
| .resource = component_reg_phys, |
| }; |
| |
| if (component_reg_phys == CXL_RESOURCE_NONE) |
| return 0; |
| |
| map->reg_type = CXL_REGLOC_RBI_COMPONENT; |
| map->max_size = CXL_COMPONENT_REG_BLOCK_SIZE; |
| |
| return cxl_setup_regs(map); |
| } |
| |
| static int cxl_port_setup_regs(struct cxl_port *port, |
| resource_size_t component_reg_phys) |
| { |
| if (dev_is_platform(port->uport_dev)) |
| return 0; |
| return cxl_setup_comp_regs(&port->dev, &port->reg_map, |
| component_reg_phys); |
| } |
| |
| static int cxl_dport_setup_regs(struct device *host, struct cxl_dport *dport, |
| resource_size_t component_reg_phys) |
| { |
| int rc; |
| |
| if (dev_is_platform(dport->dport_dev)) |
| return 0; |
| |
| /* |
| * use @dport->dport_dev for the context for error messages during |
| * register probing, and fixup @host after the fact, since @host may be |
| * NULL. |
| */ |
| rc = cxl_setup_comp_regs(dport->dport_dev, &dport->reg_map, |
| component_reg_phys); |
| dport->reg_map.host = host; |
| return rc; |
| } |
| |
| DEFINE_SHOW_ATTRIBUTE(einj_cxl_available_error_type); |
| |
| static int cxl_einj_inject(void *data, u64 type) |
| { |
| struct cxl_dport *dport = data; |
| |
| if (dport->rch) |
| return einj_cxl_inject_rch_error(dport->rcrb.base, type); |
| |
| return einj_cxl_inject_error(to_pci_dev(dport->dport_dev), type); |
| } |
| DEFINE_DEBUGFS_ATTRIBUTE(cxl_einj_inject_fops, NULL, cxl_einj_inject, |
| "0x%llx\n"); |
| |
| static void cxl_debugfs_create_dport_dir(struct cxl_dport *dport) |
| { |
| struct dentry *dir; |
| |
| if (!einj_cxl_is_initialized()) |
| return; |
| |
| /* |
| * dport_dev needs to be a PCIe port for CXL 2.0+ ports because |
| * EINJ expects a dport SBDF to be specified for 2.0 error injection. |
| */ |
| if (!dport->rch && !dev_is_pci(dport->dport_dev)) |
| return; |
| |
| dir = cxl_debugfs_create_dir(dev_name(dport->dport_dev)); |
| |
| debugfs_create_file("einj_inject", 0200, dir, dport, |
| &cxl_einj_inject_fops); |
| } |
| |
| static int cxl_port_add(struct cxl_port *port, |
| resource_size_t component_reg_phys, |
| struct cxl_dport *parent_dport) |
| { |
| struct device *dev __free(put_device) = &port->dev; |
| int rc; |
| |
| if (is_cxl_memdev(port->uport_dev)) { |
| struct cxl_memdev *cxlmd = to_cxl_memdev(port->uport_dev); |
| struct cxl_dev_state *cxlds = cxlmd->cxlds; |
| |
| rc = dev_set_name(dev, "endpoint%d", port->id); |
| if (rc) |
| return rc; |
| |
| /* |
| * The endpoint driver already enumerated the component and RAS |
| * registers. Reuse that enumeration while prepping them to be |
| * mapped by the cxl_port driver. |
| */ |
| port->reg_map = cxlds->reg_map; |
| port->reg_map.host = &port->dev; |
| cxlmd->endpoint = port; |
| } else if (parent_dport) { |
| rc = dev_set_name(dev, "port%d", port->id); |
| if (rc) |
| return rc; |
| |
| rc = cxl_port_setup_regs(port, component_reg_phys); |
| if (rc) |
| return rc; |
| } else { |
| rc = dev_set_name(dev, "root%d", port->id); |
| if (rc) |
| return rc; |
| } |
| |
| rc = device_add(dev); |
| if (rc) |
| return rc; |
| |
| /* Inhibit the cleanup function invoked */ |
| dev = NULL; |
| return 0; |
| } |
| |
| static struct cxl_port *__devm_cxl_add_port(struct device *host, |
| struct device *uport_dev, |
| resource_size_t component_reg_phys, |
| struct cxl_dport *parent_dport) |
| { |
| struct cxl_port *port; |
| int rc; |
| |
| port = cxl_port_alloc(uport_dev, parent_dport); |
| if (IS_ERR(port)) |
| return port; |
| |
| rc = cxl_port_add(port, component_reg_phys, parent_dport); |
| if (rc) |
| return ERR_PTR(rc); |
| |
| rc = devm_add_action_or_reset(host, unregister_port, port); |
| if (rc) |
| return ERR_PTR(rc); |
| |
| rc = devm_cxl_link_uport(host, port); |
| if (rc) |
| return ERR_PTR(rc); |
| |
| rc = devm_cxl_link_parent_dport(host, port, parent_dport); |
| if (rc) |
| return ERR_PTR(rc); |
| |
| if (parent_dport && dev_is_pci(uport_dev)) |
| port->pci_latency = cxl_pci_get_latency(to_pci_dev(uport_dev)); |
| |
| return port; |
| } |
| |
| /** |
| * devm_cxl_add_port - register a cxl_port in CXL memory decode hierarchy |
| * @host: host device for devm operations |
| * @uport_dev: "physical" device implementing this upstream port |
| * @component_reg_phys: (optional) for configurable cxl_port instances |
| * @parent_dport: next hop up in the CXL memory decode hierarchy |
| */ |
| struct cxl_port *devm_cxl_add_port(struct device *host, |
| struct device *uport_dev, |
| resource_size_t component_reg_phys, |
| struct cxl_dport *parent_dport) |
| { |
| struct cxl_port *port, *parent_port; |
| |
| port = __devm_cxl_add_port(host, uport_dev, component_reg_phys, |
| parent_dport); |
| |
| parent_port = parent_dport ? parent_dport->port : NULL; |
| if (IS_ERR(port)) { |
| dev_dbg(uport_dev, "Failed to add%s%s%s: %ld\n", |
| parent_port ? " port to " : "", |
| parent_port ? dev_name(&parent_port->dev) : "", |
| parent_port ? "" : " root port", |
| PTR_ERR(port)); |
| } else { |
| dev_dbg(uport_dev, "%s added%s%s%s\n", |
| dev_name(&port->dev), |
| parent_port ? " to " : "", |
| parent_port ? dev_name(&parent_port->dev) : "", |
| parent_port ? "" : " (root port)"); |
| } |
| |
| return port; |
| } |
| EXPORT_SYMBOL_NS_GPL(devm_cxl_add_port, CXL); |
| |
| struct cxl_root *devm_cxl_add_root(struct device *host, |
| const struct cxl_root_ops *ops) |
| { |
| struct cxl_root *cxl_root; |
| struct cxl_port *port; |
| |
| port = devm_cxl_add_port(host, host, CXL_RESOURCE_NONE, NULL); |
| if (IS_ERR(port)) |
| return ERR_CAST(port); |
| |
| cxl_root = to_cxl_root(port); |
| cxl_root->ops = ops; |
| return cxl_root; |
| } |
| EXPORT_SYMBOL_NS_GPL(devm_cxl_add_root, CXL); |
| |
| struct pci_bus *cxl_port_to_pci_bus(struct cxl_port *port) |
| { |
| /* There is no pci_bus associated with a CXL platform-root port */ |
| if (is_cxl_root(port)) |
| return NULL; |
| |
| if (dev_is_pci(port->uport_dev)) { |
| struct pci_dev *pdev = to_pci_dev(port->uport_dev); |
| |
| return pdev->subordinate; |
| } |
| |
| return xa_load(&cxl_root_buses, (unsigned long)port->uport_dev); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_port_to_pci_bus, CXL); |
| |
| static void unregister_pci_bus(void *uport_dev) |
| { |
| xa_erase(&cxl_root_buses, (unsigned long)uport_dev); |
| } |
| |
| int devm_cxl_register_pci_bus(struct device *host, struct device *uport_dev, |
| struct pci_bus *bus) |
| { |
| int rc; |
| |
| if (dev_is_pci(uport_dev)) |
| return -EINVAL; |
| |
| rc = xa_insert(&cxl_root_buses, (unsigned long)uport_dev, bus, |
| GFP_KERNEL); |
| if (rc) |
| return rc; |
| return devm_add_action_or_reset(host, unregister_pci_bus, uport_dev); |
| } |
| EXPORT_SYMBOL_NS_GPL(devm_cxl_register_pci_bus, CXL); |
| |
| static bool dev_is_cxl_root_child(struct device *dev) |
| { |
| struct cxl_port *port, *parent; |
| |
| if (!is_cxl_port(dev)) |
| return false; |
| |
| port = to_cxl_port(dev); |
| if (is_cxl_root(port)) |
| return false; |
| |
| parent = to_cxl_port(port->dev.parent); |
| if (is_cxl_root(parent)) |
| return true; |
| |
| return false; |
| } |
| |
| struct cxl_root *find_cxl_root(struct cxl_port *port) |
| { |
| struct cxl_port *iter = port; |
| |
| while (iter && !is_cxl_root(iter)) |
| iter = to_cxl_port(iter->dev.parent); |
| |
| if (!iter) |
| return NULL; |
| get_device(&iter->dev); |
| return to_cxl_root(iter); |
| } |
| EXPORT_SYMBOL_NS_GPL(find_cxl_root, CXL); |
| |
| void put_cxl_root(struct cxl_root *cxl_root) |
| { |
| if (!cxl_root) |
| return; |
| |
| put_device(&cxl_root->port.dev); |
| } |
| EXPORT_SYMBOL_NS_GPL(put_cxl_root, CXL); |
| |
| static struct cxl_dport *find_dport(struct cxl_port *port, int id) |
| { |
| struct cxl_dport *dport; |
| unsigned long index; |
| |
| device_lock_assert(&port->dev); |
| xa_for_each(&port->dports, index, dport) |
| if (dport->port_id == id) |
| return dport; |
| return NULL; |
| } |
| |
| static int add_dport(struct cxl_port *port, struct cxl_dport *dport) |
| { |
| struct cxl_dport *dup; |
| int rc; |
| |
| device_lock_assert(&port->dev); |
| dup = find_dport(port, dport->port_id); |
| if (dup) { |
| dev_err(&port->dev, |
| "unable to add dport%d-%s non-unique port id (%s)\n", |
| dport->port_id, dev_name(dport->dport_dev), |
| dev_name(dup->dport_dev)); |
| return -EBUSY; |
| } |
| |
| rc = xa_insert(&port->dports, (unsigned long)dport->dport_dev, dport, |
| GFP_KERNEL); |
| if (rc) |
| return rc; |
| |
| port->nr_dports++; |
| return 0; |
| } |
| |
| /* |
| * Since root-level CXL dports cannot be enumerated by PCI they are not |
| * enumerated by the common port driver that acquires the port lock over |
| * dport add/remove. Instead, root dports are manually added by a |
| * platform driver and cond_cxl_root_lock() is used to take the missing |
| * port lock in that case. |
| */ |
| static void cond_cxl_root_lock(struct cxl_port *port) |
| { |
| if (is_cxl_root(port)) |
| device_lock(&port->dev); |
| } |
| |
| static void cond_cxl_root_unlock(struct cxl_port *port) |
| { |
| if (is_cxl_root(port)) |
| device_unlock(&port->dev); |
| } |
| |
| static void cxl_dport_remove(void *data) |
| { |
| struct cxl_dport *dport = data; |
| struct cxl_port *port = dport->port; |
| |
| xa_erase(&port->dports, (unsigned long) dport->dport_dev); |
| put_device(dport->dport_dev); |
| } |
| |
| static void cxl_dport_unlink(void *data) |
| { |
| struct cxl_dport *dport = data; |
| struct cxl_port *port = dport->port; |
| char link_name[CXL_TARGET_STRLEN]; |
| |
| sprintf(link_name, "dport%d", dport->port_id); |
| sysfs_remove_link(&port->dev.kobj, link_name); |
| } |
| |
| static struct cxl_dport * |
| __devm_cxl_add_dport(struct cxl_port *port, struct device *dport_dev, |
| int port_id, resource_size_t component_reg_phys, |
| resource_size_t rcrb) |
| { |
| char link_name[CXL_TARGET_STRLEN]; |
| struct cxl_dport *dport; |
| struct device *host; |
| int rc; |
| |
| if (is_cxl_root(port)) |
| host = port->uport_dev; |
| else |
| host = &port->dev; |
| |
| if (!host->driver) { |
| dev_WARN_ONCE(&port->dev, 1, "dport:%s bad devm context\n", |
| dev_name(dport_dev)); |
| return ERR_PTR(-ENXIO); |
| } |
| |
| if (snprintf(link_name, CXL_TARGET_STRLEN, "dport%d", port_id) >= |
| CXL_TARGET_STRLEN) |
| return ERR_PTR(-EINVAL); |
| |
| dport = devm_kzalloc(host, sizeof(*dport), GFP_KERNEL); |
| if (!dport) |
| return ERR_PTR(-ENOMEM); |
| |
| dport->dport_dev = dport_dev; |
| dport->port_id = port_id; |
| dport->port = port; |
| |
| if (rcrb == CXL_RESOURCE_NONE) { |
| rc = cxl_dport_setup_regs(&port->dev, dport, |
| component_reg_phys); |
| if (rc) |
| return ERR_PTR(rc); |
| } else { |
| dport->rcrb.base = rcrb; |
| component_reg_phys = __rcrb_to_component(dport_dev, &dport->rcrb, |
| CXL_RCRB_DOWNSTREAM); |
| if (component_reg_phys == CXL_RESOURCE_NONE) { |
| dev_warn(dport_dev, "Invalid Component Registers in RCRB"); |
| return ERR_PTR(-ENXIO); |
| } |
| |
| /* |
| * RCH @dport is not ready to map until associated with its |
| * memdev |
| */ |
| rc = cxl_dport_setup_regs(NULL, dport, component_reg_phys); |
| if (rc) |
| return ERR_PTR(rc); |
| |
| dport->rch = true; |
| } |
| |
| if (component_reg_phys != CXL_RESOURCE_NONE) |
| dev_dbg(dport_dev, "Component Registers found for dport: %pa\n", |
| &component_reg_phys); |
| |
| cond_cxl_root_lock(port); |
| rc = add_dport(port, dport); |
| cond_cxl_root_unlock(port); |
| if (rc) |
| return ERR_PTR(rc); |
| |
| get_device(dport_dev); |
| rc = devm_add_action_or_reset(host, cxl_dport_remove, dport); |
| if (rc) |
| return ERR_PTR(rc); |
| |
| rc = sysfs_create_link(&port->dev.kobj, &dport_dev->kobj, link_name); |
| if (rc) |
| return ERR_PTR(rc); |
| |
| rc = devm_add_action_or_reset(host, cxl_dport_unlink, dport); |
| if (rc) |
| return ERR_PTR(rc); |
| |
| if (dev_is_pci(dport_dev)) |
| dport->link_latency = cxl_pci_get_latency(to_pci_dev(dport_dev)); |
| |
| cxl_debugfs_create_dport_dir(dport); |
| |
| return dport; |
| } |
| |
| /** |
| * devm_cxl_add_dport - append VH downstream port data to a cxl_port |
| * @port: the cxl_port that references this dport |
| * @dport_dev: firmware or PCI device representing the dport |
| * @port_id: identifier for this dport in a decoder's target list |
| * @component_reg_phys: optional location of CXL component registers |
| * |
| * Note that dports are appended to the devm release action's of the |
| * either the port's host (for root ports), or the port itself (for |
| * switch ports) |
| */ |
| struct cxl_dport *devm_cxl_add_dport(struct cxl_port *port, |
| struct device *dport_dev, int port_id, |
| resource_size_t component_reg_phys) |
| { |
| struct cxl_dport *dport; |
| |
| dport = __devm_cxl_add_dport(port, dport_dev, port_id, |
| component_reg_phys, CXL_RESOURCE_NONE); |
| if (IS_ERR(dport)) { |
| dev_dbg(dport_dev, "failed to add dport to %s: %ld\n", |
| dev_name(&port->dev), PTR_ERR(dport)); |
| } else { |
| dev_dbg(dport_dev, "dport added to %s\n", |
| dev_name(&port->dev)); |
| } |
| |
| return dport; |
| } |
| EXPORT_SYMBOL_NS_GPL(devm_cxl_add_dport, CXL); |
| |
| /** |
| * devm_cxl_add_rch_dport - append RCH downstream port data to a cxl_port |
| * @port: the cxl_port that references this dport |
| * @dport_dev: firmware or PCI device representing the dport |
| * @port_id: identifier for this dport in a decoder's target list |
| * @rcrb: mandatory location of a Root Complex Register Block |
| * |
| * See CXL 3.0 9.11.8 CXL Devices Attached to an RCH |
| */ |
| struct cxl_dport *devm_cxl_add_rch_dport(struct cxl_port *port, |
| struct device *dport_dev, int port_id, |
| resource_size_t rcrb) |
| { |
| struct cxl_dport *dport; |
| |
| if (rcrb == CXL_RESOURCE_NONE) { |
| dev_dbg(&port->dev, "failed to add RCH dport, missing RCRB\n"); |
| return ERR_PTR(-EINVAL); |
| } |
| |
| dport = __devm_cxl_add_dport(port, dport_dev, port_id, |
| CXL_RESOURCE_NONE, rcrb); |
| if (IS_ERR(dport)) { |
| dev_dbg(dport_dev, "failed to add RCH dport to %s: %ld\n", |
| dev_name(&port->dev), PTR_ERR(dport)); |
| } else { |
| dev_dbg(dport_dev, "RCH dport added to %s\n", |
| dev_name(&port->dev)); |
| } |
| |
| return dport; |
| } |
| EXPORT_SYMBOL_NS_GPL(devm_cxl_add_rch_dport, CXL); |
| |
| static int add_ep(struct cxl_ep *new) |
| { |
| struct cxl_port *port = new->dport->port; |
| |
| guard(device)(&port->dev); |
| if (port->dead) |
| return -ENXIO; |
| |
| return xa_insert(&port->endpoints, (unsigned long)new->ep, |
| new, GFP_KERNEL); |
| } |
| |
| /** |
| * cxl_add_ep - register an endpoint's interest in a port |
| * @dport: the dport that routes to @ep_dev |
| * @ep_dev: device representing the endpoint |
| * |
| * Intermediate CXL ports are scanned based on the arrival of endpoints. |
| * When those endpoints depart the port can be destroyed once all |
| * endpoints that care about that port have been removed. |
| */ |
| static int cxl_add_ep(struct cxl_dport *dport, struct device *ep_dev) |
| { |
| struct cxl_ep *ep; |
| int rc; |
| |
| ep = kzalloc(sizeof(*ep), GFP_KERNEL); |
| if (!ep) |
| return -ENOMEM; |
| |
| ep->ep = get_device(ep_dev); |
| ep->dport = dport; |
| |
| rc = add_ep(ep); |
| if (rc) |
| cxl_ep_release(ep); |
| return rc; |
| } |
| |
| struct cxl_find_port_ctx { |
| const struct device *dport_dev; |
| const struct cxl_port *parent_port; |
| struct cxl_dport **dport; |
| }; |
| |
| static int match_port_by_dport(struct device *dev, const void *data) |
| { |
| const struct cxl_find_port_ctx *ctx = data; |
| struct cxl_dport *dport; |
| struct cxl_port *port; |
| |
| if (!is_cxl_port(dev)) |
| return 0; |
| if (ctx->parent_port && dev->parent != &ctx->parent_port->dev) |
| return 0; |
| |
| port = to_cxl_port(dev); |
| dport = cxl_find_dport_by_dev(port, ctx->dport_dev); |
| if (ctx->dport) |
| *ctx->dport = dport; |
| return dport != NULL; |
| } |
| |
| static struct cxl_port *__find_cxl_port(struct cxl_find_port_ctx *ctx) |
| { |
| struct device *dev; |
| |
| if (!ctx->dport_dev) |
| return NULL; |
| |
| dev = bus_find_device(&cxl_bus_type, NULL, ctx, match_port_by_dport); |
| if (dev) |
| return to_cxl_port(dev); |
| return NULL; |
| } |
| |
| static struct cxl_port *find_cxl_port(struct device *dport_dev, |
| struct cxl_dport **dport) |
| { |
| struct cxl_find_port_ctx ctx = { |
| .dport_dev = dport_dev, |
| .dport = dport, |
| }; |
| struct cxl_port *port; |
| |
| port = __find_cxl_port(&ctx); |
| return port; |
| } |
| |
| static struct cxl_port *find_cxl_port_at(struct cxl_port *parent_port, |
| struct device *dport_dev, |
| struct cxl_dport **dport) |
| { |
| struct cxl_find_port_ctx ctx = { |
| .dport_dev = dport_dev, |
| .parent_port = parent_port, |
| .dport = dport, |
| }; |
| struct cxl_port *port; |
| |
| port = __find_cxl_port(&ctx); |
| return port; |
| } |
| |
| /* |
| * All users of grandparent() are using it to walk PCIe-like switch port |
| * hierarchy. A PCIe switch is comprised of a bridge device representing the |
| * upstream switch port and N bridges representing downstream switch ports. When |
| * bridges stack the grand-parent of a downstream switch port is another |
| * downstream switch port in the immediate ancestor switch. |
| */ |
| static struct device *grandparent(struct device *dev) |
| { |
| if (dev && dev->parent) |
| return dev->parent->parent; |
| return NULL; |
| } |
| |
| static struct device *endpoint_host(struct cxl_port *endpoint) |
| { |
| struct cxl_port *port = to_cxl_port(endpoint->dev.parent); |
| |
| if (is_cxl_root(port)) |
| return port->uport_dev; |
| return &port->dev; |
| } |
| |
| static void delete_endpoint(void *data) |
| { |
| struct cxl_memdev *cxlmd = data; |
| struct cxl_port *endpoint = cxlmd->endpoint; |
| struct device *host = endpoint_host(endpoint); |
| |
| scoped_guard(device, host) { |
| if (host->driver && !endpoint->dead) { |
| devm_release_action(host, cxl_unlink_parent_dport, endpoint); |
| devm_release_action(host, cxl_unlink_uport, endpoint); |
| devm_release_action(host, unregister_port, endpoint); |
| } |
| cxlmd->endpoint = NULL; |
| } |
| put_device(&endpoint->dev); |
| put_device(host); |
| } |
| |
| int cxl_endpoint_autoremove(struct cxl_memdev *cxlmd, struct cxl_port *endpoint) |
| { |
| struct device *host = endpoint_host(endpoint); |
| struct device *dev = &cxlmd->dev; |
| |
| get_device(host); |
| get_device(&endpoint->dev); |
| cxlmd->depth = endpoint->depth; |
| return devm_add_action_or_reset(dev, delete_endpoint, cxlmd); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_endpoint_autoremove, CXL); |
| |
| /* |
| * The natural end of life of a non-root 'cxl_port' is when its parent port goes |
| * through a ->remove() event ("top-down" unregistration). The unnatural trigger |
| * for a port to be unregistered is when all memdevs beneath that port have gone |
| * through ->remove(). This "bottom-up" removal selectively removes individual |
| * child ports manually. This depends on devm_cxl_add_port() to not change is |
| * devm action registration order, and for dports to have already been |
| * destroyed by reap_dports(). |
| */ |
| static void delete_switch_port(struct cxl_port *port) |
| { |
| devm_release_action(port->dev.parent, cxl_unlink_parent_dport, port); |
| devm_release_action(port->dev.parent, cxl_unlink_uport, port); |
| devm_release_action(port->dev.parent, unregister_port, port); |
| } |
| |
| static void reap_dports(struct cxl_port *port) |
| { |
| struct cxl_dport *dport; |
| unsigned long index; |
| |
| device_lock_assert(&port->dev); |
| |
| xa_for_each(&port->dports, index, dport) { |
| devm_release_action(&port->dev, cxl_dport_unlink, dport); |
| devm_release_action(&port->dev, cxl_dport_remove, dport); |
| devm_kfree(&port->dev, dport); |
| } |
| } |
| |
| struct detach_ctx { |
| struct cxl_memdev *cxlmd; |
| int depth; |
| }; |
| |
| static int port_has_memdev(struct device *dev, const void *data) |
| { |
| const struct detach_ctx *ctx = data; |
| struct cxl_port *port; |
| |
| if (!is_cxl_port(dev)) |
| return 0; |
| |
| port = to_cxl_port(dev); |
| if (port->depth != ctx->depth) |
| return 0; |
| |
| return !!cxl_ep_load(port, ctx->cxlmd); |
| } |
| |
| static void cxl_detach_ep(void *data) |
| { |
| struct cxl_memdev *cxlmd = data; |
| |
| for (int i = cxlmd->depth - 1; i >= 1; i--) { |
| struct cxl_port *port, *parent_port; |
| struct detach_ctx ctx = { |
| .cxlmd = cxlmd, |
| .depth = i, |
| }; |
| struct cxl_ep *ep; |
| bool died = false; |
| |
| struct device *dev __free(put_device) = |
| bus_find_device(&cxl_bus_type, NULL, &ctx, port_has_memdev); |
| if (!dev) |
| continue; |
| port = to_cxl_port(dev); |
| |
| parent_port = to_cxl_port(port->dev.parent); |
| device_lock(&parent_port->dev); |
| device_lock(&port->dev); |
| ep = cxl_ep_load(port, cxlmd); |
| dev_dbg(&cxlmd->dev, "disconnect %s from %s\n", |
| ep ? dev_name(ep->ep) : "", dev_name(&port->dev)); |
| cxl_ep_remove(port, ep); |
| if (ep && !port->dead && xa_empty(&port->endpoints) && |
| !is_cxl_root(parent_port) && parent_port->dev.driver) { |
| /* |
| * This was the last ep attached to a dynamically |
| * enumerated port. Block new cxl_add_ep() and garbage |
| * collect the port. |
| */ |
| died = true; |
| port->dead = true; |
| reap_dports(port); |
| } |
| device_unlock(&port->dev); |
| |
| if (died) { |
| dev_dbg(&cxlmd->dev, "delete %s\n", |
| dev_name(&port->dev)); |
| delete_switch_port(port); |
| } |
| device_unlock(&parent_port->dev); |
| } |
| } |
| |
| static resource_size_t find_component_registers(struct device *dev) |
| { |
| struct cxl_register_map map; |
| struct pci_dev *pdev; |
| |
| /* |
| * Theoretically, CXL component registers can be hosted on a |
| * non-PCI device, in practice, only cxl_test hits this case. |
| */ |
| if (!dev_is_pci(dev)) |
| return CXL_RESOURCE_NONE; |
| |
| pdev = to_pci_dev(dev); |
| |
| cxl_find_regblock(pdev, CXL_REGLOC_RBI_COMPONENT, &map); |
| return map.resource; |
| } |
| |
| static int add_port_attach_ep(struct cxl_memdev *cxlmd, |
| struct device *uport_dev, |
| struct device *dport_dev) |
| { |
| struct device *dparent = grandparent(dport_dev); |
| struct cxl_dport *dport, *parent_dport; |
| resource_size_t component_reg_phys; |
| int rc; |
| |
| if (!dparent) { |
| /* |
| * The iteration reached the topology root without finding the |
| * CXL-root 'cxl_port' on a previous iteration, fail for now to |
| * be re-probed after platform driver attaches. |
| */ |
| dev_dbg(&cxlmd->dev, "%s is a root dport\n", |
| dev_name(dport_dev)); |
| return -ENXIO; |
| } |
| |
| struct cxl_port *parent_port __free(put_cxl_port) = |
| find_cxl_port(dparent, &parent_dport); |
| if (!parent_port) { |
| /* iterate to create this parent_port */ |
| return -EAGAIN; |
| } |
| |
| /* |
| * Definition with __free() here to keep the sequence of |
| * dereferencing the device of the port before the parent_port releasing. |
| */ |
| struct cxl_port *port __free(put_cxl_port) = NULL; |
| scoped_guard(device, &parent_port->dev) { |
| if (!parent_port->dev.driver) { |
| dev_warn(&cxlmd->dev, |
| "port %s:%s disabled, failed to enumerate CXL.mem\n", |
| dev_name(&parent_port->dev), dev_name(uport_dev)); |
| return -ENXIO; |
| } |
| |
| port = find_cxl_port_at(parent_port, dport_dev, &dport); |
| if (!port) { |
| component_reg_phys = find_component_registers(uport_dev); |
| port = devm_cxl_add_port(&parent_port->dev, uport_dev, |
| component_reg_phys, parent_dport); |
| if (IS_ERR(port)) |
| return PTR_ERR(port); |
| |
| /* retry find to pick up the new dport information */ |
| port = find_cxl_port_at(parent_port, dport_dev, &dport); |
| if (!port) |
| return -ENXIO; |
| } |
| } |
| |
| dev_dbg(&cxlmd->dev, "add to new port %s:%s\n", |
| dev_name(&port->dev), dev_name(port->uport_dev)); |
| rc = cxl_add_ep(dport, &cxlmd->dev); |
| if (rc == -EBUSY) { |
| /* |
| * "can't" happen, but this error code means |
| * something to the caller, so translate it. |
| */ |
| rc = -ENXIO; |
| } |
| |
| return rc; |
| } |
| |
| int devm_cxl_enumerate_ports(struct cxl_memdev *cxlmd) |
| { |
| struct device *dev = &cxlmd->dev; |
| struct device *iter; |
| int rc; |
| |
| /* |
| * Skip intermediate port enumeration in the RCH case, there |
| * are no ports in between a host bridge and an endpoint. |
| */ |
| if (cxlmd->cxlds->rcd) |
| return 0; |
| |
| rc = devm_add_action_or_reset(&cxlmd->dev, cxl_detach_ep, cxlmd); |
| if (rc) |
| return rc; |
| |
| /* |
| * Scan for and add all cxl_ports in this device's ancestry. |
| * Repeat until no more ports are added. Abort if a port add |
| * attempt fails. |
| */ |
| retry: |
| for (iter = dev; iter; iter = grandparent(iter)) { |
| struct device *dport_dev = grandparent(iter); |
| struct device *uport_dev; |
| struct cxl_dport *dport; |
| |
| /* |
| * The terminal "grandparent" in PCI is NULL and @platform_bus |
| * for platform devices |
| */ |
| if (!dport_dev || dport_dev == &platform_bus) |
| return 0; |
| |
| uport_dev = dport_dev->parent; |
| if (!uport_dev) { |
| dev_warn(dev, "at %s no parent for dport: %s\n", |
| dev_name(iter), dev_name(dport_dev)); |
| return -ENXIO; |
| } |
| |
| dev_dbg(dev, "scan: iter: %s dport_dev: %s parent: %s\n", |
| dev_name(iter), dev_name(dport_dev), |
| dev_name(uport_dev)); |
| struct cxl_port *port __free(put_cxl_port) = |
| find_cxl_port(dport_dev, &dport); |
| if (port) { |
| dev_dbg(&cxlmd->dev, |
| "found already registered port %s:%s\n", |
| dev_name(&port->dev), |
| dev_name(port->uport_dev)); |
| rc = cxl_add_ep(dport, &cxlmd->dev); |
| |
| /* |
| * If the endpoint already exists in the port's list, |
| * that's ok, it was added on a previous pass. |
| * Otherwise, retry in add_port_attach_ep() after taking |
| * the parent_port lock as the current port may be being |
| * reaped. |
| */ |
| if (rc && rc != -EBUSY) |
| return rc; |
| |
| /* Any more ports to add between this one and the root? */ |
| if (!dev_is_cxl_root_child(&port->dev)) |
| continue; |
| |
| return 0; |
| } |
| |
| rc = add_port_attach_ep(cxlmd, uport_dev, dport_dev); |
| /* port missing, try to add parent */ |
| if (rc == -EAGAIN) |
| continue; |
| /* failed to add ep or port */ |
| if (rc) |
| return rc; |
| /* port added, new descendants possible, start over */ |
| goto retry; |
| } |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_NS_GPL(devm_cxl_enumerate_ports, CXL); |
| |
| struct cxl_port *cxl_pci_find_port(struct pci_dev *pdev, |
| struct cxl_dport **dport) |
| { |
| return find_cxl_port(pdev->dev.parent, dport); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_pci_find_port, CXL); |
| |
| struct cxl_port *cxl_mem_find_port(struct cxl_memdev *cxlmd, |
| struct cxl_dport **dport) |
| { |
| return find_cxl_port(grandparent(&cxlmd->dev), dport); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_mem_find_port, CXL); |
| |
| static int decoder_populate_targets(struct cxl_switch_decoder *cxlsd, |
| struct cxl_port *port, int *target_map) |
| { |
| int i; |
| |
| if (!target_map) |
| return 0; |
| |
| device_lock_assert(&port->dev); |
| |
| if (xa_empty(&port->dports)) |
| return -EINVAL; |
| |
| guard(rwsem_write)(&cxl_region_rwsem); |
| for (i = 0; i < cxlsd->cxld.interleave_ways; i++) { |
| struct cxl_dport *dport = find_dport(port, target_map[i]); |
| |
| if (!dport) |
| return -ENXIO; |
| cxlsd->target[i] = dport; |
| } |
| |
| return 0; |
| } |
| |
| static struct lock_class_key cxl_decoder_key; |
| |
| /** |
| * cxl_decoder_init - Common decoder setup / initialization |
| * @port: owning port of this decoder |
| * @cxld: common decoder properties to initialize |
| * |
| * A port may contain one or more decoders. Each of those decoders |
| * enable some address space for CXL.mem utilization. A decoder is |
| * expected to be configured by the caller before registering via |
| * cxl_decoder_add() |
| */ |
| static int cxl_decoder_init(struct cxl_port *port, struct cxl_decoder *cxld) |
| { |
| struct device *dev; |
| int rc; |
| |
| rc = ida_alloc(&port->decoder_ida, GFP_KERNEL); |
| if (rc < 0) |
| return rc; |
| |
| /* need parent to stick around to release the id */ |
| get_device(&port->dev); |
| cxld->id = rc; |
| |
| dev = &cxld->dev; |
| device_initialize(dev); |
| lockdep_set_class(&dev->mutex, &cxl_decoder_key); |
| device_set_pm_not_required(dev); |
| dev->parent = &port->dev; |
| dev->bus = &cxl_bus_type; |
| |
| /* Pre initialize an "empty" decoder */ |
| cxld->interleave_ways = 1; |
| cxld->interleave_granularity = PAGE_SIZE; |
| cxld->target_type = CXL_DECODER_HOSTONLYMEM; |
| cxld->hpa_range = (struct range) { |
| .start = 0, |
| .end = -1, |
| }; |
| |
| return 0; |
| } |
| |
| static int cxl_switch_decoder_init(struct cxl_port *port, |
| struct cxl_switch_decoder *cxlsd, |
| int nr_targets) |
| { |
| if (nr_targets > CXL_DECODER_MAX_INTERLEAVE) |
| return -EINVAL; |
| |
| cxlsd->nr_targets = nr_targets; |
| return cxl_decoder_init(port, &cxlsd->cxld); |
| } |
| |
| /** |
| * cxl_root_decoder_alloc - Allocate a root level decoder |
| * @port: owning CXL root of this decoder |
| * @nr_targets: static number of downstream targets |
| * |
| * Return: A new cxl decoder to be registered by cxl_decoder_add(). A |
| * 'CXL root' decoder is one that decodes from a top-level / static platform |
| * firmware description of CXL resources into a CXL standard decode |
| * topology. |
| */ |
| struct cxl_root_decoder *cxl_root_decoder_alloc(struct cxl_port *port, |
| unsigned int nr_targets) |
| { |
| struct cxl_root_decoder *cxlrd; |
| struct cxl_switch_decoder *cxlsd; |
| struct cxl_decoder *cxld; |
| int rc; |
| |
| if (!is_cxl_root(port)) |
| return ERR_PTR(-EINVAL); |
| |
| cxlrd = kzalloc(struct_size(cxlrd, cxlsd.target, nr_targets), |
| GFP_KERNEL); |
| if (!cxlrd) |
| return ERR_PTR(-ENOMEM); |
| |
| cxlsd = &cxlrd->cxlsd; |
| rc = cxl_switch_decoder_init(port, cxlsd, nr_targets); |
| if (rc) { |
| kfree(cxlrd); |
| return ERR_PTR(rc); |
| } |
| |
| mutex_init(&cxlrd->range_lock); |
| |
| cxld = &cxlsd->cxld; |
| cxld->dev.type = &cxl_decoder_root_type; |
| /* |
| * cxl_root_decoder_release() special cases negative ids to |
| * detect memregion_alloc() failures. |
| */ |
| atomic_set(&cxlrd->region_id, -1); |
| rc = memregion_alloc(GFP_KERNEL); |
| if (rc < 0) { |
| put_device(&cxld->dev); |
| return ERR_PTR(rc); |
| } |
| |
| atomic_set(&cxlrd->region_id, rc); |
| cxlrd->qos_class = CXL_QOS_CLASS_INVALID; |
| return cxlrd; |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_root_decoder_alloc, CXL); |
| |
| /** |
| * cxl_switch_decoder_alloc - Allocate a switch level decoder |
| * @port: owning CXL switch port of this decoder |
| * @nr_targets: max number of dynamically addressable downstream targets |
| * |
| * Return: A new cxl decoder to be registered by cxl_decoder_add(). A |
| * 'switch' decoder is any decoder that can be enumerated by PCIe |
| * topology and the HDM Decoder Capability. This includes the decoders |
| * that sit between Switch Upstream Ports / Switch Downstream Ports and |
| * Host Bridges / Root Ports. |
| */ |
| struct cxl_switch_decoder *cxl_switch_decoder_alloc(struct cxl_port *port, |
| unsigned int nr_targets) |
| { |
| struct cxl_switch_decoder *cxlsd; |
| struct cxl_decoder *cxld; |
| int rc; |
| |
| if (is_cxl_root(port) || is_cxl_endpoint(port)) |
| return ERR_PTR(-EINVAL); |
| |
| cxlsd = kzalloc(struct_size(cxlsd, target, nr_targets), GFP_KERNEL); |
| if (!cxlsd) |
| return ERR_PTR(-ENOMEM); |
| |
| rc = cxl_switch_decoder_init(port, cxlsd, nr_targets); |
| if (rc) { |
| kfree(cxlsd); |
| return ERR_PTR(rc); |
| } |
| |
| cxld = &cxlsd->cxld; |
| cxld->dev.type = &cxl_decoder_switch_type; |
| return cxlsd; |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_switch_decoder_alloc, CXL); |
| |
| /** |
| * cxl_endpoint_decoder_alloc - Allocate an endpoint decoder |
| * @port: owning port of this decoder |
| * |
| * Return: A new cxl decoder to be registered by cxl_decoder_add() |
| */ |
| struct cxl_endpoint_decoder *cxl_endpoint_decoder_alloc(struct cxl_port *port) |
| { |
| struct cxl_endpoint_decoder *cxled; |
| struct cxl_decoder *cxld; |
| int rc; |
| |
| if (!is_cxl_endpoint(port)) |
| return ERR_PTR(-EINVAL); |
| |
| cxled = kzalloc(sizeof(*cxled), GFP_KERNEL); |
| if (!cxled) |
| return ERR_PTR(-ENOMEM); |
| |
| cxled->pos = -1; |
| cxld = &cxled->cxld; |
| rc = cxl_decoder_init(port, cxld); |
| if (rc) { |
| kfree(cxled); |
| return ERR_PTR(rc); |
| } |
| |
| cxld->dev.type = &cxl_decoder_endpoint_type; |
| return cxled; |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_endpoint_decoder_alloc, CXL); |
| |
| /** |
| * cxl_decoder_add_locked - Add a decoder with targets |
| * @cxld: The cxl decoder allocated by cxl_<type>_decoder_alloc() |
| * @target_map: A list of downstream ports that this decoder can direct memory |
| * traffic to. These numbers should correspond with the port number |
| * in the PCIe Link Capabilities structure. |
| * |
| * Certain types of decoders may not have any targets. The main example of this |
| * is an endpoint device. A more awkward example is a hostbridge whose root |
| * ports get hot added (technically possible, though unlikely). |
| * |
| * This is the locked variant of cxl_decoder_add(). |
| * |
| * Context: Process context. Expects the device lock of the port that owns the |
| * @cxld to be held. |
| * |
| * Return: Negative error code if the decoder wasn't properly configured; else |
| * returns 0. |
| */ |
| int cxl_decoder_add_locked(struct cxl_decoder *cxld, int *target_map) |
| { |
| struct cxl_port *port; |
| struct device *dev; |
| int rc; |
| |
| if (WARN_ON_ONCE(!cxld)) |
| return -EINVAL; |
| |
| if (WARN_ON_ONCE(IS_ERR(cxld))) |
| return PTR_ERR(cxld); |
| |
| if (cxld->interleave_ways < 1) |
| return -EINVAL; |
| |
| dev = &cxld->dev; |
| |
| port = to_cxl_port(cxld->dev.parent); |
| if (!is_endpoint_decoder(dev)) { |
| struct cxl_switch_decoder *cxlsd = to_cxl_switch_decoder(dev); |
| |
| rc = decoder_populate_targets(cxlsd, port, target_map); |
| if (rc && (cxld->flags & CXL_DECODER_F_ENABLE)) { |
| dev_err(&port->dev, |
| "Failed to populate active decoder targets\n"); |
| return rc; |
| } |
| } |
| |
| rc = dev_set_name(dev, "decoder%d.%d", port->id, cxld->id); |
| if (rc) |
| return rc; |
| |
| return device_add(dev); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_decoder_add_locked, CXL); |
| |
| /** |
| * cxl_decoder_add - Add a decoder with targets |
| * @cxld: The cxl decoder allocated by cxl_<type>_decoder_alloc() |
| * @target_map: A list of downstream ports that this decoder can direct memory |
| * traffic to. These numbers should correspond with the port number |
| * in the PCIe Link Capabilities structure. |
| * |
| * This is the unlocked variant of cxl_decoder_add_locked(). |
| * See cxl_decoder_add_locked(). |
| * |
| * Context: Process context. Takes and releases the device lock of the port that |
| * owns the @cxld. |
| */ |
| int cxl_decoder_add(struct cxl_decoder *cxld, int *target_map) |
| { |
| struct cxl_port *port; |
| |
| if (WARN_ON_ONCE(!cxld)) |
| return -EINVAL; |
| |
| if (WARN_ON_ONCE(IS_ERR(cxld))) |
| return PTR_ERR(cxld); |
| |
| port = to_cxl_port(cxld->dev.parent); |
| |
| guard(device)(&port->dev); |
| return cxl_decoder_add_locked(cxld, target_map); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_decoder_add, CXL); |
| |
| static void cxld_unregister(void *dev) |
| { |
| struct cxl_endpoint_decoder *cxled; |
| |
| if (is_endpoint_decoder(dev)) { |
| cxled = to_cxl_endpoint_decoder(dev); |
| cxl_decoder_kill_region(cxled); |
| } |
| |
| device_unregister(dev); |
| } |
| |
| int cxl_decoder_autoremove(struct device *host, struct cxl_decoder *cxld) |
| { |
| return devm_add_action_or_reset(host, cxld_unregister, &cxld->dev); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_decoder_autoremove, CXL); |
| |
| /** |
| * __cxl_driver_register - register a driver for the cxl bus |
| * @cxl_drv: cxl driver structure to attach |
| * @owner: owning module/driver |
| * @modname: KBUILD_MODNAME for parent driver |
| */ |
| int __cxl_driver_register(struct cxl_driver *cxl_drv, struct module *owner, |
| const char *modname) |
| { |
| if (!cxl_drv->probe) { |
| pr_debug("%s ->probe() must be specified\n", modname); |
| return -EINVAL; |
| } |
| |
| if (!cxl_drv->name) { |
| pr_debug("%s ->name must be specified\n", modname); |
| return -EINVAL; |
| } |
| |
| if (!cxl_drv->id) { |
| pr_debug("%s ->id must be specified\n", modname); |
| return -EINVAL; |
| } |
| |
| cxl_drv->drv.bus = &cxl_bus_type; |
| cxl_drv->drv.owner = owner; |
| cxl_drv->drv.mod_name = modname; |
| cxl_drv->drv.name = cxl_drv->name; |
| |
| return driver_register(&cxl_drv->drv); |
| } |
| EXPORT_SYMBOL_NS_GPL(__cxl_driver_register, CXL); |
| |
| void cxl_driver_unregister(struct cxl_driver *cxl_drv) |
| { |
| driver_unregister(&cxl_drv->drv); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_driver_unregister, CXL); |
| |
| static int cxl_bus_uevent(const struct device *dev, struct kobj_uevent_env *env) |
| { |
| return add_uevent_var(env, "MODALIAS=" CXL_MODALIAS_FMT, |
| cxl_device_id(dev)); |
| } |
| |
| static int cxl_bus_match(struct device *dev, const struct device_driver *drv) |
| { |
| return cxl_device_id(dev) == to_cxl_drv(drv)->id; |
| } |
| |
| static int cxl_bus_probe(struct device *dev) |
| { |
| int rc; |
| |
| rc = to_cxl_drv(dev->driver)->probe(dev); |
| dev_dbg(dev, "probe: %d\n", rc); |
| return rc; |
| } |
| |
| static void cxl_bus_remove(struct device *dev) |
| { |
| struct cxl_driver *cxl_drv = to_cxl_drv(dev->driver); |
| |
| if (cxl_drv->remove) |
| cxl_drv->remove(dev); |
| } |
| |
| static struct workqueue_struct *cxl_bus_wq; |
| |
| static int cxl_rescan_attach(struct device *dev, void *data) |
| { |
| int rc = device_attach(dev); |
| |
| dev_vdbg(dev, "rescan: %s\n", rc ? "attach" : "detached"); |
| |
| return 0; |
| } |
| |
| static void cxl_bus_rescan_queue(struct work_struct *w) |
| { |
| bus_for_each_dev(&cxl_bus_type, NULL, NULL, cxl_rescan_attach); |
| } |
| |
| void cxl_bus_rescan(void) |
| { |
| static DECLARE_WORK(rescan_work, cxl_bus_rescan_queue); |
| |
| queue_work(cxl_bus_wq, &rescan_work); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_bus_rescan, CXL); |
| |
| void cxl_bus_drain(void) |
| { |
| drain_workqueue(cxl_bus_wq); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_bus_drain, CXL); |
| |
| bool schedule_cxl_memdev_detach(struct cxl_memdev *cxlmd) |
| { |
| return queue_work(cxl_bus_wq, &cxlmd->detach_work); |
| } |
| EXPORT_SYMBOL_NS_GPL(schedule_cxl_memdev_detach, CXL); |
| |
| static void add_latency(struct access_coordinate *c, long latency) |
| { |
| for (int i = 0; i < ACCESS_COORDINATE_MAX; i++) { |
| c[i].write_latency += latency; |
| c[i].read_latency += latency; |
| } |
| } |
| |
| static bool coordinates_valid(struct access_coordinate *c) |
| { |
| for (int i = 0; i < ACCESS_COORDINATE_MAX; i++) { |
| if (c[i].read_bandwidth && c[i].write_bandwidth && |
| c[i].read_latency && c[i].write_latency) |
| continue; |
| return false; |
| } |
| |
| return true; |
| } |
| |
| static void set_min_bandwidth(struct access_coordinate *c, unsigned int bw) |
| { |
| for (int i = 0; i < ACCESS_COORDINATE_MAX; i++) { |
| c[i].write_bandwidth = min(c[i].write_bandwidth, bw); |
| c[i].read_bandwidth = min(c[i].read_bandwidth, bw); |
| } |
| } |
| |
| static void set_access_coordinates(struct access_coordinate *out, |
| struct access_coordinate *in) |
| { |
| for (int i = 0; i < ACCESS_COORDINATE_MAX; i++) |
| out[i] = in[i]; |
| } |
| |
| static bool parent_port_is_cxl_root(struct cxl_port *port) |
| { |
| return is_cxl_root(to_cxl_port(port->dev.parent)); |
| } |
| |
| /** |
| * cxl_endpoint_get_perf_coordinates - Retrieve performance numbers stored in dports |
| * of CXL path |
| * @port: endpoint cxl_port |
| * @coord: output performance data |
| * |
| * Return: errno on failure, 0 on success. |
| */ |
| int cxl_endpoint_get_perf_coordinates(struct cxl_port *port, |
| struct access_coordinate *coord) |
| { |
| struct cxl_memdev *cxlmd = to_cxl_memdev(port->uport_dev); |
| struct access_coordinate c[] = { |
| { |
| .read_bandwidth = UINT_MAX, |
| .write_bandwidth = UINT_MAX, |
| }, |
| { |
| .read_bandwidth = UINT_MAX, |
| .write_bandwidth = UINT_MAX, |
| }, |
| }; |
| struct cxl_port *iter = port; |
| struct cxl_dport *dport; |
| struct pci_dev *pdev; |
| struct device *dev; |
| unsigned int bw; |
| bool is_cxl_root; |
| |
| if (!is_cxl_endpoint(port)) |
| return -EINVAL; |
| |
| /* |
| * Skip calculation for RCD. Expectation is HMAT already covers RCD case |
| * since RCH does not support hotplug. |
| */ |
| if (cxlmd->cxlds->rcd) |
| return 0; |
| |
| /* |
| * Exit the loop when the parent port of the current iter port is cxl |
| * root. The iterative loop starts at the endpoint and gathers the |
| * latency of the CXL link from the current device/port to the connected |
| * downstream port each iteration. |
| */ |
| do { |
| dport = iter->parent_dport; |
| iter = to_cxl_port(iter->dev.parent); |
| is_cxl_root = parent_port_is_cxl_root(iter); |
| |
| /* |
| * There's no valid access_coordinate for a root port since RPs do not |
| * have CDAT and therefore needs to be skipped. |
| */ |
| if (!is_cxl_root) { |
| if (!coordinates_valid(dport->coord)) |
| return -EINVAL; |
| cxl_coordinates_combine(c, c, dport->coord); |
| } |
| add_latency(c, dport->link_latency); |
| } while (!is_cxl_root); |
| |
| dport = iter->parent_dport; |
| /* Retrieve HB coords */ |
| if (!coordinates_valid(dport->coord)) |
| return -EINVAL; |
| cxl_coordinates_combine(c, c, dport->coord); |
| |
| dev = port->uport_dev->parent; |
| if (!dev_is_pci(dev)) |
| return -ENODEV; |
| |
| /* Get the calculated PCI paths bandwidth */ |
| pdev = to_pci_dev(dev); |
| bw = pcie_bandwidth_available(pdev, NULL, NULL, NULL); |
| if (bw == 0) |
| return -ENXIO; |
| bw /= BITS_PER_BYTE; |
| |
| set_min_bandwidth(c, bw); |
| set_access_coordinates(coord, c); |
| |
| return 0; |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_endpoint_get_perf_coordinates, CXL); |
| |
| int cxl_port_get_switch_dport_bandwidth(struct cxl_port *port, |
| struct access_coordinate *c) |
| { |
| struct cxl_dport *dport = port->parent_dport; |
| |
| /* Check this port is connected to a switch DSP and not an RP */ |
| if (parent_port_is_cxl_root(to_cxl_port(port->dev.parent))) |
| return -ENODEV; |
| |
| if (!coordinates_valid(dport->coord)) |
| return -EINVAL; |
| |
| for (int i = 0; i < ACCESS_COORDINATE_MAX; i++) { |
| c[i].read_bandwidth = dport->coord[i].read_bandwidth; |
| c[i].write_bandwidth = dport->coord[i].write_bandwidth; |
| } |
| |
| return 0; |
| } |
| |
| /* for user tooling to ensure port disable work has completed */ |
| static ssize_t flush_store(const struct bus_type *bus, const char *buf, size_t count) |
| { |
| if (sysfs_streq(buf, "1")) { |
| flush_workqueue(cxl_bus_wq); |
| return count; |
| } |
| |
| return -EINVAL; |
| } |
| |
| static BUS_ATTR_WO(flush); |
| |
| static struct attribute *cxl_bus_attributes[] = { |
| &bus_attr_flush.attr, |
| NULL, |
| }; |
| |
| static struct attribute_group cxl_bus_attribute_group = { |
| .attrs = cxl_bus_attributes, |
| }; |
| |
| static const struct attribute_group *cxl_bus_attribute_groups[] = { |
| &cxl_bus_attribute_group, |
| NULL, |
| }; |
| |
| struct bus_type cxl_bus_type = { |
| .name = "cxl", |
| .uevent = cxl_bus_uevent, |
| .match = cxl_bus_match, |
| .probe = cxl_bus_probe, |
| .remove = cxl_bus_remove, |
| .bus_groups = cxl_bus_attribute_groups, |
| }; |
| EXPORT_SYMBOL_NS_GPL(cxl_bus_type, CXL); |
| |
| static struct dentry *cxl_debugfs; |
| |
| struct dentry *cxl_debugfs_create_dir(const char *dir) |
| { |
| return debugfs_create_dir(dir, cxl_debugfs); |
| } |
| EXPORT_SYMBOL_NS_GPL(cxl_debugfs_create_dir, CXL); |
| |
| static __init int cxl_core_init(void) |
| { |
| int rc; |
| |
| cxl_debugfs = debugfs_create_dir("cxl", NULL); |
| |
| if (einj_cxl_is_initialized()) |
| debugfs_create_file("einj_types", 0400, cxl_debugfs, NULL, |
| &einj_cxl_available_error_type_fops); |
| |
| cxl_mbox_init(); |
| |
| rc = cxl_memdev_init(); |
| if (rc) |
| return rc; |
| |
| cxl_bus_wq = alloc_ordered_workqueue("cxl_port", 0); |
| if (!cxl_bus_wq) { |
| rc = -ENOMEM; |
| goto err_wq; |
| } |
| |
| rc = bus_register(&cxl_bus_type); |
| if (rc) |
| goto err_bus; |
| |
| rc = cxl_region_init(); |
| if (rc) |
| goto err_region; |
| |
| return 0; |
| |
| err_region: |
| bus_unregister(&cxl_bus_type); |
| err_bus: |
| destroy_workqueue(cxl_bus_wq); |
| err_wq: |
| cxl_memdev_exit(); |
| return rc; |
| } |
| |
| static void cxl_core_exit(void) |
| { |
| cxl_region_exit(); |
| bus_unregister(&cxl_bus_type); |
| destroy_workqueue(cxl_bus_wq); |
| cxl_memdev_exit(); |
| debugfs_remove_recursive(cxl_debugfs); |
| } |
| |
| subsys_initcall(cxl_core_init); |
| module_exit(cxl_core_exit); |
| MODULE_DESCRIPTION("CXL: Core Compute Express Link support"); |
| MODULE_LICENSE("GPL v2"); |
| MODULE_IMPORT_NS(CXL); |