/*
 * Copyright (c) 2004 Michael Hayes <m.hayes@elec.canterbury.ac.nz>.
 *
 * The author hereby grant permission to use, copy, modify, distribute,
 * and license this software and its documentation for any purpose, provided
 * that existing copyright notices are retained in all copies and that this
 * notice is included verbatim in any distributions. No written agreement,
 * license, or royalty fee is required for any of the authorized uses.
 * Modifications to this software may be copyrighted by their authors
 * and need not follow the licensing terms described here, provided that
 * the new terms are clearly indicated on the first page of each file where
 * they apply.
 */
/* setjmp/longjmp routines. */

#include <picolibc.h>

	.sect .text
	.global setjmp
	.global longjmp

setjmp:
	pop	r1	   
	ldi	sp, ar0
#ifndef _REGPARM
	ldi	*ar0, ar2	
#endif

	sti	r4, *ar2++
	sti	r5, *ar2++
	stf	r6, *ar2++
	stf	r7, *ar2++
#ifdef _TMS320C4x
	sti	r8, *ar2++
#endif
	sti	ar3, *ar2++
	sti	ar4, *ar2++
	sti	ar5, *ar2++
	sti	ar6, *ar2++
	sti	ar7, *ar2++
	bd	r1	
	sti	r1, *ar2++ 
	sti	ar0, *ar2  
	ldi	0, r0	

	
longjmp:
#ifndef _REGPARM
	ldi	sp, ar0
	ldi	*-ar0(1), ar2  
	ldi	*-ar0(2), r0   
	ldiz	1, r0	
#else
	ldi	r2, r0	 
	ldiz	1, r0	
#endif
 
	ldi	*ar2++, r4 
	ldi	*ar2++, r5 
	ldf	*ar2++, r6 
	ldf	*ar2++, r7
#ifdef _TMS320C4x
	ldi	*ar2++, r8
#endif
	ldi	*ar2++, ar3
	ldi	*ar2++, ar4 
	ldi	*ar2++, ar5 
	ldi	*ar2++, ar6 
	ldi	*ar2++, ar7 
	ldi	*ar2++, r1 
	ldi	*ar2, sp	
    
	b	 r1	
	.end
	
	

