Logo Search packages:      
Sourcecode: linux version File versions

mtfsf.c

#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;
}

Generated by  Doxygen 1.6.0   Back to index