| 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 | #include "double.h" | 
|  | 7 |  | 
|  | 8 | int | 
|  | 9 | fcmpo(u32 *ccr, int crfD, void *frA, void *frB) | 
|  | 10 | { | 
|  | 11 | FP_DECL_D(A); | 
|  | 12 | FP_DECL_D(B); | 
|  | 13 | int code[4] = { (1 << 3), (1 << 1), (1 << 2), (1 << 0) }; | 
|  | 14 | long cmp; | 
|  | 15 | int ret = 0; | 
|  | 16 |  | 
|  | 17 | #ifdef DEBUG | 
| Harvey Harrison | e48b1b4 | 2008-03-29 08:21:07 +1100 | [diff] [blame] | 18 | printk("%s: %p (%08x) %d %p %p\n", __func__, ccr, *ccr, crfD, frA, frB); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 19 | #endif | 
|  | 20 |  | 
|  | 21 | __FP_UNPACK_D(A, frA); | 
|  | 22 | __FP_UNPACK_D(B, frB); | 
|  | 23 |  | 
|  | 24 | #ifdef DEBUG | 
|  | 25 | printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); | 
|  | 26 | printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c); | 
|  | 27 | #endif | 
|  | 28 |  | 
|  | 29 | if (A_c == FP_CLS_NAN || B_c == FP_CLS_NAN) | 
|  | 30 | ret |= EFLAG_VXVC; | 
|  | 31 |  | 
|  | 32 | FP_CMP_D(cmp, A, B, 2); | 
|  | 33 | cmp = code[(cmp + 1) & 3]; | 
|  | 34 |  | 
|  | 35 | __FPU_FPSCR &= ~(0x1f000); | 
|  | 36 | __FPU_FPSCR |= (cmp << 12); | 
|  | 37 |  | 
|  | 38 | *ccr &= ~(15 << ((7 - crfD) << 2)); | 
|  | 39 | *ccr |= (cmp << ((7 - crfD) << 2)); | 
|  | 40 |  | 
|  | 41 | #ifdef DEBUG | 
|  | 42 | printk("CR: %08x\n", *ccr); | 
|  | 43 | #endif | 
|  | 44 |  | 
|  | 45 | return ret; | 
|  | 46 | } |