| Kyle Swenson | 8d8f654 | 2021-03-15 11:02:55 -0600 | [diff] [blame^] | 1 | #include <linux/types.h> |
| 2 | #include <linux/errno.h> | ||||
| 3 | #include <asm/uaccess.h> | ||||
| 4 | |||||
| 5 | #include <asm/sfp-machine.h> | ||||
| 6 | #include <math-emu/soft-fp.h> | ||||
| 7 | |||||
| 8 | int | ||||
| 9 | mtfsfi(unsigned int crfD, unsigned int IMM) | ||||
| 10 | { | ||||
| 11 | u32 mask = 0xf; | ||||
| 12 | |||||
| 13 | if (!crfD) | ||||
| 14 | mask = 9; | ||||
| 15 | |||||
| 16 | __FPU_FPSCR &= ~(mask << ((7 - crfD) << 2)); | ||||
| 17 | __FPU_FPSCR |= (IMM & 0xf) << ((7 - crfD) << 2); | ||||
| 18 | |||||
| 19 | #ifdef DEBUG | ||||
| 20 | printk("%s: %d %x: %08lx\n", __func__, crfD, IMM, __FPU_FPSCR); | ||||
| 21 | #endif | ||||
| 22 | |||||
| 23 | return 0; | ||||
| 24 | } | ||||