#include <linux/types.h> | |
#include <linux/errno.h> | |
#include <asm/uaccess.h> | |
#include <asm/sfp-machine.h> | |
#include <math-emu/soft-fp.h> | |
int | |
mtfsf(unsigned int FM, u32 *frB) | |
{ | |
u32 mask; | |
u32 fpscr; | |
if (FM == 0) | |
return 0; | |
if (FM == 0xff) | |
mask = 0x9fffffff; | |
else { | |
mask = 0; | |
if (FM & (1 << 0)) | |
mask |= 0x90000000; | |
if (FM & (1 << 1)) | |
mask |= 0x0f000000; | |
if (FM & (1 << 2)) | |
mask |= 0x00f00000; | |
if (FM & (1 << 3)) | |
mask |= 0x000f0000; | |
if (FM & (1 << 4)) | |
mask |= 0x0000f000; | |
if (FM & (1 << 5)) | |
mask |= 0x00000f00; | |
if (FM & (1 << 6)) | |
mask |= 0x000000f0; | |
if (FM & (1 << 7)) | |
mask |= 0x0000000f; | |
} | |
__FPU_FPSCR &= ~(mask); | |
__FPU_FPSCR |= (frB[1] & mask); | |
__FPU_FPSCR &= ~(FPSCR_VX); | |
if (__FPU_FPSCR & (FPSCR_VXSNAN | FPSCR_VXISI | FPSCR_VXIDI | | |
FPSCR_VXZDZ | FPSCR_VXIMZ | FPSCR_VXVC | | |
FPSCR_VXSOFT | FPSCR_VXSQRT | FPSCR_VXCVI)) | |
__FPU_FPSCR |= FPSCR_VX; | |
fpscr = __FPU_FPSCR; | |
fpscr &= ~(FPSCR_FEX); | |
if (((fpscr & FPSCR_VX) && (fpscr & FPSCR_VE)) || | |
((fpscr & FPSCR_OX) && (fpscr & FPSCR_OE)) || | |
((fpscr & FPSCR_UX) && (fpscr & FPSCR_UE)) || | |
((fpscr & FPSCR_ZX) && (fpscr & FPSCR_ZE)) || | |
((fpscr & FPSCR_XX) && (fpscr & FPSCR_XE))) | |
fpscr |= FPSCR_FEX; | |
__FPU_FPSCR = fpscr; | |
#ifdef DEBUG | |
printk("%s: %02x %p: %08lx\n", __func__, FM, frB, __FPU_FPSCR); | |
#endif | |
return 0; | |
} |