2 * Copyright (C) 2005 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.
29 /** @addtogroup ia32xen
36 #include <arch/smp/smp.h>
37 #include <arch/smp/mps.h>
38 #include <arch/smp/ap.h>
39 #include <arch/boot/boot.h>
40 #include <genarch/acpi/acpi.h>
41 #include <genarch/acpi/madt.h>
43 #include <synch/waitq.h>
44 #include <synch/synch.h>
59 static struct smp_config_operations
*ops
= NULL
;
63 uintptr_t l_apic_address
, io_apic_address
;
67 ops
= &madt_config_operations
;
69 if (config
.cpu_count
== 1) {
71 ops
= &mps_config_operations
;
74 l_apic_address
= (uintptr_t) frame_alloc(ONE_FRAME
, FRAME_ATOMIC
| FRAME_KA
);
76 panic("cannot allocate address for l_apic\n");
78 io_apic_address
= (uintptr_t) frame_alloc(ONE_FRAME
, FRAME_ATOMIC
| FRAME_KA
);
80 panic("cannot allocate address for io_apic\n");
82 if (config
.cpu_count
> 1) {
83 page_mapping_insert(AS_KERNEL
, l_apic_address
, (uintptr_t) l_apic
,
85 page_mapping_insert(AS_KERNEL
, io_apic_address
, (uintptr_t) io_apic
,
88 l_apic
= (uint32_t *) l_apic_address
;
89 io_apic
= (uint32_t *) io_apic_address
;
94 * Kernel thread for bringing up application processors. It becomes clear
95 * that we need an arrangement like this (AP's being initialized by a kernel
96 * thread), for a thread has its dedicated stack. (The stack used during the
97 * BSP initialization (prior the very first call to scheduler()) will be used
98 * as an initialization stack for each AP.)
106 waitq_initialize(&ap_completion_wq
);
109 * We need to access data in frame 0.
110 * We boldly make use of kernel address space mapping.
114 * Save 0xa to address 0xf of the CMOS RAM.
115 * BIOS will not do the POST after the INIT signal.
120 // pic_disable_irqs(0xffff);
123 for (i
= 0; i
< ops
->cpu_count(); i
++) {
124 struct descriptor
*gdt_new
;
127 * Skip processors marked unusable.
129 if (!ops
->cpu_enabled(i
))
133 * The bootstrap processor is already up.
135 if (ops
->cpu_bootstrap(i
))
138 if (ops
->cpu_apic_id(i
) == l_apic_id()) {
139 printf("%s: bad processor entry #%d, will not send IPI to myself\n", __FUNCTION__
, i
);
144 * Prepare new GDT for CPU in question.
146 if (!(gdt_new
= (struct descriptor
*) malloc(GDT_ITEMS
*sizeof(struct descriptor
), FRAME_ATOMIC
)))
147 panic("couldn't allocate memory for GDT\n");
149 memcpy(gdt_new
, gdt
, GDT_ITEMS
* sizeof(struct descriptor
));
150 memsetb((uintptr_t)(&gdt_new
[TSS_DES
]), sizeof(struct descriptor
), 0);
151 gdtr
.base
= (uintptr_t) gdt_new
;
153 if (l_apic_send_init_ipi(ops
->cpu_apic_id(i
))) {
155 * There may be just one AP being initialized at
156 * the time. After it comes completely up, it is
157 * supposed to wake us up.
159 if (waitq_sleep_timeout(&ap_completion_wq
, 1000000, SYNCH_FLAGS_NONE
) == ESYNCH_TIMEOUT
)
160 printf("%s: waiting for cpu%d (APIC ID = %d) timed out\n", __FUNCTION__
, config
.cpu_active
> i
? config
.cpu_active
: i
, ops
->cpu_apic_id(i
));
162 printf("INIT IPI for l_apic%d failed\n", ops
->cpu_apic_id(i
));
166 int smp_irq_to_pin(int irq
)
169 return ops
->irq_to_pin(irq
);
172 #endif /* CONFIG_SMP */