Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2)  * Copyright (C) 2009 Wind River Systems Inc
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  *   Implemented by fredrik.markstrom@gmail.com and ivarholmqvist@gmail.com
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * This file is subject to the terms and conditions of the GNU General Public
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  * License.  See the file "COPYING" in the main directory of this archive
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  * for more details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/sched.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <asm/cpuinfo.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) /* pteaddr:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16)  *   ptbase | vpn* | zero
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)  *   31-22  | 21-2 | 1-0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)  *   *vpn is preserved on double fault
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)  * tlbacc:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)  *   IG   |*flags| pfn
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)  *   31-25|24-20 | 19-0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)  *   *crwxg
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)  * tlbmisc:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28)  *   resv  |way   |rd | we|pid |dbl|bad|perm|d
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)  *   31-24 |23-20 |19 | 20|17-4|3  |2  |1   |0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)  * Initialize a new pgd / pmd table with invalid pointers.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) static void pgd_init(pgd_t *pgd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	unsigned long *p = (unsigned long *) pgd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	for (i = 0; i < USER_PTRS_PER_PGD; i += 8) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 		p[i + 0] = (unsigned long) invalid_pte_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 		p[i + 1] = (unsigned long) invalid_pte_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 		p[i + 2] = (unsigned long) invalid_pte_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 		p[i + 3] = (unsigned long) invalid_pte_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 		p[i + 4] = (unsigned long) invalid_pte_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 		p[i + 5] = (unsigned long) invalid_pte_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 		p[i + 6] = (unsigned long) invalid_pte_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 		p[i + 7] = (unsigned long) invalid_pte_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) pgd_t *pgd_alloc(struct mm_struct *mm)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 	pgd_t *ret, *init;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	ret = (pgd_t *) __get_free_pages(GFP_KERNEL, PGD_ORDER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 		init = pgd_offset(&init_mm, 0UL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 		pgd_init(ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 		memcpy(ret + USER_PTRS_PER_PGD, init + USER_PTRS_PER_PGD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 		       (PTRS_PER_PGD - USER_PTRS_PER_PGD) * sizeof(pgd_t));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) void __init pagetable_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 	/* Initialize the entire pgd.  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 	pgd_init(swapper_pg_dir);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 	pgd_init(swapper_pg_dir + USER_PTRS_PER_PGD);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) }