| /* |
| * 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 |