@@ -379,6 +379,38 @@ static int devm_cxl_link_uport(struct device *host, struct cxl_port *port)
return devm_add_action_or_reset(host, cxl_unlink_uport, port);
}
+static int cxl_port_map_component_registers(struct cxl_port *port,
+ struct cxl_component_regs *regs)
+{
+ struct cxl_register_map map;
+ struct cxl_component_reg_map *comp_map = &map.component_map;
+ void __iomem *crb;
+
+ if (port->component_reg_phys == CXL_RESOURCE_NONE)
+ return 0;
+
+ crb = devm_cxl_iomap_block(&port->dev,
+ port->component_reg_phys,
+ /* CXL_COMPONENT_REG_BLOCK_SIZE */ SZ_64K);
+ if (IS_ERR(crb))
+ return PTR_ERR(crb);
+
+ if (!crb) {
+ dev_err(&port->dev, "No component registers mapped\n");
+ return -ENXIO;
+ }
+
+ cxl_probe_component_regs(&port->dev, crb, comp_map);
+ if (!comp_map->hdm_decoder.valid) {
+ dev_err(&port->dev, "HDM decoder registers invalid\n");
+ return -ENXIO;
+ }
+
+ regs->hdm_decoder = crb + comp_map->hdm_decoder.offset;
+
+ return 0;
+}
+
static struct cxl_port *cxl_port_alloc(struct device *uport,
resource_size_t component_reg_phys,
struct cxl_port *parent_port)
@@ -436,6 +468,7 @@ struct cxl_port *devm_cxl_add_port(struct device *host, struct device *uport,
resource_size_t component_reg_phys,
struct cxl_port *parent_port)
{
+ struct cxl_component_regs crb;
struct cxl_port *port;
struct device *dev;
int rc;
@@ -467,6 +500,10 @@ struct cxl_port *devm_cxl_add_port(struct device *host, struct device *uport,
if (rc)
return ERR_PTR(rc);
+ rc = cxl_port_map_component_registers(port, &crb);
+ if (rc)
+ return ERR_PTR(rc);
+
return port;
err:
@@ -144,9 +144,8 @@ void cxl_probe_device_regs(struct device *dev, void __iomem *base,
}
EXPORT_SYMBOL_GPL(cxl_probe_device_regs);
-static void __iomem *devm_cxl_iomap_block(struct device *dev,
- resource_size_t addr,
- resource_size_t length)
+void __iomem *devm_cxl_iomap_block(struct device *dev, resource_size_t addr,
+ resource_size_t length)
{
void __iomem *ret_val;
struct resource *res;
@@ -165,6 +164,7 @@ static void __iomem *devm_cxl_iomap_block(struct device *dev,
return ret_val;
}
+EXPORT_SYMBOL_GPL(devm_cxl_iomap_block);
int cxl_map_component_regs(struct pci_dev *pdev,
struct cxl_component_regs *regs,
@@ -149,6 +149,8 @@ struct cxl_register_map {
};
};
+void __iomem *devm_cxl_iomap_block(struct device *dev, resource_size_t addr,
+ resource_size_t length);
void cxl_probe_component_regs(struct device *dev, void __iomem *base,
struct cxl_component_reg_map *map);
void cxl_probe_device_regs(struct device *dev, void __iomem *base,
@@ -59,7 +59,7 @@ static int cxl_memdev_probe(struct device *dev)
}
rc = PTR_ERR_OR_ZERO(devm_cxl_add_port(&cxlmd->dev, &cxlmd->dev,
- CXL_RESOURCE_NONE,
+ cxlmd->component_reg_phys,
to_cxl_port(port_dev)));
if (rc)
dev_err(dev, "Unable to add devices upstream port");
@@ -50,6 +50,7 @@ struct cxl_memdev {
struct cxl_mem *cxlm;
int id;
void (*shutdown)(struct cxl_memdev *cxlmd);
+ unsigned long component_reg_phys;
};
struct cxl_memdev *
@@ -1345,7 +1345,7 @@ static int cxl_mem_probe(struct pci_dev *pdev, const struct pci_device_id *id)
struct cxl_register_map maps[CXL_REGLOC_RBI_TYPES];
struct cxl_memdev *cxlmd;
struct cxl_mem *cxlm;
- int rc;
+ int rc, i;
rc = pcim_enable_device(pdev);
if (rc)
@@ -1376,6 +1376,17 @@ static int cxl_mem_probe(struct pci_dev *pdev, const struct pci_device_id *id)
if (IS_ERR(cxlmd))
return PTR_ERR(cxlmd);
+ for (i = 0; i < ARRAY_SIZE(maps); i++) {
+ struct cxl_register_map *map = &maps[i];
+
+ if (map->reg_type != CXL_REGLOC_RBI_COMPONENT)
+ continue;
+
+ cxlmd->component_reg_phys =
+ pci_resource_start(pdev, map->barno) +
+ map->block_offset;
+ }
+
if (range_len(&cxlm->pmem_range) && IS_ENABLED(CONFIG_CXL_PMEM))
rc = devm_cxl_add_nvdimm(&pdev->dev, cxlmd);
Signed-off-by: Ben Widawsky <ben.widawsky@intel.com> --- drivers/cxl/core/bus.c | 37 +++++++++++++++++++++++++++++++++++++ drivers/cxl/core/regs.c | 6 +++--- drivers/cxl/cxl.h | 2 ++ drivers/cxl/mem.c | 2 +- drivers/cxl/mem.h | 1 + drivers/cxl/pci.c | 13 ++++++++++++- 6 files changed, 56 insertions(+), 5 deletions(-)