rt-thread/libcpu/mips/loongson_1c/stackframe_fpu.h

/*
 * ls1c FPU's stackframe
 * 最开始本想，将代码加入到stackframe.h中的SAVE_ALL, RESTORE_ALL和RESTORE_ALL_AND_RET中，
 * 但考虑到源文件"stackframe.h"位于目录"libcpu\mips\common"内，怕影响到其它mips cpu
 * 所以，另外新建本源文件
 */
#ifndef __OPENLOONGSON_STACKFRAME_FPU_H
#define __OPENLOONGSON_STACKFRAME_FPU_H


#include "../common/asm.h"
#include "../common/mipsregs.h"
#include "../common/stackframe.h"



#define PT_FPU_R0               (0)
#define PT_FPU_R2               ((PT_FPU_R0) + 2*LONGSIZE)
#define PT_FPU_R4               ((PT_FPU_R2) + 2*LONGSIZE)
#define PT_FPU_R6               ((PT_FPU_R4) + 2*LONGSIZE)
#define PT_FPU_R8               ((PT_FPU_R6) + 2*LONGSIZE)
#define PT_FPU_R10              ((PT_FPU_R8) + 2*LONGSIZE)
#define PT_FPU_R12              ((PT_FPU_R10) + 2*LONGSIZE)
#define PT_FPU_R14              ((PT_FPU_R12) + 2*LONGSIZE)
#define PT_FPU_R16              ((PT_FPU_R14) + 2*LONGSIZE)
#define PT_FPU_R18              ((PT_FPU_R16) + 2*LONGSIZE)
#define PT_FPU_R20              ((PT_FPU_R18) + 2*LONGSIZE)
#define PT_FPU_R22              ((PT_FPU_R20) + 2*LONGSIZE)
#define PT_FPU_R24              ((PT_FPU_R22) + 2*LONGSIZE)
#define PT_FPU_R26              ((PT_FPU_R24) + 2*LONGSIZE)
#define PT_FPU_R28              ((PT_FPU_R26) + 2*LONGSIZE)
#define PT_FPU_R30              ((PT_FPU_R28) + 2*LONGSIZE)

#define PT_FPU_SIZE             ((((PT_FPU_R30) + 2*LONGSIZE) + (2*PTRSIZE-1)) & ~(2*PTRSIZE-1))


    .macro SAVE_FPU
    .set push
    .set noreorder
#ifdef RT_USING_FPU
    move k1, sp                     /* 保存现场 */
    and k0, k1, 0xFFFFFFF8          /* 8字节对齐 */    
    PTR_SUBU sp, k0, PT_FPU_SIZE    /* 计算栈底 */
    s.d $f0, PT_FPU_R0(sp)
    s.d $f2, PT_FPU_R2(sp)
    s.d $f4, PT_FPU_R4(sp)
    s.d $f6, PT_FPU_R6(sp)
    s.d $f8, PT_FPU_R8(sp)
    s.d $f10, PT_FPU_R10(sp)
    s.d $f12, PT_FPU_R12(sp)
    s.d $f14, PT_FPU_R14(sp)
    s.d $f16, PT_FPU_R16(sp)
    s.d $f18, PT_FPU_R18(sp)
    s.d $f20, PT_FPU_R20(sp)
    s.d $f22, PT_FPU_R22(sp)
    s.d $f24, PT_FPU_R24(sp)
    s.d $f26, PT_FPU_R26(sp)
    s.d $f28, PT_FPU_R28(sp)
    s.d $f30, PT_FPU_R30(sp)
    move sp, k1                     /* 恢复现场 */
#endif
    .set reorder
    .set pop
    .endm


    .macro RESTORE_FPU
    .set push
    .set noreorder
#ifdef RT_USING_FPU
    move k1, sp                     /* 保存现场 */
    and k0, k1, 0xFFFFFFF8          /* 8字节对齐 */
    PTR_SUBU sp, k0, PT_FPU_SIZE    /* 计算栈底*/
    l.d $f0, PT_FPU_R0(sp)
    l.d $f2, PT_FPU_R2(sp)
    l.d $f4, PT_FPU_R4(sp)
    l.d $f6, PT_FPU_R6(sp)
    l.d $f8, PT_FPU_R8(sp)
    l.d $f10, PT_FPU_R10(sp)
    l.d $f12, PT_FPU_R12(sp)
    l.d $f14, PT_FPU_R14(sp)
    l.d $f16, PT_FPU_R16(sp)
    l.d $f18, PT_FPU_R18(sp)
    l.d $f20, PT_FPU_R20(sp)
    l.d $f22, PT_FPU_R22(sp)
    l.d $f24, PT_FPU_R24(sp)
    l.d $f26, PT_FPU_R26(sp)
    l.d $f28, PT_FPU_R28(sp)
    l.d $f30, PT_FPU_R30(sp)
    move sp, k1                     /* 恢复现场 */
#endif
    .set reorder
    .set pop
    .endm


#endif