| 0,0 → 1,167 |
|---|
| /* |
| * Copyright (c) 2005 Jakub Vana |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * |
| * - Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * - Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * - The name of the author may not be used to endorse or promote products |
| * derived from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
| * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
| * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
| * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
| * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
| * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| */ |
| |
| /** @addtogroup ia64 |
| * @{ |
| */ |
| /** @file |
| */ |
| |
| #include <arch.h> |
| #include <arch/ski/ski.h> |
| #include <arch/drivers/it.h> |
| #include <arch/interrupt.h> |
| #include <arch/barrier.h> |
| #include <arch/asm.h> |
| #include <arch/register.h> |
| #include <arch/types.h> |
| #include <arch/context.h> |
| #include <arch/stack.h> |
| #include <arch/mm/page.h> |
| #include <mm/as.h> |
| #include <config.h> |
| #include <userspace.h> |
| #include <console/console.h> |
| #include <proc/uarg.h> |
| #include <syscall/syscall.h> |
| #include <ddi/irq.h> |
| #include <ddi/device.h> |
| #include <arch/bootinfo.h> |
| #include <smp/smp.h> |
| #include <smp/ipi.h> |
| #include <arch/atomic.h> |
| #include <panic.h> |
| #include <print.h> |
| |
| #ifdef CONFIG_SMP |
| |
| extern char cpu_by_id_eid_list[256][256]; |
| |
| static void sapic_init(void) |
| { |
| bootinfo->sapic = (unative_t *)(PA2KA((unative_t)(bootinfo->sapic)) | |
| FW_OFFSET); |
| } |
| |
| static void ipi_broadcast_arch_all(int ipi) |
| { |
| int id, eid; |
| int myid, myeid; |
| |
| myid = ia64_get_cpu_id(); |
| myeid = ia64_get_cpu_eid(); |
| |
| for (id = 0; id < 256; id++) |
| for (eid = 0; eid < 256; eid++) |
| if ((id != myid) || (eid != myeid)) |
| ipi_send_ipi(id, eid, ipi); |
| } |
| |
| void ipi_broadcast_arch(int ipi ) |
| { |
| int id, eid; |
| int myid, myeid; |
| |
| myid = ia64_get_cpu_id(); |
| myeid = ia64_get_cpu_eid(); |
| |
| for (id = 0; id < 256; id++) |
| for (eid = 0; eid < 256; eid++) |
| if ((id != myid) || (eid != myeid)) |
| if (cpu_by_id_eid_list[id][eid]) |
| ipi_send_ipi(id, eid, ipi); |
| } |
| |
| void smp_init(void) |
| { |
| if (!bootinfo->hello_configured) |
| return; |
| |
| /* |
| * If we have not got system prepared by hello, we are not able to start |
| * AP's. This means we are running on a simulator. |
| */ |
| |
| sapic_init(); |
| ipi_broadcast_arch_all(bootinfo->wakeup_intno); |
| volatile long long brk; |
| for (brk = 0; brk < 100LL * 1024LL * 1024LL; brk++) |
| ; /* wait a while before CPUs starts */ |
| |
| config.cpu_count = 0; |
| int id, eid; |
| |
| for (id = 0; id < 256; id++) |
| for (eid = 0; eid < 256; eid++) |
| if (cpu_by_id_eid_list[id][eid] == 1) { |
| config.cpu_count++; |
| cpu_by_id_eid_list[id][eid] = 2; |
| } |
| } |
| |
| void kmp(void *arg __attribute__((unused))) |
| { |
| int id, eid; |
| int myid, myeid; |
| |
| myid = ia64_get_cpu_id(); |
| myeid = ia64_get_cpu_eid(); |
| |
| for (id = 0; id < 256; id++) |
| for (eid = 0; eid < 256; eid++) |
| if ((id != myid) || (eid != myeid)) |
| if (cpu_by_id_eid_list[id][eid] != 0) { |
| if (cpu_by_id_eid_list[id][eid] == 1) { |
| printf("Found Late CPU ID:%d " |
| "EDI:%d Not added to " |
| "system!!!\n", id, eid); |
| continue; |
| } |
| cpu_by_id_eid_list[id][eid] = 3; |
| /* |
| * There may be just one AP being |
| * initialized at the time. After |
| * it comes completely up, it is |
| * supposed to wake us up. |
| */ |
| if (waitq_sleep_timeout( |
| &ap_completion_wq, 1000000, |
| SYNCH_FLAGS_NONE) == |
| ESYNCH_TIMEOUT) { |
| printf("%s: waiting for cpu " |
| "ID:%d EID:%d timed out\n", |
| __FUNCTION__, id, eid); |
| } |
| } |
| } |
| |
| #endif |
| |
| /** @} |
| */ |
| |