Rev 2071 | Rev 2726 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2071 | Rev 2082 | ||
---|---|---|---|
Line 47... | Line 47... | ||
47 | */ |
47 | */ |
48 | static inline uintptr_t get_stack_base(void) |
48 | static inline uintptr_t get_stack_base(void) |
49 | { |
49 | { |
50 | uint64_t v; |
50 | uint64_t v; |
51 | 51 | ||
52 | __asm__ volatile ("and %0 = %1, r12" : "=r" (v) : "r" (~(STACK_SIZE-1))); |
52 | asm volatile ("and %0 = %1, r12" : "=r" (v) : "r" (~(STACK_SIZE-1))); |
53 | 53 | ||
54 | return v; |
54 | return v; |
55 | } |
55 | } |
56 | 56 | ||
57 | /** Return Processor State Register. |
57 | /** Return Processor State Register. |
Line 60... | Line 60... | ||
60 | */ |
60 | */ |
61 | static inline uint64_t psr_read(void) |
61 | static inline uint64_t psr_read(void) |
62 | { |
62 | { |
63 | uint64_t v; |
63 | uint64_t v; |
64 | 64 | ||
65 | __asm__ volatile ("mov %0 = psr\n" : "=r" (v)); |
65 | asm volatile ("mov %0 = psr\n" : "=r" (v)); |
66 | 66 | ||
67 | return v; |
67 | return v; |
68 | } |
68 | } |
69 | 69 | ||
70 | /** Read IVA (Interruption Vector Address). |
70 | /** Read IVA (Interruption Vector Address). |
Line 73... | Line 73... | ||
73 | */ |
73 | */ |
74 | static inline uint64_t iva_read(void) |
74 | static inline uint64_t iva_read(void) |
75 | { |
75 | { |
76 | uint64_t v; |
76 | uint64_t v; |
77 | 77 | ||
78 | __asm__ volatile ("mov %0 = cr.iva\n" : "=r" (v)); |
78 | asm volatile ("mov %0 = cr.iva\n" : "=r" (v)); |
79 | 79 | ||
80 | return v; |
80 | return v; |
81 | } |
81 | } |
82 | 82 | ||
83 | /** Write IVA (Interruption Vector Address) register. |
83 | /** Write IVA (Interruption Vector Address) register. |
84 | * |
84 | * |
85 | * @param v New location of interruption vector table. |
85 | * @param v New location of interruption vector table. |
86 | */ |
86 | */ |
87 | static inline void iva_write(uint64_t v) |
87 | static inline void iva_write(uint64_t v) |
88 | { |
88 | { |
89 | __asm__ volatile ("mov cr.iva = %0\n" : : "r" (v)); |
89 | asm volatile ("mov cr.iva = %0\n" : : "r" (v)); |
90 | } |
90 | } |
91 | 91 | ||
92 | 92 | ||
93 | /** Read IVR (External Interrupt Vector Register). |
93 | /** Read IVR (External Interrupt Vector Register). |
94 | * |
94 | * |
Line 96... | Line 96... | ||
96 | */ |
96 | */ |
97 | static inline uint64_t ivr_read(void) |
97 | static inline uint64_t ivr_read(void) |
98 | { |
98 | { |
99 | uint64_t v; |
99 | uint64_t v; |
100 | 100 | ||
101 | __asm__ volatile ("mov %0 = cr.ivr\n" : "=r" (v)); |
101 | asm volatile ("mov %0 = cr.ivr\n" : "=r" (v)); |
102 | 102 | ||
103 | return v; |
103 | return v; |
104 | } |
104 | } |
105 | 105 | ||
106 | /** Write ITC (Interval Timer Counter) register. |
106 | /** Write ITC (Interval Timer Counter) register. |
107 | * |
107 | * |
108 | * @param v New counter value. |
108 | * @param v New counter value. |
109 | */ |
109 | */ |
110 | static inline void itc_write(uint64_t v) |
110 | static inline void itc_write(uint64_t v) |
111 | { |
111 | { |
112 | __asm__ volatile ("mov ar.itc = %0\n" : : "r" (v)); |
112 | asm volatile ("mov ar.itc = %0\n" : : "r" (v)); |
113 | } |
113 | } |
114 | 114 | ||
115 | /** Read ITC (Interval Timer Counter) register. |
115 | /** Read ITC (Interval Timer Counter) register. |
116 | * |
116 | * |
117 | * @return Current counter value. |
117 | * @return Current counter value. |
118 | */ |
118 | */ |
119 | static inline uint64_t itc_read(void) |
119 | static inline uint64_t itc_read(void) |
120 | { |
120 | { |
121 | uint64_t v; |
121 | uint64_t v; |
122 | 122 | ||
123 | __asm__ volatile ("mov %0 = ar.itc\n" : "=r" (v)); |
123 | asm volatile ("mov %0 = ar.itc\n" : "=r" (v)); |
124 | 124 | ||
125 | return v; |
125 | return v; |
126 | } |
126 | } |
127 | 127 | ||
128 | /** Write ITM (Interval Timer Match) register. |
128 | /** Write ITM (Interval Timer Match) register. |
129 | * |
129 | * |
130 | * @param v New match value. |
130 | * @param v New match value. |
131 | */ |
131 | */ |
132 | static inline void itm_write(uint64_t v) |
132 | static inline void itm_write(uint64_t v) |
133 | { |
133 | { |
134 | __asm__ volatile ("mov cr.itm = %0\n" : : "r" (v)); |
134 | asm volatile ("mov cr.itm = %0\n" : : "r" (v)); |
135 | } |
135 | } |
136 | 136 | ||
137 | /** Read ITM (Interval Timer Match) register. |
137 | /** Read ITM (Interval Timer Match) register. |
138 | * |
138 | * |
139 | * @return Match value. |
139 | * @return Match value. |
140 | */ |
140 | */ |
141 | static inline uint64_t itm_read(void) |
141 | static inline uint64_t itm_read(void) |
142 | { |
142 | { |
143 | uint64_t v; |
143 | uint64_t v; |
144 | 144 | ||
145 | __asm__ volatile ("mov %0 = cr.itm\n" : "=r" (v)); |
145 | asm volatile ("mov %0 = cr.itm\n" : "=r" (v)); |
146 | 146 | ||
147 | return v; |
147 | return v; |
148 | } |
148 | } |
149 | 149 | ||
150 | /** Read ITV (Interval Timer Vector) register. |
150 | /** Read ITV (Interval Timer Vector) register. |
Line 153... | Line 153... | ||
153 | */ |
153 | */ |
154 | static inline uint64_t itv_read(void) |
154 | static inline uint64_t itv_read(void) |
155 | { |
155 | { |
156 | uint64_t v; |
156 | uint64_t v; |
157 | 157 | ||
158 | __asm__ volatile ("mov %0 = cr.itv\n" : "=r" (v)); |
158 | asm volatile ("mov %0 = cr.itv\n" : "=r" (v)); |
159 | 159 | ||
160 | return v; |
160 | return v; |
161 | } |
161 | } |
162 | 162 | ||
163 | /** Write ITV (Interval Timer Vector) register. |
163 | /** Write ITV (Interval Timer Vector) register. |
164 | * |
164 | * |
165 | * @param v New vector and mask bit. |
165 | * @param v New vector and mask bit. |
166 | */ |
166 | */ |
167 | static inline void itv_write(uint64_t v) |
167 | static inline void itv_write(uint64_t v) |
168 | { |
168 | { |
169 | __asm__ volatile ("mov cr.itv = %0\n" : : "r" (v)); |
169 | asm volatile ("mov cr.itv = %0\n" : : "r" (v)); |
170 | } |
170 | } |
171 | 171 | ||
172 | /** Write EOI (End Of Interrupt) register. |
172 | /** Write EOI (End Of Interrupt) register. |
173 | * |
173 | * |
174 | * @param v This value is ignored. |
174 | * @param v This value is ignored. |
175 | */ |
175 | */ |
176 | static inline void eoi_write(uint64_t v) |
176 | static inline void eoi_write(uint64_t v) |
177 | { |
177 | { |
178 | __asm__ volatile ("mov cr.eoi = %0\n" : : "r" (v)); |
178 | asm volatile ("mov cr.eoi = %0\n" : : "r" (v)); |
179 | } |
179 | } |
180 | 180 | ||
181 | /** Read TPR (Task Priority Register). |
181 | /** Read TPR (Task Priority Register). |
182 | * |
182 | * |
183 | * @return Current value of TPR. |
183 | * @return Current value of TPR. |
184 | */ |
184 | */ |
185 | static inline uint64_t tpr_read(void) |
185 | static inline uint64_t tpr_read(void) |
186 | { |
186 | { |
187 | uint64_t v; |
187 | uint64_t v; |
188 | 188 | ||
189 | __asm__ volatile ("mov %0 = cr.tpr\n" : "=r" (v)); |
189 | asm volatile ("mov %0 = cr.tpr\n" : "=r" (v)); |
190 | 190 | ||
191 | return v; |
191 | return v; |
192 | } |
192 | } |
193 | 193 | ||
194 | /** Write TPR (Task Priority Register). |
194 | /** Write TPR (Task Priority Register). |
195 | * |
195 | * |
196 | * @param v New value of TPR. |
196 | * @param v New value of TPR. |
197 | */ |
197 | */ |
198 | static inline void tpr_write(uint64_t v) |
198 | static inline void tpr_write(uint64_t v) |
199 | { |
199 | { |
200 | __asm__ volatile ("mov cr.tpr = %0\n" : : "r" (v)); |
200 | asm volatile ("mov cr.tpr = %0\n" : : "r" (v)); |
201 | } |
201 | } |
202 | 202 | ||
203 | /** Disable interrupts. |
203 | /** Disable interrupts. |
204 | * |
204 | * |
205 | * Disable interrupts and return previous |
205 | * Disable interrupts and return previous |
Line 209... | Line 209... | ||
209 | */ |
209 | */ |
210 | static ipl_t interrupts_disable(void) |
210 | static ipl_t interrupts_disable(void) |
211 | { |
211 | { |
212 | uint64_t v; |
212 | uint64_t v; |
213 | 213 | ||
214 | __asm__ volatile ( |
214 | asm volatile ( |
215 | "mov %0 = psr\n" |
215 | "mov %0 = psr\n" |
216 | "rsm %1\n" |
216 | "rsm %1\n" |
217 | : "=r" (v) |
217 | : "=r" (v) |
218 | : "i" (PSR_I_MASK) |
218 | : "i" (PSR_I_MASK) |
219 | ); |
219 | ); |
Line 230... | Line 230... | ||
230 | */ |
230 | */ |
231 | static ipl_t interrupts_enable(void) |
231 | static ipl_t interrupts_enable(void) |
232 | { |
232 | { |
233 | uint64_t v; |
233 | uint64_t v; |
234 | 234 | ||
235 | __asm__ volatile ( |
235 | asm volatile ( |
236 | "mov %0 = psr\n" |
236 | "mov %0 = psr\n" |
237 | "ssm %1\n" |
237 | "ssm %1\n" |
238 | ";;\n" |
238 | ";;\n" |
239 | "srlz.d\n" |
239 | "srlz.d\n" |
240 | : "=r" (v) |
240 | : "=r" (v) |
Line 268... | Line 268... | ||
268 | } |
268 | } |
269 | 269 | ||
270 | /** Disable protection key checking. */ |
270 | /** Disable protection key checking. */ |
271 | static inline void pk_disable(void) |
271 | static inline void pk_disable(void) |
272 | { |
272 | { |
273 | __asm__ volatile ("rsm %0\n" : : "i" (PSR_PK_MASK)); |
273 | asm volatile ("rsm %0\n" : : "i" (PSR_PK_MASK)); |
274 | } |
274 | } |
275 | 275 | ||
276 | extern void cpu_halt(void); |
276 | extern void cpu_halt(void); |
277 | extern void cpu_sleep(void); |
277 | extern void cpu_sleep(void); |
278 | extern void asm_delay_loop(uint32_t t); |
278 | extern void asm_delay_loop(uint32_t t); |