SimpleOS

LXR

Navigation



Site hébergé par : enix

The LXR Cross Referencer for SOS

source navigation ]
diff markup ]
identifier search ]
general search ]
 
 
Article:1 ] [ 2 ] [ 3 ] [ 4 ] [ 5 ] [ 6 ] [ 6.5 ] [ 7 ] [ 7.5 ] [ 8 ] [ 9 ] [ 9.5 ]

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 ]