kernel/arch/mips32/src/mach/msim/dorder.c

   1 /*
   2  * Copyright (c) 2007 Martin Decky
   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
  29 /** @addtogroup kernel_mips32
  30  * @{
  31  */
  32 /** @file
  33  */
  34
  35 #include <arch/mach/msim/dorder.h>
  36 #include <arch/mach/msim/msim.h>
  37 #include <stdint.h>
  38 #include <smp/ipi.h>
  39 #include <interrupt.h>
  40 #include <arch/asm.h>
  41 #include <typedefs.h>
  42
  43 static irq_t dorder_irq;
  44
  45 #ifdef CONFIG_SMP
  46
  47 void ipi_broadcast_arch(int ipi)
  48 {
  49         pio_write_32(((ioport32_t *) MSIM_DORDER_ADDRESS), 0x7fffffff);
  50 }
  51
  52 #endif
  53
  54 static irq_ownership_t dorder_claim(irq_t *irq)
  55 {
  56         return IRQ_ACCEPT;
  57 }
  58
  59 static void dorder_irq_handler(irq_t *irq)
  60 {
  61         dorder_ipi_ack(1 << dorder_cpuid());
  62 }
  63
  64 void dorder_init(void)
  65 {
  66         irq_initialize(&dorder_irq);
  67         dorder_irq.inr = MSIM_DORDER_IRQ;
  68         dorder_irq.claim = dorder_claim;
  69         dorder_irq.handler = dorder_irq_handler;
  70         irq_register(&dorder_irq);
  71
  72         cp0_unmask_int(MSIM_DORDER_IRQ);
  73 }
  74
  75 uint32_t dorder_cpuid(void)
  76 {
  77         return pio_read_32((ioport32_t *) MSIM_DORDER_ADDRESS);
  78 }
  79
  80 void dorder_ipi_ack(uint32_t mask)
  81 {
  82         pio_write_32((ioport32_t *) (MSIM_DORDER_ADDRESS + 4), mask);
  83 }
  84
  85 /** @}
  86  */