setjmp.s

ICCAVR中所有的库函数源码

; setjmp(jmpbuf)
;
	.text
_setjmp::
	mov R26,R16
	mov R27,R17
; these are the regs that may be used as register variables
	st X+,R2
	st X+,R3
	st X+,R4
	st X+,R5
	st X+,R6
	st X+,R7
	st X+,R8
	st X+,R9
	st X+,R10
	st X+,R11
	st X+,R12
	st X+,R13
	st X+,R14
	st X+,R15
	st X+,R20
	st X+,R21
	st X+,R22
	st X+,R23
	st X+,R24
	st X+,R25
	; save PC
	pop R31
	pop R30
	st X+,R28
	st X+,R29
	st X+,R30
	st X+,R31
	clr R16
	clr R17
	ijmp

; longjmp(jmpbuf, val)
	
_longjmp::
	mov R26,R16
	mov R27,R17
	ld R2,X+
	ld R3,X+
	ld R4,X+
	ld R5,X+
	ld R6,X+
	ld R7,X+
	ld R8,X+
	ld R9,X+
	ld R10,X+
	ld R11,X+
	ld R12,X+
	ld R13,X+
	ld R14,X+
	ld R15,X+
	ld R20,X+
	ld R21,X+
	ld R22,X+
	ld R23,X+
	ld R24,X+
	ld R25,X+
	ld R28,X+
	ld R29,X+
	ld R30,X+
	ld R31,X+
	out 0x3d,r30
	out 0x3e,r31
	mov R0,R18
	or R0,R19
	brne notzero
	clr R16
	inc R16
	clr R17
	ijmp
notzero:
	mov R16,R18
	mov R17,R19
	ijmp