Rev 3763 | Rev 3766 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
36 | jermar | 1 | /* |
2071 | jermar | 2 | * Copyright (c) 2005 Jakub Jermar |
36 | jermar | 3 | * All rights reserved. |
4 | * |
||
5 | * Redistribution and use in source and binary forms, with or without |
||
6 | * modification, are permitted provided that the following conditions |
||
7 | * are met: |
||
8 | * |
||
9 | * - Redistributions of source code must retain the above copyright |
||
10 | * notice, this list of conditions and the following disclaimer. |
||
11 | * - Redistributions in binary form must reproduce the above copyright |
||
12 | * notice, this list of conditions and the following disclaimer in the |
||
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 |
||
15 | * derived from this software without specific prior written permission. |
||
16 | * |
||
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 |
||
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
||
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
||
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
||
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 |
||
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 |
||
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
||
27 | */ |
||
28 | |||
1888 | jermar | 29 | /** @addtogroup ia64 |
1702 | cejka | 30 | * @{ |
31 | */ |
||
32 | /** @file |
||
33 | */ |
||
34 | |||
78 | jermar | 35 | #include <arch.h> |
36 | #include <arch/ski/ski.h> |
||
435 | jermar | 37 | #include <arch/drivers/it.h> |
470 | jermar | 38 | #include <arch/interrupt.h> |
39 | #include <arch/barrier.h> |
||
919 | jermar | 40 | #include <arch/asm.h> |
41 | #include <arch/register.h> |
||
470 | jermar | 42 | #include <arch/types.h> |
919 | jermar | 43 | #include <arch/context.h> |
962 | jermar | 44 | #include <arch/stack.h> |
919 | jermar | 45 | #include <arch/mm/page.h> |
46 | #include <mm/as.h> |
||
47 | #include <config.h> |
||
48 | #include <userspace.h> |
||
519 | vana | 49 | #include <console/console.h> |
1078 | jermar | 50 | #include <proc/uarg.h> |
1121 | jermar | 51 | #include <syscall/syscall.h> |
1942 | jermar | 52 | #include <ddi/irq.h> |
2513 | vana | 53 | #include <ddi/device.h> |
2110 | jermar | 54 | #include <arch/drivers/ega.h> |
2513 | vana | 55 | #include <arch/bootinfo.h> |
56 | #include <genarch/kbd/i8042.h> |
||
3578 | vana | 57 | #include <genarch/kbd/ns16550.h> |
58 | #include <smp/smp.h> |
||
59 | #include <smp/ipi.h> |
||
60 | #include <arch/atomic.h> |
||
61 | #include <panic.h> |
||
62 | #include <print.h> |
||
3635 | vana | 63 | #include <sysinfo/sysinfo.h> |
519 | vana | 64 | |
3578 | vana | 65 | /*NS16550 as a COM 1*/ |
3764 | jermar | 66 | #define NS16550_IRQ (4+LEGACY_INTERRUPT_BASE) |
3578 | vana | 67 | #define NS16550_PORT 0x3f8 |
68 | |||
2513 | vana | 69 | bootinfo_t *bootinfo; |
70 | |||
3657 | vana | 71 | static uint64_t iosapic_base=0xfec00000; |
72 | |||
1223 | jermar | 73 | void arch_pre_main(void) |
74 | { |
||
75 | /* Setup usermode init tasks. */ |
||
2513 | vana | 76 | |
2745 | decky | 77 | unsigned int i; |
78 | |||
2513 | vana | 79 | init.cnt = bootinfo->taskmap.count; |
2745 | decky | 80 | |
81 | for (i = 0; i < init.cnt; i++) { |
||
82 | init.tasks[i].addr = ((unsigned long) bootinfo->taskmap.tasks[i].addr) | VRN_MASK; |
||
83 | init.tasks[i].size = bootinfo->taskmap.tasks[i].size; |
||
2513 | vana | 84 | } |
1223 | jermar | 85 | } |
86 | |||
78 | jermar | 87 | void arch_pre_mm_init(void) |
88 | { |
||
470 | jermar | 89 | /* Set Interruption Vector Address (i.e. location of interruption vector table). */ |
1780 | jermar | 90 | iva_write((uintptr_t) &ivt); |
470 | jermar | 91 | srlz_d(); |
92 | |||
78 | jermar | 93 | } |
94 | |||
3657 | vana | 95 | static void iosapic_init(void) |
96 | { |
||
97 | |||
98 | uint64_t IOSAPIC = PA2KA((unative_t)(iosapic_base))|FW_OFFSET; |
||
99 | int i; |
||
100 | |||
3661 | vana | 101 | int myid,myeid; |
3657 | vana | 102 | |
3661 | vana | 103 | myid=ia64_get_cpu_id(); |
104 | myeid=ia64_get_cpu_eid(); |
||
105 | |||
3657 | vana | 106 | for(i=0;i<16;i++) |
107 | { |
||
108 | |||
109 | if(i==2) continue; //Disable Cascade interrupt |
||
110 | ((uint32_t*)(IOSAPIC+0x00))[0]=0x10+2*i; |
||
111 | srlz_d(); |
||
3764 | jermar | 112 | ((uint32_t*)(IOSAPIC+0x10))[0]=LEGACY_INTERRUPT_BASE+i; |
3657 | vana | 113 | srlz_d(); |
114 | ((uint32_t*)(IOSAPIC+0x00))[0]=0x10+2*i+1; |
||
115 | srlz_d(); |
||
3661 | vana | 116 | ((uint32_t*)(IOSAPIC+0x10))[0]=myid<<(56-32) | myeid<<(48-32); |
3657 | vana | 117 | srlz_d(); |
118 | } |
||
119 | |||
120 | } |
||
121 | |||
122 | |||
78 | jermar | 123 | void arch_post_mm_init(void) |
124 | { |
||
3578 | vana | 125 | if(config.cpu_active==1) |
126 | { |
||
3657 | vana | 127 | iosapic_init(); |
128 | |||
3578 | vana | 129 | irq_init(INR_COUNT, INR_COUNT); |
2064 | vana | 130 | #ifdef SKI |
3578 | vana | 131 | ski_init_console(); |
2064 | vana | 132 | #else |
3578 | vana | 133 | ega_init(); |
2064 | vana | 134 | #endif |
3578 | vana | 135 | } |
3657 | vana | 136 | it_init(); |
137 | |||
78 | jermar | 138 | } |
503 | jermar | 139 | |
1901 | jermar | 140 | void arch_post_cpu_init(void) |
141 | { |
||
142 | } |
||
143 | |||
503 | jermar | 144 | void arch_pre_smp_init(void) |
145 | { |
||
146 | } |
||
147 | |||
2513 | vana | 148 | |
149 | #ifdef I460GX |
||
150 | #define POLL_INTERVAL 50000 /* 50 ms */ |
||
151 | /** Kernel thread for polling keyboard. */ |
||
152 | static void i8042_kkbdpoll(void *arg) |
||
153 | { |
||
154 | while (1) { |
||
3578 | vana | 155 | #ifdef CONFIG_NS16550 |
3657 | vana | 156 | #ifndef CONFIG_NS16550_INTERRUPT_DRIVEN |
3578 | vana | 157 | ns16550_poll(); |
3657 | vana | 158 | #endif |
3661 | vana | 159 | #else |
160 | #ifndef CONFIG_I8042_INTERRUPT_DRIVEN |
||
161 | i8042_poll(); |
||
162 | #endif |
||
3578 | vana | 163 | #endif |
2513 | vana | 164 | thread_usleep(POLL_INTERVAL); |
165 | } |
||
166 | } |
||
167 | #endif |
||
168 | |||
3657 | vana | 169 | |
3661 | vana | 170 | void end_of_irq_void(void *cir_arg __attribute__((unused)),inr_t inr __attribute__((unused))); |
171 | void end_of_irq_void(void *cir_arg __attribute__((unused)),inr_t inr __attribute__((unused))) |
||
3657 | vana | 172 | { |
173 | return; |
||
174 | } |
||
175 | |||
176 | |||
503 | jermar | 177 | void arch_post_smp_init(void) |
178 | { |
||
1945 | jermar | 179 | |
3578 | vana | 180 | { |
1945 | jermar | 181 | /* |
182 | * Create thread that polls keyboard. |
||
183 | */ |
||
2064 | vana | 184 | #ifdef SKI |
185 | thread_t *t; |
||
186 | t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true); |
||
1945 | jermar | 187 | if (!t) |
188 | panic("cannot create kkbdpoll\n"); |
||
189 | thread_ready(t); |
||
2064 | vana | 190 | #endif |
2513 | vana | 191 | |
192 | #ifdef I460GX |
||
193 | devno_t kbd = device_assign_devno(); |
||
194 | /* keyboard controller */ |
||
195 | |||
3578 | vana | 196 | #ifdef CONFIG_NS16550 |
3659 | vana | 197 | ns16550_init(kbd, NS16550_PORT, NS16550_IRQ,end_of_irq_void,NULL); // as a COM 1 |
3578 | vana | 198 | #else |
3661 | vana | 199 | devno_t mouse = device_assign_devno(); |
200 | i8042_init(kbd, IRQ_KBD, mouse, IRQ_MOUSE); |
||
3578 | vana | 201 | #endif |
2513 | vana | 202 | thread_t *t; |
203 | t = thread_create(i8042_kkbdpoll, NULL, TASK, 0, "kkbdpoll", true); |
||
204 | if (!t) |
||
205 | panic("cannot create kkbdpoll\n"); |
||
206 | thread_ready(t); |
||
207 | |||
208 | #endif |
||
209 | |||
1945 | jermar | 210 | } |
3635 | vana | 211 | |
212 | sysinfo_set_item_val("ia64_iospace", NULL, true); |
||
213 | sysinfo_set_item_val("ia64_iospace.address", NULL, true); |
||
214 | sysinfo_set_item_val("ia64_iospace.address.virtual", NULL, IO_OFFSET); |
||
215 | |||
3657 | vana | 216 | |
217 | |||
218 | |||
219 | |||
503 | jermar | 220 | } |
919 | jermar | 221 | |
3578 | vana | 222 | |
919 | jermar | 223 | /** Enter userspace and never return. */ |
1078 | jermar | 224 | void userspace(uspace_arg_t *kernel_uarg) |
919 | jermar | 225 | { |
226 | psr_t psr; |
||
227 | rsc_t rsc; |
||
228 | |||
229 | psr.value = psr_read(); |
||
230 | psr.cpl = PL_USER; |
||
231 | psr.i = true; /* start with interrupts enabled */ |
||
232 | psr.ic = true; |
||
233 | psr.ri = 0; /* start with instruction #0 */ |
||
993 | jermar | 234 | psr.bn = 1; /* start in bank 0 */ |
919 | jermar | 235 | |
2082 | decky | 236 | asm volatile ("mov %0 = ar.rsc\n" : "=r" (rsc.value)); |
919 | jermar | 237 | rsc.loadrs = 0; |
238 | rsc.be = false; |
||
239 | rsc.pl = PL_USER; |
||
240 | rsc.mode = 3; /* eager mode */ |
||
241 | |||
1780 | jermar | 242 | switch_to_userspace((uintptr_t) kernel_uarg->uspace_entry, |
243 | ((uintptr_t) kernel_uarg->uspace_stack)+PAGE_SIZE-ALIGN_UP(STACK_ITEM_SIZE, STACK_ALIGNMENT), |
||
244 | ((uintptr_t) kernel_uarg->uspace_stack)+PAGE_SIZE, |
||
245 | (uintptr_t) kernel_uarg->uspace_uarg, |
||
1078 | jermar | 246 | psr.value, rsc.value); |
919 | jermar | 247 | |
248 | while (1) { |
||
249 | ; |
||
250 | } |
||
251 | } |
||
1121 | jermar | 252 | |
253 | /** Set thread-local-storage pointer. |
||
254 | * |
||
255 | * We use r13 (a.k.a. tp) for this purpose. |
||
256 | */ |
||
1780 | jermar | 257 | unative_t sys_tls_set(unative_t addr) |
1121 | jermar | 258 | { |
259 | return 0; |
||
260 | } |
||
1474 | palkovsky | 261 | |
262 | /** Acquire console back for kernel |
||
263 | * |
||
264 | */ |
||
265 | void arch_grab_console(void) |
||
266 | { |
||
2064 | vana | 267 | #ifdef SKI |
1942 | jermar | 268 | ski_kbd_grab(); |
3657 | vana | 269 | #else |
270 | #ifdef CONFIG_NS16550 |
||
271 | ns16550_grab(); |
||
3661 | vana | 272 | #else |
273 | i8042_grab(); |
||
3657 | vana | 274 | #endif |
2064 | vana | 275 | #endif |
1474 | palkovsky | 276 | } |
277 | /** Return console to userspace |
||
278 | * |
||
279 | */ |
||
280 | void arch_release_console(void) |
||
281 | { |
||
2064 | vana | 282 | #ifdef SKI |
1942 | jermar | 283 | ski_kbd_release(); |
3657 | vana | 284 | #else |
285 | #ifdef CONFIG_NS16550 |
||
286 | ns16550_release(); |
||
3661 | vana | 287 | #else |
288 | i8042_release(); |
||
3657 | vana | 289 | #endif |
290 | |||
2064 | vana | 291 | #endif |
1474 | palkovsky | 292 | } |
1702 | cejka | 293 | |
2227 | decky | 294 | void arch_reboot(void) |
295 | { |
||
3578 | vana | 296 | outb(0x64,0xfe); |
2227 | decky | 297 | while (1); |
298 | } |
||
299 | |||
1888 | jermar | 300 | /** @} |
1702 | cejka | 301 | */ |