Rev 2307 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2307 | Rev 2456 | ||
---|---|---|---|
1 | /* |
1 | /* |
2 | * Copyright (c) 2006 Martin Decky |
2 | * Copyright (c) 2006 Martin Decky |
3 | * All rights reserved. |
3 | * All rights reserved. |
4 | * |
4 | * |
5 | * Redistribution and use in source and binary forms, with or without |
5 | * Redistribution and use in source and binary forms, with or without |
6 | * modification, are permitted provided that the following conditions |
6 | * modification, are permitted provided that the following conditions |
7 | * are met: |
7 | * are met: |
8 | * |
8 | * |
9 | * - Redistributions of source code must retain the above copyright |
9 | * - Redistributions of source code must retain the above copyright |
10 | * notice, this list of conditions and the following disclaimer. |
10 | * notice, this list of conditions and the following disclaimer. |
11 | * - Redistributions in binary form must reproduce the above copyright |
11 | * - Redistributions in binary form must reproduce the above copyright |
12 | * notice, this list of conditions and the following disclaimer in the |
12 | * notice, this list of conditions and the following disclaimer in the |
13 | * documentation and/or other materials provided with the distribution. |
13 | * documentation and/or other materials provided with the distribution. |
14 | * - The name of the author may not be used to endorse or promote products |
14 | * - The name of the author may not be used to endorse or promote products |
15 | * derived from this software without specific prior written permission. |
15 | * derived from this software without specific prior written permission. |
16 | * |
16 | * |
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
27 | */ |
27 | */ |
28 | 28 | ||
29 | /** @addtogroup ppc32 |
29 | /** @addtogroup ppc32 |
30 | * @{ |
30 | * @{ |
31 | */ |
31 | */ |
32 | /** @file |
32 | /** @file |
33 | */ |
33 | */ |
34 | 34 | ||
35 | #include <arch/drivers/cuda.h> |
35 | #include <arch/drivers/cuda.h> |
36 | #include <ipc/irq.h> |
36 | #include <ipc/irq.h> |
37 | #include <arch/asm.h> |
37 | #include <arch/asm.h> |
38 | #include <console/console.h> |
38 | #include <console/console.h> |
39 | #include <console/chardev.h> |
39 | #include <console/chardev.h> |
40 | #include <arch/drivers/pic.h> |
40 | #include <arch/drivers/pic.h> |
41 | #include <sysinfo/sysinfo.h> |
41 | #include <sysinfo/sysinfo.h> |
42 | #include <interrupt.h> |
42 | #include <interrupt.h> |
43 | #include <stdarg.h> |
43 | #include <stdarg.h> |
- | 44 | #include <synch/rcu.h> |
|
44 | 45 | ||
45 | #define CUDA_IRQ 10 |
46 | #define CUDA_IRQ 10 |
46 | #define SPECIAL '?' |
47 | #define SPECIAL '?' |
47 | 48 | ||
48 | #define PACKET_ADB 0x00 |
49 | #define PACKET_ADB 0x00 |
49 | #define PACKET_CUDA 0x01 |
50 | #define PACKET_CUDA 0x01 |
50 | 51 | ||
51 | #define CUDA_POWERDOWN 0x0a |
52 | #define CUDA_POWERDOWN 0x0a |
52 | #define CUDA_RESET 0x11 |
53 | #define CUDA_RESET 0x11 |
53 | 54 | ||
54 | #define RS 0x200 |
55 | #define RS 0x200 |
55 | #define B (0 * RS) |
56 | #define B (0 * RS) |
56 | #define A (1 * RS) |
57 | #define A (1 * RS) |
57 | #define SR (10 * RS) |
58 | #define SR (10 * RS) |
58 | #define ACR (11 * RS) |
59 | #define ACR (11 * RS) |
59 | 60 | ||
60 | #define SR_OUT 0x10 |
61 | #define SR_OUT 0x10 |
61 | #define TACK 0x10 |
62 | #define TACK 0x10 |
62 | #define TIP 0x20 |
63 | #define TIP 0x20 |
63 | 64 | ||
64 | 65 | ||
65 | static volatile uint8_t *cuda = NULL; |
66 | static volatile uint8_t *cuda = NULL; |
66 | static irq_t cuda_irq; /**< Cuda's IRQ. */ |
67 | static irq_t cuda_irq; /**< Cuda's IRQ. */ |
67 | 68 | ||
68 | static char lchars[0x80] = { |
69 | static char lchars[0x80] = { |
69 | 'a', |
70 | 'a', |
70 | 's', |
71 | 's', |
71 | 'd', |
72 | 'd', |
72 | 'f', |
73 | 'f', |
73 | 'h', |
74 | 'h', |
74 | 'g', |
75 | 'g', |
75 | 'z', |
76 | 'z', |
76 | 'x', |
77 | 'x', |
77 | 'c', |
78 | 'c', |
78 | 'v', |
79 | 'v', |
79 | SPECIAL, |
80 | SPECIAL, |
80 | 'b', |
81 | 'b', |
81 | 'q', |
82 | 'q', |
82 | 'w', |
83 | 'w', |
83 | 'e', |
84 | 'e', |
84 | 'r', |
85 | 'r', |
85 | 'y', |
86 | 'y', |
86 | 't', |
87 | 't', |
87 | '1', |
88 | '1', |
88 | '2', |
89 | '2', |
89 | '3', |
90 | '3', |
90 | '4', |
91 | '4', |
91 | '6', |
92 | '6', |
92 | '5', |
93 | '5', |
93 | '=', |
94 | '=', |
94 | '9', |
95 | '9', |
95 | '7', |
96 | '7', |
96 | '-', |
97 | '-', |
97 | '8', |
98 | '8', |
98 | '0', |
99 | '0', |
99 | ']', |
100 | ']', |
100 | 'o', |
101 | 'o', |
101 | 'u', |
102 | 'u', |
102 | '[', |
103 | '[', |
103 | 'i', |
104 | 'i', |
104 | 'p', |
105 | 'p', |
105 | '\n', /* Enter */ |
106 | '\n', /* Enter */ |
106 | 'l', |
107 | 'l', |
107 | 'j', |
108 | 'j', |
108 | '\'', |
109 | '\'', |
109 | 'k', |
110 | 'k', |
110 | ';', |
111 | ';', |
111 | '\\', |
112 | '\\', |
112 | ',', |
113 | ',', |
113 | '/', |
114 | '/', |
114 | 'n', |
115 | 'n', |
115 | 'm', |
116 | 'm', |
116 | '.', |
117 | '.', |
117 | '\t', /* Tab */ |
118 | '\t', /* Tab */ |
118 | ' ', |
119 | ' ', |
119 | '`', |
120 | '`', |
120 | '\b', /* Backspace */ |
121 | '\b', /* Backspace */ |
121 | SPECIAL, |
122 | SPECIAL, |
122 | SPECIAL, /* Escape */ |
123 | SPECIAL, /* Escape */ |
123 | SPECIAL, /* Ctrl */ |
124 | SPECIAL, /* Ctrl */ |
124 | SPECIAL, /* Alt */ |
125 | SPECIAL, /* Alt */ |
125 | SPECIAL, /* Shift */ |
126 | SPECIAL, /* Shift */ |
126 | SPECIAL, /* Caps-Lock */ |
127 | SPECIAL, /* Caps-Lock */ |
127 | SPECIAL, /* RAlt */ |
128 | SPECIAL, /* RAlt */ |
128 | SPECIAL, /* Left */ |
129 | SPECIAL, /* Left */ |
129 | SPECIAL, /* Right */ |
130 | SPECIAL, /* Right */ |
130 | SPECIAL, /* Down */ |
131 | SPECIAL, /* Down */ |
131 | SPECIAL, /* Up */ |
132 | SPECIAL, /* Up */ |
132 | SPECIAL, |
133 | SPECIAL, |
133 | SPECIAL, |
134 | SPECIAL, |
134 | '.', /* Keypad . */ |
135 | '.', /* Keypad . */ |
135 | SPECIAL, |
136 | SPECIAL, |
136 | '*', /* Keypad * */ |
137 | '*', /* Keypad * */ |
137 | SPECIAL, |
138 | SPECIAL, |
138 | '+', /* Keypad + */ |
139 | '+', /* Keypad + */ |
139 | SPECIAL, |
140 | SPECIAL, |
140 | SPECIAL, /* NumLock */ |
141 | SPECIAL, /* NumLock */ |
141 | SPECIAL, |
142 | SPECIAL, |
142 | SPECIAL, |
143 | SPECIAL, |
143 | SPECIAL, |
144 | SPECIAL, |
144 | '/', /* Keypad / */ |
145 | '/', /* Keypad / */ |
145 | '\n', /* Keypad Enter */ |
146 | '\n', /* Keypad Enter */ |
146 | SPECIAL, |
147 | SPECIAL, |
147 | '-', /* Keypad - */ |
148 | '-', /* Keypad - */ |
148 | SPECIAL, |
149 | SPECIAL, |
149 | SPECIAL, |
150 | SPECIAL, |
150 | SPECIAL, |
151 | SPECIAL, |
151 | '0', /* Keypad 0 */ |
152 | '0', /* Keypad 0 */ |
152 | '1', /* Keypad 1 */ |
153 | '1', /* Keypad 1 */ |
153 | '2', /* Keypad 2 */ |
154 | '2', /* Keypad 2 */ |
154 | '3', /* Keypad 3 */ |
155 | '3', /* Keypad 3 */ |
155 | '4', /* Keypad 4 */ |
156 | '4', /* Keypad 4 */ |
156 | '5', /* Keypad 5 */ |
157 | '5', /* Keypad 5 */ |
157 | '6', /* Keypad 6 */ |
158 | '6', /* Keypad 6 */ |
158 | '7', /* Keypad 7 */ |
159 | '7', /* Keypad 7 */ |
159 | SPECIAL, |
160 | SPECIAL, |
160 | '8', /* Keypad 8 */ |
161 | '8', /* Keypad 8 */ |
161 | '9', /* Keypad 9 */ |
162 | '9', /* Keypad 9 */ |
162 | SPECIAL, |
163 | SPECIAL, |
163 | SPECIAL, |
164 | SPECIAL, |
164 | SPECIAL, |
165 | SPECIAL, |
165 | SPECIAL, /* F5 */ |
166 | SPECIAL, /* F5 */ |
166 | SPECIAL, /* F6 */ |
167 | SPECIAL, /* F6 */ |
167 | SPECIAL, /* F7 */ |
168 | SPECIAL, /* F7 */ |
168 | SPECIAL, /* F3 */ |
169 | SPECIAL, /* F3 */ |
169 | SPECIAL, /* F8 */ |
170 | SPECIAL, /* F8 */ |
170 | SPECIAL, /* F9 */ |
171 | SPECIAL, /* F9 */ |
171 | SPECIAL, |
172 | SPECIAL, |
172 | SPECIAL, /* F11 */ |
173 | SPECIAL, /* F11 */ |
173 | SPECIAL, |
174 | SPECIAL, |
174 | SPECIAL, /* F13 */ |
175 | SPECIAL, /* F13 */ |
175 | SPECIAL, |
176 | SPECIAL, |
176 | SPECIAL, /* ScrollLock */ |
177 | SPECIAL, /* ScrollLock */ |
177 | SPECIAL, |
178 | SPECIAL, |
178 | SPECIAL, /* F10 */ |
179 | SPECIAL, /* F10 */ |
179 | SPECIAL, |
180 | SPECIAL, |
180 | SPECIAL, /* F12 */ |
181 | SPECIAL, /* F12 */ |
181 | SPECIAL, |
182 | SPECIAL, |
182 | SPECIAL, /* Pause */ |
183 | SPECIAL, /* Pause */ |
183 | SPECIAL, /* Insert */ |
184 | SPECIAL, /* Insert */ |
184 | SPECIAL, /* Home */ |
185 | SPECIAL, /* Home */ |
185 | SPECIAL, /* PageUp */ |
186 | SPECIAL, /* PageUp */ |
186 | SPECIAL, /* Delete */ |
187 | SPECIAL, /* Delete */ |
187 | SPECIAL, /* F4 */ |
188 | SPECIAL, /* F4 */ |
188 | SPECIAL, /* End */ |
189 | SPECIAL, /* End */ |
189 | SPECIAL, /* F2 */ |
190 | SPECIAL, /* F2 */ |
190 | SPECIAL, /* PageDown */ |
191 | SPECIAL, /* PageDown */ |
191 | SPECIAL /* F1 */ |
192 | SPECIAL /* F1 */ |
192 | }; |
193 | }; |
193 | 194 | ||
194 | 195 | ||
195 | static void receive_packet(uint8_t *kind, index_t count, uint8_t data[]) |
196 | static void receive_packet(uint8_t *kind, index_t count, uint8_t data[]) |
196 | { |
197 | { |
197 | cuda[B] = cuda[B] & ~TIP; |
198 | cuda[B] = cuda[B] & ~TIP; |
198 | *kind = cuda[SR]; |
199 | *kind = cuda[SR]; |
199 | 200 | ||
200 | index_t i; |
201 | index_t i; |
201 | for (i = 0; i < count; i++) |
202 | for (i = 0; i < count; i++) |
202 | data[i] = cuda[SR]; |
203 | data[i] = cuda[SR]; |
203 | 204 | ||
204 | cuda[B] = cuda[B] | TIP; |
205 | cuda[B] = cuda[B] | TIP; |
205 | } |
206 | } |
206 | 207 | ||
207 | 208 | ||
208 | /* Called from getc(). */ |
209 | /* Called from getc(). */ |
209 | static void cuda_resume(chardev_t *d) |
210 | static void cuda_resume(chardev_t *d) |
210 | { |
211 | { |
211 | } |
212 | } |
212 | 213 | ||
213 | 214 | ||
214 | /* Called from getc(). */ |
215 | /* Called from getc(). */ |
215 | static void cuda_suspend(chardev_t *d) |
216 | static void cuda_suspend(chardev_t *d) |
216 | { |
217 | { |
217 | } |
218 | } |
218 | 219 | ||
219 | 220 | ||
220 | static char key_read(chardev_t *d) |
221 | static char key_read(chardev_t *d) |
221 | { |
222 | { |
222 | char ch; |
223 | char ch; |
223 | 224 | ||
224 | ch = 0; |
225 | ch = 0; |
225 | return ch; |
226 | return ch; |
226 | } |
227 | } |
227 | 228 | ||
228 | 229 | ||
229 | static chardev_t kbrd; |
230 | static chardev_t kbrd; |
230 | static chardev_operations_t ops = { |
231 | static chardev_operations_t ops = { |
231 | .suspend = cuda_suspend, |
232 | .suspend = cuda_suspend, |
232 | .resume = cuda_resume, |
233 | .resume = cuda_resume, |
233 | .read = key_read |
234 | .read = key_read |
234 | }; |
235 | }; |
235 | 236 | ||
236 | 237 | ||
237 | int cuda_get_scancode(void) |
238 | int cuda_get_scancode(void) |
238 | { |
239 | { |
239 | uint8_t kind; |
240 | uint8_t kind; |
240 | uint8_t data[4]; |
241 | uint8_t data[4]; |
241 | 242 | ||
242 | receive_packet(&kind, 4, data); |
243 | receive_packet(&kind, 4, data); |
243 | 244 | ||
244 | if ((kind == PACKET_ADB) && (data[0] == 0x40) && (data[1] == 0x2c)) |
245 | if ((kind == PACKET_ADB) && (data[0] == 0x40) && (data[1] == 0x2c)) |
245 | return data[2]; |
246 | return data[2]; |
246 | 247 | ||
247 | return -1; |
248 | return -1; |
248 | } |
249 | } |
249 | 250 | ||
250 | static void cuda_irq_handler(irq_t *irq, void *arg, ...) |
251 | static void cuda_irq_handler(irq_t *irq, void *arg, ...) |
251 | { |
252 | { |
252 | if ((irq->notif_cfg.notify) && (irq->notif_cfg.answerbox)) |
253 | if ((rcu_dereference_pointer(irq->notif_cfg).notify) && (rcu_dereference_pointer(irq->notif_cfg).answerbox)) |
253 | ipc_irq_send_notif(irq); |
254 | ipc_irq_send_notif(irq); |
254 | else { |
255 | else { |
255 | int scan_code = cuda_get_scancode(); |
256 | int scan_code = cuda_get_scancode(); |
256 | 257 | ||
257 | if (scan_code != -1) { |
258 | if (scan_code != -1) { |
258 | uint8_t scancode = (uint8_t) scan_code; |
259 | uint8_t scancode = (uint8_t) scan_code; |
259 | if ((scancode & 0x80) != 0x80) |
260 | if ((scancode & 0x80) != 0x80) |
260 | chardev_push_character(&kbrd, lchars[scancode & 0x7f]); |
261 | chardev_push_character(&kbrd, lchars[scancode & 0x7f]); |
261 | } |
262 | } |
262 | } |
263 | } |
263 | } |
264 | } |
264 | 265 | ||
265 | static irq_ownership_t cuda_claim(void) |
266 | static irq_ownership_t cuda_claim(void) |
266 | { |
267 | { |
267 | return IRQ_ACCEPT; |
268 | return IRQ_ACCEPT; |
268 | } |
269 | } |
269 | 270 | ||
270 | 271 | ||
271 | /** Initialize keyboard and service interrupts using kernel routine */ |
272 | /** Initialize keyboard and service interrupts using kernel routine */ |
272 | void cuda_grab(void) |
273 | void cuda_grab(void) |
273 | { |
274 | { |
274 | ipl_t ipl = interrupts_disable(); |
275 | ipl_t ipl = interrupts_disable(); |
275 | spinlock_lock(&cuda_irq.lock); |
276 | //rcu_read_lock() is not needed, ints are disabled |
276 | cuda_irq.notif_cfg.notify = false; |
277 | //rcu: atomic update doesn't need reallocation |
277 | spinlock_unlock(&cuda_irq.lock); |
278 | rcu_dereference_pointer(cuda_irq.notif_cfg).notify = false; |
278 | interrupts_restore(ipl); |
279 | interrupts_restore(ipl); |
279 | } |
280 | } |
280 | 281 | ||
281 | 282 | ||
282 | /** Resume the former interrupt vector */ |
283 | /** Resume the former interrupt vector */ |
283 | void cuda_release(void) |
284 | void cuda_release(void) |
284 | { |
285 | { |
285 | ipl_t ipl = interrupts_disable(); |
286 | ipl_t ipl = interrupts_disable(); |
- | 287 | //rcu: atomic update doesn't need reallocation |
|
286 | spinlock_lock(&cuda_irq.lock); |
288 | spinlock_lock(&cuda_irq.lock); |
287 | if (cuda_irq.notif_cfg.answerbox) |
289 | if (rcu_dereference_pointer(cuda_irq.notif_cfg).answerbox) |
288 | cuda_irq.notif_cfg.notify = true; |
290 | rcu_dereference_pointer(cuda_irq.notif_cfg).notify = true; |
289 | spinlock_unlock(&cuda_irq.unlock); |
291 | spinlock_unlock(&cuda_irq.unlock); |
290 | interrupts_restore(ipl); |
292 | interrupts_restore(ipl); |
291 | } |
293 | } |
292 | 294 | ||
293 | 295 | ||
294 | void cuda_init(devno_t devno, uintptr_t base, size_t size) |
296 | void cuda_init(devno_t devno, uintptr_t base, size_t size) |
295 | { |
297 | { |
296 | cuda = (uint8_t *) hw_map(base, size); |
298 | cuda = (uint8_t *) hw_map(base, size); |
297 | 299 | ||
298 | chardev_initialize("cuda_kbd", &kbrd, &ops); |
300 | chardev_initialize("cuda_kbd", &kbrd, &ops); |
299 | stdin = &kbrd; |
301 | stdin = &kbrd; |
300 | 302 | ||
301 | irq_initialize(&cuda_irq); |
303 | irq_initialize(&cuda_irq); |
302 | cuda_irq.devno = devno; |
304 | cuda_irq.devno = devno; |
303 | cuda_irq.inr = CUDA_IRQ; |
305 | cuda_irq.inr = CUDA_IRQ; |
304 | cuda_irq.claim = cuda_claim; |
306 | cuda_irq.claim = cuda_claim; |
305 | cuda_irq.handler = cuda_irq_handler; |
307 | cuda_irq.handler = cuda_irq_handler; |
306 | irq_register(&cuda_irq); |
308 | irq_register(&cuda_irq); |
307 | 309 | ||
308 | pic_enable_interrupt(CUDA_IRQ); |
310 | pic_enable_interrupt(CUDA_IRQ); |
309 | 311 | ||
310 | sysinfo_set_item_val("kbd", NULL, true); |
312 | sysinfo_set_item_val("kbd", NULL, true); |
311 | sysinfo_set_item_val("kbd.devno", NULL, devno); |
313 | sysinfo_set_item_val("kbd.devno", NULL, devno); |
312 | sysinfo_set_item_val("kbd.inr", NULL, CUDA_IRQ); |
314 | sysinfo_set_item_val("kbd.inr", NULL, CUDA_IRQ); |
313 | sysinfo_set_item_val("kbd.address.virtual", NULL, base); |
315 | sysinfo_set_item_val("kbd.address.virtual", NULL, base); |
314 | } |
316 | } |
315 | 317 | ||
316 | 318 | ||
317 | static void send_packet(const uint8_t kind, count_t count, ...) |
319 | static void send_packet(const uint8_t kind, count_t count, ...) |
318 | { |
320 | { |
319 | index_t i; |
321 | index_t i; |
320 | va_list va; |
322 | va_list va; |
321 | 323 | ||
322 | cuda[B] = cuda[B] | TIP; |
324 | cuda[B] = cuda[B] | TIP; |
323 | cuda[ACR] = cuda[ACR] | SR_OUT; |
325 | cuda[ACR] = cuda[ACR] | SR_OUT; |
324 | cuda[SR] = kind; |
326 | cuda[SR] = kind; |
325 | cuda[B] = cuda[B] & ~TIP; |
327 | cuda[B] = cuda[B] & ~TIP; |
326 | 328 | ||
327 | va_start(va, count); |
329 | va_start(va, count); |
328 | 330 | ||
329 | for (i = 0; i < count; i++) { |
331 | for (i = 0; i < count; i++) { |
330 | cuda[ACR] = cuda[ACR] | SR_OUT; |
332 | cuda[ACR] = cuda[ACR] | SR_OUT; |
331 | cuda[SR] = va_arg(va, int); |
333 | cuda[SR] = va_arg(va, int); |
332 | cuda[B] = cuda[B] | TACK; |
334 | cuda[B] = cuda[B] | TACK; |
333 | } |
335 | } |
334 | 336 | ||
335 | va_end(va); |
337 | va_end(va); |
336 | 338 | ||
337 | cuda[B] = cuda[B] | TIP; |
339 | cuda[B] = cuda[B] | TIP; |
338 | } |
340 | } |
339 | 341 | ||
340 | 342 | ||
341 | void cpu_halt(void) { |
343 | void cpu_halt(void) { |
342 | asm volatile ( |
344 | asm volatile ( |
343 | "b 0\n" |
345 | "b 0\n" |
344 | ); |
346 | ); |
345 | } |
347 | } |
346 | 348 | ||
347 | void arch_reboot(void) { |
349 | void arch_reboot(void) { |
348 | send_packet(PACKET_CUDA, 1, CUDA_RESET); |
350 | send_packet(PACKET_CUDA, 1, CUDA_RESET); |
349 | asm volatile ( |
351 | asm volatile ( |
350 | "b 0\n" |
352 | "b 0\n" |
351 | ); |
353 | ); |
352 | } |
354 | } |
353 | 355 | ||
354 | /** @} |
356 | /** @} |
355 | */ |
357 | */ |
356 | 358 |