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
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
115
116
117
118
119
/* SPDX-License-Identifier: GPL-2.0 */
/*
 * Copyright (C) 2006 Atmark Techno, Inc.
 */
 
#ifndef _ASM_MICROBLAZE_IRQFLAGS_H
#define _ASM_MICROBLAZE_IRQFLAGS_H
 
#include <linux/types.h>
#include <asm/registers.h>
 
#if CONFIG_XILINX_MICROBLAZE0_USE_MSR_INSTR
 
static inline notrace unsigned long arch_local_irq_save(void)
{
   unsigned long flags;
   asm volatile("    msrclr %0, %1    \n"
            "    nop        \n"
            : "=r"(flags)
            : "i"(MSR_IE)
            : "memory");
   return flags;
}
 
static inline notrace void arch_local_irq_disable(void)
{
   /* this uses r0 without declaring it - is that correct? */
   asm volatile("    msrclr r0, %0    \n"
            "    nop        \n"
            :
            : "i"(MSR_IE)
            : "memory");
}
 
static inline notrace void arch_local_irq_enable(void)
{
   /* this uses r0 without declaring it - is that correct? */
   asm volatile("    msrset    r0, %0    \n"
            "    nop        \n"
            :
            : "i"(MSR_IE)
            : "memory");
}
 
#else /* !CONFIG_XILINX_MICROBLAZE0_USE_MSR_INSTR */
 
static inline notrace unsigned long arch_local_irq_save(void)
{
   unsigned long flags, tmp;
   asm volatile ("    mfs    %0, rmsr    \n"
             "    nop            \n"
             "    andi    %1, %0, %2    \n"
             "    mts    rmsr, %1    \n"
             "    nop            \n"
             : "=r"(flags), "=r"(tmp)
             : "i"(~MSR_IE)
             : "memory");
   return flags;
}
 
static inline notrace void arch_local_irq_disable(void)
{
   unsigned long tmp;
   asm volatile("    mfs    %0, rmsr    \n"
            "    nop            \n"
            "    andi    %0, %0, %1    \n"
            "    mts    rmsr, %0    \n"
            "    nop            \n"
            : "=r"(tmp)
            : "i"(~MSR_IE)
            : "memory");
}
 
static inline notrace void arch_local_irq_enable(void)
{
   unsigned long tmp;
   asm volatile("    mfs    %0, rmsr    \n"
            "    nop            \n"
            "    ori    %0, %0, %1    \n"
            "    mts    rmsr, %0    \n"
            "    nop            \n"
            : "=r"(tmp)
            : "i"(MSR_IE)
            : "memory");
}
 
#endif /* CONFIG_XILINX_MICROBLAZE0_USE_MSR_INSTR */
 
static inline notrace unsigned long arch_local_save_flags(void)
{
   unsigned long flags;
   asm volatile("    mfs    %0, rmsr    \n"
            "    nop            \n"
            : "=r"(flags)
            :
            : "memory");
   return flags;
}
 
static inline notrace void arch_local_irq_restore(unsigned long flags)
{
   asm volatile("    mts    rmsr, %0    \n"
            "    nop            \n"
            :
            : "r"(flags)
            : "memory");
}
 
static inline notrace bool arch_irqs_disabled_flags(unsigned long flags)
{
   return (flags & MSR_IE) == 0;
}
 
static inline notrace bool arch_irqs_disabled(void)
{
   return arch_irqs_disabled_flags(arch_local_save_flags());
}
 
#endif /* _ASM_MICROBLAZE_IRQFLAGS_H */