blob: bcbe40de26fe511cf42aba2faa98ff449a7f00d9 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 * Copyright (C) 1997 Geert Uytterhoeven
3 *
4 * This file is subject to the terms and conditions of the GNU General Public
5 * License. See the file COPYING in the main directory of this archive
6 * for more details.
7 *
8 * This is a duplicate of open_pic.c that deals with U3s MPIC on
9 * G5 PowerMacs. It's the same file except it's using big endian
10 * register accesses
11 */
12
13#include <linux/config.h>
14#include <linux/types.h>
15#include <linux/kernel.h>
16#include <linux/sched.h>
17#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070018#include <linux/interrupt.h>
19#include <linux/sysdev.h>
20#include <linux/errno.h>
21#include <asm/ptrace.h>
22#include <asm/signal.h>
23#include <asm/io.h>
24#include <asm/irq.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070025#include <asm/sections.h>
26#include <asm/open_pic.h>
27#include <asm/i8259.h>
Paul Mackerrasfd582ec2005-10-11 22:08:12 +100028#include <asm/machdep.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070029
30#include "open_pic_defs.h"
31
32void *OpenPIC2_Addr;
33static volatile struct OpenPIC *OpenPIC2 = NULL;
34/*
35 * We define OpenPIC_InitSenses table thusly:
36 * bit 0x1: sense, 0 for edge and 1 for level.
37 * bit 0x2: polarity, 0 for negative, 1 for positive.
38 */
39extern u_int OpenPIC_NumInitSenses;
40extern u_char *OpenPIC_InitSenses;
41extern int use_of_interrupt_tree;
42
43static u_int NumProcessors;
44static u_int NumSources;
45static int open_pic2_irq_offset;
46static volatile OpenPIC_Source *ISR[NR_IRQS];
47
48/* Global Operations */
49static void openpic2_disable_8259_pass_through(void);
50static void openpic2_set_priority(u_int pri);
51static void openpic2_set_spurious(u_int vector);
52
53/* Timer Interrupts */
54static void openpic2_inittimer(u_int timer, u_int pri, u_int vector);
55static void openpic2_maptimer(u_int timer, u_int cpumask);
56
57/* Interrupt Sources */
58static void openpic2_enable_irq(u_int irq);
59static void openpic2_disable_irq(u_int irq);
60static void openpic2_initirq(u_int irq, u_int pri, u_int vector, int polarity,
61 int is_level);
62static void openpic2_mapirq(u_int irq, u_int cpumask, u_int keepmask);
63
64/*
65 * These functions are not used but the code is kept here
66 * for completeness and future reference.
67 */
68static void openpic2_reset(void);
69#ifdef notused
70static void openpic2_enable_8259_pass_through(void);
71static u_int openpic2_get_priority(void);
72static u_int openpic2_get_spurious(void);
73static void openpic2_set_sense(u_int irq, int sense);
74#endif /* notused */
75
76/*
77 * Description of the openpic for the higher-level irq code
78 */
79static void openpic2_end_irq(unsigned int irq_nr);
80static void openpic2_ack_irq(unsigned int irq_nr);
81
82struct hw_interrupt_type open_pic2 = {
Thomas Gleixner2830e212005-09-10 00:26:40 -070083 .typename = " OpenPIC2 ",
84 .enable = openpic2_enable_irq,
85 .disable = openpic2_disable_irq,
86 .ack = openpic2_ack_irq,
87 .end = openpic2_end_irq,
Linus Torvalds1da177e2005-04-16 15:20:36 -070088};
89
90/*
91 * Accesses to the current processor's openpic registers
92 * On cascaded controller, this is only CPU 0
93 */
94#define THIS_CPU Processor[0]
95#define DECL_THIS_CPU
96#define CHECK_THIS_CPU
97
98#if 1
99#define check_arg_ipi(ipi) \
100 if (ipi < 0 || ipi >= OPENPIC_NUM_IPI) \
101 printk("open_pic.c:%d: illegal ipi %d\n", __LINE__, ipi);
102#define check_arg_timer(timer) \
103 if (timer < 0 || timer >= OPENPIC_NUM_TIMERS) \
104 printk("open_pic.c:%d: illegal timer %d\n", __LINE__, timer);
105#define check_arg_vec(vec) \
106 if (vec < 0 || vec >= OPENPIC_NUM_VECTORS) \
107 printk("open_pic.c:%d: illegal vector %d\n", __LINE__, vec);
108#define check_arg_pri(pri) \
109 if (pri < 0 || pri >= OPENPIC_NUM_PRI) \
110 printk("open_pic.c:%d: illegal priority %d\n", __LINE__, pri);
111/*
112 * Print out a backtrace if it's out of range, since if it's larger than NR_IRQ's
113 * data has probably been corrupted and we're going to panic or deadlock later
114 * anyway --Troy
115 */
116extern unsigned long* _get_SP(void);
117#define check_arg_irq(irq) \
118 if (irq < open_pic2_irq_offset || irq >= NumSources+open_pic2_irq_offset \
119 || ISR[irq - open_pic2_irq_offset] == 0) { \
120 printk("open_pic.c:%d: illegal irq %d\n", __LINE__, irq); \
121 /*print_backtrace(_get_SP());*/ }
122#define check_arg_cpu(cpu) \
123 if (cpu < 0 || cpu >= NumProcessors){ \
124 printk("open_pic2.c:%d: illegal cpu %d\n", __LINE__, cpu); \
125 /*print_backtrace(_get_SP());*/ }
126#else
127#define check_arg_ipi(ipi) do {} while (0)
128#define check_arg_timer(timer) do {} while (0)
129#define check_arg_vec(vec) do {} while (0)
130#define check_arg_pri(pri) do {} while (0)
131#define check_arg_irq(irq) do {} while (0)
132#define check_arg_cpu(cpu) do {} while (0)
133#endif
134
135static u_int openpic2_read(volatile u_int *addr)
136{
137 u_int val;
138
139 val = in_be32(addr);
140 return val;
141}
142
143static inline void openpic2_write(volatile u_int *addr, u_int val)
144{
145 out_be32(addr, val);
146}
147
148static inline u_int openpic2_readfield(volatile u_int *addr, u_int mask)
149{
150 u_int val = openpic2_read(addr);
151 return val & mask;
152}
153
154inline void openpic2_writefield(volatile u_int *addr, u_int mask,
155 u_int field)
156{
157 u_int val = openpic2_read(addr);
158 openpic2_write(addr, (val & ~mask) | (field & mask));
159}
160
161static inline void openpic2_clearfield(volatile u_int *addr, u_int mask)
162{
163 openpic2_writefield(addr, mask, 0);
164}
165
166static inline void openpic2_setfield(volatile u_int *addr, u_int mask)
167{
168 openpic2_writefield(addr, mask, mask);
169}
170
171static void openpic2_safe_writefield(volatile u_int *addr, u_int mask,
172 u_int field)
173{
174 openpic2_setfield(addr, OPENPIC_MASK);
175 while (openpic2_read(addr) & OPENPIC_ACTIVITY);
176 openpic2_writefield(addr, mask | OPENPIC_MASK, field | OPENPIC_MASK);
177}
178
179static void openpic2_reset(void)
180{
181 openpic2_setfield(&OpenPIC2->Global.Global_Configuration0,
182 OPENPIC_CONFIG_RESET);
183 while (openpic2_readfield(&OpenPIC2->Global.Global_Configuration0,
184 OPENPIC_CONFIG_RESET))
185 mb();
186}
187
188void __init openpic2_set_sources(int first_irq, int num_irqs, void *first_ISR)
189{
190 volatile OpenPIC_Source *src = first_ISR;
191 int i, last_irq;
192
193 last_irq = first_irq + num_irqs;
194 if (last_irq > NumSources)
195 NumSources = last_irq;
196 if (src == 0)
197 src = &((struct OpenPIC *)OpenPIC2_Addr)->Source[first_irq];
198 for (i = first_irq; i < last_irq; ++i, ++src)
199 ISR[i] = src;
200}
201
202/*
203 * The `offset' parameter defines where the interrupts handled by the
204 * OpenPIC start in the space of interrupt numbers that the kernel knows
205 * about. In other words, the OpenPIC's IRQ0 is numbered `offset' in the
206 * kernel's interrupt numbering scheme.
207 * We assume there is only one OpenPIC.
208 */
209void __init openpic2_init(int offset)
210{
211 u_int t, i;
212 u_int timerfreq;
213 const char *version;
214
215 if (!OpenPIC2_Addr) {
216 printk("No OpenPIC2 found !\n");
217 return;
218 }
219 OpenPIC2 = (volatile struct OpenPIC *)OpenPIC2_Addr;
220
221 if (ppc_md.progress) ppc_md.progress("openpic: enter", 0x122);
222
223 t = openpic2_read(&OpenPIC2->Global.Feature_Reporting0);
224 switch (t & OPENPIC_FEATURE_VERSION_MASK) {
225 case 1:
226 version = "1.0";
227 break;
228 case 2:
229 version = "1.2";
230 break;
231 case 3:
232 version = "1.3";
233 break;
234 default:
235 version = "?";
236 break;
237 }
238 NumProcessors = ((t & OPENPIC_FEATURE_LAST_PROCESSOR_MASK) >>
239 OPENPIC_FEATURE_LAST_PROCESSOR_SHIFT) + 1;
240 if (NumSources == 0)
241 openpic2_set_sources(0,
242 ((t & OPENPIC_FEATURE_LAST_SOURCE_MASK) >>
243 OPENPIC_FEATURE_LAST_SOURCE_SHIFT) + 1,
244 NULL);
245 printk("OpenPIC (2) Version %s (%d CPUs and %d IRQ sources) at %p\n",
246 version, NumProcessors, NumSources, OpenPIC2);
247 timerfreq = openpic2_read(&OpenPIC2->Global.Timer_Frequency);
248 if (timerfreq)
249 printk("OpenPIC timer frequency is %d.%06d MHz\n",
250 timerfreq / 1000000, timerfreq % 1000000);
251
252 open_pic2_irq_offset = offset;
253
254 /* Initialize timer interrupts */
255 if ( ppc_md.progress ) ppc_md.progress("openpic2: timer",0x3ba);
256 for (i = 0; i < OPENPIC_NUM_TIMERS; i++) {
257 /* Disabled, Priority 0 */
258 openpic2_inittimer(i, 0, OPENPIC2_VEC_TIMER+i+offset);
259 /* No processor */
260 openpic2_maptimer(i, 0);
261 }
262
263 /* Initialize external interrupts */
264 if (ppc_md.progress) ppc_md.progress("openpic2: external",0x3bc);
265
266 openpic2_set_priority(0xf);
267
268 /* Init all external sources, including possibly the cascade. */
269 for (i = 0; i < NumSources; i++) {
270 int sense;
271
272 if (ISR[i] == 0)
273 continue;
274
275 /* the bootloader may have left it enabled (bad !) */
276 openpic2_disable_irq(i+offset);
277
278 sense = (i < OpenPIC_NumInitSenses)? OpenPIC_InitSenses[i]: \
279 (IRQ_SENSE_LEVEL | IRQ_POLARITY_NEGATIVE);
280
281 if (sense & IRQ_SENSE_MASK)
282 irq_desc[i+offset].status = IRQ_LEVEL;
283
284 /* Enabled, Priority 8 */
285 openpic2_initirq(i, 8, i+offset, (sense & IRQ_POLARITY_MASK),
286 (sense & IRQ_SENSE_MASK));
287 /* Processor 0 */
288 openpic2_mapirq(i, 1<<0, 0);
289 }
290
291 /* Init descriptors */
292 for (i = offset; i < NumSources + offset; i++)
293 irq_desc[i].handler = &open_pic2;
294
295 /* Initialize the spurious interrupt */
296 if (ppc_md.progress) ppc_md.progress("openpic2: spurious",0x3bd);
297 openpic2_set_spurious(OPENPIC2_VEC_SPURIOUS+offset);
298
299 openpic2_disable_8259_pass_through();
300 openpic2_set_priority(0);
301
302 if (ppc_md.progress) ppc_md.progress("openpic2: exit",0x222);
303}
304
305#ifdef notused
306static void openpic2_enable_8259_pass_through(void)
307{
308 openpic2_clearfield(&OpenPIC2->Global.Global_Configuration0,
309 OPENPIC_CONFIG_8259_PASSTHROUGH_DISABLE);
310}
311#endif /* notused */
312
313/* This can't be __init, it is used in openpic_sleep_restore_intrs */
314static void openpic2_disable_8259_pass_through(void)
315{
316 openpic2_setfield(&OpenPIC2->Global.Global_Configuration0,
317 OPENPIC_CONFIG_8259_PASSTHROUGH_DISABLE);
318}
319
320/*
321 * Find out the current interrupt
322 */
323u_int openpic2_irq(void)
324{
325 u_int vec;
326 DECL_THIS_CPU;
327
328 CHECK_THIS_CPU;
329 vec = openpic2_readfield(&OpenPIC2->THIS_CPU.Interrupt_Acknowledge,
330 OPENPIC_VECTOR_MASK);
331 return vec;
332}
333
334void openpic2_eoi(void)
335{
336 DECL_THIS_CPU;
337
338 CHECK_THIS_CPU;
339 openpic2_write(&OpenPIC2->THIS_CPU.EOI, 0);
340 /* Handle PCI write posting */
341 (void)openpic2_read(&OpenPIC2->THIS_CPU.EOI);
342}
343
344#ifdef notused
345static u_int openpic2_get_priority(void)
346{
347 DECL_THIS_CPU;
348
349 CHECK_THIS_CPU;
350 return openpic2_readfield(&OpenPIC2->THIS_CPU.Current_Task_Priority,
351 OPENPIC_CURRENT_TASK_PRIORITY_MASK);
352}
353#endif /* notused */
354
355static void __init openpic2_set_priority(u_int pri)
356{
357 DECL_THIS_CPU;
358
359 CHECK_THIS_CPU;
360 check_arg_pri(pri);
361 openpic2_writefield(&OpenPIC2->THIS_CPU.Current_Task_Priority,
362 OPENPIC_CURRENT_TASK_PRIORITY_MASK, pri);
363}
364
365/*
366 * Get/set the spurious vector
367 */
368#ifdef notused
369static u_int openpic2_get_spurious(void)
370{
371 return openpic2_readfield(&OpenPIC2->Global.Spurious_Vector,
372 OPENPIC_VECTOR_MASK);
373}
374#endif /* notused */
375
376/* This can't be __init, it is used in openpic_sleep_restore_intrs */
377static void openpic2_set_spurious(u_int vec)
378{
379 check_arg_vec(vec);
380 openpic2_writefield(&OpenPIC2->Global.Spurious_Vector, OPENPIC_VECTOR_MASK,
381 vec);
382}
383
384static DEFINE_SPINLOCK(openpic2_setup_lock);
385
386/*
387 * Initialize a timer interrupt (and disable it)
388 *
389 * timer: OpenPIC timer number
390 * pri: interrupt source priority
391 * vec: the vector it will produce
392 */
393static void __init openpic2_inittimer(u_int timer, u_int pri, u_int vec)
394{
395 check_arg_timer(timer);
396 check_arg_pri(pri);
397 check_arg_vec(vec);
398 openpic2_safe_writefield(&OpenPIC2->Global.Timer[timer].Vector_Priority,
399 OPENPIC_PRIORITY_MASK | OPENPIC_VECTOR_MASK,
400 (pri << OPENPIC_PRIORITY_SHIFT) | vec);
401}
402
403/*
404 * Map a timer interrupt to one or more CPUs
405 */
406static void __init openpic2_maptimer(u_int timer, u_int cpumask)
407{
408 check_arg_timer(timer);
409 openpic2_write(&OpenPIC2->Global.Timer[timer].Destination,
410 cpumask);
411}
412
413/*
414 * Initalize the interrupt source which will generate an NMI.
415 * This raises the interrupt's priority from 8 to 9.
416 *
417 * irq: The logical IRQ which generates an NMI.
418 */
419void __init
420openpic2_init_nmi_irq(u_int irq)
421{
422 check_arg_irq(irq);
423 openpic2_safe_writefield(&ISR[irq - open_pic2_irq_offset]->Vector_Priority,
424 OPENPIC_PRIORITY_MASK,
425 9 << OPENPIC_PRIORITY_SHIFT);
426}
427
428/*
429 *
430 * All functions below take an offset'ed irq argument
431 *
432 */
433
434
435/*
436 * Enable/disable an external interrupt source
437 *
438 * Externally called, irq is an offseted system-wide interrupt number
439 */
440static void openpic2_enable_irq(u_int irq)
441{
442 volatile u_int *vpp;
443
444 check_arg_irq(irq);
445 vpp = &ISR[irq - open_pic2_irq_offset]->Vector_Priority;
446 openpic2_clearfield(vpp, OPENPIC_MASK);
447 /* make sure mask gets to controller before we return to user */
448 do {
449 mb(); /* sync is probably useless here */
450 } while (openpic2_readfield(vpp, OPENPIC_MASK));
451}
452
453static void openpic2_disable_irq(u_int irq)
454{
455 volatile u_int *vpp;
456 u32 vp;
457
458 check_arg_irq(irq);
459 vpp = &ISR[irq - open_pic2_irq_offset]->Vector_Priority;
460 openpic2_setfield(vpp, OPENPIC_MASK);
461 /* make sure mask gets to controller before we return to user */
462 do {
463 mb(); /* sync is probably useless here */
464 vp = openpic2_readfield(vpp, OPENPIC_MASK | OPENPIC_ACTIVITY);
465 } while((vp & OPENPIC_ACTIVITY) && !(vp & OPENPIC_MASK));
466}
467
468
469/*
470 * Initialize an interrupt source (and disable it!)
471 *
472 * irq: OpenPIC interrupt number
473 * pri: interrupt source priority
474 * vec: the vector it will produce
475 * pol: polarity (1 for positive, 0 for negative)
476 * sense: 1 for level, 0 for edge
477 */
478static void __init
479openpic2_initirq(u_int irq, u_int pri, u_int vec, int pol, int sense)
480{
481 openpic2_safe_writefield(&ISR[irq]->Vector_Priority,
482 OPENPIC_PRIORITY_MASK | OPENPIC_VECTOR_MASK |
483 OPENPIC_SENSE_MASK | OPENPIC_POLARITY_MASK,
484 (pri << OPENPIC_PRIORITY_SHIFT) | vec |
485 (pol ? OPENPIC_POLARITY_POSITIVE :
486 OPENPIC_POLARITY_NEGATIVE) |
487 (sense ? OPENPIC_SENSE_LEVEL : OPENPIC_SENSE_EDGE));
488}
489
490/*
491 * Map an interrupt source to one or more CPUs
492 */
493static void openpic2_mapirq(u_int irq, u_int physmask, u_int keepmask)
494{
495 if (ISR[irq] == 0)
496 return;
497 if (keepmask != 0)
498 physmask |= openpic2_read(&ISR[irq]->Destination) & keepmask;
499 openpic2_write(&ISR[irq]->Destination, physmask);
500}
501
502#ifdef notused
503/*
504 * Set the sense for an interrupt source (and disable it!)
505 *
506 * sense: 1 for level, 0 for edge
507 */
508static void openpic2_set_sense(u_int irq, int sense)
509{
510 if (ISR[irq] != 0)
511 openpic2_safe_writefield(&ISR[irq]->Vector_Priority,
512 OPENPIC_SENSE_LEVEL,
513 (sense ? OPENPIC_SENSE_LEVEL : 0));
514}
515#endif /* notused */
516
517/* No spinlocks, should not be necessary with the OpenPIC
518 * (1 register = 1 interrupt and we have the desc lock).
519 */
520static void openpic2_ack_irq(unsigned int irq_nr)
521{
522 openpic2_disable_irq(irq_nr);
523 openpic2_eoi();
524}
525
526static void openpic2_end_irq(unsigned int irq_nr)
527{
528 if (!(irq_desc[irq_nr].status & (IRQ_DISABLED|IRQ_INPROGRESS)))
529 openpic2_enable_irq(irq_nr);
530}
531
532int
533openpic2_get_irq(struct pt_regs *regs)
534{
535 int irq = openpic2_irq();
536
537 if (irq == (OPENPIC2_VEC_SPURIOUS + open_pic2_irq_offset))
538 irq = -1;
539 return irq;
540}
541
542#ifdef CONFIG_PM
543
544/*
545 * We implement the IRQ controller as a sysdev and put it
546 * to sleep at powerdown stage (the callback is named suspend,
547 * but it's old semantics, for the Device Model, it's really
548 * powerdown). The possible problem is that another sysdev that
549 * happens to be suspend after this one will have interrupts off,
550 * that may be an issue... For now, this isn't an issue on pmac
551 * though...
552 */
553
554static u32 save_ipi_vp[OPENPIC_NUM_IPI];
555static u32 save_irq_src_vp[OPENPIC_MAX_SOURCES];
556static u32 save_irq_src_dest[OPENPIC_MAX_SOURCES];
557static u32 save_cpu_task_pri[OPENPIC_MAX_PROCESSORS];
558static int openpic_suspend_count;
559
560static void openpic2_cached_enable_irq(u_int irq)
561{
562 check_arg_irq(irq);
563 save_irq_src_vp[irq - open_pic2_irq_offset] &= ~OPENPIC_MASK;
564}
565
566static void openpic2_cached_disable_irq(u_int irq)
567{
568 check_arg_irq(irq);
569 save_irq_src_vp[irq - open_pic2_irq_offset] |= OPENPIC_MASK;
570}
571
572/* WARNING: Can be called directly by the cpufreq code with NULL parameter,
573 * we need something better to deal with that... Maybe switch to S1 for
574 * cpufreq changes
575 */
Richard Purdiee36d3942005-09-16 19:27:53 -0700576int openpic2_suspend(struct sys_device *sysdev, pm_message_t state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700577{
578 int i;
579 unsigned long flags;
580
581 spin_lock_irqsave(&openpic2_setup_lock, flags);
582
583 if (openpic_suspend_count++ > 0) {
584 spin_unlock_irqrestore(&openpic2_setup_lock, flags);
585 return 0;
586 }
587
588 open_pic2.enable = openpic2_cached_enable_irq;
589 open_pic2.disable = openpic2_cached_disable_irq;
590
591 for (i=0; i<NumProcessors; i++) {
592 save_cpu_task_pri[i] = openpic2_read(&OpenPIC2->Processor[i].Current_Task_Priority);
593 openpic2_writefield(&OpenPIC2->Processor[i].Current_Task_Priority,
594 OPENPIC_CURRENT_TASK_PRIORITY_MASK, 0xf);
595 }
596
597 for (i=0; i<OPENPIC_NUM_IPI; i++)
598 save_ipi_vp[i] = openpic2_read(&OpenPIC2->Global.IPI_Vector_Priority(i));
599 for (i=0; i<NumSources; i++) {
600 if (ISR[i] == 0)
601 continue;
602 save_irq_src_vp[i] = openpic2_read(&ISR[i]->Vector_Priority) & ~OPENPIC_ACTIVITY;
603 save_irq_src_dest[i] = openpic2_read(&ISR[i]->Destination);
604 }
605
606 spin_unlock_irqrestore(&openpic2_setup_lock, flags);
607
608 return 0;
609}
610
611/* WARNING: Can be called directly by the cpufreq code with NULL parameter,
612 * we need something better to deal with that... Maybe switch to S1 for
613 * cpufreq changes
614 */
615int openpic2_resume(struct sys_device *sysdev)
616{
617 int i;
618 unsigned long flags;
619 u32 vppmask = OPENPIC_PRIORITY_MASK | OPENPIC_VECTOR_MASK |
620 OPENPIC_SENSE_MASK | OPENPIC_POLARITY_MASK |
621 OPENPIC_MASK;
622
623 spin_lock_irqsave(&openpic2_setup_lock, flags);
624
625 if ((--openpic_suspend_count) > 0) {
626 spin_unlock_irqrestore(&openpic2_setup_lock, flags);
627 return 0;
628 }
629
630 openpic2_reset();
631
632 /* OpenPIC sometimes seem to need some time to be fully back up... */
633 do {
634 openpic2_set_spurious(OPENPIC2_VEC_SPURIOUS+open_pic2_irq_offset);
635 } while(openpic2_readfield(&OpenPIC2->Global.Spurious_Vector, OPENPIC_VECTOR_MASK)
636 != (OPENPIC2_VEC_SPURIOUS + open_pic2_irq_offset));
637
638 openpic2_disable_8259_pass_through();
639
640 for (i=0; i<OPENPIC_NUM_IPI; i++)
641 openpic2_write(&OpenPIC2->Global.IPI_Vector_Priority(i),
642 save_ipi_vp[i]);
643 for (i=0; i<NumSources; i++) {
644 if (ISR[i] == 0)
645 continue;
646 openpic2_write(&ISR[i]->Destination, save_irq_src_dest[i]);
647 openpic2_write(&ISR[i]->Vector_Priority, save_irq_src_vp[i]);
648 /* make sure mask gets to controller before we return to user */
649 do {
650 openpic2_write(&ISR[i]->Vector_Priority, save_irq_src_vp[i]);
651 } while (openpic2_readfield(&ISR[i]->Vector_Priority, vppmask)
652 != (save_irq_src_vp[i] & vppmask));
653 }
654 for (i=0; i<NumProcessors; i++)
655 openpic2_write(&OpenPIC2->Processor[i].Current_Task_Priority,
656 save_cpu_task_pri[i]);
657
658 open_pic2.enable = openpic2_enable_irq;
659 open_pic2.disable = openpic2_disable_irq;
660
661 spin_unlock_irqrestore(&openpic2_setup_lock, flags);
662
663 return 0;
664}
665
666#endif /* CONFIG_PM */
667
668/* HACK ALERT */
669static struct sysdev_class openpic2_sysclass = {
670 set_kset_name("openpic2"),
671};
672
673static struct sys_device device_openpic2 = {
674 .id = 0,
675 .cls = &openpic2_sysclass,
676};
677
678static struct sysdev_driver driver_openpic2 = {
679#ifdef CONFIG_PM
680 .suspend = &openpic2_suspend,
681 .resume = &openpic2_resume,
682#endif /* CONFIG_PM */
683};
684
685static int __init init_openpic2_sysfs(void)
686{
687 int rc;
688
689 if (!OpenPIC2_Addr)
690 return -ENODEV;
691 printk(KERN_DEBUG "Registering openpic2 with sysfs...\n");
692 rc = sysdev_class_register(&openpic2_sysclass);
693 if (rc) {
694 printk(KERN_ERR "Failed registering openpic sys class\n");
695 return -ENODEV;
696 }
697 rc = sysdev_register(&device_openpic2);
698 if (rc) {
699 printk(KERN_ERR "Failed registering openpic sys device\n");
700 return -ENODEV;
701 }
702 rc = sysdev_driver_register(&openpic2_sysclass, &driver_openpic2);
703 if (rc) {
704 printk(KERN_ERR "Failed registering openpic sys driver\n");
705 return -ENODEV;
706 }
707 return 0;
708}
709
710subsys_initcall(init_openpic2_sysfs);
711