|  | /* | 
|  | * Added to U-boot, | 
|  | * Daniel Hellstrom, Gaisler Research, daniel@gaisler.com | 
|  | * Copyright (C) 2007 | 
|  | * | 
|  | * LEON2/3 LIBIO low-level routines | 
|  | * Written by Jiri Gaisler. | 
|  | * Copyright (C) 2004  Gaisler Research AB | 
|  |  | 
|  | * This program is free software; you can redistribute it and/or modify | 
|  | * it under the terms of the GNU General Public License as published by | 
|  | * the Free Software Foundation; either version 2 of the License, or | 
|  | * (at your option) any later version. | 
|  |  | 
|  | * This program is distributed in the hope that it will be useful, | 
|  | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | * GNU General Public License for more details. | 
|  |  | 
|  | * You should have received a copy of the GNU General Public License | 
|  | * along with this program; if not, write to the Free Software | 
|  | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA | 
|  |  | 
|  | */ | 
|  |  | 
|  | #ifndef __SPARC_WINMACRO_H__ | 
|  | #define __SPARC_WINMACRO_H__ | 
|  |  | 
|  | #include <asm/asmmacro.h> | 
|  | #include <asm/stack.h> | 
|  |  | 
|  | /* Store the register window onto the 8-byte aligned area starting | 
|  | * at %reg.  It might be %sp, it might not, we don't care. | 
|  | */ | 
|  | #define RW_STORE(reg) \ | 
|  | std	%l0, [%reg + RW_L0]; \ | 
|  | std	%l2, [%reg + RW_L2]; \ | 
|  | std	%l4, [%reg + RW_L4]; \ | 
|  | std	%l6, [%reg + RW_L6]; \ | 
|  | std	%i0, [%reg + RW_I0]; \ | 
|  | std	%i2, [%reg + RW_I2]; \ | 
|  | std	%i4, [%reg + RW_I4]; \ | 
|  | std	%i6, [%reg + RW_I6]; | 
|  |  | 
|  | /* Load a register window from the area beginning at %reg. */ | 
|  | #define RW_LOAD(reg) \ | 
|  | ldd	[%reg + RW_L0], %l0; \ | 
|  | ldd	[%reg + RW_L2], %l2; \ | 
|  | ldd	[%reg + RW_L4], %l4; \ | 
|  | ldd	[%reg + RW_L6], %l6; \ | 
|  | ldd	[%reg + RW_I0], %i0; \ | 
|  | ldd	[%reg + RW_I2], %i2; \ | 
|  | ldd	[%reg + RW_I4], %i4; \ | 
|  | ldd	[%reg + RW_I6], %i6; | 
|  |  | 
|  | /* Loading and storing struct pt_reg trap frames. */ | 
|  | #define PT_LOAD_INS(base_reg) \ | 
|  | ldd	[%base_reg + SF_REGS_SZ + PT_I0], %i0; \ | 
|  | ldd	[%base_reg + SF_REGS_SZ + PT_I2], %i2; \ | 
|  | ldd	[%base_reg + SF_REGS_SZ + PT_I4], %i4; \ | 
|  | ldd	[%base_reg + SF_REGS_SZ + PT_I6], %i6; | 
|  |  | 
|  | #define PT_LOAD_GLOBALS(base_reg) \ | 
|  | ld	[%base_reg + SF_REGS_SZ + PT_G1], %g1; \ | 
|  | ldd	[%base_reg + SF_REGS_SZ + PT_G2], %g2; \ | 
|  | ldd	[%base_reg + SF_REGS_SZ + PT_G4], %g4; \ | 
|  | ldd	[%base_reg + SF_REGS_SZ + PT_G6], %g6; | 
|  |  | 
|  | #define PT_LOAD_YREG(base_reg, scratch) \ | 
|  | ld	[%base_reg + SF_REGS_SZ + PT_Y], %scratch; \ | 
|  | wr	%scratch, 0x0, %y; | 
|  |  | 
|  | #define PT_LOAD_PRIV(base_reg, pt_psr, pt_pc, pt_npc) \ | 
|  | ld	[%base_reg + SF_REGS_SZ + PT_PSR], %pt_psr; \ | 
|  | ld	[%base_reg + SF_REGS_SZ + PT_PC], %pt_pc; \ | 
|  | ld	[%base_reg + SF_REGS_SZ + PT_NPC], %pt_npc; | 
|  |  | 
|  | #define PT_LOAD_ALL(base_reg, pt_psr, pt_pc, pt_npc, scratch) \ | 
|  | PT_LOAD_YREG(base_reg, scratch) \ | 
|  | PT_LOAD_INS(base_reg) \ | 
|  | PT_LOAD_GLOBALS(base_reg) \ | 
|  | PT_LOAD_PRIV(base_reg, pt_psr, pt_pc, pt_npc) | 
|  |  | 
|  | #define PT_STORE_INS(base_reg) \ | 
|  | std	%i0, [%base_reg + SF_REGS_SZ + PT_I0]; \ | 
|  | std	%i2, [%base_reg + SF_REGS_SZ + PT_I2]; \ | 
|  | std	%i4, [%base_reg + SF_REGS_SZ + PT_I4]; \ | 
|  | std	%i6, [%base_reg + SF_REGS_SZ + PT_I6]; | 
|  |  | 
|  | #define PT_STORE_GLOBALS(base_reg) \ | 
|  | st	%g1, [%base_reg + SF_REGS_SZ + PT_G1]; \ | 
|  | std	%g2, [%base_reg + SF_REGS_SZ + PT_G2]; \ | 
|  | std	%g4, [%base_reg + SF_REGS_SZ + PT_G4]; \ | 
|  | std	%g6, [%base_reg + SF_REGS_SZ + PT_G6]; | 
|  |  | 
|  | #define PT_STORE_YREG(base_reg, scratch) \ | 
|  | rd	%y, %scratch; \ | 
|  | st	%scratch, [%base_reg + SF_REGS_SZ + PT_Y]; | 
|  |  | 
|  | #define PT_STORE_PRIV(base_reg, pt_psr, pt_pc, pt_npc) \ | 
|  | st	%pt_psr, [%base_reg + SF_REGS_SZ + PT_PSR]; \ | 
|  | st	%pt_pc,  [%base_reg + SF_REGS_SZ + PT_PC]; \ | 
|  | st	%pt_npc, [%base_reg + SF_REGS_SZ + PT_NPC]; | 
|  |  | 
|  | #define PT_STORE_ALL(base_reg, reg_psr, reg_pc, reg_npc, g_scratch) \ | 
|  | PT_STORE_PRIV(base_reg, reg_psr, reg_pc, reg_npc) \ | 
|  | PT_STORE_GLOBALS(base_reg) \ | 
|  | PT_STORE_YREG(base_reg, g_scratch) \ | 
|  | PT_STORE_INS(base_reg) | 
|  |  | 
|  | /* Store the fpu register window*/ | 
|  | #define FW_STORE(reg) \ | 
|  | std	%f0, [reg + FW_F0]; \ | 
|  | std	%f2, [reg + FW_F2]; \ | 
|  | std	%f4, [reg + FW_F4]; \ | 
|  | std	%f6, [reg + FW_F6]; \ | 
|  | std	%f8, [reg + FW_F8]; \ | 
|  | std	%f10, [reg + FW_F10]; \ | 
|  | std	%f12, [reg + FW_F12]; \ | 
|  | std	%f14, [reg + FW_F14]; \ | 
|  | std	%f16, [reg + FW_F16]; \ | 
|  | std	%f18, [reg + FW_F18]; \ | 
|  | std	%f20, [reg + FW_F20]; \ | 
|  | std	%f22, [reg + FW_F22]; \ | 
|  | std	%f24, [reg + FW_F24]; \ | 
|  | std	%f26, [reg + FW_F26]; \ | 
|  | std	%f28, [reg + FW_F28]; \ | 
|  | std	%f30, [reg + FW_F30]; \ | 
|  | st	%fsr, [reg + FW_FSR]; | 
|  |  | 
|  | /* Load a fpu register window from the area beginning at reg. */ | 
|  | #define FW_LOAD(reg) \ | 
|  | ldd	[reg + FW_F0], %f0; \ | 
|  | ldd	[reg + FW_F2], %f2; \ | 
|  | ldd	[reg + FW_F4], %f4; \ | 
|  | ldd	[reg + FW_F6], %f6; \ | 
|  | ldd	[reg + FW_F8], %f8; \ | 
|  | ldd	[reg + FW_F10], %f10; \ | 
|  | ldd	[reg + FW_F12], %f12; \ | 
|  | ldd	[reg + FW_F14], %f14; \ | 
|  | ldd	[reg + FW_F16], %f16; \ | 
|  | ldd	[reg + FW_F18], %f18; \ | 
|  | ldd	[reg + FW_F20], %f20; \ | 
|  | ldd	[reg + FW_F22], %f22; \ | 
|  | ldd	[reg + FW_F24], %f24; \ | 
|  | ldd	[reg + FW_F26], %f26; \ | 
|  | ldd	[reg + FW_F28], %f28; \ | 
|  | ldd	[reg + FW_F30], %f30; \ | 
|  | ld	[reg + FW_FSR], %fsr; | 
|  |  | 
|  | #endif |