hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
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
/* SPDX-License-Identifier: GPL-2.0 */
#ifndef __ASM_SH_ATOMIC_GRB_H
#define __ASM_SH_ATOMIC_GRB_H
 
#define ATOMIC_OP(op)                            \
static inline void atomic_##op(int i, atomic_t *v)            \
{                                    \
   int tmp;                            \
                                   \
   __asm__ __volatile__ (                        \
       "   .align 2              \n\t"                \
       "   mova    1f,   r0      \n\t" /* r0 = end point */    \
       "   mov    r15,   r1      \n\t" /* r1 = saved sp */    \
       "   mov    #-6,   r15     \n\t" /* LOGIN: r15 = size */    \
       "   mov.l  @%1,   %0      \n\t" /* load  old value */    \
       " " #op "   %2,   %0      \n\t" /* $op */        \
       "   mov.l   %0,   @%1     \n\t" /* store new value */    \
       "1: mov     r1,   r15     \n\t" /* LOGOUT */        \
       : "=&r" (tmp),                        \
         "+r"  (v)                        \
       : "r"   (i)                        \
       : "memory" , "r0", "r1");                \
}                                    \
 
#define ATOMIC_OP_RETURN(op)                        \
static inline int atomic_##op##_return(int i, atomic_t *v)        \
{                                    \
   int tmp;                            \
                                   \
   __asm__ __volatile__ (                        \
       "   .align 2              \n\t"                \
       "   mova    1f,   r0      \n\t" /* r0 = end point */    \
       "   mov    r15,   r1      \n\t" /* r1 = saved sp */    \
       "   mov    #-6,   r15     \n\t" /* LOGIN: r15 = size */    \
       "   mov.l  @%1,   %0      \n\t" /* load  old value */    \
       " " #op "   %2,   %0      \n\t" /* $op */        \
       "   mov.l   %0,   @%1     \n\t" /* store new value */    \
       "1: mov     r1,   r15     \n\t" /* LOGOUT */        \
       : "=&r" (tmp),                        \
         "+r"  (v)                        \
       : "r"   (i)                        \
       : "memory" , "r0", "r1");                \
                                   \
   return tmp;                            \
}
 
#define ATOMIC_FETCH_OP(op)                        \
static inline int atomic_fetch_##op(int i, atomic_t *v)            \
{                                    \
   int res, tmp;                            \
                                   \
   __asm__ __volatile__ (                        \
       "   .align 2              \n\t"                \
       "   mova    1f,   r0      \n\t" /* r0 = end point */    \
       "   mov    r15,   r1      \n\t" /* r1 = saved sp */    \
       "   mov    #-6,   r15     \n\t" /* LOGIN: r15 = size */    \
       "   mov.l  @%2,   %0      \n\t" /* load old value */    \
       "   mov     %0,   %1      \n\t" /* save old value */    \
       " " #op "   %3,   %0      \n\t" /* $op */        \
       "   mov.l   %0,   @%2     \n\t" /* store new value */    \
       "1: mov     r1,   r15     \n\t" /* LOGOUT */        \
       : "=&r" (tmp), "=&r" (res), "+r"  (v)            \
       : "r"   (i)                        \
       : "memory" , "r0", "r1");                \
                                   \
   return res;                            \
}
 
#define ATOMIC_OPS(op) ATOMIC_OP(op) ATOMIC_OP_RETURN(op) ATOMIC_FETCH_OP(op)
 
ATOMIC_OPS(add)
ATOMIC_OPS(sub)
 
#undef ATOMIC_OPS
#define ATOMIC_OPS(op) ATOMIC_OP(op) ATOMIC_FETCH_OP(op)
 
ATOMIC_OPS(and)
ATOMIC_OPS(or)
ATOMIC_OPS(xor)
 
#undef ATOMIC_OPS
#undef ATOMIC_FETCH_OP
#undef ATOMIC_OP_RETURN
#undef ATOMIC_OP
 
#endif /* __ASM_SH_ATOMIC_GRB_H */