12025cf9eSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2f295e53bSDan Williams /*
3f295e53bSDan Williams * Copyright (c) 2014-2016, Intel Corporation.
4f295e53bSDan Williams */
5f295e53bSDan Williams #include "test/nfit_test.h"
6f295e53bSDan Williams #include <linux/blkdev.h>
7*e511c4a3SJane Chu #include <linux/dax.h>
8f295e53bSDan Williams #include <pmem.h>
9f295e53bSDan Williams #include <nd.h>
10f295e53bSDan Williams
__pmem_direct_access(struct pmem_device * pmem,pgoff_t pgoff,long nr_pages,enum dax_access_mode mode,void ** kaddr,pfn_t * pfn)11c1d6e828SDan Williams long __pmem_direct_access(struct pmem_device *pmem, pgoff_t pgoff,
12*e511c4a3SJane Chu long nr_pages, enum dax_access_mode mode, void **kaddr,
13*e511c4a3SJane Chu pfn_t *pfn)
14f295e53bSDan Williams {
15c1d6e828SDan Williams resource_size_t offset = PFN_PHYS(pgoff) + pmem->data_offset;
16f295e53bSDan Williams
17c1d6e828SDan Williams if (unlikely(is_bad_pmem(&pmem->bb, PFN_PHYS(pgoff) / 512,
18c1d6e828SDan Williams PFN_PHYS(nr_pages))))
19f295e53bSDan Williams return -EIO;
20ee8520feSDan Williams
21ee8520feSDan Williams /*
22ee8520feSDan Williams * Limit dax to a single page at a time given vmalloc()-backed
23ee8520feSDan Williams * in the nfit_test case.
24ee8520feSDan Williams */
25ee8520feSDan Williams if (get_nfit_res(pmem->phys_addr + offset)) {
26ee8520feSDan Williams struct page *page;
27ee8520feSDan Williams
2845df5d3dSHuaisheng Ye if (kaddr)
29ee8520feSDan Williams *kaddr = pmem->virt_addr + offset;
30ee8520feSDan Williams page = vmalloc_to_page(pmem->virt_addr + offset);
3145df5d3dSHuaisheng Ye if (pfn)
32ee8520feSDan Williams *pfn = page_to_pfn_t(page);
33c1d6e828SDan Williams pr_debug_ratelimited("%s: pmem: %p pgoff: %#lx pfn: %#lx\n",
34c1d6e828SDan Williams __func__, pmem, pgoff, page_to_pfn(page));
35ee8520feSDan Williams
36c1d6e828SDan Williams return 1;
37ee8520feSDan Williams }
38ee8520feSDan Williams
3945df5d3dSHuaisheng Ye if (kaddr)
40f295e53bSDan Williams *kaddr = pmem->virt_addr + offset;
4145df5d3dSHuaisheng Ye if (pfn)
42f295e53bSDan Williams *pfn = phys_to_pfn_t(pmem->phys_addr + offset, pmem->pfn_flags);
43f295e53bSDan Williams
44f295e53bSDan Williams /*
45f295e53bSDan Williams * If badblocks are present, limit known good range to the
46f295e53bSDan Williams * requested range.
47f295e53bSDan Williams */
48f295e53bSDan Williams if (unlikely(pmem->bb.count))
49c1d6e828SDan Williams return nr_pages;
50c1d6e828SDan Williams return PHYS_PFN(pmem->size - pmem->pfn_pad - offset);
51f295e53bSDan Williams }
52