162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci#include <linux/types.h> 362306a36Sopenharmony_ci#include <linux/errno.h> 462306a36Sopenharmony_ci#include <linux/uaccess.h> 562306a36Sopenharmony_ci 662306a36Sopenharmony_ci#include <asm/sfp-machine.h> 762306a36Sopenharmony_ci#include <math-emu/soft-fp.h> 862306a36Sopenharmony_ci 962306a36Sopenharmony_ciint 1062306a36Sopenharmony_cimtfsfi(unsigned int crfD, unsigned int IMM) 1162306a36Sopenharmony_ci{ 1262306a36Sopenharmony_ci u32 mask = 0xf; 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci if (!crfD) 1562306a36Sopenharmony_ci mask = 9; 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_ci __FPU_FPSCR &= ~(mask << ((7 - crfD) << 2)); 1862306a36Sopenharmony_ci __FPU_FPSCR |= (IMM & 0xf) << ((7 - crfD) << 2); 1962306a36Sopenharmony_ci 2062306a36Sopenharmony_ci#ifdef DEBUG 2162306a36Sopenharmony_ci printk("%s: %d %x: %08lx\n", __func__, crfD, IMM, __FPU_FPSCR); 2262306a36Sopenharmony_ci#endif 2362306a36Sopenharmony_ci 2462306a36Sopenharmony_ci return 0; 2562306a36Sopenharmony_ci} 26