1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0 2*4882a593Smuzhiyun #include <linux/types.h> 3*4882a593Smuzhiyun #include <linux/errno.h> 4*4882a593Smuzhiyun #include <linux/uaccess.h> 5*4882a593Smuzhiyun 6*4882a593Smuzhiyun #include <asm/sfp-machine.h> 7*4882a593Smuzhiyun #include <math-emu/soft-fp.h> 8*4882a593Smuzhiyun 9*4882a593Smuzhiyun int mtfsfi(unsigned int crfD,unsigned int IMM)10*4882a593Smuzhiyunmtfsfi(unsigned int crfD, unsigned int IMM) 11*4882a593Smuzhiyun { 12*4882a593Smuzhiyun u32 mask = 0xf; 13*4882a593Smuzhiyun 14*4882a593Smuzhiyun if (!crfD) 15*4882a593Smuzhiyun mask = 9; 16*4882a593Smuzhiyun 17*4882a593Smuzhiyun __FPU_FPSCR &= ~(mask << ((7 - crfD) << 2)); 18*4882a593Smuzhiyun __FPU_FPSCR |= (IMM & 0xf) << ((7 - crfD) << 2); 19*4882a593Smuzhiyun 20*4882a593Smuzhiyun #ifdef DEBUG 21*4882a593Smuzhiyun printk("%s: %d %x: %08lx\n", __func__, crfD, IMM, __FPU_FPSCR); 22*4882a593Smuzhiyun #endif 23*4882a593Smuzhiyun 24*4882a593Smuzhiyun return 0; 25*4882a593Smuzhiyun } 26