float_regs_xtensa.h

Go to the documentation of this file.

/*
 * Copyright (c) 2022 Espressif Systems (Shanghai) Co., Ltd.
 *
 * SPDX-License-Identifier: Apache-2.0
 */
 
#ifndef _FLOAT_REGS_XTENSA_H
#define _FLOAT_REGS_XTENSA_H
 
#include <zephyr/toolchain.h>
#include "float_context.h"
 
static inline void _load_all_float_registers(struct fp_register_set *regs)
{
        __asm__ volatile("wfr f0, %0\n" :: "r"(regs->fp_non_volatile.reg[0]));
        __asm__ volatile("wfr f1, %0\n" :: "r"(regs->fp_non_volatile.reg[1]));
        __asm__ volatile("wfr f2, %0\n" :: "r"(regs->fp_non_volatile.reg[2]));
        __asm__ volatile("wfr f3, %0\n" :: "r"(regs->fp_non_volatile.reg[3]));
        __asm__ volatile("wfr f4, %0\n" :: "r"(regs->fp_non_volatile.reg[4]));
        __asm__ volatile("wfr f5, %0\n" :: "r"(regs->fp_non_volatile.reg[5]));
        __asm__ volatile("wfr f6, %0\n" :: "r"(regs->fp_non_volatile.reg[6]));
        __asm__ volatile("wfr f7, %0\n" :: "r"(regs->fp_non_volatile.reg[7]));
        __asm__ volatile("wfr f8, %0\n" :: "r"(regs->fp_non_volatile.reg[8]));
        __asm__ volatile("wfr f9, %0\n" :: "r"(regs->fp_non_volatile.reg[9]));
        __asm__ volatile("wfr f10, %0\n" :: "r"(regs->fp_non_volatile.reg[10]));
        __asm__ volatile("wfr f11, %0\n" :: "r"(regs->fp_non_volatile.reg[11]));
        __asm__ volatile("wfr f12, %0\n" :: "r"(regs->fp_non_volatile.reg[12]));
        __asm__ volatile("wfr f13, %0\n" :: "r"(regs->fp_non_volatile.reg[13]));
        __asm__ volatile("wfr f14, %0\n" :: "r"(regs->fp_non_volatile.reg[14]));
        __asm__ volatile("wfr f15, %0\n" :: "r"(regs->fp_non_volatile.reg[15]));
        __asm__ volatile("wur.fsr %0\n" :: "r"(regs->fp_non_volatile.reg[16]));
        __asm__ volatile("wur.fcr %0\n" :: "r"(regs->fp_non_volatile.reg[17]));
}
 
static inline void _store_all_float_registers(struct fp_register_set *regs)
{
        __asm__ volatile("rfr %0, f0\n" : "=r"(regs->fp_non_volatile.reg[0]));
        __asm__ volatile("rfr %0, f1\n" : "=r"(regs->fp_non_volatile.reg[1]));
        __asm__ volatile("rfr %0, f2\n" : "=r"(regs->fp_non_volatile.reg[2]));
        __asm__ volatile("rfr %0, f3\n" : "=r"(regs->fp_non_volatile.reg[3]));
        __asm__ volatile("rfr %0, f4\n" : "=r"(regs->fp_non_volatile.reg[4]));
        __asm__ volatile("rfr %0, f5\n" : "=r"(regs->fp_non_volatile.reg[5]));
        __asm__ volatile("rfr %0, f6\n" : "=r"(regs->fp_non_volatile.reg[6]));
        __asm__ volatile("rfr %0, f7\n" : "=r"(regs->fp_non_volatile.reg[7]));
        __asm__ volatile("rfr %0, f8\n" : "=r"(regs->fp_non_volatile.reg[8]));
        __asm__ volatile("rfr %0, f9\n" : "=r"(regs->fp_non_volatile.reg[9]));
        __asm__ volatile("rfr %0, f10\n" : "=r"(regs->fp_non_volatile.reg[10]));
        __asm__ volatile("rfr %0, f11\n" : "=r"(regs->fp_non_volatile.reg[11]));
        __asm__ volatile("rfr %0, f12\n" : "=r"(regs->fp_non_volatile.reg[12]));
        __asm__ volatile("rfr %0, f13\n" : "=r"(regs->fp_non_volatile.reg[13]));
        __asm__ volatile("rfr %0, f14\n" : "=r"(regs->fp_non_volatile.reg[14]));
        __asm__ volatile("rfr %0, f15\n" : "=r"(regs->fp_non_volatile.reg[15]));
        __asm__ volatile("rur.fsr %0\n" : "=r"(regs->fp_non_volatile.reg[16]));
        __asm__ volatile("rur.fcr %0\n" : "=r"(regs->fp_non_volatile.reg[17]));
}
 
static inline void _load_then_store_all_float_registers(struct fp_register_set
                                                        *regs)
{
        _load_all_float_registers(regs);
        _store_all_float_registers(regs);
}
 
#endif /* _FLOAT_REGS_XTENSA_H */