From 429bc0270f5f81256219905e82a5644f21fd4e5f Mon Sep 17 00:00:00 2001 From: Anthony Liu Date: Thu, 5 Dec 2013 23:59:42 +0800 Subject: [PATCH] Improve interrupt trigger code readability --- src/cpu8051.c | 35 +++++++++++++++++++++++++---------- src/cpu8051.h | 11 +++++++++++ 2 files changed, 36 insertions(+), 10 deletions(-) diff --git a/src/cpu8051.c b/src/cpu8051.c index 956ae7d..bf7bd99 100644 --- a/src/cpu8051.c +++ b/src/cpu8051.c @@ -223,6 +223,21 @@ cpu8051_ReadB(uint8_t bit_address) return BitValue; } +static int +cpu8051_interrupt_fire(int interrupt_no, int priority) +{ + if (cpu8051_ReadD(_IP_) & INTERRUPT_MASK(interrupt_no)) + return priority; + else + return !priority; +} + +static int +cpu8051_interrupt_enabled(int interrupt_no) +{ + return (cpu8051_ReadD(_IE_) & INTERRUPT_MASK(interrupt_no)) ? 1 : 0; +} + static void cpu8051_process_interrupt(int pc, int pri) { @@ -241,20 +256,20 @@ cpu8051_CheckInterrupts(void) if ((cpu8051_ReadD(_IE_) & 0x80) == 0) return; - for (i = 1; i >= 0; i--) { + for (i = INTERRUPT_PRIORITY_HIGH; i >= INTERRUPT_PRIORITY_LOW; i--) { if (cpu8051.active_priority < i) { /* Interrupt timer 0 */ - if ((cpu8051_ReadD(_IE_) & 0x02) && - ((cpu8051_ReadD(_IP_ & 0x02) ? i : !i) && - (cpu8051_ReadD(_TCON_) & 0x20))) { + if (cpu8051_interrupt_enabled(INTERRUPT_1) && + cpu8051_interrupt_fire(INTERRUPT_1, i) && + (cpu8051_ReadD(_TCON_) & 0x20)) { cpu8051_WriteD(_TCON_, cpu8051_ReadD(_TCON_) & 0xDF); cpu8051_process_interrupt(0x0B, i); return; } /* Interrupt timer 1 */ - if ((cpu8051_ReadD(_IE_) & 0x08) && - ((cpu8051_ReadD(_IP_) & 0x08) ? i : !i) && + if (cpu8051_interrupt_enabled(INTERRUPT_3) && + cpu8051_interrupt_fire(INTERRUPT_3, i) && (cpu8051_ReadD(_TCON_) & 0x80)) { cpu8051_WriteD(_TCON_, cpu8051_ReadD(_TCON_) & 0x7F); @@ -262,15 +277,15 @@ cpu8051_CheckInterrupts(void) return; } /* Serial Interrupts */ - if ((cpu8051_ReadD(_IE_) & 0x10) && - ((cpu8051_ReadD(_IP_) & 0x10) ? i : !i) && + if (cpu8051_interrupt_enabled(INTERRUPT_4) && + cpu8051_interrupt_fire(INTERRUPT_4, i) && (cpu8051_ReadD(_SCON_) & 0x03)) { cpu8051_process_interrupt(0x23, i); return; } /* Interrupt timer 2 */ - if ((cpu8051_ReadD(_IE_) & 0x20) && - ((cpu8051_ReadD(_IP_) & 0x20) ? i : !i) && + if (cpu8051_interrupt_enabled(INTERRUPT_5) && + cpu8051_interrupt_fire(INTERRUPT_5, i) && (cpu8051_ReadD(_T2CON_) & 0x80)) { cpu8051_process_interrupt(0x2B, i); return; diff --git a/src/cpu8051.h b/src/cpu8051.h index 4d77690..adb96c8 100644 --- a/src/cpu8051.h +++ b/src/cpu8051.h @@ -27,6 +27,17 @@ /* Maximum number of BreakPoints */ #define MAXBP 32 +#define INTERRUPT_0 (0) +#define INTERRUPT_1 (1) +#define INTERRUPT_2 (2) +#define INTERRUPT_3 (3) +#define INTERRUPT_4 (4) +#define INTERRUPT_5 (5) +#define INTERRUPT_MASK(n) (1 << n) + +#define INTERRUPT_PRIORITY_HIGH (1) +#define INTERRUPT_PRIORITY_LOW (0) + struct cpu8051_t { unsigned int pc; /* Program counter */ unsigned long clock; -- 2.20.1