X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=cpu%2Fcpu.h;h=1e68ac2c2d578e6deadb4e7d778ed6c62c74982d;hb=753d17c6975a0edd44fd771f1af01d95a61d292a;hp=af769d644293c3e5f37221328c2a5acc655df6b1;hpb=408a9a0c71f129357a588afebfc82e14149fbe78;p=bertos.git

diff --git a/cpu/cpu.h b/cpu/cpu.h
index af769d64..1e68ac2c 100644
--- a/cpu/cpu.h
+++ b/cpu/cpu.h
@@ -120,7 +120,7 @@
 	/* Register counts include SREG too */
 	#define CPU_REG_BITS           32
 	#define CPU_REGS_CNT           16
-	#define CPU_SAVED_REGS_CNT     FIXME
+	#define CPU_SAVED_REGS_CNT     9
 	#define CPU_STACK_GROWS_UPWARD 0
 	#define CPU_SP_ON_EMPTY_SLOT   0
 	#define CPU_BYTE_ORDER         (__BIG_ENDIAN__ ? CPU_BIG_ENDIAN : CPU_LITTLE_ENDIAN)
@@ -154,7 +154,7 @@
 			set_CPSR(x); \
 		} while (0)
 
-		#define IRQ_GETSTATE() \
+		#define IRQ_ENABLED() \
 			((bool)(get_CPSR() & 0xb0))
 
 		#define BREAKPOINT  /* asm("bkpt 0") DOES NOT WORK */
@@ -203,17 +203,33 @@
 			); \
 		} while (0)
 
-		#define IRQ_GETSTATE() \
+		#define CPU_READ_FLAGS() \
 		({ \
-			uint32_t sreg; \
+			cpuflags_t sreg; \
 			asm volatile ( \
 				"mrs %0, cpsr\n\t" \
 				: "=r" (sreg) \
 				: /* no inputs */ \
 			); \
-			!((sreg & 0xc0) == 0xc0); \
+			sreg; \
 		})
 
+		#define IRQ_ENABLED() ((CPU_READ_FLAGS() & 0xc0) != 0xc0)
+
+		/**
+	 	 * Initialization value for registers in stack frame.
+	 	 * The register index is not directly corrispondent to CPU
+	 	 * register numbers, but is related to how are pushed to
+	 	 * stack (\see asm_switch_context).
+		 * Index (CPU_SAVED_REGS_CNT - 1) is the CPSR register,
+		 * the initial value is set to:
+		 * - All flags (N, Z, C, V) set to 0.
+		 * - IRQ and FIQ enabled.
+		 * - ARM state.
+		 * - CPU in Supervisor Mode (SVC).
+	 	 */
+		#define CPU_REG_INIT_VALUE(reg) (reg == (CPU_SAVED_REGS_CNT - 1) ? 0x13 : 0)
+
 	#endif /* !__IAR_SYSTEMS_ICC_ */
 
 #elif CPU_PPC
@@ -223,7 +239,7 @@
 	#define IRQ_ENABLE          FIXME
 	#define IRQ_SAVE_DISABLE(x) FIXME
 	#define IRQ_RESTORE(x)      FIXME
-	#define IRQ_GETSTATE()      FIXME
+	#define IRQ_ENABLED()      FIXME
 
 	typedef uint32_t cpuflags_t; // FIXME
 	typedef uint32_t cpustack_t; // FIXME
@@ -256,13 +272,13 @@
 	}
 	#define IRQ_RUNNING() irq_running()
 
-	static inline bool irq_getstate(void)
+	static inline bool irq_enabled(void)
 	{
 		uint16_t x;
 		asm(move SR,x);
 		return !(x & 0x0200);
 	}
-	#define IRQ_GETSTATE() irq_getstate()
+	#define IRQ_ENABLED() irq_enabled()
 
 	typedef uint16_t cpuflags_t;
 	typedef unsigned int cpustack_t;
@@ -304,7 +320,7 @@
 		); \
 	} while (0)
 
-	#define IRQ_GETSTATE() \
+	#define IRQ_ENABLED() \
 	({ \
 		uint8_t sreg; \
 		__asm__ __volatile__( \