ip22-sc.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:5k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * ip22-sc.c: Indy cache management functions.
  3.  *
  4.  * Copyright (C) 1997, 2001 Ralf Baechle (ralf@gnu.org),
  5.  * derived from r4xx0.c by David S. Miller (dm@engr.sgi.com).
  6.  */
  7. #include <linux/init.h>
  8. #include <linux/kernel.h>
  9. #include <linux/sched.h>
  10. #include <linux/mm.h>
  11. #include <asm/bcache.h>
  12. #include <asm/sgi/sgi.h>
  13. #include <asm/sgi/sgimc.h>
  14. #include <asm/page.h>
  15. #include <asm/pgtable.h>
  16. #include <asm/system.h>
  17. #include <asm/bootinfo.h>
  18. #include <asm/sgialib.h>
  19. #include <asm/mmu_context.h>
  20. /* Secondary cache size in bytes, if present.  */
  21. static unsigned long scache_size;
  22. #undef DEBUG_CACHE
  23. #define SC_SIZE 0x00080000
  24. #define SC_LINE 32
  25. #define CI_MASK (SC_SIZE - SC_LINE)
  26. #define SC_INDEX(n) ((n) & CI_MASK)
  27. static inline void indy_sc_wipe(unsigned long first, unsigned long last)
  28. {
  29. unsigned long tmp;
  30. __asm__ __volatile__(
  31. ".settpushttt# indy_sc_wipent"
  32. ".settnoreordernt"
  33. ".settmips3nt"
  34. ".settnoatnt"
  35. "mfc0t%2, $12nt"
  36. "lit$1, 0x80ttt# Go 64 bitnt"
  37. "mtc0t$1, $12nt"
  38. "dlit$1, 0x9000000080000000nt"
  39. "ort%0, $1ttt# first line to flushnt"
  40. "ort%1, $1ttt# last line to flushnt"
  41. ".settatnt"
  42. "1:tswt$0, 0(%0)nt"
  43. "bnet%0, %1, 1bnt"
  44. " daddut%0, 32nt"
  45. "mtc0t%2, $12ttt# Back to 32 bitnt"
  46. "nop; nop; nop; nop;nt"
  47. ".settpop"
  48. : "=r" (first), "=r" (last), "=&r" (tmp)
  49. : "0" (first), "1" (last));
  50. }
  51. static void indy_sc_wback_invalidate(unsigned long addr, unsigned long size)
  52. {
  53. unsigned long first_line, last_line;
  54. unsigned int flags;
  55. #ifdef DEBUG_CACHE
  56. printk("indy_sc_wback_invalidate[%08lx,%08lx]", addr, size);
  57. #endif
  58. if (!size)
  59. return;
  60. /* Which lines to flush?  */
  61. first_line = SC_INDEX(addr);
  62. last_line = SC_INDEX(addr + size - 1);
  63. __save_and_cli(flags);
  64. if (first_line <= last_line) {
  65. indy_sc_wipe(first_line, last_line);
  66. goto out;
  67. }
  68. indy_sc_wipe(first_line, SC_SIZE - SC_LINE);
  69. indy_sc_wipe(0, last_line);
  70. out:
  71. __restore_flags(flags);
  72. }
  73. static void indy_sc_enable(void)
  74. {
  75. unsigned long addr, tmp1, tmp2;
  76. /* This is really cool... */
  77. #ifdef DEBUG_CACHE
  78. printk("Enabling R4600 SCACHEn");
  79. #endif
  80. __asm__ __volatile__(
  81. ".settpushnt"
  82. ".settnoreordernt"
  83. ".settmips3nt"
  84. "mfc0t%2, $12nt"
  85. "nop; nop; nop; nop;nt"
  86. "lit%1, 0x80nt"
  87. "mtc0t%1, $12nt"
  88. "nop; nop; nop; nop;nt"
  89. "lit%0, 0x1nt"
  90. "dsllt%0, 31nt"
  91. "luit%1, 0x9000nt"
  92. "dsll32t%1, 0nt"
  93. "ort%0, %1, %0nt"
  94. "sbt$0, 0(%0)nt"
  95. "mtc0t$0, $12nt"
  96. "nop; nop; nop; nop;nt"
  97. "mtc0t%2, $12nt"
  98. "nop; nop; nop; nop;nt"
  99. ".settpop"
  100. : "=r" (tmp1), "=r" (tmp2), "=r" (addr));
  101. }
  102. static void indy_sc_disable(void)
  103. {
  104. unsigned long tmp1, tmp2, tmp3;
  105. #ifdef DEBUG_CACHE
  106. printk("Disabling R4600 SCACHEn");
  107. #endif
  108. __asm__ __volatile__(
  109. ".settpushnt"
  110. ".settnoreordernt"
  111. ".settmips3nt"
  112. "lit%0, 0x1nt"
  113. "dsllt%0, 31nt"
  114. "luit%1, 0x9000nt"
  115. "dsll32t%1, 0nt"
  116. "ort%0, %1, %0nt"
  117. "mfc0t%2, $12nt"
  118. "nop; nop; nop; nopnt"
  119. "lit%1, 0x80nt"
  120. "mtc0t%1, $12nt"
  121. "nop; nop; nop; nopnt"
  122. "sht$0, 0(%0)nt"
  123. "mtc0t$0, $12nt"
  124. "nop; nop; nop; nopnt"
  125. "mtc0t%2, $12nt"
  126. "nop; nop; nop; nopnt"
  127. ".settpop"
  128. : "=r" (tmp1), "=r" (tmp2), "=r" (tmp3));
  129. }
  130. static inline int __init indy_sc_probe(void)
  131. {
  132. volatile unsigned int *cpu_control;
  133. unsigned short cmd = 0xc220;
  134. unsigned long data = 0;
  135. int i, n;
  136. #ifdef __MIPSEB__
  137. cpu_control = (volatile unsigned int *) KSEG1ADDR(0x1fa00034);
  138. #else
  139. cpu_control = (volatile unsigned int *) KSEG1ADDR(0x1fa00030);
  140. #endif
  141. #define DEASSERT(bit) (*(cpu_control) &= (~(bit)))
  142. #define ASSERT(bit) (*(cpu_control) |= (bit))
  143. #define DELAY  for(n = 0; n < 100000; n++) __asm__ __volatile__("")
  144. DEASSERT(SGIMC_EEPROM_PRE);
  145. DEASSERT(SGIMC_EEPROM_SDATAO);
  146. DEASSERT(SGIMC_EEPROM_SECLOCK);
  147. DEASSERT(SGIMC_EEPROM_PRE);
  148. DELAY;
  149. ASSERT(SGIMC_EEPROM_CSEL); ASSERT(SGIMC_EEPROM_SECLOCK);
  150. for(i = 0; i < 11; i++) {
  151. if(cmd & (1<<15))
  152. ASSERT(SGIMC_EEPROM_SDATAO);
  153. else
  154. DEASSERT(SGIMC_EEPROM_SDATAO);
  155. DEASSERT(SGIMC_EEPROM_SECLOCK);
  156. ASSERT(SGIMC_EEPROM_SECLOCK);
  157. cmd <<= 1;
  158. }
  159. DEASSERT(SGIMC_EEPROM_SDATAO);
  160. for(i = 0; i < (sizeof(unsigned short) * 8); i++) {
  161. unsigned int tmp;
  162. DEASSERT(SGIMC_EEPROM_SECLOCK);
  163. DELAY;
  164. ASSERT(SGIMC_EEPROM_SECLOCK);
  165. DELAY;
  166. data <<= 1;
  167. tmp = *cpu_control;
  168. if(tmp & SGIMC_EEPROM_SDATAI)
  169. data |= 1;
  170. }
  171. DEASSERT(SGIMC_EEPROM_SECLOCK);
  172. DEASSERT(SGIMC_EEPROM_CSEL);
  173. ASSERT(SGIMC_EEPROM_PRE);
  174. ASSERT(SGIMC_EEPROM_SECLOCK);
  175. data <<= PAGE_SHIFT;
  176. if (data == 0)
  177. return 0;
  178. scache_size = data;
  179. printk("R4600/R5000 SCACHE size %ldK, linesize 32 bytes.n",
  180.        scache_size >> 10);
  181. return 1;
  182. }
  183. /* XXX Check with wje if the Indy caches can differenciate between
  184.    writeback + invalidate and just invalidate.  */
  185. struct bcache_ops indy_sc_ops = {
  186. indy_sc_enable,
  187. indy_sc_disable,
  188. indy_sc_wback_invalidate,
  189. indy_sc_wback_invalidate
  190. };
  191. void __init indy_sc_init(void)
  192. {
  193. if (indy_sc_probe()) {
  194. indy_sc_enable();
  195. bcops = &indy_sc_ops;
  196. }
  197. }