|
[ source navigation ] [ diff markup ] [ identifier search ] [ general search ] |
|||
|
001 /* Copyright (C) 2004 David Decotigny 002 Copyright (C) 1999 Free Software Foundation, Inc. 003 004 This program is free software; you can redistribute it and/or 005 modify it under the terms of the GNU General Public License 006 as published by the Free Software Foundation; either version 2 007 of the License, or (at your option) any later version. 008 009 This program is distributed in the hope that it will be useful, 010 but WITHOUT ANY WARRANTY; without even the implied warranty of 011 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 012 GNU General Public License for more details. 013 014 You should have received a copy of the GNU General Public License 015 along with this program; if not, write to the Free Software 016 Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, 017 USA. 018 */ 019 #include "idt.h" 020 #include "i8259.h" 021 022 #include "irq.h" 023 024 /** array of IRQ wrappers, defined in irq_wrappers.S */ 025 extern sos_vaddr_t sos_irq_wrapper_array[SOS_IRQ_NUM]; 026 027 /** arrays of IRQ handlers, shared with irq_wrappers.S */ 028 sos_irq_handler_t sos_irq_handler_array[SOS_IRQ_NUM] = { NULL, }; 029 030 /** Number of interrupt handlers that are currently executing */ 031 sos_ui32_t sos_irq_nested_level_counter; 032 033 sos_ret_t sos_irq_subsystem_setup(void) 034 { 035 sos_irq_nested_level_counter = 0; 036 return sos_i8259_subsystem_setup(); 037 } 038 039 040 sos_ret_t sos_irq_set_routine(int irq_level, 041 sos_irq_handler_t routine) 042 { 043 sos_ret_t retval; 044 sos_ui32_t flags; 045 046 if ((irq_level < 0) || (irq_level >= SOS_IRQ_NUM)) 047 return -SOS_EINVAL; 048 049 sos_disable_IRQs(flags); 050 051 retval = SOS_OK; 052 053 /* Set the irq routine to be called by the IRQ wrapper */ 054 sos_irq_handler_array[irq_level] = routine; 055 056 /* If the irq is to be enabled, update the IDT with the IRQ 057 wrapper */ 058 if (routine != NULL) 059 { 060 retval 061 = sos_idt_set_handler(SOS_IRQ_BASE + irq_level, 062 (sos_vaddr_t) sos_irq_wrapper_array[irq_level], 063 0 /* CPL0 routine */); 064 /* A problem occured */ 065 if (retval != SOS_OK) 066 sos_irq_handler_array[irq_level] = NULL; 067 } 068 else /* Disable this idt entry */ 069 { 070 retval 071 = sos_idt_set_handler(SOS_IRQ_BASE + irq_level, 072 (sos_vaddr_t)NULL /* Disable IDTE */, 073 0 /* Don't care */); 074 } 075 076 /* Update the PIC only if an IRQ handler has been set */ 077 if (sos_irq_handler_array[irq_level] != NULL) 078 sos_i8259_enable_irq_line(irq_level); 079 else 080 sos_i8259_disable_irq_line(irq_level); 081 082 sos_restore_IRQs(flags); 083 return retval; 084 } 085 086 087 sos_irq_handler_t sos_irq_get_routine(int irq_level) 088 { 089 if ((irq_level < 0) || (irq_level >= SOS_IRQ_NUM)) 090 return NULL; 091 092 /* Expected to be atomic */ 093 return sos_irq_handler_array[irq_level]; 094 } 095 096 097 sos_ui32_t sos_irq_get_nested_level() 098 { 099 /* No need to disable interrupts here */ 100 return sos_irq_nested_level_counter; 101 }
[ source navigation ] | [ diff markup ] | [ identifier search ] | [ general search ] |