2 * Copyright (c) 2008 Jakub Jermar
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
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.
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.
36 #include <arch/smp/smp.h>
37 #include <arch/smp/mps.h>
38 #include <arch/smp/ap.h>
39 #include <arch/boot/boot.h>
42 #include <genarch/acpi/acpi.h>
43 #include <genarch/acpi/madt.h>
45 #include <synch/waitq.h>
57 #include <arch/drivers/i8259.h>
62 static struct smp_config_operations
*ops
= NULL
;
68 ops
= &madt_config_operations
;
71 if (config
.cpu_count
== 1) {
73 ops
= &mps_config_operations
;
76 if (config
.cpu_count
> 1) {
77 l_apic
= (uint32_t *) km_map((uintptr_t) l_apic
, PAGE_SIZE
,
78 PAGE_WRITE
| PAGE_NOT_CACHEABLE
);
79 io_apic
= (uint32_t *) km_map((uintptr_t) io_apic
, PAGE_SIZE
,
80 PAGE_WRITE
| PAGE_NOT_CACHEABLE
);
84 static void cpu_arch_id_init(void)
89 for (unsigned int i
= 0; i
< config
.cpu_count
; ++i
) {
90 cpus
[i
].arch
.id
= ops
->cpu_apic_id(i
);
95 * Kernel thread for bringing up application processors. It becomes clear
96 * that we need an arrangement like this (AP's being initialized by a kernel
97 * thread), for a thread has its dedicated stack. (The stack used during the
98 * BSP initialization (prior the very first call to scheduler()) will be used
99 * as an initialization stack for each AP.)
101 void kmp(void *arg
__attribute__((unused
)))
108 * SMP initialized, cpus array allocated. Assign each CPU its
114 * We need to access data in frame 0.
115 * We boldly make use of kernel address space mapping.
119 * Set the warm-reset vector to the real-mode address of 4K-aligned ap_boot()
121 *((uint16_t *) (PA2KA(0x467 + 0))) =
122 (uint16_t) (((uintptr_t) ap_boot
) >> 4); /* segment */
123 *((uint16_t *) (PA2KA(0x467 + 2))) = 0; /* offset */
126 * Save 0xa to address 0xf of the CMOS RAM.
127 * BIOS will not do the POST after the INIT signal.
129 pio_write_8((ioport8_t
*) 0x70, 0xf);
130 pio_write_8((ioport8_t
*) 0x71, 0xa);
132 pic_disable_irqs(0xffff);
135 for (i
= 0; i
< config
.cpu_count
; i
++) {
137 * Skip processors marked unusable.
139 if (!ops
->cpu_enabled(i
))
143 * The bootstrap processor is already up.
145 if (ops
->cpu_bootstrap(i
))
148 if (ops
->cpu_apic_id(i
) == bsp_l_apic
) {
149 log(LF_ARCH
, LVL_ERROR
, "kmp: bad processor entry #%u, "
150 "will not send IPI to myself", i
);
155 * Prepare new GDT for CPU in question.
158 /* XXX Flag FRAME_LOW_4_GiB was removed temporarily,
159 * it needs to be replaced by a generic fuctionality of
160 * the memory subsystem
162 descriptor_t
*gdt_new
=
163 (descriptor_t
*) malloc(GDT_ITEMS
* sizeof(descriptor_t
),
166 panic("Cannot allocate memory for GDT.");
168 memcpy(gdt_new
, gdt
, GDT_ITEMS
* sizeof(descriptor_t
));
169 memsetb(&gdt_new
[TSS_DES
], sizeof(descriptor_t
), 0);
170 protected_ap_gdtr
.limit
= GDT_ITEMS
* sizeof(descriptor_t
);
171 protected_ap_gdtr
.base
= KA2PA((uintptr_t) gdt_new
);
172 gdtr
.base
= (uintptr_t) gdt_new
;
174 if (l_apic_send_init_ipi(ops
->cpu_apic_id(i
))) {
176 * There may be just one AP being initialized at
177 * the time. After it comes completely up, it is
178 * supposed to wake us up.
180 if (waitq_sleep_timeout(&ap_completion_wq
, 1000000,
181 SYNCH_FLAGS_NONE
, NULL
) == ETIMEOUT
) {
182 log(LF_ARCH
, LVL_NOTE
, "%s: waiting for cpu%u "
183 "(APIC ID = %d) timed out", __FUNCTION__
,
184 i
, ops
->cpu_apic_id(i
));
187 log(LF_ARCH
, LVL_ERROR
, "INIT IPI for l_apic%d failed",
188 ops
->cpu_apic_id(i
));
192 int smp_irq_to_pin(unsigned int irq
)
195 return ops
->irq_to_pin(irq
);
198 #endif /* CONFIG_SMP */