Rev 3880 | Rev 3963 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
206 | palkovsky | 1 | /* |
2071 | jermar | 2 | * Copyright (c) 2005 Ondrej Palkovsky |
206 | palkovsky | 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 | |||
1842 | jermar | 29 | /** @addtogroup amd64 |
1702 | cejka | 30 | * @{ |
31 | */ |
||
32 | /** @file |
||
33 | */ |
||
34 | |||
206 | palkovsky | 35 | #include <arch.h> |
36 | |||
37 | #include <arch/types.h> |
||
38 | |||
39 | #include <config.h> |
||
40 | |||
1112 | palkovsky | 41 | #include <proc/thread.h> |
3932 | jermar | 42 | #include <genarch/drivers/legacy/ia32/io.h> |
3779 | jermar | 43 | #include <genarch/drivers/ega/ega.h> |
1477 | decky | 44 | #include <arch/drivers/vesa.h> |
1842 | jermar | 45 | #include <genarch/kbd/i8042.h> |
1477 | decky | 46 | #include <arch/drivers/i8254.h> |
47 | #include <arch/drivers/i8259.h> |
||
206 | palkovsky | 48 | |
1901 | jermar | 49 | #ifdef CONFIG_SMP |
50 | #include <arch/smp/apic.h> |
||
51 | #endif |
||
52 | |||
206 | palkovsky | 53 | #include <arch/bios/bios.h> |
251 | palkovsky | 54 | #include <arch/cpu.h> |
55 | #include <print.h> |
||
56 | #include <arch/cpuid.h> |
||
452 | decky | 57 | #include <genarch/acpi/acpi.h> |
282 | palkovsky | 58 | #include <panic.h> |
576 | palkovsky | 59 | #include <interrupt.h> |
803 | palkovsky | 60 | #include <arch/syscall.h> |
1072 | palkovsky | 61 | #include <arch/debugger.h> |
1112 | palkovsky | 62 | #include <syscall/syscall.h> |
1474 | palkovsky | 63 | #include <console/console.h> |
1958 | decky | 64 | #include <ddi/irq.h> |
65 | #include <ddi/device.h> |
||
206 | palkovsky | 66 | |
1112 | palkovsky | 67 | |
799 | palkovsky | 68 | /** Disable I/O on non-privileged levels |
69 | * |
||
70 | * Clean IOPL(12,13) and NT(14) flags in EFLAGS register |
||
71 | */ |
||
72 | static void clean_IOPL_NT_flags(void) |
||
73 | { |
||
2697 | decky | 74 | asm ( |
75 | "pushfq\n" |
||
76 | "pop %%rax\n" |
||
77 | "and $~(0x7000), %%rax\n" |
||
78 | "pushq %%rax\n" |
||
79 | "popfq\n" |
||
799 | palkovsky | 80 | : |
81 | : |
||
2697 | decky | 82 | : "%rax" |
799 | palkovsky | 83 | ); |
84 | } |
||
85 | |||
86 | /** Disable alignment check |
||
87 | * |
||
88 | * Clean AM(18) flag in CR0 register |
||
89 | */ |
||
90 | static void clean_AM_flag(void) |
||
91 | { |
||
2697 | decky | 92 | asm ( |
93 | "mov %%cr0, %%rax\n" |
||
94 | "and $~(0x40000), %%rax\n" |
||
95 | "mov %%rax, %%cr0\n" |
||
799 | palkovsky | 96 | : |
97 | : |
||
2697 | decky | 98 | : "%rax" |
799 | palkovsky | 99 | ); |
100 | } |
||
101 | |||
206 | palkovsky | 102 | void arch_pre_mm_init(void) |
103 | { |
||
2692 | decky | 104 | /* Enable no-execute pages */ |
251 | palkovsky | 105 | set_efer_flag(AMD_NXE_FLAG); |
282 | palkovsky | 106 | /* Enable FPU */ |
107 | cpu_setup_fpu(); |
||
803 | palkovsky | 108 | |
799 | palkovsky | 109 | /* Initialize segmentation */ |
206 | palkovsky | 110 | pm_init(); |
2692 | decky | 111 | |
112 | /* Disable I/O on nonprivileged levels |
||
113 | * clear the NT (nested-thread) flag |
||
799 | palkovsky | 114 | */ |
115 | clean_IOPL_NT_flags(); |
||
116 | /* Disable alignment check */ |
||
117 | clean_AM_flag(); |
||
118 | |||
206 | palkovsky | 119 | if (config.cpu_active == 1) { |
1958 | decky | 120 | interrupt_init(); |
206 | palkovsky | 121 | bios_init(); |
1958 | decky | 122 | |
123 | /* PIC */ |
||
124 | i8259_init(); |
||
206 | palkovsky | 125 | } |
126 | } |
||
127 | |||
2697 | decky | 128 | |
206 | palkovsky | 129 | void arch_post_mm_init(void) |
130 | { |
||
131 | if (config.cpu_active == 1) { |
||
1958 | decky | 132 | /* Initialize IRQ routing */ |
133 | irq_init(IRQ_COUNT, IRQ_COUNT); |
||
134 | |||
135 | /* hard clock */ |
||
136 | i8254_init(); |
||
2697 | decky | 137 | |
1289 | vana | 138 | #ifdef CONFIG_FB |
1303 | palkovsky | 139 | if (vesa_present()) |
140 | vesa_init(); |
||
141 | else |
||
1289 | vana | 142 | #endif |
3779 | jermar | 143 | ega_init(EGA_BASE, EGA_VIDEORAM); /* video */ |
1958 | decky | 144 | |
1072 | palkovsky | 145 | /* Enable debugger */ |
146 | debugger_init(); |
||
1303 | palkovsky | 147 | /* Merge all memory zones to 1 big zone */ |
148 | zone_merge_all(); |
||
206 | palkovsky | 149 | } |
2697 | decky | 150 | |
803 | palkovsky | 151 | /* Setup fast SYSCALL/SYSRET */ |
152 | syscall_setup_cpu(); |
||
206 | palkovsky | 153 | } |
242 | palkovsky | 154 | |
1901 | jermar | 155 | void arch_post_cpu_init() |
156 | { |
||
157 | #ifdef CONFIG_SMP |
||
158 | if (config.cpu_active > 1) { |
||
159 | l_apic_init(); |
||
160 | l_apic_debug(); |
||
161 | } |
||
162 | #endif |
||
163 | } |
||
164 | |||
503 | jermar | 165 | void arch_pre_smp_init(void) |
242 | palkovsky | 166 | { |
167 | if (config.cpu_active == 1) { |
||
2723 | decky | 168 | #ifdef CONFIG_SMP |
242 | palkovsky | 169 | acpi_init(); |
2723 | decky | 170 | #endif /* CONFIG_SMP */ |
242 | palkovsky | 171 | } |
172 | } |
||
173 | |||
503 | jermar | 174 | void arch_post_smp_init(void) |
175 | { |
||
1958 | decky | 176 | /* keyboard controller */ |
177 | i8042_init(device_assign_devno(), IRQ_KBD, device_assign_devno(), IRQ_MOUSE); |
||
503 | jermar | 178 | } |
179 | |||
242 | palkovsky | 180 | void calibrate_delay_loop(void) |
181 | { |
||
182 | i8254_calibrate_delay_loop(); |
||
1958 | decky | 183 | if (config.cpu_active == 1) { |
184 | /* |
||
185 | * This has to be done only on UP. |
||
186 | * On SMP, i8254 is not used for time keeping and its interrupt pin remains masked. |
||
187 | */ |
||
188 | i8254_normal_operation(); |
||
189 | } |
||
242 | palkovsky | 190 | } |
1112 | palkovsky | 191 | |
1121 | jermar | 192 | /** Set thread-local-storage pointer |
1112 | palkovsky | 193 | * |
194 | * TLS pointer is set in FS register. Unfortunately the 64-bit |
||
195 | * part can be set only in CPL0 mode. |
||
196 | * |
||
1121 | jermar | 197 | * The specs say, that on %fs:0 there is stored contents of %fs register, |
1112 | palkovsky | 198 | * we need not to go to CPL0 to read it. |
199 | */ |
||
1780 | jermar | 200 | unative_t sys_tls_set(unative_t addr) |
1112 | palkovsky | 201 | { |
1184 | jermar | 202 | THREAD->arch.tls = addr; |
1112 | palkovsky | 203 | write_msr(AMD_MSR_FS, addr); |
204 | return 0; |
||
205 | } |
||
1474 | palkovsky | 206 | |
207 | /** Acquire console back for kernel |
||
208 | * |
||
209 | */ |
||
210 | void arch_grab_console(void) |
||
211 | { |
||
3762 | decky | 212 | #ifdef CONFIG_FB |
213 | vesa_redraw(); |
||
214 | #else |
||
215 | ega_redraw(); |
||
216 | #endif |
||
217 | |||
1474 | palkovsky | 218 | i8042_grab(); |
219 | } |
||
3706 | decky | 220 | |
1474 | palkovsky | 221 | /** Return console to userspace |
222 | * |
||
223 | */ |
||
224 | void arch_release_console(void) |
||
225 | { |
||
226 | i8042_release(); |
||
227 | } |
||
1702 | cejka | 228 | |
3880 | decky | 229 | /** Construct function pointer |
230 | * |
||
231 | * @param fptr function pointer structure |
||
232 | * @param addr function address |
||
233 | * @param caller calling function address |
||
234 | * |
||
235 | * @return address of the function pointer |
||
236 | * |
||
237 | */ |
||
238 | void *arch_construct_function(fncptr_t *fptr, void *addr, void *caller) |
||
239 | { |
||
240 | return addr; |
||
241 | } |
||
242 | |||
1842 | jermar | 243 | /** @} |
1702 | cejka | 244 | */ |