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", &region_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