Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) // Copyright (C) 2005-2017 Andes Technology Corporation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4) #include <linux/syscalls.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #include <asm/cachectl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include <asm/proc-fns.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #include <asm/fpu.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <asm/fp_udfiex_crtl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) SYSCALL_DEFINE6(mmap2, unsigned long, addr, unsigned long, len,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 	       unsigned long, prot, unsigned long, flags,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 	       unsigned long, fd, unsigned long, pgoff)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	if (pgoff & (~PAGE_MASK >> 12))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	return sys_mmap_pgoff(addr, len, prot, flags, fd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 			      pgoff >> (PAGE_SHIFT - 12));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) SYSCALL_DEFINE4(fadvise64_64_wrapper,int, fd, int, advice, loff_t, offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 					 loff_t, len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	return sys_fadvise64_64(fd, offset, len, advice);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) SYSCALL_DEFINE3(cacheflush, unsigned int, start, unsigned int, end, int, cache)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	struct vm_area_struct *vma;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	bool flushi = true, wbd = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	vma = find_vma(current->mm, start);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	if (!vma)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 	switch (cache) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	case ICACHE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 		wbd = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	case DCACHE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 		flushi = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	case BCACHE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	cpu_cache_wbinval_range_check(vma, start, end, flushi, wbd);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) SYSCALL_DEFINE2(fp_udfiex_crtl, unsigned int, cmd, unsigned int, act)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) #if IS_ENABLED(CONFIG_SUPPORT_DENORMAL_ARITHMETIC)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	int old_udf_iex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 	if (!used_math()) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 		load_fpu(&init_fpuregs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 		current->thread.fpu.UDF_IEX_trap = init_fpuregs.UDF_IEX_trap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 		set_used_math();
^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) 	old_udf_iex = current->thread.fpu.UDF_IEX_trap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 	act &= (FPCSR_mskUDFE | FPCSR_mskIEXE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 	case DISABLE_UDF_IEX_TRAP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 		current->thread.fpu.UDF_IEX_trap &= ~act;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 	case ENABLE_UDF_IEX_TRAP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 		current->thread.fpu.UDF_IEX_trap |= act;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) 	case GET_UDF_IEX_TRAP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) 	return old_udf_iex;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) 	return -ENOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) }