162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci#include <linux/types.h> 362306a36Sopenharmony_ci#include <linux/errno.h> 462306a36Sopenharmony_ci#include <linux/uaccess.h> 562306a36Sopenharmony_ci 662306a36Sopenharmony_ci#include <asm/sfp-machine.h> 762306a36Sopenharmony_ci#include <math-emu/soft-fp.h> 862306a36Sopenharmony_ci#include <math-emu/double.h> 962306a36Sopenharmony_ci 1062306a36Sopenharmony_ciint 1162306a36Sopenharmony_cifcmpu(u32 *ccr, int crfD, void *frA, void *frB) 1262306a36Sopenharmony_ci{ 1362306a36Sopenharmony_ci FP_DECL_D(A); 1462306a36Sopenharmony_ci FP_DECL_D(B); 1562306a36Sopenharmony_ci FP_DECL_EX; 1662306a36Sopenharmony_ci int code[4] = { (1 << 3), (1 << 1), (1 << 2), (1 << 0) }; 1762306a36Sopenharmony_ci long cmp; 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci#ifdef DEBUG 2062306a36Sopenharmony_ci printk("%s: %p (%08x) %d %p %p\n", __func__, ccr, *ccr, crfD, frA, frB); 2162306a36Sopenharmony_ci#endif 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci FP_UNPACK_DP(A, frA); 2462306a36Sopenharmony_ci FP_UNPACK_DP(B, frB); 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci#ifdef DEBUG 2762306a36Sopenharmony_ci printk("A: %ld %lu %lu %ld (%ld)\n", A_s, A_f1, A_f0, A_e, A_c); 2862306a36Sopenharmony_ci printk("B: %ld %lu %lu %ld (%ld)\n", B_s, B_f1, B_f0, B_e, B_c); 2962306a36Sopenharmony_ci#endif 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci FP_CMP_D(cmp, A, B, 2); 3262306a36Sopenharmony_ci cmp = code[(cmp + 1) & 3]; 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_ci __FPU_FPSCR &= ~(0x1f000); 3562306a36Sopenharmony_ci __FPU_FPSCR |= (cmp << 12); 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_ci *ccr &= ~(15 << ((7 - crfD) << 2)); 3862306a36Sopenharmony_ci *ccr |= (cmp << ((7 - crfD) << 2)); 3962306a36Sopenharmony_ci 4062306a36Sopenharmony_ci#ifdef DEBUG 4162306a36Sopenharmony_ci printk("CR: %08x\n", *ccr); 4262306a36Sopenharmony_ci#endif 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci return 0; 4562306a36Sopenharmony_ci} 46