/arch/powerpc/math-emu/mcrfs.c

https://bitbucket.org/cresqo/cm7-p500-kernel · C · 32 lines · 24 code · 8 blank · 0 comment · 1 complexity · 2dcb2132a99559e3846168e9a1af6ef1 MD5 · raw file 

    

  1. #include <linux/types.h>
    2. 

  2. #include <linux/errno.h>
    3. 

  3. #include <asm/uaccess.h>
    4. 

  4. 

  5. #include <asm/sfp-machine.h>
    6. 

  6. #include <math-emu/soft-fp.h>
    7. 

  7. 

  8. int
    9. 

  9. mcrfs(u32 *ccr, u32 crfD, u32 crfS)
    10. 

  10. {
    11. 

  11. 	u32 value, clear;
    12. 

  12. 

  13. #ifdef DEBUG
    14. 

  14. 	printk("%s: %p (%08x) %d %d\n", __func__, ccr, *ccr, crfD, crfS);
    15. 

  15. #endif
    16. 

  16. 

  17. 	clear = 15 << ((7 - crfS) << 2);
    18. 

  18. 	if (!crfS)
    19. 

  19. 		clear = 0x90000000;
    20. 

  20. 

  21. 	value = (__FPU_FPSCR >> ((7 - crfS) << 2)) & 15;
    22. 

  22. 	__FPU_FPSCR &= ~(clear);
    23. 

  23. 

  24. 	*ccr &= ~(15 << ((7 - crfD) << 2));
    25. 

  25. 	*ccr |= (value << ((7 - crfD) << 2));
    26. 

  26. 

  27. #ifdef DEBUG
    28. 

  28. 	printk("CR: %08x\n", __func__, *ccr);
    29. 

  29. #endif
    30. 

  30. 

  31. 	return 0;
    32. 

  32. }
    33.