X-Git-Url: http://gitweb.hugovil.com/?a=blobdiff_plain;f=src%2Fmemory.c;h=ac8bca5154cc0e01c145941ff75d3131a075e23c;hb=84075f7a1709b2d05858dc5f866fb4e4eb385ce0;hp=057af5660fb0f10f4321c3bd830a40c289406eab;hpb=3615ed71ecaa97d539debdf803fa5f3ea21e4a1e;p=emu8051.git

diff --git a/src/memory.c b/src/memory.c
index 057af56..ac8bca5 100644
--- a/src/memory.c
+++ b/src/memory.c
@@ -131,6 +131,58 @@ memory_sfr_read_dptr(void)
 		memory_read8(INT_MEM_ID, _DPTRLOW_);
 }
 
+void
+stack_push8(uint8_t value)
+{
+	uint8_t sp;
+
+	sp = memory_read8(INT_MEM_ID, _SP_);
+
+	memory_write8(INT_MEM_ID, ++sp, value);
+	memory_write8(INT_MEM_ID, _SP_, sp); /* Save new stack pointer */
+}
+
+void
+stack_push16(uint16_t value)
+{
+	uint8_t sp;
+
+	sp = memory_read8(INT_MEM_ID, _SP_);
+
+	memory_write8(INT_MEM_ID, ++sp, (uint8_t) value); /* Write LSB */
+	memory_write8(INT_MEM_ID, ++sp, value >> 8);      /* Write MSB */
+	memory_write8(INT_MEM_ID, _SP_, sp); /* Save new stack pointer */
+}
+
+uint8_t
+stack_pop8(void)
+{
+	uint8_t sp;
+	uint8_t value;
+
+	sp = memory_read8(INT_MEM_ID, _SP_);
+
+	value = memory_read8(INT_MEM_ID, sp--);
+	memory_write8(INT_MEM_ID, _SP_, sp); /* Save new stack pointer */
+
+	return value;
+}
+
+uint16_t
+stack_pop16(void)
+{
+	uint8_t sp;
+	uint16_t value;
+
+	sp = memory_read8(INT_MEM_ID, _SP_);
+
+	value = memory_read8(INT_MEM_ID, sp--) << 8; /* Read MSB */
+	value |= memory_read8(INT_MEM_ID, sp--);     /* Read LSB */
+	memory_write8(INT_MEM_ID, _SP_, sp); /* Save new stack pointer */
+
+	return value;
+}
+
 /* Dump memory */
 void
 DumpMem(char *Address, char *Asize, int memory_id)