killed the ohci_init FM_INTERVAL fail
[ppcskel.git] / irq.c
1 /*
2         ppcskel - a Free Software replacement for the Nintendo/BroadOn IOS.
3         IRQ support
4
5 Copyright (C) 2008, 2009        Hector Martin "marcan" <marcan@marcansoft.com>
6 Copyright (C) 2008, 2009        Sven Peter <svenpeter@gmail.com>
7 Copyright (C) 2009                      Andre Heider "dhewg" <dhewg@wiibrew.org>
8
9 # This code is licensed to you under the terms of the GNU GPL, version 2;
10 # see file COPYING or http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt
11 */
12
13 #include "irq.h"
14 #include "hollywood.h"
15 #include "ipc.h"
16 #include "bootmii_ppc.h"
17 #include "ohci.h"
18
19 void irq_initialize(void)
20 {
21         // clear flipper-pic (processor interface)
22         write32(BW_PI_IRQMASK, 0);
23         write32(BW_PI_IRQFLAG, 0xffffffff);
24
25         // clear hollywood-pic
26         write32(HW_PPCIRQMASK, 0);
27         write32(HW_PPCIRQFLAG, 0xffffffff);
28
29         /* ??? -- needed?!
30          * in mini they do
31          *
32          * write32(HW_ARMIRQMASK+0x04, 0);
33          * write32(HW_ARMIRQMASK+0x20, 0);
34          *
35          *
36          * may it's here following; on the other 
37          * hand it's already done by mini...
38          *
39          * write32(HW_PPCIRQMASK+0x04+0x08, 0);
40          * write32(HW_PPCIRQMASK+0x20+0x08, 0);
41          */
42
43         _CPU_ISR_Enable()
44 }
45
46 void irq_shutdown(void)
47 {
48         write32(HW_PPCIRQMASK, 0);
49         write32(HW_PPCIRQFLAG, 0xffffffff);
50         (void) irq_kill();
51 }
52
53 void irq_handler(void)
54 {
55         u32 enabled = read32(BW_PI_IRQMASK);
56         u32 flags = read32(BW_PI_IRQFLAG);
57         printf( "========================\n"
58                         "flags1: 0x%08X\n", flags);
59
60         flags = flags & enabled;
61
62         if (flags & (1<<BW_PI_IRQ_RESET)) { 
63                 write32(BW_PI_IRQFLAG, 1<<BW_PI_IRQ_RESET);
64                 printf("IRQ-BW RESET\n");
65         }
66         if (flags & (1<<BW_PI_IRQ_HW)) { //HW-PIC IRQ
67                 u32 hw_enabled = read32(HW_PPCIRQMASK);
68                 u32 hw_flags = read32(HW_PPCIRQFLAG);
69
70                 printf("In IRQ handler: 0x%08x 0x%08x 0x%08x\n", hw_enabled, hw_flags, hw_flags & hw_enabled);
71
72                 hw_flags = hw_flags & hw_enabled;
73
74                 if(hw_flags & IRQF_TIMER) {
75                         write32(HW_PPCIRQFLAG, IRQF_TIMER);
76                 }
77                 if(hw_flags & IRQF_NAND) {
78                         //              printf("IRQ: NAND\n");
79                         // hmmm... should be done by mini?
80                         write32(NAND_CMD, 0x7fffffff); // shut it up
81                         write32(HW_PPCIRQFLAG, IRQF_NAND);
82                         //nand_irq();
83                 }
84                 if(hw_flags & IRQF_GPIO1B) {
85                         //              printf("IRQ: GPIO1B\n");
86                         // hmmm... should be done by mini?
87                         write32(HW_GPIO1BINTFLAG, 0xFFFFFF); // shut it up
88                         write32(HW_PPCIRQFLAG, IRQF_GPIO1B);
89                 }
90                 if(hw_flags & IRQF_GPIO1) {
91                         //              printf("IRQ: GPIO1\n");
92                         // hmmm... should be done by mini?
93                         write32(HW_GPIO1INTFLAG, 0xFFFFFF); // shut it up
94                         write32(HW_PPCIRQFLAG, IRQF_GPIO1);
95                 }
96                 if(hw_flags & IRQF_RESET) {
97                         //              printf("IRQ: RESET\n");
98                         write32(HW_PPCIRQFLAG, IRQF_RESET);
99                 }
100                 if(hw_flags & IRQF_IPC) {
101                         //printf("IRQ: IPC\n");
102                         //not necessary here?
103                         //ipc_irq();
104                         write32(HW_PPCIRQFLAG, IRQF_IPC);
105                 }
106                 if(hw_flags & IRQF_AES) {
107                         //              printf("IRQ: AES\n");
108                         write32(HW_PPCIRQFLAG, IRQF_AES);
109                 }
110                 if (hw_flags & IRQF_SDHC) {
111                         //              printf("IRQ: SDHC\n");
112                         write32(HW_PPCIRQFLAG, IRQF_SDHC);
113                         //sdhc_irq();
114                 }
115                 if (hw_flags & IRQF_OHCI0) {
116                         ohci0_irq();
117                         write32(HW_PPCIRQFLAG, IRQF_OHCI0);
118                 }
119                 if (hw_flags & IRQF_OHCI1) {
120                         printf("IRQ: OHCI1\n");
121                         write32(HW_PPCIRQFLAG, IRQF_OHCI1);
122                         //TODO: ohci1_irq();
123                 }
124
125                 hw_flags &= ~IRQF_ALL;
126                 if(hw_flags) {
127                         printf("IRQ: unknown 0x%08x\n", hw_flags);
128                         write32(HW_PPCIRQFLAG, hw_flags);
129                 }
130
131                 printf("hw_flags1: 0x%08x\n", read32(HW_PPCIRQFLAG));
132
133                 // not necessary here, but "cleaner"?
134                 write32(BW_PI_IRQFLAG, 1<<BW_PI_IRQ_HW);
135         }
136         printf("flags2: 0x%08X\n", read32(BW_PI_IRQFLAG));
137 }
138
139 void irq_bw_enable(u32 irq)
140 {
141         set32(BW_PI_IRQMASK, 1<<irq);
142 }
143
144 void irq_bw_disable(u32 irq) {
145         clear32(BW_PI_IRQMASK, 1<<irq);
146 }
147
148 void irq_hw_enable(u32 irq)
149 {
150         set32(HW_PPCIRQMASK, 1<<irq);
151 }
152
153 void irq_hw_disable(u32 irq)
154 {
155         clear32(HW_PPCIRQMASK, 1<<irq);
156 }
157
158 u32 irq_kill() {
159         u32 cookie;
160         _CPU_ISR_Disable(cookie);
161         return cookie;
162 }
163
164 void irq_restore(u32 cookie) {
165         _CPU_ISR_Restore(cookie);
166 }
167