244 lines
		
	
	
		
			3.5 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			244 lines
		
	
	
		
			3.5 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 * entry.h - routines for context saving and restoring (for interrupts/exceptions)
 | 
						|
 *
 | 
						|
 * Copyright (c) 2005-2007 Analog Devices Inc.
 | 
						|
 *
 | 
						|
 * SPDX-License-Identifier:	GPL-2.0+
 | 
						|
 */
 | 
						|
 | 
						|
#ifndef __BLACKFIN_ENTRY_H
 | 
						|
#define __BLACKFIN_ENTRY_H
 | 
						|
#ifdef __ASSEMBLY__
 | 
						|
 | 
						|
#define SAVE_ALL_INT		save_context_no_interrupts
 | 
						|
#define SAVE_ALL_SYS		save_context_no_interrupts
 | 
						|
#define SAVE_CONTEXT		save_context_with_interrupts
 | 
						|
 | 
						|
#define RESTORE_ALL		restore_context_no_interrupts
 | 
						|
#define RESTORE_ALL_SYS		restore_context_no_interrupts
 | 
						|
#define RESTORE_CONTEXT		restore_context_with_interrupts
 | 
						|
 | 
						|
/*
 | 
						|
 * Code to save processor context.
 | 
						|
 * We even save the register which are preserved by a function call
 | 
						|
 * - r4, r5, r6, r7, p3, p4, p5
 | 
						|
 */
 | 
						|
.macro save_context_with_interrupts
 | 
						|
	[--sp] = R0;
 | 
						|
	[--sp] = ( R7:0, P5:0 );
 | 
						|
	[--sp] = fp;
 | 
						|
	[--sp] = usp;
 | 
						|
 | 
						|
	[--sp] = i0;
 | 
						|
	[--sp] = i1;
 | 
						|
	[--sp] = i2;
 | 
						|
	[--sp] = i3;
 | 
						|
 | 
						|
	[--sp] = m0;
 | 
						|
	[--sp] = m1;
 | 
						|
	[--sp] = m2;
 | 
						|
	[--sp] = m3;
 | 
						|
 | 
						|
	[--sp] = l0;
 | 
						|
	[--sp] = l1;
 | 
						|
	[--sp] = l2;
 | 
						|
	[--sp] = l3;
 | 
						|
 | 
						|
	[--sp] = b0;
 | 
						|
	[--sp] = b1;
 | 
						|
	[--sp] = b2;
 | 
						|
	[--sp] = b3;
 | 
						|
	[--sp] = a0.x;
 | 
						|
	[--sp] = a0.w;
 | 
						|
	[--sp] = a1.x;
 | 
						|
	[--sp] = a1.w;
 | 
						|
 | 
						|
	[--sp] = LC0;
 | 
						|
	[--sp] = LC1;
 | 
						|
	[--sp] = LT0;
 | 
						|
	[--sp] = LT1;
 | 
						|
	[--sp] = LB0;
 | 
						|
	[--sp] = LB1;
 | 
						|
 | 
						|
	[--sp] = ASTAT;
 | 
						|
 | 
						|
	[--sp] = r0;	/* Skip reserved */
 | 
						|
	[--sp] = RETS;
 | 
						|
	[--sp] = RETI;
 | 
						|
	[--sp] = RETX;
 | 
						|
	[--sp] = RETN;
 | 
						|
	[--sp] = RETE;
 | 
						|
	[--sp] = SEQSTAT;
 | 
						|
	[--sp] = SYSCFG;
 | 
						|
#ifdef CONFIG_CMD_KGDB
 | 
						|
	p0.l = lo(IPEND)
 | 
						|
	p0.h = hi(IPEND)
 | 
						|
	r0 = [p0];
 | 
						|
#endif
 | 
						|
	[--sp] = r0;	/* Skip IPEND as well. */
 | 
						|
.endm
 | 
						|
 | 
						|
.macro save_context_no_interrupts
 | 
						|
	[--sp] = R0;
 | 
						|
	[--sp] = ( R7:0, P5:0 );
 | 
						|
	[--sp] = fp;
 | 
						|
	[--sp] = usp;
 | 
						|
 | 
						|
	[--sp] = i0;
 | 
						|
	[--sp] = i1;
 | 
						|
	[--sp] = i2;
 | 
						|
	[--sp] = i3;
 | 
						|
 | 
						|
	[--sp] = m0;
 | 
						|
	[--sp] = m1;
 | 
						|
	[--sp] = m2;
 | 
						|
	[--sp] = m3;
 | 
						|
 | 
						|
	[--sp] = l0;
 | 
						|
	[--sp] = l1;
 | 
						|
	[--sp] = l2;
 | 
						|
	[--sp] = l3;
 | 
						|
 | 
						|
	[--sp] = b0;
 | 
						|
	[--sp] = b1;
 | 
						|
	[--sp] = b2;
 | 
						|
	[--sp] = b3;
 | 
						|
	[--sp] = a0.x;
 | 
						|
	[--sp] = a0.w;
 | 
						|
	[--sp] = a1.x;
 | 
						|
	[--sp] = a1.w;
 | 
						|
 | 
						|
	[--sp] = LC0;
 | 
						|
	[--sp] = LC1;
 | 
						|
	[--sp] = LT0;
 | 
						|
	[--sp] = LT1;
 | 
						|
	[--sp] = LB0;
 | 
						|
	[--sp] = LB1;
 | 
						|
 | 
						|
	[--sp] = ASTAT;
 | 
						|
 | 
						|
	[--sp] = r0;	/* Skip reserved */
 | 
						|
	[--sp] = RETS;
 | 
						|
	r0 = RETI;
 | 
						|
	[--sp] = r0;
 | 
						|
	[--sp] = RETX;
 | 
						|
	[--sp] = RETN;
 | 
						|
	[--sp] = RETE;
 | 
						|
	[--sp] = SEQSTAT;
 | 
						|
	[--sp] = SYSCFG;
 | 
						|
