Dave Jiang | efebc71 | 2017-04-07 15:33:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2016, Intel Corporation. |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or modify it |
| 5 | * under the terms and conditions of the GNU General Public License, |
| 6 | * version 2, as published by the Free Software Foundation. |
| 7 | * |
| 8 | * This program is distributed in the hope it will be useful, but WITHOUT |
| 9 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| 10 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| 11 | * more details. |
| 12 | */ |
| 13 | #include "test/nfit_test.h" |
| 14 | #include <linux/mm.h> |
| 15 | #include "../../../drivers/dax/dax-private.h" |
| 16 | |
Dan Williams | 7361636 | 2017-05-04 23:38:43 -0700 | [diff] [blame^] | 17 | phys_addr_t dax_pgoff_to_phys(struct dev_dax *dev_dax, pgoff_t pgoff, |
Dave Jiang | efebc71 | 2017-04-07 15:33:36 -0700 | [diff] [blame] | 18 | unsigned long size) |
| 19 | { |
| 20 | struct resource *res; |
| 21 | phys_addr_t addr; |
| 22 | int i; |
| 23 | |
Dan Williams | 7361636 | 2017-05-04 23:38:43 -0700 | [diff] [blame^] | 24 | for (i = 0; i < dev_dax->num_resources; i++) { |
| 25 | res = &dev_dax->res[i]; |
Dave Jiang | efebc71 | 2017-04-07 15:33:36 -0700 | [diff] [blame] | 26 | addr = pgoff * PAGE_SIZE + res->start; |
| 27 | if (addr >= res->start && addr <= res->end) |
| 28 | break; |
| 29 | pgoff -= PHYS_PFN(resource_size(res)); |
| 30 | } |
| 31 | |
Dan Williams | 7361636 | 2017-05-04 23:38:43 -0700 | [diff] [blame^] | 32 | if (i < dev_dax->num_resources) { |
| 33 | res = &dev_dax->res[i]; |
Dave Jiang | efebc71 | 2017-04-07 15:33:36 -0700 | [diff] [blame] | 34 | if (addr + size - 1 <= res->end) { |
| 35 | if (get_nfit_res(addr)) { |
| 36 | struct page *page; |
| 37 | |
Dan Williams | 7361636 | 2017-05-04 23:38:43 -0700 | [diff] [blame^] | 38 | if (dev_dax->region->align > PAGE_SIZE) |
Dave Jiang | efebc71 | 2017-04-07 15:33:36 -0700 | [diff] [blame] | 39 | return -1; |
| 40 | |
| 41 | page = vmalloc_to_page((void *)addr); |
| 42 | return PFN_PHYS(page_to_pfn(page)); |
| 43 | } else |
| 44 | return addr; |
| 45 | } |
| 46 | } |
| 47 | |
| 48 | return -1; |
| 49 | } |