hc
2023-02-13 e440ec23c5a540cdd3f7464e8779219be6fd3d95
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
/*
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * Copyright (C) 1996, 1997, 1998, 1999, 2000 by Ralf Baechle
 * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
 *
 * Protected memory access.  Used for everything that might take revenge
 * by sending a DBE error like accessing possibly non-existent memory or
 * devices.
 */
#ifndef _ASM_PACCESS_H
#define _ASM_PACCESS_H
 
#include <linux/errno.h>
 
#ifdef CONFIG_32BIT
#define __PA_ADDR    ".word"
#endif
#ifdef CONFIG_64BIT
#define __PA_ADDR    ".dword"
#endif
 
extern asmlinkage void handle_ibe(void);
extern asmlinkage void handle_dbe(void);
 
#define put_dbe(x, ptr) __put_dbe((x), (ptr), sizeof(*(ptr)))
#define get_dbe(x, ptr) __get_dbe((x), (ptr), sizeof(*(ptr)))
 
struct __large_pstruct { unsigned long buf[100]; };
#define __mp(x) (*(struct __large_pstruct *)(x))
 
#define __get_dbe(x, ptr, size)                        \
({                                    \
   long __gu_err;                            \
   __typeof__(*(ptr)) __gu_val;                    \
   unsigned long __gu_addr;                    \
   __asm__("":"=r" (__gu_val));                    \
   __gu_addr = (unsigned long) (ptr);                \
   __asm__("":"=r" (__gu_err));                    \
   switch (size) {                            \
   case 1: __get_dbe_asm("lb"); break;                \
   case 2: __get_dbe_asm("lh"); break;                \
   case 4: __get_dbe_asm("lw"); break;                \
   case 8:     __get_dbe_asm("ld"); break;                \
   default: __get_dbe_unknown(); break;                \
   }                                \
   x = (__typeof__(*(ptr))) __gu_val;                \
   __gu_err;                            \
})
 
#define __get_dbe_asm(insn)                        \
{                                    \
   __asm__ __volatile__(                        \
   "1:\t" insn "\t%1,%2\n\t"                    \
   "move\t%0,$0\n"                            \
   "2:\n\t"                            \
   ".insn\n\t"                            \
   ".section\t.fixup,\"ax\"\n"                    \
   "3:\tli\t%0,%3\n\t"                        \
   "move\t%1,$0\n\t"                        \
   "j\t2b\n\t"                            \
   ".previous\n\t"                            \
   ".section\t__dbe_table,\"a\"\n\t"                \
   __PA_ADDR "\t1b, 3b\n\t"                    \
   ".previous"                            \
   :"=r" (__gu_err), "=r" (__gu_val)                \
   :"o" (__mp(__gu_addr)), "i" (-EFAULT));                \
}
 
extern void __get_dbe_unknown(void);
 
#define __put_dbe(x, ptr, size)                        \
({                                    \
   long __pu_err;                            \
   __typeof__(*(ptr)) __pu_val;                    \
   long __pu_addr;                            \
   __pu_val = (x);                            \
   __pu_addr = (long) (ptr);                    \
   __asm__("":"=r" (__pu_err));                    \
   switch (size) {                            \
   case 1: __put_dbe_asm("sb"); break;                \
   case 2: __put_dbe_asm("sh"); break;                \
   case 4: __put_dbe_asm("sw"); break;                \
   case 8: __put_dbe_asm("sd"); break;                \
   default: __put_dbe_unknown(); break;                \
   }                                \
   __pu_err;                            \
})
 
#define __put_dbe_asm(insn)                        \
{                                    \
   __asm__ __volatile__(                        \
   "1:\t" insn "\t%1,%2\n\t"                    \
   "move\t%0,$0\n"                            \
   "2:\n\t"                            \
   ".insn\n\t"                            \
   ".section\t.fixup,\"ax\"\n"                    \
   "3:\tli\t%0,%3\n\t"                        \
   "j\t2b\n\t"                            \
   ".previous\n\t"                            \
   ".section\t__dbe_table,\"a\"\n\t"                \
   __PA_ADDR "\t1b, 3b\n\t"                    \
   ".previous"                            \
   : "=r" (__pu_err)                        \
   : "r" (__pu_val), "o" (__mp(__pu_addr)), "i" (-EFAULT));    \
}
 
extern void __put_dbe_unknown(void);
 
extern unsigned long search_dbe_table(unsigned long addr);
 
#endif /* _ASM_PACCESS_H */