xref: /openbmc/linux/arch/sh/lib/io.c (revision 4494ce4f)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * arch/sh/lib/io.c - SH32 optimized I/O routines
4  *
5  * Copyright (C) 2000  Stuart Menefy
6  * Copyright (C) 2005  Paul Mundt
7  *
8  * Provide real functions which expand to whatever the header file defined.
9  * Also definitions of machine independent IO functions.
10  */
11 #include <linux/module.h>
12 #include <linux/io.h>
13 
__raw_readsl(const void __iomem * addr,void * datap,int len)14 void __raw_readsl(const void __iomem *addr, void *datap, int len)
15 {
16 	u32 *data;
17 
18 	for (data = datap; (len != 0) && (((u32)data & 0x1f) != 0); len--)
19 		*data++ = __raw_readl(addr);
20 
21 	if (likely(len >= (0x20 >> 2))) {
22 		int tmp2, tmp3, tmp4, tmp5, tmp6;
23 
24 		__asm__ __volatile__(
25 			"1:			\n\t"
26 			"mov.l	@%7, r0		\n\t"
27 			"mov.l	@%7, %2		\n\t"
28 #ifdef CONFIG_CPU_SH4
29 			"movca.l r0, @%0	\n\t"
30 #else
31 			"mov.l	r0, @%0		\n\t"
32 #endif
33 			"mov.l	@%7, %3		\n\t"
34 			"mov.l	@%7, %4		\n\t"
35 			"mov.l	@%7, %5		\n\t"
36 			"mov.l	@%7, %6		\n\t"
37 			"mov.l	@%7, r7		\n\t"
38 			"mov.l	@%7, r0		\n\t"
39 			"mov.l	%2, @(0x04,%0)	\n\t"
40 			"mov	#0x20>>2, %2	\n\t"
41 			"mov.l	%3, @(0x08,%0)	\n\t"
42 			"sub	%2, %1		\n\t"
43 			"mov.l	%4, @(0x0c,%0)	\n\t"
44 			"cmp/hi	%1, %2		! T if 32 > len	\n\t"
45 			"mov.l	%5, @(0x10,%0)	\n\t"
46 			"mov.l	%6, @(0x14,%0)	\n\t"
47 			"mov.l	r7, @(0x18,%0)	\n\t"
48 			"mov.l	r0, @(0x1c,%0)	\n\t"
49 			"bf.s	1b		\n\t"
50 			" add	#0x20, %0	\n\t"
51 			: "=&r" (data), "=&r" (len),
52 			  "=&r" (tmp2), "=&r" (tmp3), "=&r" (tmp4),
53 			  "=&r" (tmp5), "=&r" (tmp6)
54 			: "r"(addr), "0" (data), "1" (len)
55 			: "r0", "r7", "t", "memory");
56 	}
57 
58 	for (; len != 0; len--)
59 		*data++ = __raw_readl(addr);
60 }
61 EXPORT_SYMBOL(__raw_readsl);
62 
__raw_writesl(void __iomem * addr,const void * data,int len)63 void __raw_writesl(void __iomem *addr, const void *data, int len)
64 {
65 	if (likely(len != 0)) {
66 		int tmp1;
67 
68 		__asm__ __volatile__ (
69 			"1:				\n\t"
70 			"mov.l	@%0+, %1	\n\t"
71 			"dt		%3		\n\t"
72 			"bf.s		1b		\n\t"
73 			" mov.l	%1, @%4		\n\t"
74 			: "=&r" (data), "=&r" (tmp1)
75 			: "0" (data), "r" (len), "r"(addr)
76 			: "t", "memory");
77 	}
78 }
79 EXPORT_SYMBOL(__raw_writesl);
80