/*
* Copyright (C) 2020 Linux Studio Plugins Project
* (C) 2020 Vladimir Sadovnikov
*
* This file is part of lsp-dsp-lib
* Created on: 31 мар. 2020 г.
*
* lsp-dsp-lib is free software: you can redistribute it and/or modify
* it under the terms of the GNU Lesser General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* any later version.
*
* lsp-dsp-lib 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 Lesser General Public License for more details.
*
* You should have received a copy of the GNU Lesser General Public License
* along with lsp-dsp-lib. If not, see .
*/
#ifndef PRIVATE_DSP_ARCH_X86_SSE_MXCSR_H_
#define PRIVATE_DSP_ARCH_X86_SSE_MXCSR_H_
#ifndef PRIVATE_DSP_ARCH_X86_SSE_IMPL
#error "This header should not be included directly"
#endif /* PRIVATE_DSP_ARCH_X86_SSE_IMPL */
#define MXCSR_IE (1 << 0)
#define MXCSR_DE (1 << 1)
#define MXCSR_ZE (1 << 2)
#define MXCSR_OE (1 << 3)
#define MXCSR_UE (1 << 4)
#define MXCSR_PE (1 << 5)
#define MXCSR_DAZ (1 << 6) /* Denormals are zeros flag */
#define MXCSR_IM (1 << 7)
#define MXCSR_DM (1 << 8)
#define MXCSR_ZM (1 << 9)
#define MXCSR_OM (1 << 10)
#define MXCSR_UM (1 << 11)
#define MXCSR_PM (1 << 12)
#define MXCSR_ALL_MASK (MXCSR_IM | MXCSR_DM | MXCSR_ZM | MXCSR_OM | MXCSR_UM | MXCSR_PM)
#define MXCSR_RC_MASK (3 << 13)
#define MXCSR_RC_NEAREST (0 << 13)
#define MXCSR_RC_N_INF (1 << 13)
#define MXCSR_RC_P_INF (2 << 13)
#define MXCSR_RC_ZERO (3 << 13)
#define MXCSR_FZ (1 << 15) /* Flush to zero flag */
#define MXCSR_DEFAULT 0xffbf
namespace lsp
{
namespace sse
{
static uint32_t mxcsr_mask = MXCSR_DEFAULT;
inline void init_mxcsr_mask()
{
uint8_t fxsave[512] __lsp_aligned16;
uint8_t *ptr = fxsave;
ARCH_X86_ASM
(
// Clear FXSAVE structure
__ASM_EMIT("xor %%eax, %%eax")
__ASM_EMIT("mov $0x80, %%ecx")
__ASM_EMIT("rep stosl")
// Issue fxsave
__ASM_EMIT("fxsave (%[fxsave])")
// Get mask
__ASM_EMIT("mov 0x1c(%[fxsave]), %%eax")
__ASM_EMIT("test %%eax, %%eax")
__ASM_EMIT("jnz 1f")
__ASM_EMIT("mov %[mxcsr_dfl], %%eax") // Old processors issue zero MXCSR mask
__ASM_EMIT("1:")
// Store MXCSR mask
__ASM_EMIT("mov %%eax, %[mask]")
: "+D" (ptr), [fxsave] "+S" (ptr), [mask] "+m" (mxcsr_mask)
: [mxcsr_dfl] "i" (MXCSR_DEFAULT)
: "cc", "memory",
"%eax", "%ecx"
);
}
inline uint32_t read_mxcsr()
{
uint32_t result = 0;
ARCH_X86_ASM
(
__ASM_EMIT("stmxcsr %[result]")
: [result] "+m" (result)
:
: "memory"
);
return result;
}
inline void write_mxcsr(uint32_t value)
{
ARCH_X86_ASM
(
// Clear FXSAVE structure
__ASM_EMIT("and %[mask], %[value]")
__ASM_EMIT("ldmxcsr %[value]")
: [value] "+m" (value)
: [mask] "r" (mxcsr_mask)
: "cc", "memory"
);
}
}
}
#endif /* PRIVATE_DSP_ARCH_X86_SSE_MXCSR_H_ */