io.c 1.9 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * arch/sh/lib/io.c - SH32 optimized I/O routines
  4. *
  5. * Copyright (C) 2000 Stuart Menefy
  6. * Copyright (C) 2005 Paul Mundt
  7. *
  8. * Provide real functions which expand to whatever the header file defined.
  9. * Also definitions of machine independent IO functions.
  10. */
  11. #include <linux/module.h>
  12. #include <linux/io.h>
  13. void __raw_readsl(const void __iomem *addr, void *datap, int len)
  14. {
  15. u32 *data;
  16. for (data = datap; (len != 0) && (((u32)data & 0x1f) != 0); len--)
  17. *data++ = __raw_readl(addr);
  18. if (likely(len >= (0x20 >> 2))) {
  19. int tmp2, tmp3, tmp4, tmp5, tmp6;
  20. __asm__ __volatile__(
  21. "1: \n\t"
  22. "mov.l @%7, r0 \n\t"
  23. "mov.l @%7, %2 \n\t"
  24. #ifdef CONFIG_CPU_SH4
  25. "movca.l r0, @%0 \n\t"
  26. #else
  27. "mov.l r0, @%0 \n\t"
  28. #endif
  29. "mov.l @%7, %3 \n\t"
  30. "mov.l @%7, %4 \n\t"
  31. "mov.l @%7, %5 \n\t"
  32. "mov.l @%7, %6 \n\t"
  33. "mov.l @%7, r7 \n\t"
  34. "mov.l @%7, r0 \n\t"
  35. "mov.l %2, @(0x04,%0) \n\t"
  36. "mov #0x20>>2, %2 \n\t"
  37. "mov.l %3, @(0x08,%0) \n\t"
  38. "sub %2, %1 \n\t"
  39. "mov.l %4, @(0x0c,%0) \n\t"
  40. "cmp/hi %1, %2 ! T if 32 > len \n\t"
  41. "mov.l %5, @(0x10,%0) \n\t"
  42. "mov.l %6, @(0x14,%0) \n\t"
  43. "mov.l r7, @(0x18,%0) \n\t"
  44. "mov.l r0, @(0x1c,%0) \n\t"
  45. "bf.s 1b \n\t"
  46. " add #0x20, %0 \n\t"
  47. : "=&r" (data), "=&r" (len),
  48. "=&r" (tmp2), "=&r" (tmp3), "=&r" (tmp4),
  49. "=&r" (tmp5), "=&r" (tmp6)
  50. : "r"(addr), "0" (data), "1" (len)
  51. : "r0", "r7", "t", "memory");
  52. }
  53. for (; len != 0; len--)
  54. *data++ = __raw_readl(addr);
  55. }
  56. EXPORT_SYMBOL(__raw_readsl);
  57. void __raw_writesl(void __iomem *addr, const void *data, int len)
  58. {
  59. if (likely(len != 0)) {
  60. int tmp1;
  61. __asm__ __volatile__ (
  62. "1: \n\t"
  63. "mov.l @%0+, %1 \n\t"
  64. "dt %3 \n\t"
  65. "bf.s 1b \n\t"
  66. " mov.l %1, @%4 \n\t"
  67. : "=&r" (data), "=&r" (tmp1)
  68. : "0" (data), "r" (len), "r"(addr)
  69. : "t", "memory");
  70. }
  71. }
  72. EXPORT_SYMBOL(__raw_writesl);