X-Git-Url: https://git.cryptolib.org/?p=avr-crypto-lib.git;a=blobdiff_plain;f=avr-asm-macros.S;h=1a640c70177e0756698fa3f97fff9ac04cdbe7e9;hp=f878be85914f0fa6483195fd68aaa68a3b905029;hb=c26c0ae7602db9d3b2d7baf6ae6fc9639539ad02;hpb=5ac75cfae217122b540c1a6d258054230dc534c3

diff --git a/avr-asm-macros.S b/avr-asm-macros.S
index f878be8..1a640c7 100644
--- a/avr-asm-macros.S
+++ b/avr-asm-macros.S
@@ -1,6 +1,6 @@
 /* avr-asm-macros.S */
 /*
-    This file is part of the Crypto-avr-lib/microcrypt-lib.
+    This file is part of the AVR-Crypto-Lib.
     Copyright (C) 2008  Daniel Otte (daniel.otte@rub.de)
 
     This program is free software: you can redistribute it and/or modify
@@ -17,31 +17,34 @@
     along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */
 
-/* 
+/*
  * File:        avr-asm-macros.S
  * Author:      Daniel Otte
  * Date:        2008-08-13
  * License:     GPLv3 or later
  * Description: some macros which are quite usefull
- * 
+ *
  */
- 
-#include <avr/io.h>
 
+//#ifndef AVR_ASM_MACROS__S__
+//#define AVR_ASM_MACROS__S__
+.nolist
+#include <avr/io.h>
+.list
 /*******************************************************************************
 *  MACRO SECTION                                                               *
 *******************************************************************************/
 
 .macro push_ p1:req, p2:vararg
 	push \p1
-.ifnb \p2	
+.ifnb \p2
 	push_ \p2
 .endif
 .endm
 
 .macro pop_ p1:req, p2:vararg
 	pop \p1
-.ifnb \p2	
+.ifnb \p2
 	pop_ \p2
 .endif
 .endm
@@ -50,13 +53,13 @@
 	push \from
 .if     \to-\from
 	push_range "(\from+1)",\to
-.endif		
+.endif
 .endm
 
 .macro pop_range from:req, to:req
 	pop \to
 .if     \to-\from
-	pop_range \from,"(\to-1)"	
+	pop_range \from,"(\to-1)"
 .endif
 .endm
 
@@ -64,7 +67,7 @@
 	in r0, _SFR_IO_ADDR(SREG)
 	in \reg1, _SFR_IO_ADDR(SPL)
 	in \reg2, _SFR_IO_ADDR(SPH)
-	sbiw \reg1, \size 
+	sbiw \reg1, \size
 	cli
 	out _SFR_IO_ADDR(SPH), \reg2
 	out _SFR_IO_ADDR(SREG), r0
@@ -75,16 +78,74 @@
 	in r0, _SFR_IO_ADDR(SREG)
 	in \reg1, _SFR_IO_ADDR(SPL)
 	in \reg2, _SFR_IO_ADDR(SPH)
-	adiw \reg1, \size 
+	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
+
+.macro stack_free_large2 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, 63
+	adiw \reg1, (\size-63*2)
 	cli
 	out _SFR_IO_ADDR(SPH), \reg2
 	out _SFR_IO_ADDR(SREG), r0
 	out _SFR_IO_ADDR(SPL), \reg1
 .endm
 
+.macro stack_free_large3 size:req, reg1=r30, reg2=r31
+	in r0, _SFR_IO_ADDR(SREG)
+	in \reg1, _SFR_IO_ADDR(SPL)
+	in \reg2, _SFR_IO_ADDR(SPH)
+	push r16
+	push r17
+	ldi r16, lo8(\size)
+	ldi r17, hi8(\size)
+	add \reg1, r16
+	adc \reg2, r17
+	pop r17
+	pop r16
+	cli
+	out _SFR_IO_ADDR(SPH), \reg2
+	out _SFR_IO_ADDR(SREG), r0
+	out _SFR_IO_ADDR(SPL), \reg1
+.endm
+
+
 /*******************************************************************************
 * END of MACRO SECTION                                                         *
 *******************************************************************************/
 
 
+//#endif /* AVR_ASM_MACROS__S__ */