Rev 3593 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 3593 | Rev 3665 | ||
|---|---|---|---|
| Line 58... | Line 58... | ||
| 58 | #include <smp/smp.h> |
58 | #include <smp/smp.h> |
| 59 | #include <smp/ipi.h> |
59 | #include <smp/ipi.h> |
| 60 | #include <arch/atomic.h> |
60 | #include <arch/atomic.h> |
| 61 | #include <panic.h> |
61 | #include <panic.h> |
| 62 | #include <print.h> |
62 | #include <print.h> |
| - | 63 | #include <sysinfo/sysinfo.h> |
|
| 63 | 64 | ||
| 64 | /*NS16550 as a COM 1*/ |
65 | /*NS16550 as a COM 1*/ |
| 65 | #define NS16550_IRQ 4 |
66 | #define NS16550_IRQ (4+LAGACY_INTERRUPT_BASE) |
| 66 | #define NS16550_PORT 0x3f8 |
67 | #define NS16550_PORT 0x3f8 |
| 67 | 68 | ||
| 68 | bootinfo_t *bootinfo; |
69 | bootinfo_t *bootinfo; |
| 69 | 70 | ||
| - | 71 | static uint64_t iosapic_base=0xfec00000; |
|
| - | 72 | ||
| 70 | void arch_pre_main(void) |
73 | void arch_pre_main(void) |
| 71 | { |
74 | { |
| 72 | /* Setup usermode init tasks. */ |
75 | /* Setup usermode init tasks. */ |
| 73 | 76 | ||
| 74 | //#ifdef I460GX |
77 | //#ifdef I460GX |
| Line 108... | Line 111... | ||
| 108 | iva_write((uintptr_t) &ivt); |
111 | iva_write((uintptr_t) &ivt); |
| 109 | srlz_d(); |
112 | srlz_d(); |
| 110 | 113 | ||
| 111 | } |
114 | } |
| 112 | 115 | ||
| - | 116 | static void iosapic_init(void) |
|
| - | 117 | { |
|
| - | 118 | ||
| - | 119 | uint64_t IOSAPIC = PA2KA((unative_t)(iosapic_base))|FW_OFFSET; |
|
| - | 120 | int i; |
|
| - | 121 | ||
| - | 122 | int myid,myeid; |
|
| - | 123 | ||
| - | 124 | myid=ia64_get_cpu_id(); |
|
| - | 125 | myeid=ia64_get_cpu_eid(); |
|
| - | 126 | ||
| - | 127 | for(i=0;i<16;i++) |
|
| - | 128 | { |
|
| - | 129 | ||
| - | 130 | if(i==2) continue; //Disable Cascade interrupt |
|
| - | 131 | ((uint32_t*)(IOSAPIC+0x00))[0]=0x10+2*i; |
|
| - | 132 | srlz_d(); |
|
| - | 133 | ((uint32_t*)(IOSAPIC+0x10))[0]=LAGACY_INTERRUPT_BASE+i; |
|
| - | 134 | srlz_d(); |
|
| - | 135 | ((uint32_t*)(IOSAPIC+0x00))[0]=0x10+2*i+1; |
|
| - | 136 | srlz_d(); |
|
| - | 137 | ((uint32_t*)(IOSAPIC+0x10))[0]=myid<<(56-32) | myeid<<(48-32); |
|
| - | 138 | srlz_d(); |
|
| - | 139 | } |
|
| - | 140 | ||
| - | 141 | } |
|
| - | 142 | ||
| - | 143 | ||
| 113 | void arch_post_mm_init(void) |
144 | void arch_post_mm_init(void) |
| 114 | { |
145 | { |
| 115 | if(config.cpu_active==1) |
146 | if(config.cpu_active==1) |
| 116 | { |
147 | { |
| - | 148 | iosapic_init(); |
|
| - | 149 | ||
| 117 | irq_init(INR_COUNT, INR_COUNT); |
150 | irq_init(INR_COUNT, INR_COUNT); |
| 118 | #ifdef SKI |
151 | #ifdef SKI |
| 119 | ski_init_console(); |
152 | ski_init_console(); |
| 120 | #else |
153 | #else |
| 121 | ega_init(); |
154 | ega_init(); |
| 122 | #endif |
155 | #endif |
| 123 | } |
156 | } |
| 124 | it_init(); |
157 | it_init(); |
| - | 158 | ||
| 125 | } |
159 | } |
| 126 | 160 | ||
| 127 | void arch_post_cpu_init(void) |
161 | void arch_post_cpu_init(void) |
| 128 | { |
162 | { |
| 129 | } |
163 | } |
| Line 137... | Line 171... | ||
| 137 | #define POLL_INTERVAL 50000 /* 50 ms */ |
171 | #define POLL_INTERVAL 50000 /* 50 ms */ |
| 138 | /** Kernel thread for polling keyboard. */ |
172 | /** Kernel thread for polling keyboard. */ |
| 139 | static void i8042_kkbdpoll(void *arg) |
173 | static void i8042_kkbdpoll(void *arg) |
| 140 | { |
174 | { |
| 141 | while (1) { |
175 | while (1) { |
| 142 | i8042_poll(); |
- | |
| 143 | #ifdef CONFIG_NS16550 |
176 | #ifdef CONFIG_NS16550 |
| - | 177 | #ifndef CONFIG_NS16550_INTERRUPT_DRIVEN |
|
| 144 | ns16550_poll(); |
178 | ns16550_poll(); |
| - | 179 | #endif |
|
| - | 180 | #else |
|
| - | 181 | #ifndef CONFIG_I8042_INTERRUPT_DRIVEN |
|
| - | 182 | i8042_poll(); |
|
| - | 183 | #endif |
|
| 145 | #endif |
184 | #endif |
| 146 | thread_usleep(POLL_INTERVAL); |
185 | thread_usleep(POLL_INTERVAL); |
| 147 | } |
186 | } |
| 148 | } |
187 | } |
| 149 | #endif |
188 | #endif |
| 150 | 189 | ||
| - | 190 | ||
| - | 191 | void end_of_irq_void(void *cir_arg __attribute__((unused)),inr_t inr __attribute__((unused))); |
|
| - | 192 | void end_of_irq_void(void *cir_arg __attribute__((unused)),inr_t inr __attribute__((unused))) |
|
| - | 193 | { |
|
| - | 194 | return; |
|
| - | 195 | } |
|
| - | 196 | ||
| - | 197 | ||
| 151 | void arch_post_smp_init(void) |
198 | void arch_post_smp_init(void) |
| 152 | { |
199 | { |
| 153 | 200 | ||
| 154 | { |
201 | { |
| 155 | /* |
202 | /* |
| Line 163... | Line 210... | ||
| 163 | thread_ready(t); |
210 | thread_ready(t); |
| 164 | #endif |
211 | #endif |
| 165 | 212 | ||
| 166 | #ifdef I460GX |
213 | #ifdef I460GX |
| 167 | devno_t kbd = device_assign_devno(); |
214 | devno_t kbd = device_assign_devno(); |
| 168 | devno_t mouse = device_assign_devno(); |
- | |
| 169 | /* keyboard controller */ |
215 | /* keyboard controller */ |
| 170 | i8042_init(kbd, IRQ_KBD, mouse, IRQ_MOUSE); |
- | |
| 171 | 216 | ||
| 172 | #ifdef CONFIG_NS16550 |
217 | #ifdef CONFIG_NS16550 |
| 173 | ns16550_init(kbd, NS16550_IRQ, NS16550_PORT); // as a COM 1 |
218 | ns16550_init(kbd, NS16550_PORT, NS16550_IRQ,end_of_irq_void,NULL); // as a COM 1 |
| 174 | #else |
219 | #else |
| - | 220 | devno_t mouse = device_assign_devno(); |
|
| - | 221 | i8042_init(kbd, IRQ_KBD, mouse, IRQ_MOUSE); |
|
| 175 | #endif |
222 | #endif |
| 176 | thread_t *t; |
223 | thread_t *t; |
| 177 | t = thread_create(i8042_kkbdpoll, NULL, TASK, 0, "kkbdpoll", true); |
224 | t = thread_create(i8042_kkbdpoll, NULL, TASK, 0, "kkbdpoll", true); |
| 178 | if (!t) |
225 | if (!t) |
| 179 | panic("cannot create kkbdpoll\n"); |
226 | panic("cannot create kkbdpoll\n"); |
| 180 | thread_ready(t); |
227 | thread_ready(t); |
| 181 | 228 | ||
| 182 | #endif |
229 | #endif |
| 183 | 230 | ||
| 184 | } |
231 | } |
| - | 232 | ||
| - | 233 | sysinfo_set_item_val("ia64_iospace", NULL, true); |
|
| - | 234 | sysinfo_set_item_val("ia64_iospace.address", NULL, true); |
|
| - | 235 | sysinfo_set_item_val("ia64_iospace.address.virtual", NULL, IO_OFFSET); |
|
| - | 236 | ||
| - | 237 | ||
| - | 238 | ||
| - | 239 | ||
| - | 240 | ||
| 185 | } |
241 | } |
| 186 | 242 | ||
| 187 | 243 | ||
| 188 | /** Enter userspace and never return. */ |
244 | /** Enter userspace and never return. */ |
| 189 | void userspace(uspace_arg_t *kernel_uarg) |
245 | void userspace(uspace_arg_t *kernel_uarg) |
| Line 229... | Line 285... | ||
| 229 | */ |
285 | */ |
| 230 | void arch_grab_console(void) |
286 | void arch_grab_console(void) |
| 231 | { |
287 | { |
| 232 | #ifdef SKI |
288 | #ifdef SKI |
| 233 | ski_kbd_grab(); |
289 | ski_kbd_grab(); |
| - | 290 | #else |
|
| - | 291 | #ifdef CONFIG_NS16550 |
|
| - | 292 | ns16550_grab(); |
|
| - | 293 | #else |
|
| - | 294 | i8042_grab(); |
|
| - | 295 | #endif |
|
| 234 | #endif |
296 | #endif |
| 235 | } |
297 | } |
| 236 | /** Return console to userspace |
298 | /** Return console to userspace |
| 237 | * |
299 | * |
| 238 | */ |
300 | */ |
| 239 | void arch_release_console(void) |
301 | void arch_release_console(void) |
| 240 | { |
302 | { |
| 241 | #ifdef SKI |
303 | #ifdef SKI |
| 242 | ski_kbd_release(); |
304 | ski_kbd_release(); |
| - | 305 | #else |
|
| - | 306 | #ifdef CONFIG_NS16550 |
|
| - | 307 | ns16550_release(); |
|
| - | 308 | #else |
|
| - | 309 | i8042_release(); |
|
| - | 310 | #endif |
|
| - | 311 | ||
| 243 | #endif |
312 | #endif |
| 244 | } |
313 | } |
| 245 | 314 | ||
| 246 | void arch_reboot(void) |
315 | void arch_reboot(void) |
| 247 | { |
316 | { |