|
[ 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 031 sos_ret_t sos_irq_setup(void) 032 { 033 return sos_i8259_setup(); 034 } 035 036 037 sos_ret_t sos_irq_set_routine(int irq_level, 038 sos_irq_handler_t routine) 039 { 040 sos_ret_t retval; 041 sos_ui32_t flags; 042 043 if ((irq_level < 0) || (irq_level >= SOS_IRQ_NUM)) 044 return -SOS_EINVAL; 045 046 sos_disable_IRQs(flags); 047 048 retval = SOS_OK; 049 050 /* Set the irq routine to be called by the IRQ wrapper */ 051 sos_irq_handler_array[irq_level] = routine; 052 053 /* If the irq is to be enabled, update the IDT with the IRQ 054 wrapper */ 055 if (routine != NULL) 056 { 057 retval 058 = sos_idt_set_handler(SOS_IRQ_BASE + irq_level, 059 (sos_vaddr_t) sos_irq_wrapper_array[irq_level], 060 0 /* CPL0 routine */); 061 /* A problem occured */ 062 if (retval != SOS_OK) 063 sos_irq_handler_array[irq_level] = NULL; 064 } 065 else /* Disable this idt entry */ 066 { 067 retval 068 = sos_idt_set_handler(SOS_IRQ_BASE + irq_level, 069 (sos_vaddr_t)NULL /* Disable IDTE */, 070 0 /* Don't care */); 071 } 072 073 /* Update the PIC only if an IRQ handler has been set */ 074 if (sos_irq_handler_array[irq_level] != NULL) 075 sos_i8259_enable_irq_line(irq_level); 076 else 077 sos_i8259_disable_irq_line(irq_level); 078 079 sos_restore_IRQs(flags); 080 return retval; 081 } 082 083 084 sos_irq_handler_t sos_irq_get_routine(int irq_level) 085 { 086 if ((irq_level < 0) || (irq_level >= SOS_IRQ_NUM)) 087 return NULL; 088 089 /* Expected to be atomic */ 090 return sos_irq_handler_array[irq_level]; 091 }
[ source navigation ] | [ diff markup ] | [ identifier search ] | [ general search ] |