mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
33 lines
620 B
33 lines
620 B
// SPDX-License-Identifier: GPL-2.0 |
|
#include <linux/types.h> |
|
#include <linux/errno.h> |
|
#include <linux/uaccess.h> |
|
|
|
#include <asm/sfp-machine.h> |
|
#include <math-emu/soft-fp.h> |
|
|
|
int |
|
mcrfs(u32 *ccr, u32 crfD, u32 crfS) |
|
{ |
|
u32 value, clear; |
|
|
|
#ifdef DEBUG |
|
printk("%s: %p (%08x) %d %d\n", __func__, ccr, *ccr, crfD, crfS); |
|
#endif |
|
|
|
clear = 15 << ((7 - crfS) << 2); |
|
if (!crfS) |
|
clear = 0x90000000; |
|
|
|
value = (__FPU_FPSCR >> ((7 - crfS) << 2)) & 15; |
|
__FPU_FPSCR &= ~(clear); |
|
|
|
*ccr &= ~(15 << ((7 - crfD) << 2)); |
|
*ccr |= (value << ((7 - crfD) << 2)); |
|
|
|
#ifdef DEBUG |
|
printk("CR: %08x\n", __func__, *ccr); |
|
#endif |
|
|
|
return 0; |
|
}
|
|
|