#ifdef CONFIG_CMD_KGDB
 | 
						|
	p0.l = lo(IPEND)
 | 
						|
	p0.h = hi(IPEND)
 | 
						|
	r0 = [p0];
 | 
						|
#endif
 | 
						|
	[--sp] = r0;	/* Skip IPEND as well. */
 | 
						|
.endm
 | 
						|
 | 
						|
.macro restore_context_no_interrupts
 | 
						|
	sp += 4;
 | 
						|
	SYSCFG = [sp++];
 | 
						|
	SEQSTAT = [sp++];
 | 
						|
	RETE = [sp++];
 | 
						|
	RETN = [sp++];
 | 
						|
	RETX = [sp++];
 | 
						|
	r0 = [sp++];
 | 
						|
	RETI = r0;
 | 
						|
	RETS = [sp++];
 | 
						|
 | 
						|
	sp += 4;
 | 
						|
 | 
						|
	ASTAT = [sp++];
 | 
						|
 | 
						|
	LB1 = [sp++];
 | 
						|
	LB0 = [sp++];
 | 
						|
	LT1 = [sp++];
 | 
						|
	LT0 = [sp++];
 | 
						|
	LC1 = [sp++];
 | 
						|
	LC0 = [sp++];
 | 
						|
 | 
						|
	a1.w = [sp++];
 | 
						|
	a1.x = [sp++];
 | 
						|
	a0.w = [sp++];
 | 
						|
	a0.x = [sp++];
 | 
						|
	b3 = [sp++];
 | 
						|
	b2 = [sp++];
 | 
						|
	b1 = [sp++];
 | 
						|
	b0 = [sp++];
 | 
						|
 | 
						|
	l3 = [sp++];
 | 
						|
	l2 = [sp++];
 | 
						|
	l1 = [sp++];
 | 
						|
	l0 = [sp++];
 | 
						|
 | 
						|
	m3 = [sp++];
 | 
						|
	m2 = [sp++];
 | 
						|
	m1 = [sp++];
 | 
						|
	m0 = [sp++];
 | 
						|
 | 
						|
	i3 = [sp++];
 | 
						|
	i2 = [sp++];
 | 
						|
	i1 = [sp++];
 | 
						|
	i0 = [sp++];
 | 
						|
 | 
						|
	sp += 4;
 | 
						|
	fp = [sp++];
 | 
						|
 | 
						|
	( R7 : 0, P5 : 0) = [ SP ++ ];
 | 
						|
	sp += 4;
 | 
						|
.endm
 | 
						|
 | 
						|
.macro restore_context_with_interrupts
 | 
						|
	sp += 4;
 | 
						|
	SYSCFG = [sp++];
 | 
						|
	SEQSTAT = [sp++];
 | 
						|
	RETE = [sp++];
 | 
						|
	RETN = [sp++];
 | 
						|
	RETX = [sp++];
 | 
						|
	RETI = [sp++];
 | 
						|
	RETS = [sp++];
 | 
						|
 | 
						|
	sp += 4;
 | 
						|
 | 
						|
	ASTAT = [sp++];
 | 
						|
 | 
						|
	LB1 = [sp++];
 | 
						|
	LB0 = [sp++];
 | 
						|
	LT1 = [sp++];
 | 
						|
	LT0 = [sp++];
 | 
						|
	LC1 = [sp++];
 | 
						|
	LC0 = [sp++];
 | 
						|
 | 
						|
	a1.w = [sp++];
 | 
						|
	a1.x = [sp++];
 | 
						|
	a0.w = [sp++];
 | 
						|
	a0.x = [sp++];
 | 
						|
	b3 = [sp++];
 | 
						|
	b2 = [sp++];
 | 
						|
	b1 = [sp++];
 | 
						|
	b0 = [sp++];
 | 
						|
 | 
						|
	l3 = [sp++];
 | 
						|
	l2 = [sp++];
 | 
						|
	l1 = [sp++];
 | 
						|
	l0 = [sp++];
 | 
						|
 | 
						|
	m3 = [sp++];
 | 
						|
	m2 = [sp++];
 | 
						|
	m1 = [sp++];
 | 
						|
	m0 = [sp++];
 | 
						|
 | 
						|
	i3 = [sp++];
 | 
						|
	i2 = [sp++];
 | 
						|
	i1 = [sp++];
 | 
						|
	i0 = [sp++];
 | 
						|
 | 
						|
	sp += 4;
 | 
						|
	fp = [sp++];
 | 
						|
 | 
						|
	( R7 : 0, P5 : 0) = [ SP ++ ];
 | 
						|
	sp += 4;
 | 
						|
.endm
 | 
						|
 | 
						|
#endif
 | 
						|
#endif
 |