diff options
Diffstat (limited to 'firmware/export/system.h')
-rw-r--r-- | firmware/export/system.h | 5 |
1 files changed, 4 insertions, 1 deletions
diff --git a/firmware/export/system.h b/firmware/export/system.h index 3db38c9c7b..66a21332fc 100644 --- a/firmware/export/system.h +++ b/firmware/export/system.h | |||
@@ -314,11 +314,14 @@ static inline int set_irq_level(int level) | |||
314 | return (cpsr >> 7) & 1; | 314 | return (cpsr >> 7) & 1; |
315 | } | 315 | } |
316 | 316 | ||
317 | static inline void enable_fiq(void(*fiq_handler)(void)) | 317 | static inline void set_fiq_handler(void(*fiq_handler)(void)) |
318 | { | 318 | { |
319 | /* Install the FIQ handler */ | 319 | /* Install the FIQ handler */ |
320 | *((unsigned int*)(15*4)) = (unsigned int)fiq_handler; | 320 | *((unsigned int*)(15*4)) = (unsigned int)fiq_handler; |
321 | } | ||
321 | 322 | ||
323 | static inline void enable_fiq(void) | ||
324 | { | ||
322 | /* Clear FIQ disable bit */ | 325 | /* Clear FIQ disable bit */ |
323 | asm volatile ( | 326 | asm volatile ( |
324 | "mrs r0, cpsr \n"\ | 327 | "mrs r0, cpsr \n"\ |