| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame^] | 1 | #include <linux/types.h> |
| 2 | #include <linux/errno.h> |
| 3 | #include <asm/uaccess.h> |
| 4 | |
| 5 | #include "soft-fp.h" |
| 6 | |
| 7 | int |
| 8 | mcrfs(u32 *ccr, u32 crfD, u32 crfS) |
| 9 | { |
| 10 | u32 value, clear; |
| 11 | |
| 12 | #ifdef DEBUG |
| 13 | printk("%s: %p (%08x) %d %d\n", __FUNCTION__, ccr, *ccr, crfD, crfS); |
| 14 | #endif |
| 15 | |
| 16 | clear = 15 << ((7 - crfS) << 2); |
| 17 | if (!crfS) |
| 18 | clear = 0x90000000; |
| 19 | |
| 20 | value = (__FPU_FPSCR >> ((7 - crfS) << 2)) & 15; |
| 21 | __FPU_FPSCR &= ~(clear); |
| 22 | |
| 23 | *ccr &= ~(15 << ((7 - crfD) << 2)); |
| 24 | *ccr |= (value << ((7 - crfD) << 2)); |
| 25 | |
| 26 | #ifdef DEBUG |
| 27 | printk("CR: %08x\n", __FUNCTION__, *ccr); |
| 28 | #endif |
| 29 | |
| 30 | return 0; |
| 31 | } |