forked from Minki/linux
46 lines
752 B
C
46 lines
752 B
C
|
#include <linux/types.h>
|
||
|
|
#include <linux/errno.h>
|
||
|
|
#include <asm/uaccess.h>
|
||
|
|
|
||
|
|
#include "soft-fp.h"
|
||
|
|
|
||
|
|
int
|
||
|
|
mtfsf(unsigned int FM, u32 *frB)
|
||
|
|
{
|
||
|
|
u32 mask;
|
||
|
|
|
||
|
|
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);
|
||
|
|
|
||
|
|
#ifdef DEBUG
|
||
|
|
printk("%s: %02x %p: %08lx\n", __FUNCTION__, FM, frB, __FPU_FPSCR);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|