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)  *  Port on Texas Instruments TMS320C6x architecture
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  *  Copyright (C) 2004, 2009, 2010, 2011 Texas Instruments Incorporated
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  *  Author: Aurelien Jacquiot (aurelien.jacquiot@jaluna.com)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #ifndef _ASM_C6X_DELAY_H
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #define _ASM_C6X_DELAY_H
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) extern unsigned int ticks_per_ns_scaled;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) static inline void __delay(unsigned long loops)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	uint32_t tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	/* 6 cycles per loop */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	asm volatile ("        mv    .s1  %0,%1\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 		      "0: [%1] b     .s1  0b\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 		      "        add   .l1  -6,%0,%0\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 		      "        cmplt .l1  1,%0,%1\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 		      "        nop   3\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 		      : "+a"(loops), "=A"(tmp));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) static inline void _c6x_tickdelay(unsigned int x)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	uint32_t cnt, endcnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	asm volatile ("        mvc   .s2   TSCL,%0\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 		      "        add   .s2x  %0,%1,%2\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 		      " ||     mvk   .l2   1,B0\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 		      "0: [B0] b     .s2   0b\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 		      "        mvc   .s2   TSCL,%0\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 		      "        sub   .s2   %0,%2,%0\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 		      "        cmpgt .l2   0,%0,B0\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 		      "        nop   2\n"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 		      : "=b"(cnt), "+a"(x), "=b"(endcnt) : : "B0");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) /* use scaled math to avoid slow division */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define C6X_NDELAY_SCALE 10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) static inline void _ndelay(unsigned int n)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	_c6x_tickdelay((ticks_per_ns_scaled * n) >> C6X_NDELAY_SCALE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) static inline void _udelay(unsigned int n)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 	while (n >= 10) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 		_ndelay(10000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 		n -= 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	while (n-- > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 		_ndelay(1000);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) #define udelay(x) _udelay((unsigned int)(x))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) #define ndelay(x) _ndelay((unsigned int)(x))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) #endif /* _ASM_C6X_DELAY_H */