diff options
Diffstat (limited to 'firmware/kernel.c')
-rw-r--r-- | firmware/kernel.c | 18 |
1 files changed, 5 insertions, 13 deletions
diff --git a/firmware/kernel.c b/firmware/kernel.c index b0c28e56dc..8474126a0d 100644 --- a/firmware/kernel.c +++ b/firmware/kernel.c | |||
@@ -53,21 +53,13 @@ void yield(void) | |||
53 | /**************************************************************************** | 53 | /**************************************************************************** |
54 | * Interrupt level setting | 54 | * Interrupt level setting |
55 | ****************************************************************************/ | 55 | ****************************************************************************/ |
56 | static int current_irq_level = 15; | ||
57 | |||
58 | int set_irq_level(int level) | 56 | int set_irq_level(int level) |
59 | { | 57 | { |
60 | int old; | 58 | int i; |
61 | 59 | /* Read the old level and set the new one */ | |
62 | /* First raise to highest level and update the shadow */ | 60 | asm volatile ("stc sr, %0" : "=r" (i)); |
63 | asm volatile ("ldc %0, sr" : : "r" (15<<4)); | 61 | asm volatile ("ldc %0, sr" : : "r" (level << 4)); |
64 | old = current_irq_level; | 62 | return (i >> 4) & 0x0f; |
65 | current_irq_level = level; | ||
66 | |||
67 | /* Then set the wanted level */ | ||
68 | asm volatile ("ldc %0, sr" : : "r" ((unsigned int)level<<4)); | ||
69 | |||
70 | return ((unsigned int)old >> 4) & 0x0f; | ||
71 | } | 63 | } |
72 | 64 | ||
73 | /**************************************************************************** | 65 | /**************************************************************************** |