18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/* Copyright(c) 2016 - 2018 Intel Corporation. All rights reserved. */
38c2ecf20Sopenharmony_ci#include <linux/memremap.h>
48c2ecf20Sopenharmony_ci#include <linux/module.h>
58c2ecf20Sopenharmony_ci#include <linux/pfn_t.h>
68c2ecf20Sopenharmony_ci#include "../../nvdimm/pfn.h"
78c2ecf20Sopenharmony_ci#include "../../nvdimm/nd.h"
88c2ecf20Sopenharmony_ci#include "../bus.h"
98c2ecf20Sopenharmony_ci
108c2ecf20Sopenharmony_cistruct dev_dax *__dax_pmem_probe(struct device *dev, enum dev_dax_subsys subsys)
118c2ecf20Sopenharmony_ci{
128c2ecf20Sopenharmony_ci	struct range range;
138c2ecf20Sopenharmony_ci	int rc, id, region_id;
148c2ecf20Sopenharmony_ci	resource_size_t offset;
158c2ecf20Sopenharmony_ci	struct nd_pfn_sb *pfn_sb;
168c2ecf20Sopenharmony_ci	struct dev_dax *dev_dax;
178c2ecf20Sopenharmony_ci	struct dev_dax_data data;
188c2ecf20Sopenharmony_ci	struct nd_namespace_io *nsio;
198c2ecf20Sopenharmony_ci	struct dax_region *dax_region;
208c2ecf20Sopenharmony_ci	struct dev_pagemap pgmap = { };
218c2ecf20Sopenharmony_ci	struct nd_namespace_common *ndns;
228c2ecf20Sopenharmony_ci	struct nd_dax *nd_dax = to_nd_dax(dev);
238c2ecf20Sopenharmony_ci	struct nd_pfn *nd_pfn = &nd_dax->nd_pfn;
248c2ecf20Sopenharmony_ci	struct nd_region *nd_region = to_nd_region(dev->parent);
258c2ecf20Sopenharmony_ci
268c2ecf20Sopenharmony_ci	ndns = nvdimm_namespace_common_probe(dev);
278c2ecf20Sopenharmony_ci	if (IS_ERR(ndns))
288c2ecf20Sopenharmony_ci		return ERR_CAST(ndns);
298c2ecf20Sopenharmony_ci
308c2ecf20Sopenharmony_ci	/* parse the 'pfn' info block via ->rw_bytes */
318c2ecf20Sopenharmony_ci	rc = devm_namespace_enable(dev, ndns, nd_info_block_reserve());
328c2ecf20Sopenharmony_ci	if (rc)
338c2ecf20Sopenharmony_ci		return ERR_PTR(rc);
348c2ecf20Sopenharmony_ci	rc = nvdimm_setup_pfn(nd_pfn, &pgmap);
358c2ecf20Sopenharmony_ci	if (rc)
368c2ecf20Sopenharmony_ci		return ERR_PTR(rc);
378c2ecf20Sopenharmony_ci	devm_namespace_disable(dev, ndns);
388c2ecf20Sopenharmony_ci
398c2ecf20Sopenharmony_ci	/* reserve the metadata area, device-dax will reserve the data */
408c2ecf20Sopenharmony_ci	pfn_sb = nd_pfn->pfn_sb;
418c2ecf20Sopenharmony_ci	offset = le64_to_cpu(pfn_sb->dataoff);
428c2ecf20Sopenharmony_ci	nsio = to_nd_namespace_io(&ndns->dev);
438c2ecf20Sopenharmony_ci	if (!devm_request_mem_region(dev, nsio->res.start, offset,
448c2ecf20Sopenharmony_ci				dev_name(&ndns->dev))) {
458c2ecf20Sopenharmony_ci		dev_warn(dev, "could not reserve metadata\n");
468c2ecf20Sopenharmony_ci		return ERR_PTR(-EBUSY);
478c2ecf20Sopenharmony_ci	}
488c2ecf20Sopenharmony_ci
498c2ecf20Sopenharmony_ci	rc = sscanf(dev_name(&ndns->dev), "namespace%d.%d", &region_id, &id);
508c2ecf20Sopenharmony_ci	if (rc != 2)
518c2ecf20Sopenharmony_ci		return ERR_PTR(-EINVAL);
528c2ecf20Sopenharmony_ci
538c2ecf20Sopenharmony_ci	/* adjust the dax_region range to the start of data */
548c2ecf20Sopenharmony_ci	range = pgmap.range;
558c2ecf20Sopenharmony_ci	range.start += offset,
568c2ecf20Sopenharmony_ci	dax_region = alloc_dax_region(dev, region_id, &range,
578c2ecf20Sopenharmony_ci			nd_region->target_node, le32_to_cpu(pfn_sb->align),
588c2ecf20Sopenharmony_ci			IORESOURCE_DAX_STATIC);
598c2ecf20Sopenharmony_ci	if (!dax_region)
608c2ecf20Sopenharmony_ci		return ERR_PTR(-ENOMEM);
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_ci	data = (struct dev_dax_data) {
638c2ecf20Sopenharmony_ci		.dax_region = dax_region,
648c2ecf20Sopenharmony_ci		.id = id,
658c2ecf20Sopenharmony_ci		.pgmap = &pgmap,
668c2ecf20Sopenharmony_ci		.subsys = subsys,
678c2ecf20Sopenharmony_ci		.size = range_len(&range),
688c2ecf20Sopenharmony_ci	};
698c2ecf20Sopenharmony_ci	dev_dax = devm_create_dev_dax(&data);
708c2ecf20Sopenharmony_ci
718c2ecf20Sopenharmony_ci	/* child dev_dax instances now own the lifetime of the dax_region */
728c2ecf20Sopenharmony_ci	dax_region_put(dax_region);
738c2ecf20Sopenharmony_ci
748c2ecf20Sopenharmony_ci	return dev_dax;
758c2ecf20Sopenharmony_ci}
768c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(__dax_pmem_probe);
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL v2");
798c2ecf20Sopenharmony_ciMODULE_AUTHOR("Intel Corporation");
80