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