162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* Copyright(c) 2016 - 2018 Intel Corporation. All rights reserved. */ 362306a36Sopenharmony_ci#include <linux/memremap.h> 462306a36Sopenharmony_ci#include <linux/module.h> 562306a36Sopenharmony_ci#include <linux/pfn_t.h> 662306a36Sopenharmony_ci#include "../nvdimm/pfn.h" 762306a36Sopenharmony_ci#include "../nvdimm/nd.h" 862306a36Sopenharmony_ci#include "bus.h" 962306a36Sopenharmony_ci 1062306a36Sopenharmony_cistatic struct dev_dax *__dax_pmem_probe(struct device *dev) 1162306a36Sopenharmony_ci{ 1262306a36Sopenharmony_ci struct range range; 1362306a36Sopenharmony_ci int rc, id, region_id; 1462306a36Sopenharmony_ci resource_size_t offset; 1562306a36Sopenharmony_ci struct nd_pfn_sb *pfn_sb; 1662306a36Sopenharmony_ci struct dev_dax_data data; 1762306a36Sopenharmony_ci struct nd_namespace_io *nsio; 1862306a36Sopenharmony_ci struct dax_region *dax_region; 1962306a36Sopenharmony_ci struct dev_pagemap pgmap = { }; 2062306a36Sopenharmony_ci struct nd_namespace_common *ndns; 2162306a36Sopenharmony_ci struct nd_dax *nd_dax = to_nd_dax(dev); 2262306a36Sopenharmony_ci struct nd_pfn *nd_pfn = &nd_dax->nd_pfn; 2362306a36Sopenharmony_ci struct nd_region *nd_region = to_nd_region(dev->parent); 2462306a36Sopenharmony_ci 2562306a36Sopenharmony_ci ndns = nvdimm_namespace_common_probe(dev); 2662306a36Sopenharmony_ci if (IS_ERR(ndns)) 2762306a36Sopenharmony_ci return ERR_CAST(ndns); 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci /* parse the 'pfn' info block via ->rw_bytes */ 3062306a36Sopenharmony_ci rc = devm_namespace_enable(dev, ndns, nd_info_block_reserve()); 3162306a36Sopenharmony_ci if (rc) 3262306a36Sopenharmony_ci return ERR_PTR(rc); 3362306a36Sopenharmony_ci rc = nvdimm_setup_pfn(nd_pfn, &pgmap); 3462306a36Sopenharmony_ci if (rc) 3562306a36Sopenharmony_ci return ERR_PTR(rc); 3662306a36Sopenharmony_ci devm_namespace_disable(dev, ndns); 3762306a36Sopenharmony_ci 3862306a36Sopenharmony_ci /* reserve the metadata area, device-dax will reserve the data */ 3962306a36Sopenharmony_ci pfn_sb = nd_pfn->pfn_sb; 4062306a36Sopenharmony_ci offset = le64_to_cpu(pfn_sb->dataoff); 4162306a36Sopenharmony_ci nsio = to_nd_namespace_io(&ndns->dev); 4262306a36Sopenharmony_ci if (!devm_request_mem_region(dev, nsio->res.start, offset, 4362306a36Sopenharmony_ci dev_name(&ndns->dev))) { 4462306a36Sopenharmony_ci dev_warn(dev, "could not reserve metadata\n"); 4562306a36Sopenharmony_ci return ERR_PTR(-EBUSY); 4662306a36Sopenharmony_ci } 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci rc = sscanf(dev_name(&ndns->dev), "namespace%d.%d", ®ion_id, &id); 4962306a36Sopenharmony_ci if (rc != 2) 5062306a36Sopenharmony_ci return ERR_PTR(-EINVAL); 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_ci /* adjust the dax_region range to the start of data */ 5362306a36Sopenharmony_ci range = pgmap.range; 5462306a36Sopenharmony_ci range.start += offset; 5562306a36Sopenharmony_ci dax_region = alloc_dax_region(dev, region_id, &range, 5662306a36Sopenharmony_ci nd_region->target_node, le32_to_cpu(pfn_sb->align), 5762306a36Sopenharmony_ci IORESOURCE_DAX_STATIC); 5862306a36Sopenharmony_ci if (!dax_region) 5962306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci data = (struct dev_dax_data) { 6262306a36Sopenharmony_ci .dax_region = dax_region, 6362306a36Sopenharmony_ci .id = id, 6462306a36Sopenharmony_ci .pgmap = &pgmap, 6562306a36Sopenharmony_ci .size = range_len(&range), 6662306a36Sopenharmony_ci }; 6762306a36Sopenharmony_ci 6862306a36Sopenharmony_ci return devm_create_dev_dax(&data); 6962306a36Sopenharmony_ci} 7062306a36Sopenharmony_ci 7162306a36Sopenharmony_cistatic int dax_pmem_probe(struct device *dev) 7262306a36Sopenharmony_ci{ 7362306a36Sopenharmony_ci return PTR_ERR_OR_ZERO(__dax_pmem_probe(dev)); 7462306a36Sopenharmony_ci} 7562306a36Sopenharmony_ci 7662306a36Sopenharmony_cistatic struct nd_device_driver dax_pmem_driver = { 7762306a36Sopenharmony_ci .probe = dax_pmem_probe, 7862306a36Sopenharmony_ci .drv = { 7962306a36Sopenharmony_ci .name = "dax_pmem", 8062306a36Sopenharmony_ci }, 8162306a36Sopenharmony_ci .type = ND_DRIVER_DAX_PMEM, 8262306a36Sopenharmony_ci}; 8362306a36Sopenharmony_ci 8462306a36Sopenharmony_cistatic int __init dax_pmem_init(void) 8562306a36Sopenharmony_ci{ 8662306a36Sopenharmony_ci return nd_driver_register(&dax_pmem_driver); 8762306a36Sopenharmony_ci} 8862306a36Sopenharmony_cimodule_init(dax_pmem_init); 8962306a36Sopenharmony_ci 9062306a36Sopenharmony_cistatic void __exit dax_pmem_exit(void) 9162306a36Sopenharmony_ci{ 9262306a36Sopenharmony_ci driver_unregister(&dax_pmem_driver.drv); 9362306a36Sopenharmony_ci} 9462306a36Sopenharmony_cimodule_exit(dax_pmem_exit); 9562306a36Sopenharmony_ci 9662306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 9762306a36Sopenharmony_ciMODULE_AUTHOR("Intel Corporation"); 9862306a36Sopenharmony_ciMODULE_ALIAS_ND_DEVICE(ND_DEVICE_DAX_PMEM); 99