diff options
Diffstat (limited to 'firmware/export')
-rw-r--r-- | firmware/export/system.h | 13 |
1 files changed, 12 insertions, 1 deletions
diff --git a/firmware/export/system.h b/firmware/export/system.h index 380c229f1d..e88c793fae 100644 --- a/firmware/export/system.h +++ b/firmware/export/system.h | |||
@@ -345,7 +345,7 @@ static inline int set_irq_level(int level) | |||
345 | 345 | ||
346 | static inline void enable_fiq(void) | 346 | static inline void enable_fiq(void) |
347 | { | 347 | { |
348 | /* enable FIQ */ | 348 | /* Clear FIQ disable bit */ |
349 | asm volatile ( | 349 | asm volatile ( |
350 | "mrs r0, cpsr \n"\ | 350 | "mrs r0, cpsr \n"\ |
351 | "bic r0, r0, #0x40 \n"\ | 351 | "bic r0, r0, #0x40 \n"\ |
@@ -354,6 +354,17 @@ static inline void enable_fiq(void) | |||
354 | ); | 354 | ); |
355 | } | 355 | } |
356 | 356 | ||
357 | static inline void disable_fiq(void) | ||
358 | { | ||
359 | /* Set FIQ disable bit */ | ||
360 | asm volatile ( | ||
361 | "mrs r0, cpsr \n"\ | ||
362 | "orr r0, r0, #0x40 \n"\ | ||
363 | "msr cpsr_c, r0 " | ||
364 | : : : "r0" | ||
365 | ); | ||
366 | } | ||
367 | |||
357 | #define invalidate_icache() | 368 | #define invalidate_icache() |
358 | 369 | ||
359 | #if CONFIG_CPU == PNX0101 | 370 | #if CONFIG_CPU == PNX0101 |