|
102 | 102 | { __asm__ __volatile__ ("mtmsr %0" : "=&r" ((_msr_value)) : "0" ((_msr_value))); } |
103 | 103 |
|
104 | 104 | #define _CPU_ISR_Enable() \ |
105 | | - { register u32 _val = 0; \ |
106 | | - __asm__ __volatile__ ( \ |
107 | | - "mfmsr %0\n" \ |
108 | | - "ori %0,%0,0x8000\n" \ |
109 | | - "mtmsr %0" \ |
110 | | - : "=&r" ((_val)) : "0" ((_val)) \ |
111 | | - ); \ |
112 | | - } |
| 105 | + do { \ |
| 106 | + register u32 _val = 0; \ |
| 107 | + __asm__ __volatile__ ( \ |
| 108 | + "mfmsr %0\n" \ |
| 109 | + "ori %0,%0,0x8000\n" \ |
| 110 | + "mtmsr %0" \ |
| 111 | + : "=&r" ((_val)) : "0" ((_val)) \ |
| 112 | + : : "memory" \ |
| 113 | + ); \ |
| 114 | + } while (0) |
113 | 115 |
|
114 | 116 | #define _CPU_ISR_Disable( _isr_cookie ) \ |
115 | | - { register u32 _disable_mask = 0; \ |
116 | | - _isr_cookie = 0; \ |
117 | | - __asm__ __volatile__ ( \ |
118 | | - "mfmsr %0\n" \ |
119 | | - "rlwinm %1,%0,0,17,15\n" \ |
120 | | - "mtmsr %1\n" \ |
121 | | - "extrwi %0,%0,1,16" \ |
122 | | - : "=&r" ((_isr_cookie)), "=&r" ((_disable_mask)) \ |
123 | | - : "0" ((_isr_cookie)), "1" ((_disable_mask)) \ |
124 | | - ); \ |
125 | | - } |
| 117 | + do { \ |
| 118 | + register u32 _disable_mask = 0; \ |
| 119 | + _isr_cookie = 0; \ |
| 120 | + __asm__ __volatile__ ( \ |
| 121 | + "mfmsr %0\n" \ |
| 122 | + "rlwinm %1,%0,0,17,15\n" \ |
| 123 | + "mtmsr %1\n" \ |
| 124 | + "extrwi %0,%0,1,16" \ |
| 125 | + : "=&r" ((_isr_cookie)), "=&r" ((_disable_mask)) \ |
| 126 | + : "0" ((_isr_cookie)), "1" ((_disable_mask)) \ |
| 127 | + : "memory" \ |
| 128 | + ); \ |
| 129 | + } while (0) |
126 | 130 |
|
127 | 131 | #define _CPU_ISR_Restore( _isr_cookie ) \ |
128 | | - { register u32 _enable_mask = 0; \ |
129 | | - __asm__ __volatile__ ( \ |
130 | | - " cmpwi %0,0\n" \ |
131 | | - " beq 1f\n" \ |
132 | | - " mfmsr %1\n" \ |
133 | | - " ori %1,%1,0x8000\n" \ |
134 | | - " mtmsr %1\n" \ |
135 | | - "1:" \ |
136 | | - : "=r"((_isr_cookie)),"=&r" ((_enable_mask)) \ |
137 | | - : "0"((_isr_cookie)),"1" ((_enable_mask)) \ |
138 | | - ); \ |
139 | | - } |
| 132 | + do { \ |
| 133 | + register u32 _enable_mask = 0; \ |
| 134 | + __asm__ __volatile__ ( \ |
| 135 | + "cmpwi %0,0\n" \ |
| 136 | + "beq 1f\n" \ |
| 137 | + "mfmsr %1\n" \ |
| 138 | + "ori %1,%1,0x8000\n" \ |
| 139 | + "mtmsr %1\n" \ |
| 140 | + "1:" \ |
| 141 | + : "=r"((_isr_cookie)),"=&r" ((_enable_mask)) \ |
| 142 | + : "0"((_isr_cookie)),"1" ((_enable_mask)) \ |
| 143 | + : "memory" \ |
| 144 | + ); \ |
| 145 | + } while (0) |
140 | 146 |
|
141 | 147 | #define _CPU_ISR_Flash( _isr_cookie ) \ |
142 | | - { register u32 _flash_mask = 0; \ |
143 | | - __asm__ __volatile__ ( \ |
144 | | - " cmpwi %0,0\n" \ |
145 | | - " beq 1f\n" \ |
146 | | - " mfmsr %1\n" \ |
147 | | - " ori %1,%1,0x8000\n" \ |
148 | | - " mtmsr %1\n" \ |
149 | | - " rlwinm %1,%1,0,17,15\n" \ |
150 | | - " mtmsr %1\n" \ |
151 | | - "1:" \ |
152 | | - : "=r" ((_isr_cookie)), "=&r" ((_flash_mask)) \ |
153 | | - : "0" ((_isr_cookie)), "1" ((_flash_mask)) \ |
154 | | - ); \ |
155 | | - } |
| 148 | + do { \ |
| 149 | + register u32 _flash_mask = 0; \ |
| 150 | + __asm__ __volatile__ ( \ |
| 151 | + "cmpwi %0,0\n" \ |
| 152 | + "beq 1f\n" \ |
| 153 | + "mfmsr %1\n" \ |
| 154 | + "ori %1,%1,0x8000\n" \ |
| 155 | + "mtmsr %1\n" \ |
| 156 | + "rlwinm %1,%1,0,17,15\n" \ |
| 157 | + "mtmsr %1\n" \ |
| 158 | + "1:" \ |
| 159 | + : "=r" ((_isr_cookie)), "=&r" ((_flash_mask)) \ |
| 160 | + : "0" ((_isr_cookie)), "1" ((_flash_mask)) \ |
| 161 | + : "memory" \ |
| 162 | + ); \ |
| 163 | + } while (0) |
156 | 164 |
|
157 | 165 | #define _CPU_FPR_Enable() \ |
158 | 166 | { register u32 _val = 0; \ |
|
0 commit comments