FreeCalypso > hg > freecalypso-sw
view gsm-fw/gpf/osl/os_isr.c @ 459:38afaeb194ea
os_tim_fl.c: os_QueryTimer() decompiled w/o real understanding of the logic
author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
---|---|
date | Mon, 23 Jun 2014 06:54:40 +0000 |
parents | e63ab4a97e24 |
children | 6e6d4c1ec733 |
line wrap: on
line source
/* * This C module is a reconstruction based on the disassembly of * os_isr.obj in frame_na7_db_fl.lib from the Leonardo package. */ /* set of included headers from COFF symtab: */ #include <string.h> #include "gpfconf.h" /* FreeCalypso addition */ #include "../../nucleus/nucleus.h" #include "typedefs.h" #include "os.h" #include "gdi.h" #include "os_types.h" #include "os_glob.h" typedef unsigned char u_char; extern T_OS_OSISR_TABLE_ENTRY OSISRTable[]; extern OS_HANDLE os_int_pool_handle; GLOBAL LONG os_isr_init(void) { USHORT i; for (i = 1; i <= MaxOSISRs; i++) OSISRTable[i].name[0] = 0; return(OS_OK); } GLOBAL LONG os_SetInterruptState(OS_INT_STATE new_state, OS_INT_STATE *old_state) { INT state; if (new_state) state = NU_ENABLE_INTERRUPTS; else state = NU_DISABLE_INTERRUPTS; state = NU_Control_Interrupts(state); if (state & 0xFF) *old_state = 0; else *old_state = 1; return(OS_OK); } GLOBAL LONG os_EnableInterrupts(OS_INT_STATE *old_state) { INT state; state = NU_Control_Interrupts(NU_ENABLE_INTERRUPTS); if (state & 0xFF) *old_state = 0; else *old_state = 1; return(OS_OK); } GLOBAL LONG os_DisableInterrupts(OS_INT_STATE *old_state) { INT state; state = NU_Control_Interrupts(NU_DISABLE_INTERRUPTS); if (state & 0xFF) *old_state = 0; else *old_state = 1; return(OS_OK); } GLOBAL LONG os_DeleteOSISR(OS_HANDLE hisr_handle) { OS_INT_STATE old_state, state; if (hisr_handle <= 0 || hisr_handle > MaxOSISRs) return(OS_ERROR); if (OSISRTable[hisr_handle].hisr_cb.tc_activation_count) return(OS_ERROR); os_DisableInterrupts(&old_state); if (os_DeallocateMemory(os_MyHandle(), OSISRTable[hisr_handle].stack) == OS_ERROR) { error: os_SetInterruptState(old_state, &state); return(OS_ERROR); } if (NU_Delete_HISR(&OSISRTable[hisr_handle].hisr_cb) != NU_SUCCESS) goto error; OSISRTable[hisr_handle].name[0] = 0; os_SetInterruptState(old_state, &state); return(OS_OK); } GLOBAL LONG os_CreateOSISR(char *name, void (*OSISR_entry)(void), int stacksize, int priority, int flags, OS_HANDLE *hisr_handle) { OS_HANDLE handle; T_VOID_STRUCT *hisr_stack; OS_INT_STATE old_state, state; if (priority < 0 || priority > 2) return(OS_ERROR); priority = 2 - priority; os_DisableInterrupts(&old_state); for (handle = 1; handle <= MaxOSISRs; handle++) if (!strncmp(OSISRTable[handle].name, name, RESOURCE_NAMELEN - 1)) { error: os_SetInterruptState(old_state, &state); return(OS_ERROR); } for (handle = 1; handle <= MaxOSISRs; handle++) if (!OSISRTable[handle].name[0]) break; if (handle > MaxOSISRs) goto error; if (os_AllocateMemory(os_MyHandle(), &hisr_stack, stacksize, 0xFFFFFFFF, os_int_pool_handle) == OS_ERROR) goto error; memset((u_char *)hisr_stack, INITIAL_STACK_VALUE, stacksize); *hisr_stack = GUARD_PATTERN; if (NU_Create_HISR(&OSISRTable[handle].hisr_cb, name, OSISR_entry, priority, (VOID *)hisr_stack, stacksize) != NU_SUCCESS) goto error; strncpy(OSISRTable[handle].name, name, RESOURCE_NAMELEN); OSISRTable[handle].name[RESOURCE_NAMELEN-1] = 0; *hisr_handle = handle; os_SetInterruptState(old_state, &state); return(OS_OK); } GLOBAL LONG os_ActivateOSISR(OS_HANDLE hisr_handle) { if (hisr_handle <= 0 || hisr_handle > MaxOSISRs) return(OS_ERROR); if (NU_Activate_HISR(&OSISRTable[hisr_handle].hisr_cb) == NU_SUCCESS) return(OS_OK); else return(OS_ERROR); }