X-Git-Url: https://git.cryptolib.org/?a=blobdiff_plain;f=avr-asm-macros.S;h=4991ceea0ec1a5fa39353305dafb9b52d8abcc41;hb=fabad4ec561c343bbeba87450a6aedbc07ab1750;hp=2acb4a13799e393ab07a80a9e32c7e8b7a2a8844;hpb=8fcf3f56d6688f240da7bd78bfe2042bc0bb2e8c;p=avr-crypto-lib.git

diff --git a/avr-asm-macros.S b/avr-asm-macros.S
index 2acb4a1..4991cee 100644
--- a/avr-asm-macros.S
+++ b/avr-asm-macros.S
@@ -67,8 +67,8 @@
 	sbiw \reg1, \size 
 	cli
 	out _SFR_IO_ADDR(SPH), \reg2
-	out _SFR_IO_ADDR(SPL), \reg1
 	out _SFR_IO_ADDR(SREG), r0
+	out _SFR_IO_ADDR(SPL), \reg1
 .endm
 
 .macro stack_free size:req, reg1=r30, reg2=r31
@@ -78,10 +78,37 @@
 	adiw \reg1, \size 
 	cli
 	out _SFR_IO_ADDR(SPH), \reg2
+	out _SFR_IO_ADDR(SREG), r0
 	out _SFR_IO_ADDR(SPL), \reg1
+.endm
+
+
+.macro stack_alloc_large size:req, reg1=r30, reg2=r31
+	in r0, _SFR_IO_ADDR(SREG)
+	in \reg1, _SFR_IO_ADDR(SPL)
+	in \reg2, _SFR_IO_ADDR(SPH)
+	subi \reg1, lo8(\size)
+	sbci \reg2, hi8(\size)	 
+	cli
+	out _SFR_IO_ADDR(SPH), \reg2
 	out _SFR_IO_ADDR(SREG), r0
+	out _SFR_IO_ADDR(SPL), \reg1
 .endm
 
+.macro stack_free_large size:req, reg1=r30, reg2=r31
+	in r0, _SFR_IO_ADDR(SREG)
+	in \reg1, _SFR_IO_ADDR(SPL)
+	in \reg2, _SFR_IO_ADDR(SPH)
+	adiw \reg1, 63
+	adiw \reg1, (\size-63) 
+	cli
+	out _SFR_IO_ADDR(SPH), \reg2
+	out _SFR_IO_ADDR(SREG), r0
+	out _SFR_IO_ADDR(SPL), \reg1
+.endm
+
+
+
 /*******************************************************************************
 * END of MACRO SECTION                                                         *
 *******************************************************************************/