msm_sdcc.c: stylistic cleaning
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / arch / powerpc / math-emu / mtfsf.c
blobdbce92e4f046d9295c057f4fb3408f52b17990cc
1 #include <linux/types.h>
2 #include <linux/errno.h>
3 #include <asm/uaccess.h>
5 #include <asm/sfp-machine.h>
6 #include <math-emu/soft-fp.h>
8 int
9 mtfsf(unsigned int FM, u32 *frB)
11 u32 mask;
12 u32 fpscr;
14 if (FM == 0)
15 return 0;
17 if (FM == 0xff)
18 mask = 0x9fffffff;
19 else {
20 mask = 0;
21 if (FM & (1 << 0))
22 mask |= 0x90000000;
23 if (FM & (1 << 1))
24 mask |= 0x0f000000;
25 if (FM & (1 << 2))
26 mask |= 0x00f00000;
27 if (FM & (1 << 3))
28 mask |= 0x000f0000;
29 if (FM & (1 << 4))
30 mask |= 0x0000f000;
31 if (FM & (1 << 5))
32 mask |= 0x00000f00;
33 if (FM & (1 << 6))
34 mask |= 0x000000f0;
35 if (FM & (1 << 7))
36 mask |= 0x0000000f;
39 __FPU_FPSCR &= ~(mask);
40 __FPU_FPSCR |= (frB[1] & mask);
42 __FPU_FPSCR &= ~(FPSCR_VX);
43 if (__FPU_FPSCR & (FPSCR_VXSNAN | FPSCR_VXISI | FPSCR_VXIDI |
44 FPSCR_VXZDZ | FPSCR_VXIMZ | FPSCR_VXVC |
45 FPSCR_VXSOFT | FPSCR_VXSQRT | FPSCR_VXCVI))
46 __FPU_FPSCR |= FPSCR_VX;
48 fpscr = __FPU_FPSCR;
49 fpscr &= ~(FPSCR_FEX);
50 if (((fpscr & FPSCR_VX) && (fpscr & FPSCR_VE)) ||
51 ((fpscr & FPSCR_OX) && (fpscr & FPSCR_OE)) ||
52 ((fpscr & FPSCR_UX) && (fpscr & FPSCR_UE)) ||
53 ((fpscr & FPSCR_ZX) && (fpscr & FPSCR_ZE)) ||
54 ((fpscr & FPSCR_XX) && (fpscr & FPSCR_XE)))
55 fpscr |= FPSCR_FEX;
56 __FPU_FPSCR = fpscr;
58 #ifdef DEBUG
59 printk("%s: %02x %p: %08lx\n", __func__, FM, frB, __FPU_FPSCR);
60 #endif
62 return 0;