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_cimcrfs(u32 *ccr, u32 crfD, u32 crfS) 1162306a36Sopenharmony_ci{ 1262306a36Sopenharmony_ci u32 value, clear; 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci#ifdef DEBUG 1562306a36Sopenharmony_ci printk("%s: %p (%08x) %d %d\n", __func__, ccr, *ccr, crfD, crfS); 1662306a36Sopenharmony_ci#endif 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ci clear = 15 << ((7 - crfS) << 2); 1962306a36Sopenharmony_ci if (!crfS) 2062306a36Sopenharmony_ci clear = 0x90000000; 2162306a36Sopenharmony_ci 2262306a36Sopenharmony_ci value = (__FPU_FPSCR >> ((7 - crfS) << 2)) & 15; 2362306a36Sopenharmony_ci __FPU_FPSCR &= ~(clear); 2462306a36Sopenharmony_ci 2562306a36Sopenharmony_ci *ccr &= ~(15 << ((7 - crfD) << 2)); 2662306a36Sopenharmony_ci *ccr |= (value << ((7 - crfD) << 2)); 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_ci#ifdef DEBUG 2962306a36Sopenharmony_ci printk("CR: %08x\n", __func__, *ccr); 3062306a36Sopenharmony_ci#endif 3162306a36Sopenharmony_ci 3262306a36Sopenharmony_ci return 0; 3362306a36Sopenharmony_ci} 34