11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h> 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5d2b194ed820880eb19c43b9c10d9f5f30026ee54Kumar Gala#include <asm/sfp-machine.h> 6d2b194ed820880eb19c43b9c10d9f5f30026ee54Kumar Gala#include <math-emu/soft-fp.h> 7d2b194ed820880eb19c43b9c10d9f5f30026ee54Kumar Gala#include <math-emu/double.h> 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsfcmpu(u32 *ccr, int crfD, void *frA, void *frB) 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds FP_DECL_D(A); 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds FP_DECL_D(B); 14d2b194ed820880eb19c43b9c10d9f5f30026ee54Kumar Gala FP_DECL_EX; 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int code[4] = { (1 << 3), (1 << 1), (1 << 2), (1 << 0) }; 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds long cmp; 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef DEBUG 19e48b1b452ff630288c930fd8e0c2d808bc15f7adHarvey Harrison printk("%s: %p (%08x) %d %p %p\n", __func__, ccr, *ccr, crfD, frA, frB); 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22d2b194ed820880eb19c43b9c10d9f5f30026ee54Kumar Gala FP_UNPACK_DP(A, frA); 23d2b194ed820880eb19c43b9c10d9f5f30026ee54Kumar Gala FP_UNPACK_DP(B, frB); 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef DEBUG 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c); 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds FP_CMP_D(cmp, A, B, 2); 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cmp = code[(cmp + 1) & 3]; 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __FPU_FPSCR &= ~(0x1f000); 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __FPU_FPSCR |= (cmp << 12); 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *ccr &= ~(15 << ((7 - crfD) << 2)); 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *ccr |= (cmp << ((7 - crfD) << 2)); 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef DEBUG 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("CR: %08x\n", *ccr); 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 45