Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * Copyright (c) 2016, Intel Corporation.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) #include "test/nfit_test.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #include "../../../drivers/dax/dax-private.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) phys_addr_t dax_pgoff_to_phys(struct dev_dax *dev_dax, pgoff_t pgoff,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) 		unsigned long size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	for (i = 0; i < dev_dax->nr_range; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 		struct dev_dax_range *dax_range = &dev_dax->ranges[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 		struct range *range = &dax_range->range;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 		unsigned long long pgoff_end;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 		phys_addr_t addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 		pgoff_end = dax_range->pgoff + PHYS_PFN(range_len(range)) - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 		if (pgoff < dax_range->pgoff || pgoff > pgoff_end)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 			continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 		addr = PFN_PHYS(pgoff - dax_range->pgoff) + range->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 		if (addr + size - 1 <= range->end) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 			if (get_nfit_res(addr)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 				struct page *page;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 				if (dev_dax->region->align > PAGE_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 					return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 				page = vmalloc_to_page((void *)addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 				return PFN_PHYS(page_to_pfn(page));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 			return addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) }