|
[ 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 "irq.h" 021 022 #include "exception.h" 023 024 /* array of exception wrappers, defined in exception_wrappers.S */ 025 extern sos_vaddr_t sos_exception_wrapper_array[SOS_EXCEPT_NUM]; 026 027 /* arrays of exception handlers, shared with exception_wrappers.S */ 028 sos_exception_handler_t sos_exception_handler_array[SOS_EXCEPT_NUM] = 029 { NULL, }; 030 031 sos_ret_t sos_exceptions_setup(void) 032 { 033 return SOS_OK; 034 } 035 036 037 sos_ret_t sos_exception_set_routine(int exception_number, 038 sos_exception_handler_t routine) 039 { 040 sos_ret_t retval; 041 sos_ui32_t flags; 042 043 if ((exception_number < 0) || (exception_number >= SOS_EXCEPT_NUM)) 044 return -SOS_EINVAL; 045 046 /* Double fault not supported */ 047 if (exception_number == SOS_EXCEPT_DOUBLE_FAULT) 048 return -SOS_ENOSUP; 049 050 sos_disable_IRQs(flags); 051 052 retval = SOS_OK; 053 054 /* Set the exception routine to be called by the exception wrapper */ 055 sos_exception_handler_array[exception_number] = routine; 056 057 /* If the exception is to be enabled, update the IDT with the exception 058 wrapper */ 059 if (routine != NULL) 060 retval 061 = sos_idt_set_handler(SOS_EXCEPT_BASE + exception_number, 062 (sos_vaddr_t) sos_exception_wrapper_array[exception_number], 063 0 /* CPL0 routine */); 064 else /* Disable the IDT entry */ 065 retval 066 = sos_idt_set_handler(SOS_EXCEPT_BASE + exception_number, 067 (sos_vaddr_t)NULL /* No routine => disable IDTE */, 068 0 /* don't care */); 069 070 sos_restore_IRQs(flags); 071 return retval; 072 } 073 074 075 sos_exception_handler_t sos_exception_get_routine(int exception_number) 076 { 077 if ((exception_number < 0) || (exception_number >= SOS_EXCEPT_NUM)) 078 return NULL; 079 080 /* Double fault not supported */ 081 if (exception_number == SOS_EXCEPT_DOUBLE_FAULT) 082 return NULL; 083 084 /* Expected to be atomic */ 085 return sos_exception_handler_array[exception_number]; 086 }
[ source navigation ] | [ diff markup ] | [ identifier search ] | [ general search ] |