Subversion Repositories HelenOS

Rev

Rev 3431 | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (c) 2006 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 ppc32interrupt
  30.  * @{
  31.  */
  32. /** @file
  33.  */
  34.  
  35. #include <ddi/irq.h>
  36. #include <interrupt.h>
  37. #include <arch/interrupt.h>
  38. #include <arch/types.h>
  39. #include <arch.h>
  40. #include <time/clock.h>
  41. #include <ipc/sysipc.h>
  42. #include <arch/drivers/pic.h>
  43. #include <arch/mm/tlb.h>
  44. #include <print.h>
  45.  
  46.  
  47. void start_decrementer(void)
  48. {
  49.     asm volatile (
  50.         "mtdec %0\n"
  51.         :
  52.         : "r" (1000)
  53.     );
  54. }
  55.  
  56.  
  57. /** Handler of external interrupts */
  58. static void exception_external(int n, istate_t *istate)
  59. {
  60.     int inum;
  61.    
  62.     while ((inum = pic_get_pending()) != -1) {
  63.         irq_t *irq = irq_dispatch_and_lock(inum);
  64.         if (irq) {
  65.             /*
  66.              * The IRQ handler was found.
  67.              */
  68.            
  69.             if (irq->preack) {
  70.                 /* Acknowledge the interrupt before processing */
  71.                 if (irq->cir)
  72.                     irq->cir(irq->cir_arg, irq->inr);
  73.             }
  74.            
  75.             irq->handler(irq);
  76.            
  77.             if (!irq->preack) {
  78.                 if (irq->cir)
  79.                     irq->cir(irq->cir_arg, irq->inr);
  80.             }
  81.            
  82.             spinlock_unlock(&irq->lock);
  83.         } else {
  84.             /*
  85.              * Spurious interrupt.
  86.              */
  87. #ifdef CONFIG_DEBUG
  88.             printf("cpu%u: spurious interrupt (inum=%d)\n", CPU->id, inum);
  89. #endif
  90.         }
  91.     }
  92. }
  93.  
  94.  
  95. static void exception_decrementer(int n, istate_t *istate)
  96. {
  97.     start_decrementer();
  98.     clock();
  99. }
  100.  
  101. #ifdef CONFIG_UDEBUG
  102.  
  103. static void exception_program_trap(istate_t *istate)
  104. {
  105.     if (istate_from_uspace(istate))
  106.         udebug_breakpoint_event(0);
  107.     else
  108.         panic("Program trap exception.");
  109. }
  110.  
  111. static void exception_program(int n, istate_t *istate)
  112. {
  113.     if ((istate->srr1 & SRR1_TRAP_EXC) != 0) {
  114.         exception_program_trap(istate);
  115.     } else {
  116.         fault_if_from_uspace(istate, "Unhandled program exception.");
  117.         panic("Unhandled program exception.");
  118.     }
  119. }
  120.  
  121. #endif
  122.  
  123. /* Initialize basic tables for exception dispatching */
  124. void interrupt_init(void)
  125. {
  126.     exc_register(VECTOR_DATA_STORAGE, "data_storage", pht_refill);
  127.     exc_register(VECTOR_INSTRUCTION_STORAGE, "instruction_storage", pht_refill);
  128.     exc_register(VECTOR_EXTERNAL, "external", exception_external);
  129.     exc_register(VECTOR_DECREMENTER, "timer", exception_decrementer);
  130. #ifdef CONFIG_UDEBUG
  131.     exc_register(VECTOR_PROGRAM, "program", exception_program);
  132. #endif
  133. }
  134.  
  135. /** @}
  136.  */
  137.