| 0,0 → 1,123 |
|---|
| /* |
| * Copyright (c) 2009 Pavel Rimsky |
| * 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 sparc64interrupt |
| * @{ |
| */ |
| /** @file |
| */ |
| |
| #include <arch/interrupt.h> |
| #include <arch/trap/interrupt.h> |
| #include <arch/sparc64.h> |
| #include <arch/trap/interrupt.h> |
| #include <interrupt.h> |
| #include <ddi/irq.h> |
| #include <arch/types.h> |
| #include <debug.h> |
| #include <arch/asm.h> |
| #include <arch/barrier.h> |
| #include <print.h> |
| #include <arch.h> |
| #include <mm/tlb.h> |
| #include <config.h> |
| #include <synch/spinlock.h> |
| #include <arch/sun4v/hypercall.h> |
| |
| /** number of uint64_t-s in one CPU mondo message */ |
| #define CPU_MONDO_ENTRY_SIZE 8 |
| |
| /** number of entries (messages) in the CPU mondo queue */ |
| #define CPU_MONDO_NENTRIES 8 |
| |
| /** number of uint64_t-s in the CPU mondo queue */ |
| #define CPU_MONDO_QUEUE_SIZE ((CPU_MONDO_NENTRIES) * (CPU_MONDO_ENTRY_SIZE)) |
| |
| /** used to identify CPU mondo queue in the hypercall */ |
| #define CPU_MONDO_QUEUE_ID 0x3c |
| |
| /** ASI for reading/writing CPU mondo head/tail registers */ |
| #define ASI_QUEUE 0x25 |
| |
| /** VA for reading the CPU mondo tail */ |
| #define VA_CPU_MONDO_QUEUE_TAIL 0x3c8 |
| |
| /** VA for reading/writing the CPU mondo head */ |
| #define VA_CPU_MONDO_QUEUE_HEAD 0x3c0 |
| |
| /** |
| * array which contains CPU mondo queue for every CPU |
| */ |
| uint64_t cpu_mondo_queues[MAX_NUM_STRANDS][CPU_MONDO_QUEUE_SIZE] |
| __attribute__((aligned( |
| CPU_MONDO_QUEUE_SIZE * sizeof(uint64_t)))); |
| |
| /** |
| * Initializes CPU mondo queue for the current CPU. |
| */ |
| void sun4v_ipi_init(void) |
| { |
| if (__hypercall_fast3( |
| CPU_QCONF, |
| CPU_MONDO_QUEUE_ID, |
| KA2PA(cpu_mondo_queues[CPU->id]), |
| CPU_MONDO_NENTRIES) != EOK) |
| panic("Initializing mondo queue failed on CPU %d.\n", |
| CPU->arch.id); |
| } |
| |
| /** |
| * Handler of the CPU Mondo trap. Reads the message queue, updates the head |
| * register and processes the message (invokes a function call). |
| */ |
| void cpu_mondo(void) |
| { |
| unsigned int tail = asi_u64_read(ASI_QUEUE, VA_CPU_MONDO_QUEUE_TAIL); |
| unsigned int head = asi_u64_read(ASI_QUEUE, VA_CPU_MONDO_QUEUE_HEAD); |
| |
| while (head != tail) { |
| |
| uint64_t data1 = cpu_mondo_queues[CPU->id][0]; |
| |
| head = (head + CPU_MONDO_ENTRY_SIZE * sizeof(uint64_t)) % |
| (CPU_MONDO_QUEUE_SIZE * sizeof(uint64_t)); |
| asi_u64_write(ASI_QUEUE, VA_CPU_MONDO_QUEUE_HEAD, head); |
| |
| if (data1 == (uint64_t) tlb_shootdown_ipi_recv) { |
| ((void (*)(void)) data1)(); |
| } else { |
| printf("Spurious interrupt on %d, data = %lx.\n", |
| CPU->arch.id, data1); |
| } |
| |
| } |
| |
| } |
| |
| /** @} |
| */ |