sun4c.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:70k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /* $Id: sun4c.c,v 1.210 2001/11/13 03:27:47 davem Exp $
  2.  * sun4c.c: Doing in software what should be done in hardware.
  3.  *
  4.  * Copyright (C) 1996 David S. Miller (davem@caip.rutgers.edu)
  5.  * Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be)
  6.  * Copyright (C) 1996 Andrew Tridgell (Andrew.Tridgell@anu.edu.au)
  7.  * Copyright (C) 1997-2000 Anton Blanchard (anton@samba.org)
  8.  * Copyright (C) 1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
  9.  */
  10. #define NR_TASK_BUCKETS 512
  11. #include <linux/config.h>
  12. #include <linux/kernel.h>
  13. #include <linux/mm.h>
  14. #include <linux/init.h>
  15. #include <linux/bootmem.h>
  16. #include <linux/highmem.h>
  17. #include <linux/fs.h>
  18. #include <linux/seq_file.h>
  19. #include <asm/scatterlist.h>
  20. #include <asm/page.h>
  21. #include <asm/pgalloc.h>
  22. #include <asm/pgtable.h>
  23. #include <asm/vaddrs.h>
  24. #include <asm/idprom.h>
  25. #include <asm/machines.h>
  26. #include <asm/memreg.h>
  27. #include <asm/processor.h>
  28. #include <asm/auxio.h>
  29. #include <asm/io.h>
  30. #include <asm/oplib.h>
  31. #include <asm/openprom.h>
  32. #include <asm/mmu_context.h>
  33. #include <asm/sun4paddr.h>
  34. #include <asm/highmem.h>
  35. /* Because of our dynamic kernel TLB miss strategy, and how
  36.  * our DVMA mapping allocation works, you _MUST_:
  37.  *
  38.  * 1) Disable interrupts _and_ not touch any dynamic kernel
  39.  *    memory while messing with kernel MMU state.  By
  40.  *    dynamic memory I mean any object which is not in
  41.  *    the kernel image itself or a task_struct (both of
  42.  *    which are locked into the MMU).
  43.  * 2) Disable interrupts while messing with user MMU state.
  44.  */
  45. extern int num_segmaps, num_contexts;
  46. extern unsigned long page_kernel;
  47. #ifdef CONFIG_SUN4
  48. #define SUN4C_VAC_SIZE sun4c_vacinfo.num_bytes
  49. #else
  50. /* That's it, we prom_halt() on sun4c if the cache size is something other than 65536.
  51.  * So let's save some cycles and just use that everywhere except for that bootup
  52.  * sanity check.
  53.  */
  54. #define SUN4C_VAC_SIZE 65536
  55. #endif
  56. #define SUN4C_KERNEL_BUCKETS 32
  57. #ifndef MAX
  58. #define MAX(a,b) ((a)<(b)?(b):(a))
  59. #endif
  60. #ifndef MIN
  61. #define MIN(a,b) ((a)<(b)?(a):(b))
  62. #endif
  63. /* Flushing the cache. */
  64. struct sun4c_vac_props sun4c_vacinfo;
  65. unsigned long sun4c_kernel_faults;
  66. /* Invalidate every sun4c cache line tag. */
  67. void sun4c_flush_all(void)
  68. {
  69. unsigned long begin, end;
  70. if (sun4c_vacinfo.on)
  71. panic("SUN4C: AIEEE, trying to invalidate vac while"
  72.                       " it is on.");
  73. /* Clear 'valid' bit in all cache line tags */
  74. begin = AC_CACHETAGS;
  75. end = (AC_CACHETAGS + SUN4C_VAC_SIZE);
  76. while (begin < end) {
  77. __asm__ __volatile__("sta %%g0, [%0] %1nt" : :
  78.      "r" (begin), "i" (ASI_CONTROL));
  79. begin += sun4c_vacinfo.linesize;
  80. }
  81. }
  82. static __inline__ void sun4c_flush_context_hw(void)
  83. {
  84. unsigned long end = SUN4C_VAC_SIZE;
  85. __asm__ __volatile__(
  86. "1: addcc %0, -4096, %0nt"
  87. " bne 1bnt"
  88. "  sta %%g0, [%0] %2"
  89. : "=&r" (end)
  90. : "0" (end), "i" (ASI_HWFLUSHCONTEXT)
  91. : "cc");
  92. }
  93. /* Must be called minimally with IRQs disabled. */
  94. static void sun4c_flush_segment_hw(unsigned long addr)
  95. {
  96. if (sun4c_get_segmap(addr) != invalid_segment) {
  97. unsigned long vac_size = SUN4C_VAC_SIZE;
  98. __asm__ __volatile__(
  99. "1: addcc %0, -4096, %0nt"
  100. " bne 1bnt"
  101. "  sta %%g0, [%2 + %0] %3"
  102. : "=&r" (vac_size)
  103. : "0" (vac_size), "r" (addr), "i" (ASI_HWFLUSHSEG)
  104. : "cc");
  105. }
  106. }
  107. /* Must be called minimally with interrupts disabled. */
  108. static __inline__ void sun4c_flush_page_hw(unsigned long addr)
  109. {
  110. addr &= PAGE_MASK;
  111. if ((int)sun4c_get_pte(addr) < 0)
  112. __asm__ __volatile__("sta %%g0, [%0] %1"
  113.      : : "r" (addr), "i" (ASI_HWFLUSHPAGE));
  114. }
  115. /* Don't inline the software version as it eats too many cache lines if expanded. */
  116. static void sun4c_flush_context_sw(void)
  117. {
  118. unsigned long nbytes = SUN4C_VAC_SIZE;
  119. unsigned long lsize = sun4c_vacinfo.linesize;
  120. __asm__ __volatile__(
  121. "add %2, %2, %%g1nt"
  122. "add %2, %%g1, %%g2nt"
  123. "add %2, %%g2, %%g3nt"
  124. "add %2, %%g3, %%g4nt"
  125. "add %2, %%g4, %%g5nt"
  126. "add %2, %%g5, %%o4nt"
  127. "add %2, %%o4, %%o5n"
  128. "1:nt"
  129. "subcc %0, %%o5, %0nt"
  130. "sta %%g0, [%0] %3nt"
  131. "sta %%g0, [%0 + %2] %3nt"
  132. "sta %%g0, [%0 + %%g1] %3nt"
  133. "sta %%g0, [%0 + %%g2] %3nt"
  134. "sta %%g0, [%0 + %%g3] %3nt"
  135. "sta %%g0, [%0 + %%g4] %3nt"
  136. "sta %%g0, [%0 + %%g5] %3nt"
  137. "bg 1bnt"
  138. " sta %%g0, [%1 + %%o4] %3n"
  139. : "=&r" (nbytes)
  140. : "0" (nbytes), "r" (lsize), "i" (ASI_FLUSHCTX)
  141. : "g1", "g2", "g3", "g4", "g5", "o4", "o5", "cc");
  142. }
  143. /* Don't inline the software version as it eats too many cache lines if expanded. */
  144. static void sun4c_flush_segment_sw(unsigned long addr)
  145. {
  146. if (sun4c_get_segmap(addr) != invalid_segment) {
  147. unsigned long nbytes = SUN4C_VAC_SIZE;
  148. unsigned long lsize = sun4c_vacinfo.linesize;
  149. __asm__ __volatile__(
  150. "add %2, %2, %%g1nt"
  151. "add %2, %%g1, %%g2nt"
  152. "add %2, %%g2, %%g3nt"
  153. "add %2, %%g3, %%g4nt"
  154. "add %2, %%g4, %%g5nt"
  155. "add %2, %%g5, %%o4nt"
  156. "add %2, %%o4, %%o5n"
  157. "1:nt"
  158. "subcc %1, %%o5, %1nt"
  159. "sta %%g0, [%0] %6nt"
  160. "sta %%g0, [%0 + %2] %6nt"
  161. "sta %%g0, [%0 + %%g1] %6nt"
  162. "sta %%g0, [%0 + %%g2] %6nt"
  163. "sta %%g0, [%0 + %%g3] %6nt"
  164. "sta %%g0, [%0 + %%g4] %6nt"
  165. "sta %%g0, [%0 + %%g5] %6nt"
  166. "sta %%g0, [%0 + %%o4] %6nt"
  167. "bg 1bnt"
  168. " add %0, %%o5, %0n"
  169. : "=&r" (addr), "=&r" (nbytes), "=&r" (lsize)
  170. : "0" (addr), "1" (nbytes), "2" (lsize),
  171.   "i" (ASI_FLUSHSEG)
  172. : "g1", "g2", "g3", "g4", "g5", "o4", "o5", "cc");
  173. }
  174. }
  175. /* Bolix one page from the virtual cache. */
  176. static void sun4c_flush_page(unsigned long addr)
  177. {
  178. addr &= PAGE_MASK;
  179. if ((sun4c_get_pte(addr) & (_SUN4C_PAGE_NOCACHE | _SUN4C_PAGE_VALID)) !=
  180.     _SUN4C_PAGE_VALID)
  181. return;
  182. if (sun4c_vacinfo.do_hwflushes) {
  183. __asm__ __volatile__("sta %%g0, [%0] %1;nop;nop;nop;nt" : :
  184.      "r" (addr), "i" (ASI_HWFLUSHPAGE));
  185. } else {
  186. unsigned long left = PAGE_SIZE;
  187. unsigned long lsize = sun4c_vacinfo.linesize;
  188. __asm__ __volatile__("add %2, %2, %%g1nt"
  189.      "add %2, %%g1, %%g2nt"
  190.      "add %2, %%g2, %%g3nt"
  191.      "add %2, %%g3, %%g4nt"
  192.      "add %2, %%g4, %%g5nt"
  193.      "add %2, %%g5, %%o4nt"
  194.      "add %2, %%o4, %%o5n"
  195.      "1:nt"
  196.      "subcc %1, %%o5, %1nt"
  197.      "sta %%g0, [%0] %6nt"
  198.      "sta %%g0, [%0 + %2] %6nt"
  199.      "sta %%g0, [%0 + %%g1] %6nt"
  200.      "sta %%g0, [%0 + %%g2] %6nt"
  201.      "sta %%g0, [%0 + %%g3] %6nt"
  202.      "sta %%g0, [%0 + %%g4] %6nt"
  203.      "sta %%g0, [%0 + %%g5] %6nt"
  204.      "sta %%g0, [%0 + %%o4] %6nt"
  205.      "bg 1bnt"
  206.      " add %0, %%o5, %0nt"
  207.      : "=&r" (addr), "=&r" (left), "=&r" (lsize)
  208.      : "0" (addr), "1" (left), "2" (lsize),
  209.        "i" (ASI_FLUSHPG)
  210.      : "g1", "g2", "g3", "g4", "g5", "o4", "o5", "cc");
  211. }
  212. }
  213. /* Don't inline the software version as it eats too many cache lines if expanded. */
  214. static void sun4c_flush_page_sw(unsigned long addr)
  215. {
  216. addr &= PAGE_MASK;
  217. if ((sun4c_get_pte(addr) & (_SUN4C_PAGE_NOCACHE | _SUN4C_PAGE_VALID)) ==
  218.     _SUN4C_PAGE_VALID) {
  219. unsigned long left = PAGE_SIZE;
  220. unsigned long lsize = sun4c_vacinfo.linesize;
  221. __asm__ __volatile__(
  222. "add %2, %2, %%g1nt"
  223. "add %2, %%g1, %%g2nt"
  224. "add %2, %%g2, %%g3nt"
  225. "add %2, %%g3, %%g4nt"
  226. "add %2, %%g4, %%g5nt"
  227. "add %2, %%g5, %%o4nt"
  228. "add %2, %%o4, %%o5n"
  229. "1:nt"
  230. "subcc %1, %%o5, %1nt"
  231. "sta %%g0, [%0] %6nt"
  232. "sta %%g0, [%0 + %2] %6nt"
  233. "sta %%g0, [%0 + %%g1] %6nt"
  234. "sta %%g0, [%0 + %%g2] %6nt"
  235. "sta %%g0, [%0 + %%g3] %6nt"
  236. "sta %%g0, [%0 + %%g4] %6nt"
  237. "sta %%g0, [%0 + %%g5] %6nt"
  238. "sta %%g0, [%0 + %%o4] %6nt"
  239. "bg 1bnt"
  240. " add %0, %%o5, %0n"
  241. : "=&r" (addr), "=&r" (left), "=&r" (lsize)
  242. : "0" (addr), "1" (left), "2" (lsize),
  243.   "i" (ASI_FLUSHPG)
  244. : "g1", "g2", "g3", "g4", "g5", "o4", "o5", "cc");
  245. }
  246. }
  247. /* The sun4c's do have an on chip store buffer.  And the way you
  248.  * clear them out isn't so obvious.  The only way I can think of
  249.  * to accomplish this is to read the current context register,
  250.  * store the same value there, then read an external hardware
  251.  * register.
  252.  */
  253. void sun4c_complete_all_stores(void)
  254. {
  255. volatile int _unused;
  256. _unused = sun4c_get_context();
  257. sun4c_set_context(_unused);
  258. #ifdef CONFIG_SUN_AUXIO
  259. _unused = *AUXREG;
  260. #endif
  261. }
  262. /* Bootup utility functions. */
  263. static inline void sun4c_init_clean_segmap(unsigned char pseg)
  264. {
  265. unsigned long vaddr;
  266. sun4c_put_segmap(0, pseg);
  267. for (vaddr = 0; vaddr < SUN4C_REAL_PGDIR_SIZE; vaddr += PAGE_SIZE)
  268. sun4c_put_pte(vaddr, 0);
  269. sun4c_put_segmap(0, invalid_segment);
  270. }
  271. static inline void sun4c_init_clean_mmu(unsigned long kernel_end)
  272. {
  273. unsigned long vaddr;
  274. unsigned char savectx, ctx;
  275. savectx = sun4c_get_context();
  276. kernel_end = SUN4C_REAL_PGDIR_ALIGN(kernel_end);
  277. for (ctx = 0; ctx < num_contexts; ctx++) {
  278. sun4c_set_context(ctx);
  279. for (vaddr = 0; vaddr < 0x20000000; vaddr += SUN4C_REAL_PGDIR_SIZE)
  280. sun4c_put_segmap(vaddr, invalid_segment);
  281. for (vaddr = 0xe0000000; vaddr < KERNBASE; vaddr += SUN4C_REAL_PGDIR_SIZE)
  282. sun4c_put_segmap(vaddr, invalid_segment);
  283. for (vaddr = kernel_end; vaddr < KADB_DEBUGGER_BEGVM; vaddr += SUN4C_REAL_PGDIR_SIZE)
  284. sun4c_put_segmap(vaddr, invalid_segment);
  285. for (vaddr = LINUX_OPPROM_ENDVM; vaddr; vaddr += SUN4C_REAL_PGDIR_SIZE)
  286. sun4c_put_segmap(vaddr, invalid_segment);
  287. }
  288. sun4c_set_context(savectx);
  289. }
  290. void __init sun4c_probe_vac(void)
  291. {
  292. sun4c_disable_vac();
  293. if (ARCH_SUN4) {
  294. switch (idprom->id_machtype) {
  295. case (SM_SUN4|SM_4_110):
  296. sun4c_vacinfo.type = NONE;
  297. sun4c_vacinfo.num_bytes = 0;
  298. sun4c_vacinfo.linesize = 0;
  299. sun4c_vacinfo.do_hwflushes = 0;
  300. prom_printf("No VAC. Get some bucks and buy a real computer.");
  301. prom_halt();
  302. break;
  303. case (SM_SUN4|SM_4_260):
  304. sun4c_vacinfo.type = WRITE_BACK;
  305. sun4c_vacinfo.num_bytes = 128 * 1024;
  306. sun4c_vacinfo.linesize = 16;
  307. sun4c_vacinfo.do_hwflushes = 0;
  308. break;
  309. case (SM_SUN4|SM_4_330):
  310. sun4c_vacinfo.type = WRITE_THROUGH;
  311. sun4c_vacinfo.num_bytes = 128 * 1024;
  312. sun4c_vacinfo.linesize = 16;
  313. sun4c_vacinfo.do_hwflushes = 0;
  314. break;
  315. case (SM_SUN4|SM_4_470):
  316. sun4c_vacinfo.type = WRITE_BACK;
  317. sun4c_vacinfo.num_bytes = 128 * 1024;
  318. sun4c_vacinfo.linesize = 32;
  319. sun4c_vacinfo.do_hwflushes = 0;
  320. break;
  321. default:
  322. prom_printf("Cannot initialize VAC - weird sun4 model idprom->id_machtype = %d", idprom->id_machtype);
  323. prom_halt();
  324. };
  325. } else {
  326. sun4c_vacinfo.type = WRITE_THROUGH;
  327. if ((idprom->id_machtype == (SM_SUN4C | SM_4C_SS1)) ||
  328.     (idprom->id_machtype == (SM_SUN4C | SM_4C_SS1PLUS))) {
  329. /* PROM on SS1 lacks this info, to be super safe we
  330.  * hard code it here since this arch is cast in stone.
  331.  */
  332. sun4c_vacinfo.num_bytes = 65536;
  333. sun4c_vacinfo.linesize = 16;
  334. } else {
  335. sun4c_vacinfo.num_bytes =
  336.  prom_getintdefault(prom_root_node, "vac-size", 65536);
  337. sun4c_vacinfo.linesize =
  338.  prom_getintdefault(prom_root_node, "vac-linesize", 16);
  339. }
  340. sun4c_vacinfo.do_hwflushes =
  341.  prom_getintdefault(prom_root_node, "vac-hwflush", 0);
  342. if (sun4c_vacinfo.do_hwflushes == 0)
  343. sun4c_vacinfo.do_hwflushes =
  344.  prom_getintdefault(prom_root_node, "vac_hwflush", 0);
  345. if (sun4c_vacinfo.num_bytes != 65536) {
  346. prom_printf("WEIRD Sun4C VAC cache size, tell davem");
  347. prom_halt();
  348. }
  349. }
  350. sun4c_vacinfo.num_lines =
  351. (sun4c_vacinfo.num_bytes / sun4c_vacinfo.linesize);
  352. switch (sun4c_vacinfo.linesize) {
  353. case 16:
  354. sun4c_vacinfo.log2lsize = 4;
  355. break;
  356. case 32:
  357. sun4c_vacinfo.log2lsize = 5;
  358. break;
  359. default:
  360. prom_printf("probe_vac: Didn't expect vac-linesize of %d, haltingn",
  361.     sun4c_vacinfo.linesize);
  362. prom_halt();
  363. };
  364. sun4c_flush_all();
  365. sun4c_enable_vac();
  366. }
  367. /* Patch instructions for the low level kernel fault handler. */
  368. extern unsigned long invalid_segment_patch1, invalid_segment_patch1_ff;
  369. extern unsigned long invalid_segment_patch2, invalid_segment_patch2_ff;
  370. extern unsigned long invalid_segment_patch1_1ff, invalid_segment_patch2_1ff;
  371. extern unsigned long num_context_patch1, num_context_patch1_16;
  372. extern unsigned long num_context_patch2, num_context_patch2_16;
  373. extern unsigned long vac_linesize_patch, vac_linesize_patch_32;
  374. extern unsigned long vac_hwflush_patch1, vac_hwflush_patch1_on;
  375. extern unsigned long vac_hwflush_patch2, vac_hwflush_patch2_on;
  376. #define PATCH_INSN(src, dst) do {
  377. daddr = &(dst);
  378. iaddr = &(src);
  379. *daddr = *iaddr;
  380. } while (0);
  381. static void patch_kernel_fault_handler(void)
  382. {
  383. unsigned long *iaddr, *daddr;
  384. switch (num_segmaps) {
  385. case 128:
  386. /* Default, nothing to do. */
  387. break;
  388. case 256:
  389. PATCH_INSN(invalid_segment_patch1_ff,
  390.    invalid_segment_patch1);
  391. PATCH_INSN(invalid_segment_patch2_ff,
  392.    invalid_segment_patch2);
  393. break;
  394. case 512:
  395. PATCH_INSN(invalid_segment_patch1_1ff,
  396.    invalid_segment_patch1);
  397. PATCH_INSN(invalid_segment_patch2_1ff,
  398.    invalid_segment_patch2);
  399. break;
  400. default:
  401. prom_printf("Unhandled number of segmaps: %dn",
  402.     num_segmaps);
  403. prom_halt();
  404. };
  405. switch (num_contexts) {
  406. case 8:
  407. /* Default, nothing to do. */
  408. break;
  409. case 16:
  410. PATCH_INSN(num_context_patch1_16,
  411.    num_context_patch1);
  412. #if 0
  413. PATCH_INSN(num_context_patch2_16,
  414.    num_context_patch2);
  415. #endif
  416. break;
  417. default:
  418. prom_printf("Unhandled number of contexts: %dn",
  419.     num_contexts);
  420. prom_halt();
  421. };
  422. if (sun4c_vacinfo.do_hwflushes != 0) {
  423. PATCH_INSN(vac_hwflush_patch1_on, vac_hwflush_patch1);
  424. PATCH_INSN(vac_hwflush_patch2_on, vac_hwflush_patch2);
  425. } else {
  426. switch (sun4c_vacinfo.linesize) {
  427. case 16:
  428. /* Default, nothing to do. */
  429. break;
  430. case 32:
  431. PATCH_INSN(vac_linesize_patch_32, vac_linesize_patch);
  432. break;
  433. default:
  434. prom_printf("Impossible VAC linesize %d, halting...n",
  435.     sun4c_vacinfo.linesize);
  436. prom_halt();
  437. };
  438. }
  439. }
  440. static void __init sun4c_probe_mmu(void)
  441. {
  442. if (ARCH_SUN4) {
  443. switch (idprom->id_machtype) {
  444. case (SM_SUN4|SM_4_110):
  445. prom_printf("No support for 4100 yetn");
  446. prom_halt();
  447. num_segmaps = 256;
  448. num_contexts = 8;
  449. break;
  450. case (SM_SUN4|SM_4_260):
  451. /* should be 512 segmaps. when it get fixed */
  452. num_segmaps = 256;
  453. num_contexts = 16;
  454. break;
  455. case (SM_SUN4|SM_4_330):
  456. num_segmaps = 256;
  457. num_contexts = 16;
  458. break;
  459. case (SM_SUN4|SM_4_470):
  460. /* should be 1024 segmaps. when it get fixed */
  461. num_segmaps = 256;
  462. num_contexts = 64;
  463. break;
  464. default:
  465. prom_printf("Invalid SUN4 modeln");
  466. prom_halt();
  467. };
  468. } else {
  469. if ((idprom->id_machtype == (SM_SUN4C | SM_4C_SS1)) ||
  470.     (idprom->id_machtype == (SM_SUN4C | SM_4C_SS1PLUS))) {
  471. /* Hardcode these just to be safe, PROM on SS1 does
  472.   * not have this info available in the root node.
  473.   */
  474. num_segmaps = 128;
  475. num_contexts = 8;
  476. } else {
  477. num_segmaps =
  478.     prom_getintdefault(prom_root_node, "mmu-npmg", 128);
  479. num_contexts =
  480.     prom_getintdefault(prom_root_node, "mmu-nctx", 0x8);
  481. }
  482. }
  483. patch_kernel_fault_handler();
  484. }
  485. volatile unsigned long *sun4c_memerr_reg = 0;
  486. void __init sun4c_probe_memerr_reg(void)
  487. {
  488. int node;
  489. struct linux_prom_registers regs[1];
  490. if (ARCH_SUN4) {
  491. sun4c_memerr_reg = ioremap(sun4_memreg_physaddr, PAGE_SIZE);
  492. } else {
  493. node = prom_getchild(prom_root_node);
  494. node = prom_searchsiblings(prom_root_node, "memory-error");
  495. if (!node)
  496. return;
  497. prom_getproperty(node, "reg", (char *)regs, sizeof(regs));
  498. /* hmm I think regs[0].which_io is zero here anyways */
  499. sun4c_memerr_reg = ioremap(regs[0].phys_addr, regs[0].reg_size);
  500. }
  501. }
  502. static inline void sun4c_init_ss2_cache_bug(void)
  503. {
  504. extern unsigned long start;
  505. if ((idprom->id_machtype == (SM_SUN4C | SM_4C_SS2)) ||
  506.     (idprom->id_machtype == (SM_SUN4C | SM_4C_IPX)) ||
  507.     (idprom->id_machtype == (SM_SUN4 | SM_4_330)) ||
  508.     (idprom->id_machtype == (SM_SUN4C | SM_4C_ELC))) {
  509. /* Whee.. */
  510. printk("SS2 cache bug detected, uncaching trap table pagen");
  511. sun4c_flush_page((unsigned int) &start);
  512. sun4c_put_pte(((unsigned long) &start),
  513. (sun4c_get_pte((unsigned long) &start) | _SUN4C_PAGE_NOCACHE));
  514. }
  515. }
  516. /* Addr is always aligned on a page boundry for us already. */
  517. static void sun4c_map_dma_area(unsigned long va, u32 addr, int len)
  518. {
  519. unsigned long page, end;
  520. end = PAGE_ALIGN((addr + len));
  521. while (addr < end) {
  522. page = va;
  523. sun4c_flush_page(page);
  524. page -= PAGE_OFFSET;
  525. page >>= PAGE_SHIFT;
  526. page |= (_SUN4C_PAGE_VALID | _SUN4C_PAGE_DIRTY |
  527.  _SUN4C_PAGE_NOCACHE | _SUN4C_PAGE_PRIV);
  528. sun4c_put_pte(addr, page);
  529. addr += PAGE_SIZE;
  530. va += PAGE_SIZE;
  531. }
  532. }
  533. static unsigned long sun4c_translate_dvma(unsigned long busa)
  534. {
  535. /* Fortunately for us, bus_addr == uncached_virt in sun4c. */
  536. unsigned long pte = sun4c_get_pte(busa);
  537. return (pte << PAGE_SHIFT) + PAGE_OFFSET;
  538. }
  539. static void sun4c_unmap_dma_area(unsigned long busa, int len)
  540. {
  541. /* Fortunately for us, bus_addr == uncached_virt in sun4c. */
  542. /* XXX Implement this */
  543. }
  544. /* TLB management. */
  545. /* Don't change this struct without changing entry.S. This is used
  546.  * in the in-window kernel fault handler, and you don't want to mess
  547.  * with that. (See sun4c_fault in entry.S).
  548.  */
  549. struct sun4c_mmu_entry {
  550. struct sun4c_mmu_entry *next;
  551. struct sun4c_mmu_entry *prev;
  552. unsigned long vaddr;
  553. unsigned char pseg;
  554. unsigned char locked;
  555. /* For user mappings only, and completely hidden from kernel
  556.  * TLB miss code.
  557.  */
  558. unsigned char ctx;
  559. struct sun4c_mmu_entry *lru_next;
  560. struct sun4c_mmu_entry *lru_prev;
  561. };
  562. static struct sun4c_mmu_entry mmu_entry_pool[SUN4C_MAX_SEGMAPS];
  563. static void __init sun4c_init_mmu_entry_pool(void)
  564. {
  565. int i;
  566. for (i=0; i < SUN4C_MAX_SEGMAPS; i++) {
  567. mmu_entry_pool[i].pseg = i;
  568. mmu_entry_pool[i].next = 0;
  569. mmu_entry_pool[i].prev = 0;
  570. mmu_entry_pool[i].vaddr = 0;
  571. mmu_entry_pool[i].locked = 0;
  572. mmu_entry_pool[i].ctx = 0;
  573. mmu_entry_pool[i].lru_next = 0;
  574. mmu_entry_pool[i].lru_prev = 0;
  575. }
  576. mmu_entry_pool[invalid_segment].locked = 1;
  577. }
  578. static inline void fix_permissions(unsigned long vaddr, unsigned long bits_on,
  579.    unsigned long bits_off)
  580. {
  581. unsigned long start, end;
  582. end = vaddr + SUN4C_REAL_PGDIR_SIZE;
  583. for (start = vaddr; start < end; start += PAGE_SIZE)
  584. if (sun4c_get_pte(start) & _SUN4C_PAGE_VALID)
  585. sun4c_put_pte(start, (sun4c_get_pte(start) | bits_on) &
  586.       ~bits_off);
  587. }
  588. static inline void sun4c_init_map_kernelprom(unsigned long kernel_end)
  589. {
  590. unsigned long vaddr;
  591. unsigned char pseg, ctx;
  592. #ifdef CONFIG_SUN4
  593. /* sun4/110 and 260 have no kadb. */
  594. if ((idprom->id_machtype != (SM_SUN4 | SM_4_260)) && 
  595.     (idprom->id_machtype != (SM_SUN4 | SM_4_110))) {
  596. #endif
  597. for (vaddr = KADB_DEBUGGER_BEGVM;
  598.      vaddr < LINUX_OPPROM_ENDVM;
  599.      vaddr += SUN4C_REAL_PGDIR_SIZE) {
  600. pseg = sun4c_get_segmap(vaddr);
  601. if (pseg != invalid_segment) {
  602. mmu_entry_pool[pseg].locked = 1;
  603. for (ctx = 0; ctx < num_contexts; ctx++)
  604. prom_putsegment(ctx, vaddr, pseg);
  605. fix_permissions(vaddr, _SUN4C_PAGE_PRIV, 0);
  606. }
  607. }
  608. #ifdef CONFIG_SUN4
  609. }
  610. #endif
  611. for (vaddr = KERNBASE; vaddr < kernel_end; vaddr += SUN4C_REAL_PGDIR_SIZE) {
  612. pseg = sun4c_get_segmap(vaddr);
  613. mmu_entry_pool[pseg].locked = 1;
  614. for (ctx = 0; ctx < num_contexts; ctx++)
  615. prom_putsegment(ctx, vaddr, pseg);
  616. fix_permissions(vaddr, _SUN4C_PAGE_PRIV, _SUN4C_PAGE_NOCACHE);
  617. }
  618. }
  619. static void __init sun4c_init_lock_area(unsigned long start, unsigned long end)
  620. {
  621. int i, ctx;
  622. while (start < end) {
  623. for (i = 0; i < invalid_segment; i++)
  624. if (!mmu_entry_pool[i].locked)
  625. break;
  626. mmu_entry_pool[i].locked = 1;
  627. sun4c_init_clean_segmap(i);
  628. for (ctx = 0; ctx < num_contexts; ctx++)
  629. prom_putsegment(ctx, start, mmu_entry_pool[i].pseg);
  630. start += SUN4C_REAL_PGDIR_SIZE;
  631. }
  632. }
  633. /* Don't change this struct without changing entry.S. This is used
  634.  * in the in-window kernel fault handler, and you don't want to mess
  635.  * with that. (See sun4c_fault in entry.S).
  636.  */
  637. struct sun4c_mmu_ring {
  638. struct sun4c_mmu_entry ringhd;
  639. int num_entries;
  640. };
  641. static struct sun4c_mmu_ring sun4c_context_ring[SUN4C_MAX_CONTEXTS]; /* used user entries */
  642. static struct sun4c_mmu_ring sun4c_ufree_ring;       /* free user entries */
  643. static struct sun4c_mmu_ring sun4c_ulru_ring;      /* LRU user entries */
  644. struct sun4c_mmu_ring sun4c_kernel_ring;      /* used kernel entries */
  645. struct sun4c_mmu_ring sun4c_kfree_ring;       /* free kernel entries */
  646. static inline void sun4c_init_rings(void)
  647. {
  648. int i;
  649. for (i = 0; i < SUN4C_MAX_CONTEXTS; i++) {
  650. sun4c_context_ring[i].ringhd.next =
  651. sun4c_context_ring[i].ringhd.prev =
  652. &sun4c_context_ring[i].ringhd;
  653. sun4c_context_ring[i].num_entries = 0;
  654. }
  655. sun4c_ufree_ring.ringhd.next = sun4c_ufree_ring.ringhd.prev =
  656. &sun4c_ufree_ring.ringhd;
  657. sun4c_ufree_ring.num_entries = 0;
  658. sun4c_ulru_ring.ringhd.lru_next = sun4c_ulru_ring.ringhd.lru_prev =
  659. &sun4c_ulru_ring.ringhd;
  660. sun4c_ulru_ring.num_entries = 0;
  661. sun4c_kernel_ring.ringhd.next = sun4c_kernel_ring.ringhd.prev =
  662. &sun4c_kernel_ring.ringhd;
  663. sun4c_kernel_ring.num_entries = 0;
  664. sun4c_kfree_ring.ringhd.next = sun4c_kfree_ring.ringhd.prev =
  665. &sun4c_kfree_ring.ringhd;
  666. sun4c_kfree_ring.num_entries = 0;
  667. }
  668. static void add_ring(struct sun4c_mmu_ring *ring,
  669.      struct sun4c_mmu_entry *entry)
  670. {
  671. struct sun4c_mmu_entry *head = &ring->ringhd;
  672. entry->prev = head;
  673. (entry->next = head->next)->prev = entry;
  674. head->next = entry;
  675. ring->num_entries++;
  676. }
  677. static __inline__ void add_lru(struct sun4c_mmu_entry *entry)
  678. {
  679. struct sun4c_mmu_ring *ring = &sun4c_ulru_ring;
  680. struct sun4c_mmu_entry *head = &ring->ringhd;
  681. entry->lru_next = head;
  682. (entry->lru_prev = head->lru_prev)->lru_next = entry;
  683. head->lru_prev = entry;
  684. }
  685. static void add_ring_ordered(struct sun4c_mmu_ring *ring,
  686.      struct sun4c_mmu_entry *entry)
  687. {
  688. struct sun4c_mmu_entry *head = &ring->ringhd;
  689. unsigned long addr = entry->vaddr;
  690. while ((head->next != &ring->ringhd) && (head->next->vaddr < addr))
  691. head = head->next;
  692. entry->prev = head;
  693. (entry->next = head->next)->prev = entry;
  694. head->next = entry;
  695. ring->num_entries++;
  696. add_lru(entry);
  697. }
  698. static __inline__ void remove_ring(struct sun4c_mmu_ring *ring,
  699.    struct sun4c_mmu_entry *entry)
  700. {
  701. struct sun4c_mmu_entry *next = entry->next;
  702. (next->prev = entry->prev)->next = next;
  703. ring->num_entries--;
  704. }
  705. static void remove_lru(struct sun4c_mmu_entry *entry)
  706. {
  707. struct sun4c_mmu_entry *next = entry->lru_next;
  708. (next->lru_prev = entry->lru_prev)->lru_next = next;
  709. }
  710. static void free_user_entry(int ctx, struct sun4c_mmu_entry *entry)
  711. {
  712.         remove_ring(sun4c_context_ring+ctx, entry);
  713. remove_lru(entry);
  714.         add_ring(&sun4c_ufree_ring, entry);
  715. }
  716. static void free_kernel_entry(struct sun4c_mmu_entry *entry,
  717.       struct sun4c_mmu_ring *ring)
  718. {
  719.         remove_ring(ring, entry);
  720.         add_ring(&sun4c_kfree_ring, entry);
  721. }
  722. static void __init sun4c_init_fill_kernel_ring(int howmany)
  723. {
  724. int i;
  725. while (howmany) {
  726. for (i = 0; i < invalid_segment; i++)
  727. if (!mmu_entry_pool[i].locked)
  728. break;
  729. mmu_entry_pool[i].locked = 1;
  730. sun4c_init_clean_segmap(i);
  731. add_ring(&sun4c_kfree_ring, &mmu_entry_pool[i]);
  732. howmany--;
  733. }
  734. }
  735. static void __init sun4c_init_fill_user_ring(void)
  736. {
  737. int i;
  738. for (i = 0; i < invalid_segment; i++) {
  739. if (mmu_entry_pool[i].locked)
  740. continue;
  741. sun4c_init_clean_segmap(i);
  742. add_ring(&sun4c_ufree_ring, &mmu_entry_pool[i]);
  743. }
  744. }
  745. static void sun4c_kernel_unmap(struct sun4c_mmu_entry *kentry)
  746. {
  747. int savectx, ctx;
  748. savectx = sun4c_get_context();
  749. for (ctx = 0; ctx < num_contexts; ctx++) {
  750. sun4c_set_context(ctx);
  751. sun4c_put_segmap(kentry->vaddr, invalid_segment);
  752. }
  753. sun4c_set_context(savectx);
  754. }
  755. static void sun4c_kernel_map(struct sun4c_mmu_entry *kentry)
  756. {
  757. int savectx, ctx;
  758. savectx = sun4c_get_context();
  759. for (ctx = 0; ctx < num_contexts; ctx++) {
  760. sun4c_set_context(ctx);
  761. sun4c_put_segmap(kentry->vaddr, kentry->pseg);
  762. }
  763. sun4c_set_context(savectx);
  764. }
  765. #define sun4c_user_unmap(__entry) 
  766. sun4c_put_segmap((__entry)->vaddr, invalid_segment)
  767. static void sun4c_demap_context_hw(struct sun4c_mmu_ring *crp, unsigned char ctx)
  768. {
  769. struct sun4c_mmu_entry *head = &crp->ringhd;
  770. unsigned long flags;
  771. save_and_cli(flags);
  772. if (head->next != head) {
  773. struct sun4c_mmu_entry *entry = head->next;
  774. int savectx = sun4c_get_context();
  775. flush_user_windows();
  776. sun4c_set_context(ctx);
  777. sun4c_flush_context_hw();
  778. do {
  779. struct sun4c_mmu_entry *next = entry->next;
  780. sun4c_user_unmap(entry);
  781. free_user_entry(ctx, entry);
  782. entry = next;
  783. } while (entry != head);
  784. sun4c_set_context(savectx);
  785. }
  786. restore_flags(flags);
  787. }
  788. static void sun4c_demap_context_sw(struct sun4c_mmu_ring *crp, unsigned char ctx)
  789. {
  790. struct sun4c_mmu_entry *head = &crp->ringhd;
  791. unsigned long flags;
  792. save_and_cli(flags);
  793. if (head->next != head) {
  794. struct sun4c_mmu_entry *entry = head->next;
  795. int savectx = sun4c_get_context();
  796. flush_user_windows();
  797. sun4c_set_context(ctx);
  798. sun4c_flush_context_sw();
  799. do {
  800. struct sun4c_mmu_entry *next = entry->next;
  801. sun4c_user_unmap(entry);
  802. free_user_entry(ctx, entry);
  803. entry = next;
  804. } while (entry != head);
  805. sun4c_set_context(savectx);
  806. }
  807. restore_flags(flags);
  808. }
  809. static int sun4c_user_taken_entries = 0;  /* This is how much we have.             */
  810. static int max_user_taken_entries = 0;    /* This limits us and prevents deadlock. */
  811. static struct sun4c_mmu_entry *sun4c_kernel_strategy(void)
  812. {
  813. struct sun4c_mmu_entry *this_entry;
  814. /* If some are free, return first one. */
  815. if (sun4c_kfree_ring.num_entries) {
  816. this_entry = sun4c_kfree_ring.ringhd.next;
  817. return this_entry;
  818. }
  819. /* Else free one up. */
  820. this_entry = sun4c_kernel_ring.ringhd.prev;
  821. if (sun4c_vacinfo.do_hwflushes)
  822. sun4c_flush_segment_hw(this_entry->vaddr);
  823. else
  824. sun4c_flush_segment_sw(this_entry->vaddr);
  825. sun4c_kernel_unmap(this_entry);
  826. free_kernel_entry(this_entry, &sun4c_kernel_ring);
  827. this_entry = sun4c_kfree_ring.ringhd.next;
  828. return this_entry;
  829. }
  830. /* Using this method to free up mmu entries eliminates a lot of
  831.  * potential races since we have a kernel that incurs tlb
  832.  * replacement faults.  There may be performance penalties.
  833.  *
  834.  * NOTE: Must be called with interrupts disabled.
  835.  */
  836. static struct sun4c_mmu_entry *sun4c_user_strategy(void)
  837. {
  838. struct sun4c_mmu_entry *entry;
  839. unsigned char ctx;
  840. int savectx;
  841. /* If some are free, return first one. */
  842. if (sun4c_ufree_ring.num_entries) {
  843. entry = sun4c_ufree_ring.ringhd.next;
  844. goto unlink_out;
  845. }
  846. if (sun4c_user_taken_entries) {
  847. entry = sun4c_kernel_strategy();
  848. sun4c_user_taken_entries--;
  849. goto kunlink_out;
  850. }
  851. /* Grab from the beginning of the LRU list. */
  852. entry = sun4c_ulru_ring.ringhd.lru_next;
  853. ctx = entry->ctx;
  854. savectx = sun4c_get_context();
  855. flush_user_windows();
  856. sun4c_set_context(ctx);
  857. if (sun4c_vacinfo.do_hwflushes)
  858. sun4c_flush_segment_hw(entry->vaddr);
  859. else
  860. sun4c_flush_segment_sw(entry->vaddr);
  861. sun4c_user_unmap(entry);
  862. remove_ring(sun4c_context_ring + ctx, entry);
  863. remove_lru(entry);
  864. sun4c_set_context(savectx);
  865. return entry;
  866. unlink_out:
  867. remove_ring(&sun4c_ufree_ring, entry);
  868. return entry;
  869. kunlink_out:
  870. remove_ring(&sun4c_kfree_ring, entry);
  871. return entry;
  872. }
  873. /* NOTE: Must be called with interrupts disabled. */
  874. void sun4c_grow_kernel_ring(void)
  875. {
  876. struct sun4c_mmu_entry *entry;
  877. /* Prevent deadlock condition. */
  878. if (sun4c_user_taken_entries >= max_user_taken_entries)
  879. return;
  880. if (sun4c_ufree_ring.num_entries) {
  881. entry = sun4c_ufree_ring.ringhd.next;
  882.          remove_ring(&sun4c_ufree_ring, entry);
  883. add_ring(&sun4c_kfree_ring, entry);
  884. sun4c_user_taken_entries++;
  885. }
  886. }
  887. /* 2 page buckets for task struct and kernel stack allocation.
  888.  *
  889.  * TASK_STACK_BEGIN
  890.  * bucket[0]
  891.  * bucket[1]
  892.  *   [ ... ]
  893.  * bucket[NR_TASK_BUCKETS-1]
  894.  * TASK_STACK_BEGIN + (sizeof(struct task_bucket) * NR_TASK_BUCKETS)
  895.  *
  896.  * Each slot looks like:
  897.  *
  898.  *  page 1 --  task struct + beginning of kernel stack
  899.  *  page 2 --  rest of kernel stack
  900.  */
  901. union task_union *sun4c_bucket[NR_TASK_BUCKETS];
  902. static int sun4c_lowbucket_avail;
  903. #define BUCKET_EMPTY     ((union task_union *) 0)
  904. #define BUCKET_SHIFT     (PAGE_SHIFT + 1)        /* log2(sizeof(struct task_bucket)) */
  905. #define BUCKET_SIZE      (1 << BUCKET_SHIFT)
  906. #define BUCKET_NUM(addr) ((((addr) - SUN4C_LOCK_VADDR) >> BUCKET_SHIFT))
  907. #define BUCKET_ADDR(num) (((num) << BUCKET_SHIFT) + SUN4C_LOCK_VADDR)
  908. #define BUCKET_PTE(page)       
  909.         ((((page) - PAGE_OFFSET) >> PAGE_SHIFT) | pgprot_val(SUN4C_PAGE_KERNEL))
  910. #define BUCKET_PTE_PAGE(pte)   
  911.         (PAGE_OFFSET + (((pte) & SUN4C_PFN_MASK) << PAGE_SHIFT))
  912. static void get_locked_segment(unsigned long addr)
  913. {
  914. struct sun4c_mmu_entry *stolen;
  915. unsigned long flags;
  916. save_and_cli(flags);
  917. addr &= SUN4C_REAL_PGDIR_MASK;
  918. stolen = sun4c_user_strategy();
  919. max_user_taken_entries--;
  920. stolen->vaddr = addr;
  921. flush_user_windows();
  922. sun4c_kernel_map(stolen);
  923. restore_flags(flags);
  924. }
  925. static void free_locked_segment(unsigned long addr)
  926. {
  927. struct sun4c_mmu_entry *entry;
  928. unsigned long flags;
  929. unsigned char pseg;
  930. save_and_cli(flags);
  931. addr &= SUN4C_REAL_PGDIR_MASK;
  932. pseg = sun4c_get_segmap(addr);
  933. entry = &mmu_entry_pool[pseg];
  934. flush_user_windows();
  935. if (sun4c_vacinfo.do_hwflushes)
  936. sun4c_flush_segment_hw(addr);
  937. else
  938. sun4c_flush_segment_sw(addr);
  939. sun4c_kernel_unmap(entry);
  940. add_ring(&sun4c_ufree_ring, entry);
  941. max_user_taken_entries++;
  942. restore_flags(flags);
  943. }
  944. static inline void garbage_collect(int entry)
  945. {
  946. int start, end;
  947. /* 32 buckets per segment... */
  948. entry &= ~31;
  949. start = entry;
  950. for (end = (start + 32); start < end; start++)
  951. if (sun4c_bucket[start] != BUCKET_EMPTY)
  952. return;
  953. /* Entire segment empty, release it. */
  954. free_locked_segment(BUCKET_ADDR(entry));
  955. }
  956. #ifdef CONFIG_SUN4
  957. #define TASK_STRUCT_ORDER 0
  958. #else
  959. #define TASK_STRUCT_ORDER 1
  960. #endif
  961. static struct task_struct *sun4c_alloc_task_struct(void)
  962. {
  963. unsigned long addr, pages;
  964. int entry;
  965. pages = __get_free_pages(GFP_KERNEL, TASK_STRUCT_ORDER);
  966. if (!pages)
  967. return (struct task_struct *) 0;
  968. for (entry = sun4c_lowbucket_avail; entry < NR_TASK_BUCKETS; entry++)
  969. if (sun4c_bucket[entry] == BUCKET_EMPTY)
  970. break;
  971. if (entry == NR_TASK_BUCKETS) {
  972. free_pages(pages, TASK_STRUCT_ORDER);
  973. return (struct task_struct *) 0;
  974. }
  975. if (entry >= sun4c_lowbucket_avail)
  976. sun4c_lowbucket_avail = entry + 1;
  977. addr = BUCKET_ADDR(entry);
  978. sun4c_bucket[entry] = (union task_union *) addr;
  979. if(sun4c_get_segmap(addr) == invalid_segment)
  980. get_locked_segment(addr);
  981. /* We are changing the virtual color of the page(s)
  982.  * so we must flush the cache to guarentee consistancy.
  983.  */
  984. if (sun4c_vacinfo.do_hwflushes) {
  985. sun4c_flush_page_hw(pages);
  986. #ifndef CONFIG_SUN4
  987. sun4c_flush_page_hw(pages + PAGE_SIZE);
  988. #endif
  989. } else {
  990. sun4c_flush_page_sw(pages);
  991. #ifndef CONFIG_SUN4
  992. sun4c_flush_page_sw(pages + PAGE_SIZE);
  993. #endif
  994. }
  995. sun4c_put_pte(addr, BUCKET_PTE(pages));
  996. #ifndef CONFIG_SUN4
  997. sun4c_put_pte(addr + PAGE_SIZE, BUCKET_PTE(pages + PAGE_SIZE));
  998. #endif
  999. return (struct task_struct *) addr;
  1000. }
  1001. static void sun4c_free_task_struct_hw(struct task_struct *tsk)
  1002. {
  1003. unsigned long tsaddr = (unsigned long) tsk;
  1004. unsigned long pages = BUCKET_PTE_PAGE(sun4c_get_pte(tsaddr));
  1005. int entry = BUCKET_NUM(tsaddr);
  1006. if (atomic_dec_and_test(&(tsk)->thread.refcount)) {
  1007. /* We are deleting a mapping, so the flush here is mandatory. */
  1008. sun4c_flush_page_hw(tsaddr);
  1009. #ifndef CONFIG_SUN4
  1010. sun4c_flush_page_hw(tsaddr + PAGE_SIZE);
  1011. #endif
  1012. sun4c_put_pte(tsaddr, 0);
  1013. #ifndef CONFIG_SUN4
  1014. sun4c_put_pte(tsaddr + PAGE_SIZE, 0);
  1015. #endif
  1016. sun4c_bucket[entry] = BUCKET_EMPTY;
  1017. if (entry < sun4c_lowbucket_avail)
  1018. sun4c_lowbucket_avail = entry;
  1019. free_pages(pages, TASK_STRUCT_ORDER);
  1020. garbage_collect(entry);
  1021. }
  1022. }
  1023. static void sun4c_free_task_struct_sw(struct task_struct *tsk)
  1024. {
  1025. unsigned long tsaddr = (unsigned long) tsk;
  1026. unsigned long pages = BUCKET_PTE_PAGE(sun4c_get_pte(tsaddr));
  1027. int entry = BUCKET_NUM(tsaddr);
  1028. if (atomic_dec_and_test(&(tsk)->thread.refcount)) {
  1029. /* We are deleting a mapping, so the flush here is mandatory. */
  1030. sun4c_flush_page_sw(tsaddr);
  1031. #ifndef CONFIG_SUN4
  1032. sun4c_flush_page_sw(tsaddr + PAGE_SIZE);
  1033. #endif
  1034. sun4c_put_pte(tsaddr, 0);
  1035. #ifndef CONFIG_SUN4
  1036. sun4c_put_pte(tsaddr + PAGE_SIZE, 0);
  1037. #endif
  1038. sun4c_bucket[entry] = BUCKET_EMPTY;
  1039. if (entry < sun4c_lowbucket_avail)
  1040. sun4c_lowbucket_avail = entry;
  1041. free_pages(pages, TASK_STRUCT_ORDER);
  1042. garbage_collect(entry);
  1043. }
  1044. }
  1045. static void sun4c_get_task_struct(struct task_struct *tsk)
  1046. {
  1047. atomic_inc(&(tsk)->thread.refcount);
  1048. }
  1049. static void __init sun4c_init_buckets(void)
  1050. {
  1051. int entry;
  1052. if (sizeof(union task_union) != (PAGE_SIZE << TASK_STRUCT_ORDER)) {
  1053. prom_printf("task union not %d page(s)!n", 1 << TASK_STRUCT_ORDER);
  1054. }
  1055. for (entry = 0; entry < NR_TASK_BUCKETS; entry++)
  1056. sun4c_bucket[entry] = BUCKET_EMPTY;
  1057. sun4c_lowbucket_avail = 0;
  1058. }
  1059. static unsigned long sun4c_iobuffer_start;
  1060. static unsigned long sun4c_iobuffer_end;
  1061. static unsigned long sun4c_iobuffer_high;
  1062. static unsigned long *sun4c_iobuffer_map;
  1063. static int iobuffer_map_size;
  1064. /*
  1065.  * Alias our pages so they do not cause a trap.
  1066.  * Also one page may be aliased into several I/O areas and we may
  1067.  * finish these I/O separately.
  1068.  */
  1069. static char *sun4c_lockarea(char *vaddr, unsigned long size)
  1070. {
  1071. unsigned long base, scan;
  1072. unsigned long npages;
  1073. unsigned long vpage;
  1074. unsigned long pte;
  1075. unsigned long apage;
  1076. unsigned long high;
  1077. unsigned long flags;
  1078. npages = (((unsigned long)vaddr & ~PAGE_MASK) +
  1079.   size + (PAGE_SIZE-1)) >> PAGE_SHIFT;
  1080. scan = 0;
  1081. save_and_cli(flags);
  1082. for (;;) {
  1083. scan = find_next_zero_bit(sun4c_iobuffer_map,
  1084.   iobuffer_map_size, scan);
  1085. if ((base = scan) + npages > iobuffer_map_size) goto abend;
  1086. for (;;) {
  1087. if (scan >= base + npages) goto found;
  1088. if (test_bit(scan, sun4c_iobuffer_map)) break;
  1089. scan++;
  1090. }
  1091. }
  1092. found:
  1093. high = ((base + npages) << PAGE_SHIFT) + sun4c_iobuffer_start;
  1094. high = SUN4C_REAL_PGDIR_ALIGN(high);
  1095. while (high > sun4c_iobuffer_high) {
  1096. get_locked_segment(sun4c_iobuffer_high);
  1097. sun4c_iobuffer_high += SUN4C_REAL_PGDIR_SIZE;
  1098. }
  1099. vpage = ((unsigned long) vaddr) & PAGE_MASK;
  1100. for (scan = base; scan < base+npages; scan++) {
  1101. pte = ((vpage-PAGE_OFFSET) >> PAGE_SHIFT);
  1102.   pte |= pgprot_val(SUN4C_PAGE_KERNEL);
  1103. pte |= _SUN4C_PAGE_NOCACHE;
  1104. set_bit(scan, sun4c_iobuffer_map);
  1105. apage = (scan << PAGE_SHIFT) + sun4c_iobuffer_start;
  1106. /* Flush original mapping so we see the right things later. */
  1107. sun4c_flush_page(vpage);
  1108. sun4c_put_pte(apage, pte);
  1109. vpage += PAGE_SIZE;
  1110. }
  1111. restore_flags(flags);
  1112. return (char *) ((base << PAGE_SHIFT) + sun4c_iobuffer_start +
  1113.  (((unsigned long) vaddr) & ~PAGE_MASK));
  1114. abend:
  1115. restore_flags(flags);
  1116. printk("DMA vaddr=0x%p size=%08lxn", vaddr, size);
  1117. panic("Out of iobuffer table");
  1118. return 0;
  1119. }
  1120. static void sun4c_unlockarea(char *vaddr, unsigned long size)
  1121. {
  1122. unsigned long vpage, npages;
  1123. unsigned long flags;
  1124. int scan, high;
  1125. vpage = (unsigned long)vaddr & PAGE_MASK;
  1126. npages = (((unsigned long)vaddr & ~PAGE_MASK) +
  1127.   size + (PAGE_SIZE-1)) >> PAGE_SHIFT;
  1128. save_and_cli(flags);
  1129. while (npages != 0) {
  1130. --npages;
  1131. /* This mapping is marked non-cachable, no flush necessary. */
  1132. sun4c_put_pte(vpage, 0);
  1133. clear_bit((vpage - sun4c_iobuffer_start) >> PAGE_SHIFT,
  1134.   sun4c_iobuffer_map);
  1135. vpage += PAGE_SIZE;
  1136. }
  1137. /* garbage collect */
  1138. scan = (sun4c_iobuffer_high - sun4c_iobuffer_start) >> PAGE_SHIFT;
  1139. while (scan >= 0 && !sun4c_iobuffer_map[scan >> 5])
  1140. scan -= 32;
  1141. scan += 32;
  1142. high = sun4c_iobuffer_start + (scan << PAGE_SHIFT);
  1143. high = SUN4C_REAL_PGDIR_ALIGN(high) + SUN4C_REAL_PGDIR_SIZE;
  1144. while (high < sun4c_iobuffer_high) {
  1145. sun4c_iobuffer_high -= SUN4C_REAL_PGDIR_SIZE;
  1146. free_locked_segment(sun4c_iobuffer_high);
  1147. }
  1148. restore_flags(flags);
  1149. }
  1150. /* Note the scsi code at init time passes to here buffers
  1151.  * which sit on the kernel stack, those are already locked
  1152.  * by implication and fool the page locking code above
  1153.  * if passed to by mistake.
  1154.  */
  1155. static __u32 sun4c_get_scsi_one(char *bufptr, unsigned long len, struct sbus_bus *sbus)
  1156. {
  1157. unsigned long page;
  1158. page = ((unsigned long)bufptr) & PAGE_MASK;
  1159. if (!VALID_PAGE(virt_to_page(page))) {
  1160. sun4c_flush_page(page);
  1161. return (__u32)bufptr; /* already locked */
  1162. }
  1163. return (__u32)sun4c_lockarea(bufptr, len);
  1164. }
  1165. static void sun4c_get_scsi_sgl(struct scatterlist *sg, int sz, struct sbus_bus *sbus)
  1166. {
  1167. while (sz >= 0) {
  1168. sg[sz].dvma_address = (__u32)sun4c_lockarea(sg[sz].address, sg[sz].length);
  1169. sg[sz].dvma_length = sg[sz].length;
  1170. sz--;
  1171. }
  1172. }
  1173. static void sun4c_release_scsi_one(__u32 bufptr, unsigned long len, struct sbus_bus *sbus)
  1174. {
  1175. if (bufptr < sun4c_iobuffer_start)
  1176. return; /* On kernel stack or similar, see above */
  1177. sun4c_unlockarea((char *)bufptr, len);
  1178. }
  1179. static void sun4c_release_scsi_sgl(struct scatterlist *sg, int sz, struct sbus_bus *sbus)
  1180. {
  1181. while (sz >= 0) {
  1182. sun4c_unlockarea((char *)sg[sz].dvma_address, sg[sz].length);
  1183. sz--;
  1184. }
  1185. }
  1186. #define TASK_ENTRY_SIZE    BUCKET_SIZE /* see above */
  1187. #define LONG_ALIGN(x) (((x)+(sizeof(long))-1)&~((sizeof(long))-1))
  1188. struct vm_area_struct sun4c_kstack_vma;
  1189. static void __init sun4c_init_lock_areas(void)
  1190. {
  1191. unsigned long sun4c_taskstack_start;
  1192. unsigned long sun4c_taskstack_end;
  1193. int bitmap_size;
  1194. sun4c_init_buckets();
  1195. sun4c_taskstack_start = SUN4C_LOCK_VADDR;
  1196. sun4c_taskstack_end = (sun4c_taskstack_start +
  1197.        (TASK_ENTRY_SIZE * NR_TASK_BUCKETS));
  1198. if (sun4c_taskstack_end >= SUN4C_LOCK_END) {
  1199. prom_printf("Too many tasks, decrease NR_TASK_BUCKETS please.n");
  1200. prom_halt();
  1201. }
  1202. sun4c_iobuffer_start = sun4c_iobuffer_high =
  1203. SUN4C_REAL_PGDIR_ALIGN(sun4c_taskstack_end);
  1204. sun4c_iobuffer_end = SUN4C_LOCK_END;
  1205. bitmap_size = (sun4c_iobuffer_end - sun4c_iobuffer_start) >> PAGE_SHIFT;
  1206. bitmap_size = (bitmap_size + 7) >> 3;
  1207. bitmap_size = LONG_ALIGN(bitmap_size);
  1208. iobuffer_map_size = bitmap_size << 3;
  1209. sun4c_iobuffer_map = __alloc_bootmem(bitmap_size, SMP_CACHE_BYTES, 0UL);
  1210. memset((void *) sun4c_iobuffer_map, 0, bitmap_size);
  1211. sun4c_kstack_vma.vm_mm = &init_mm;
  1212. sun4c_kstack_vma.vm_start = sun4c_taskstack_start;
  1213. sun4c_kstack_vma.vm_end = sun4c_taskstack_end;
  1214. sun4c_kstack_vma.vm_page_prot = PAGE_SHARED;
  1215. sun4c_kstack_vma.vm_flags = VM_READ | VM_WRITE | VM_EXEC;
  1216. insert_vm_struct(&init_mm, &sun4c_kstack_vma);
  1217. }
  1218. /* Cache flushing on the sun4c. */
  1219. static void sun4c_flush_cache_all(void)
  1220. {
  1221. unsigned long begin, end;
  1222. flush_user_windows();
  1223. begin = (KERNBASE + SUN4C_REAL_PGDIR_SIZE);
  1224. end = (begin + SUN4C_VAC_SIZE);
  1225. if (sun4c_vacinfo.linesize == 32) {
  1226. while (begin < end) {
  1227. __asm__ __volatile__(
  1228. "ld [%0 + 0x00], %%g0nt"
  1229. "ld [%0 + 0x20], %%g0nt"
  1230. "ld [%0 + 0x40], %%g0nt"
  1231. "ld [%0 + 0x60], %%g0nt"
  1232. "ld [%0 + 0x80], %%g0nt"
  1233. "ld [%0 + 0xa0], %%g0nt"
  1234. "ld [%0 + 0xc0], %%g0nt"
  1235. "ld [%0 + 0xe0], %%g0nt"
  1236. "ld [%0 + 0x100], %%g0nt"
  1237. "ld [%0 + 0x120], %%g0nt"
  1238. "ld [%0 + 0x140], %%g0nt"
  1239. "ld [%0 + 0x160], %%g0nt"
  1240. "ld [%0 + 0x180], %%g0nt"
  1241. "ld [%0 + 0x1a0], %%g0nt"
  1242. "ld [%0 + 0x1c0], %%g0nt"
  1243. "ld [%0 + 0x1e0], %%g0n"
  1244. : : "r" (begin));
  1245. begin += 512;
  1246. }
  1247. } else {
  1248. while (begin < end) {
  1249. __asm__ __volatile__(
  1250. "ld [%0 + 0x00], %%g0nt"
  1251. "ld [%0 + 0x10], %%g0nt"
  1252. "ld [%0 + 0x20], %%g0nt"
  1253. "ld [%0 + 0x30], %%g0nt"
  1254. "ld [%0 + 0x40], %%g0nt"
  1255. "ld [%0 + 0x50], %%g0nt"
  1256. "ld [%0 + 0x60], %%g0nt"
  1257. "ld [%0 + 0x70], %%g0nt"
  1258. "ld [%0 + 0x80], %%g0nt"
  1259. "ld [%0 + 0x90], %%g0nt"
  1260. "ld [%0 + 0xa0], %%g0nt"
  1261. "ld [%0 + 0xb0], %%g0nt"
  1262. "ld [%0 + 0xc0], %%g0nt"
  1263. "ld [%0 + 0xd0], %%g0nt"
  1264. "ld [%0 + 0xe0], %%g0nt"
  1265. "ld [%0 + 0xf0], %%g0n"
  1266. : : "r" (begin));
  1267. begin += 256;
  1268. }
  1269. }
  1270. }
  1271. static void sun4c_flush_cache_mm_hw(struct mm_struct *mm)
  1272. {
  1273. int new_ctx = mm->context;
  1274. if (new_ctx != NO_CONTEXT) {
  1275. flush_user_windows();
  1276. if (sun4c_context_ring[new_ctx].num_entries) {
  1277. struct sun4c_mmu_entry *head = &sun4c_context_ring[new_ctx].ringhd;
  1278. unsigned long flags;
  1279. save_and_cli(flags);
  1280. if (head->next != head) {
  1281. struct sun4c_mmu_entry *entry = head->next;
  1282. int savectx = sun4c_get_context();
  1283. sun4c_set_context(new_ctx);
  1284. sun4c_flush_context_hw();
  1285. do {
  1286. struct sun4c_mmu_entry *next = entry->next;
  1287. sun4c_user_unmap(entry);
  1288. free_user_entry(new_ctx, entry);
  1289. entry = next;
  1290. } while (entry != head);
  1291. sun4c_set_context(savectx);
  1292. }
  1293. restore_flags(flags);
  1294. }
  1295. }
  1296. }
  1297. static void sun4c_flush_cache_range_hw(struct mm_struct *mm, unsigned long start, unsigned long end)
  1298. {
  1299. int new_ctx = mm->context;
  1300. if (new_ctx != NO_CONTEXT) {
  1301. struct sun4c_mmu_entry *head = &sun4c_context_ring[new_ctx].ringhd;
  1302. struct sun4c_mmu_entry *entry;
  1303. unsigned long flags;
  1304. flush_user_windows();
  1305. save_and_cli(flags);
  1306. /* All user segmap chains are ordered on entry->vaddr. */
  1307. for (entry = head->next;
  1308.      (entry != head) && ((entry->vaddr+SUN4C_REAL_PGDIR_SIZE) < start);
  1309.      entry = entry->next)
  1310. ;
  1311. /* Tracing various job mixtures showed that this conditional
  1312.  * only passes ~35% of the time for most worse case situations,
  1313.  * therefore we avoid all of this gross overhead ~65% of the time.
  1314.  */
  1315. if ((entry != head) && (entry->vaddr < end)) {
  1316. int octx = sun4c_get_context();
  1317. sun4c_set_context(new_ctx);
  1318. /* At this point, always, (start >= entry->vaddr) and
  1319.  * (entry->vaddr < end), once the latter condition
  1320.  * ceases to hold, or we hit the end of the list, we
  1321.  * exit the loop.  The ordering of all user allocated
  1322.  * segmaps makes this all work out so beautifully.
  1323.  */
  1324. do {
  1325. struct sun4c_mmu_entry *next = entry->next;
  1326. unsigned long realend;
  1327. /* "realstart" is always >= entry->vaddr */
  1328. realend = entry->vaddr + SUN4C_REAL_PGDIR_SIZE;
  1329. if (end < realend)
  1330. realend = end;
  1331. if ((realend - entry->vaddr) <= (PAGE_SIZE << 3)) {
  1332. unsigned long page = entry->vaddr;
  1333. while (page < realend) {
  1334. sun4c_flush_page_hw(page);
  1335. page += PAGE_SIZE;
  1336. }
  1337. } else {
  1338. sun4c_flush_segment_hw(entry->vaddr);
  1339. sun4c_user_unmap(entry);
  1340. free_user_entry(new_ctx, entry);
  1341. }
  1342. entry = next;
  1343. } while ((entry != head) && (entry->vaddr < end));
  1344. sun4c_set_context(octx);
  1345. }
  1346. restore_flags(flags);
  1347. }
  1348. }
  1349. static void sun4c_flush_cache_page_hw(struct vm_area_struct *vma, unsigned long page)
  1350. {
  1351. struct mm_struct *mm = vma->vm_mm;
  1352. int new_ctx = mm->context;
  1353. /* Sun4c has no separate I/D caches so cannot optimize for non
  1354.  * text page flushes.
  1355.  */
  1356. if (new_ctx != NO_CONTEXT) {
  1357. int octx = sun4c_get_context();
  1358. unsigned long flags;
  1359. flush_user_windows();
  1360. save_and_cli(flags);
  1361. sun4c_set_context(new_ctx);
  1362. sun4c_flush_page_hw(page);
  1363. sun4c_set_context(octx);
  1364. restore_flags(flags);
  1365. }
  1366. }
  1367. static void sun4c_flush_page_to_ram_hw(unsigned long page)
  1368. {
  1369. unsigned long flags;
  1370. save_and_cli(flags);
  1371. sun4c_flush_page_hw(page);
  1372. restore_flags(flags);
  1373. }
  1374. static void sun4c_flush_cache_mm_sw(struct mm_struct *mm)
  1375. {
  1376. int new_ctx = mm->context;
  1377. if (new_ctx != NO_CONTEXT) {
  1378. flush_user_windows();
  1379. if (sun4c_context_ring[new_ctx].num_entries) {
  1380. struct sun4c_mmu_entry *head = &sun4c_context_ring[new_ctx].ringhd;
  1381. unsigned long flags;
  1382. save_and_cli(flags);
  1383. if (head->next != head) {
  1384. struct sun4c_mmu_entry *entry = head->next;
  1385. int savectx = sun4c_get_context();
  1386. sun4c_set_context(new_ctx);
  1387. sun4c_flush_context_sw();
  1388. do {
  1389. struct sun4c_mmu_entry *next = entry->next;
  1390. sun4c_user_unmap(entry);
  1391. free_user_entry(new_ctx, entry);
  1392. entry = next;
  1393. } while (entry != head);
  1394. sun4c_set_context(savectx);
  1395. }
  1396. restore_flags(flags);
  1397. }
  1398. }
  1399. }
  1400. static void sun4c_flush_cache_range_sw(struct mm_struct *mm, unsigned long start, unsigned long end)
  1401. {
  1402. int new_ctx = mm->context;
  1403. if (new_ctx != NO_CONTEXT) {
  1404. struct sun4c_mmu_entry *head = &sun4c_context_ring[new_ctx].ringhd;
  1405. struct sun4c_mmu_entry *entry;
  1406. unsigned long flags;
  1407. flush_user_windows();
  1408. save_and_cli(flags);
  1409. /* All user segmap chains are ordered on entry->vaddr. */
  1410. for (entry = head->next;
  1411.      (entry != head) && ((entry->vaddr+SUN4C_REAL_PGDIR_SIZE) < start);
  1412.      entry = entry->next)
  1413. ;
  1414. /* Tracing various job mixtures showed that this conditional
  1415.  * only passes ~35% of the time for most worse case situations,
  1416.  * therefore we avoid all of this gross overhead ~65% of the time.
  1417.  */
  1418. if ((entry != head) && (entry->vaddr < end)) {
  1419. int octx = sun4c_get_context();
  1420. sun4c_set_context(new_ctx);
  1421. /* At this point, always, (start >= entry->vaddr) and
  1422.  * (entry->vaddr < end), once the latter condition
  1423.  * ceases to hold, or we hit the end of the list, we
  1424.  * exit the loop.  The ordering of all user allocated
  1425.  * segmaps makes this all work out so beautifully.
  1426.  */
  1427. do {
  1428. struct sun4c_mmu_entry *next = entry->next;
  1429. unsigned long realend;
  1430. /* "realstart" is always >= entry->vaddr */
  1431. realend = entry->vaddr + SUN4C_REAL_PGDIR_SIZE;
  1432. if (end < realend)
  1433. realend = end;
  1434. if ((realend - entry->vaddr) <= (PAGE_SIZE << 3)) {
  1435. unsigned long page = entry->vaddr;
  1436. while (page < realend) {
  1437. sun4c_flush_page_sw(page);
  1438. page += PAGE_SIZE;
  1439. }
  1440. } else {
  1441. sun4c_flush_segment_sw(entry->vaddr);
  1442. sun4c_user_unmap(entry);
  1443. free_user_entry(new_ctx, entry);
  1444. }
  1445. entry = next;
  1446. } while ((entry != head) && (entry->vaddr < end));
  1447. sun4c_set_context(octx);
  1448. }
  1449. restore_flags(flags);
  1450. }
  1451. }
  1452. static void sun4c_flush_cache_page_sw(struct vm_area_struct *vma, unsigned long page)
  1453. {
  1454. struct mm_struct *mm = vma->vm_mm;
  1455. int new_ctx = mm->context;
  1456. /* Sun4c has no separate I/D caches so cannot optimize for non
  1457.  * text page flushes.
  1458.  */
  1459. if (new_ctx != NO_CONTEXT) {
  1460. int octx = sun4c_get_context();
  1461. unsigned long flags;
  1462. flush_user_windows();
  1463. save_and_cli(flags);
  1464. sun4c_set_context(new_ctx);
  1465. sun4c_flush_page_sw(page);
  1466. sun4c_set_context(octx);
  1467. restore_flags(flags);
  1468. }
  1469. }
  1470. static void sun4c_flush_page_to_ram_sw(unsigned long page)
  1471. {
  1472. unsigned long flags;
  1473. save_and_cli(flags);
  1474. sun4c_flush_page_sw(page);
  1475. restore_flags(flags);
  1476. }
  1477. /* Sun4c cache is unified, both instructions and data live there, so
  1478.  * no need to flush the on-stack instructions for new signal handlers.
  1479.  */
  1480. static void sun4c_flush_sig_insns(struct mm_struct *mm, unsigned long insn_addr)
  1481. {
  1482. }
  1483. /* TLB flushing on the sun4c.  These routines count on the cache
  1484.  * flushing code to flush the user register windows so that we need
  1485.  * not do so when we get here.
  1486.  */
  1487. static void sun4c_flush_tlb_all(void)
  1488. {
  1489. struct sun4c_mmu_entry *this_entry, *next_entry;
  1490. unsigned long flags;
  1491. int savectx, ctx;
  1492. save_and_cli(flags);
  1493. this_entry = sun4c_kernel_ring.ringhd.next;
  1494. savectx = sun4c_get_context();
  1495. flush_user_windows();
  1496. while (sun4c_kernel_ring.num_entries) {
  1497. next_entry = this_entry->next;
  1498. if (sun4c_vacinfo.do_hwflushes)
  1499. sun4c_flush_segment_hw(this_entry->vaddr);
  1500. else
  1501. sun4c_flush_segment_sw(this_entry->vaddr);
  1502. for (ctx = 0; ctx < num_contexts; ctx++) {
  1503. sun4c_set_context(ctx);
  1504. sun4c_put_segmap(this_entry->vaddr, invalid_segment);
  1505. }
  1506. free_kernel_entry(this_entry, &sun4c_kernel_ring);
  1507. this_entry = next_entry;
  1508. }
  1509. sun4c_set_context(savectx);
  1510. restore_flags(flags);
  1511. }
  1512. static void sun4c_flush_tlb_mm_hw(struct mm_struct *mm)
  1513. {
  1514. int new_ctx = mm->context;
  1515. if (new_ctx != NO_CONTEXT) {
  1516. struct sun4c_mmu_entry *head = &sun4c_context_ring[new_ctx].ringhd;
  1517. unsigned long flags;
  1518. save_and_cli(flags);
  1519. if (head->next != head) {
  1520. struct sun4c_mmu_entry *entry = head->next;
  1521. int savectx = sun4c_get_context();
  1522. sun4c_set_context(new_ctx);
  1523. sun4c_flush_context_hw();
  1524. do {
  1525. struct sun4c_mmu_entry *next = entry->next;
  1526. sun4c_user_unmap(entry);
  1527. free_user_entry(new_ctx, entry);
  1528. entry = next;
  1529. } while (entry != head);
  1530. sun4c_set_context(savectx);
  1531. }
  1532. restore_flags(flags);
  1533. }
  1534. }
  1535. static void sun4c_flush_tlb_range_hw(struct mm_struct *mm, unsigned long start, unsigned long end)
  1536. {
  1537. int new_ctx = mm->context;
  1538. if (new_ctx != NO_CONTEXT) {
  1539. struct sun4c_mmu_entry *head = &sun4c_context_ring[new_ctx].ringhd;
  1540. struct sun4c_mmu_entry *entry;
  1541. unsigned long flags;
  1542. save_and_cli(flags);
  1543. /* See commentary in sun4c_flush_cache_range_*(). */
  1544. for (entry = head->next;
  1545.      (entry != head) && ((entry->vaddr+SUN4C_REAL_PGDIR_SIZE) < start);
  1546.      entry = entry->next)
  1547. ;
  1548. if ((entry != head) && (entry->vaddr < end)) {
  1549. int octx = sun4c_get_context();
  1550. sun4c_set_context(new_ctx);
  1551. do {
  1552. struct sun4c_mmu_entry *next = entry->next;
  1553. sun4c_flush_segment_hw(entry->vaddr);
  1554. sun4c_user_unmap(entry);
  1555. free_user_entry(new_ctx, entry);
  1556. entry = next;
  1557. } while ((entry != head) && (entry->vaddr < end));
  1558. sun4c_set_context(octx);
  1559. }
  1560. restore_flags(flags);
  1561. }
  1562. }
  1563. static void sun4c_flush_tlb_page_hw(struct vm_area_struct *vma, unsigned long page)
  1564. {
  1565. struct mm_struct *mm = vma->vm_mm;
  1566. int new_ctx = mm->context;
  1567. if (new_ctx != NO_CONTEXT) {
  1568. int savectx = sun4c_get_context();
  1569. unsigned long flags;
  1570. save_and_cli(flags);
  1571. sun4c_set_context(new_ctx);
  1572. page &= PAGE_MASK;
  1573. sun4c_flush_page_hw(page);
  1574. sun4c_put_pte(page, 0);
  1575. sun4c_set_context(savectx);
  1576. restore_flags(flags);
  1577. }
  1578. }
  1579. static void sun4c_flush_tlb_mm_sw(struct mm_struct *mm)
  1580. {
  1581. int new_ctx = mm->context;
  1582. if (new_ctx != NO_CONTEXT) {
  1583. struct sun4c_mmu_entry *head = &sun4c_context_ring[new_ctx].ringhd;
  1584. unsigned long flags;
  1585. save_and_cli(flags);
  1586. if (head->next != head) {
  1587. struct sun4c_mmu_entry *entry = head->next;
  1588. int savectx = sun4c_get_context();
  1589. sun4c_set_context(new_ctx);
  1590. sun4c_flush_context_sw();
  1591. do {
  1592. struct sun4c_mmu_entry *next = entry->next;
  1593. sun4c_user_unmap(entry);
  1594. free_user_entry(new_ctx, entry);
  1595. entry = next;
  1596. } while (entry != head);
  1597. sun4c_set_context(savectx);
  1598. }
  1599. restore_flags(flags);
  1600. }
  1601. }
  1602. static void sun4c_flush_tlb_range_sw(struct mm_struct *mm, unsigned long start, unsigned long end)
  1603. {
  1604. int new_ctx = mm->context;
  1605. if (new_ctx != NO_CONTEXT) {
  1606. struct sun4c_mmu_entry *head = &sun4c_context_ring[new_ctx].ringhd;
  1607. struct sun4c_mmu_entry *entry;
  1608. unsigned long flags;
  1609. save_and_cli(flags);
  1610. /* See commentary in sun4c_flush_cache_range_*(). */
  1611. for (entry = head->next;
  1612.      (entry != head) && ((entry->vaddr+SUN4C_REAL_PGDIR_SIZE) < start);
  1613.      entry = entry->next)
  1614. ;
  1615. if ((entry != head) && (entry->vaddr < end)) {
  1616. int octx = sun4c_get_context();
  1617. sun4c_set_context(new_ctx);
  1618. do {
  1619. struct sun4c_mmu_entry *next = entry->next;
  1620. sun4c_flush_segment_sw(entry->vaddr);
  1621. sun4c_user_unmap(entry);
  1622. free_user_entry(new_ctx, entry);
  1623. entry = next;
  1624. } while ((entry != head) && (entry->vaddr < end));
  1625. sun4c_set_context(octx);
  1626. }
  1627. restore_flags(flags);
  1628. }
  1629. }
  1630. static void sun4c_flush_tlb_page_sw(struct vm_area_struct *vma, unsigned long page)
  1631. {
  1632. struct mm_struct *mm = vma->vm_mm;
  1633. int new_ctx = mm->context;
  1634. if (new_ctx != NO_CONTEXT) {
  1635. int savectx = sun4c_get_context();
  1636. unsigned long flags;
  1637. save_and_cli(flags);
  1638. sun4c_set_context(new_ctx);
  1639. page &= PAGE_MASK;
  1640. sun4c_flush_page_sw(page);
  1641. sun4c_put_pte(page, 0);
  1642. sun4c_set_context(savectx);
  1643. restore_flags(flags);
  1644. }
  1645. }
  1646. static void sun4c_set_pte(pte_t *ptep, pte_t pte)
  1647. {
  1648. *ptep = pte;
  1649. }
  1650. static void sun4c_pgd_set(pgd_t * pgdp, pmd_t * pmdp)
  1651. {
  1652. }
  1653. static void sun4c_pmd_set(pmd_t * pmdp, pte_t * ptep)
  1654. {
  1655. }
  1656. void sun4c_mapioaddr(unsigned long physaddr, unsigned long virt_addr,
  1657.      int bus_type, int rdonly)
  1658. {
  1659. unsigned long page_entry;
  1660. page_entry = ((physaddr >> PAGE_SHIFT) & SUN4C_PFN_MASK);
  1661. page_entry |= ((pg_iobits | _SUN4C_PAGE_PRIV) & ~(_SUN4C_PAGE_PRESENT));
  1662. if (rdonly)
  1663. page_entry &= ~_SUN4C_WRITEABLE;
  1664. sun4c_put_pte(virt_addr, page_entry);
  1665. }
  1666. void sun4c_unmapioaddr(unsigned long virt_addr)
  1667. {
  1668. sun4c_put_pte(virt_addr, 0);
  1669. }
  1670. static void sun4c_alloc_context_hw(struct mm_struct *old_mm, struct mm_struct *mm)
  1671. {
  1672. struct ctx_list *ctxp;
  1673. ctxp = ctx_free.next;
  1674. if (ctxp != &ctx_free) {
  1675. remove_from_ctx_list(ctxp);
  1676. add_to_used_ctxlist(ctxp);
  1677. mm->context = ctxp->ctx_number;
  1678. ctxp->ctx_mm = mm;
  1679. return;
  1680. }
  1681. ctxp = ctx_used.next;
  1682. if (ctxp->ctx_mm == old_mm)
  1683. ctxp = ctxp->next;
  1684. remove_from_ctx_list(ctxp);
  1685. add_to_used_ctxlist(ctxp);
  1686. ctxp->ctx_mm->context = NO_CONTEXT;
  1687. ctxp->ctx_mm = mm;
  1688. mm->context = ctxp->ctx_number;
  1689. sun4c_demap_context_hw(&sun4c_context_ring[ctxp->ctx_number],
  1690.        ctxp->ctx_number);
  1691. }
  1692. /* Switch the current MM context. */
  1693. static void sun4c_switch_mm_hw(struct mm_struct *old_mm, struct mm_struct *mm, struct task_struct *tsk, int cpu)
  1694. {
  1695. struct ctx_list *ctx;
  1696. int dirty = 0;
  1697. if (mm->context == NO_CONTEXT) {
  1698. dirty = 1;
  1699. sun4c_alloc_context_hw(old_mm, mm);
  1700. } else {
  1701. /* Update the LRU ring of contexts. */
  1702. ctx = ctx_list_pool + mm->context;
  1703. remove_from_ctx_list(ctx);
  1704. add_to_used_ctxlist(ctx);
  1705. }
  1706. if (dirty || old_mm != mm)
  1707. sun4c_set_context(mm->context);
  1708. }
  1709. static void sun4c_destroy_context_hw(struct mm_struct *mm)
  1710. {
  1711. struct ctx_list *ctx_old;
  1712. if (mm->context != NO_CONTEXT) {
  1713. sun4c_demap_context_hw(&sun4c_context_ring[mm->context], mm->context);
  1714. ctx_old = ctx_list_pool + mm->context;
  1715. remove_from_ctx_list(ctx_old);
  1716. add_to_free_ctxlist(ctx_old);
  1717. mm->context = NO_CONTEXT;
  1718. }
  1719. }
  1720. static void sun4c_alloc_context_sw(struct mm_struct *old_mm, struct mm_struct *mm)
  1721. {
  1722. struct ctx_list *ctxp;
  1723. ctxp = ctx_free.next;
  1724. if (ctxp != &ctx_free) {
  1725. remove_from_ctx_list(ctxp);
  1726. add_to_used_ctxlist(ctxp);
  1727. mm->context = ctxp->ctx_number;
  1728. ctxp->ctx_mm = mm;
  1729. return;
  1730. }
  1731. ctxp = ctx_used.next;
  1732. if(ctxp->ctx_mm == old_mm)
  1733. ctxp = ctxp->next;
  1734. remove_from_ctx_list(ctxp);
  1735. add_to_used_ctxlist(ctxp);
  1736. ctxp->ctx_mm->context = NO_CONTEXT;
  1737. ctxp->ctx_mm = mm;
  1738. mm->context = ctxp->ctx_number;
  1739. sun4c_demap_context_sw(&sun4c_context_ring[ctxp->ctx_number],
  1740.        ctxp->ctx_number);
  1741. }
  1742. /* Switch the current MM context. */
  1743. static void sun4c_switch_mm_sw(struct mm_struct *old_mm, struct mm_struct *mm, struct task_struct *tsk, int cpu)
  1744. {
  1745. struct ctx_list *ctx;
  1746. int dirty = 0;
  1747. if (mm->context == NO_CONTEXT) {
  1748. dirty = 1;
  1749. sun4c_alloc_context_sw(old_mm, mm);
  1750. } else {
  1751. /* Update the LRU ring of contexts. */
  1752. ctx = ctx_list_pool + mm->context;
  1753. remove_from_ctx_list(ctx);
  1754. add_to_used_ctxlist(ctx);
  1755. }
  1756. if (dirty || old_mm != mm)
  1757. sun4c_set_context(mm->context);
  1758. }
  1759. static void sun4c_destroy_context_sw(struct mm_struct *mm)
  1760. {
  1761. struct ctx_list *ctx_old;
  1762. if (mm->context != NO_CONTEXT) {
  1763. sun4c_demap_context_sw(&sun4c_context_ring[mm->context], mm->context);
  1764. ctx_old = ctx_list_pool + mm->context;
  1765. remove_from_ctx_list(ctx_old);
  1766. add_to_free_ctxlist(ctx_old);
  1767. mm->context = NO_CONTEXT;
  1768. }
  1769. }
  1770. static void sun4c_mmu_info(struct seq_file *m)
  1771. {
  1772. int used_user_entries, i;
  1773. used_user_entries = 0;
  1774. for (i = 0; i < num_contexts; i++)
  1775. used_user_entries += sun4c_context_ring[i].num_entries;
  1776. seq_printf(m, 
  1777.    "vacsizett: %d bytesn"
  1778.    "vachwflusht: %sn"
  1779.    "vaclinesizet: %d bytesn"
  1780.    "mmuctxstt: %dn"
  1781.    "mmupsegst: %dn"
  1782.    "kernelpsegst: %dn"
  1783.    "kfreepsegst: %dn"
  1784.    "usedpsegst: %dn"
  1785.    "ufreepsegst: %dn"
  1786.    "user_takent: %dn"
  1787.    "max_takent: %dn",
  1788.    sun4c_vacinfo.num_bytes,
  1789.    (sun4c_vacinfo.do_hwflushes ? "yes" : "no"),
  1790.    sun4c_vacinfo.linesize,
  1791.    num_contexts,
  1792.    (invalid_segment + 1),
  1793.    sun4c_kernel_ring.num_entries,
  1794.    sun4c_kfree_ring.num_entries,
  1795.    used_user_entries,
  1796.    sun4c_ufree_ring.num_entries,
  1797.    sun4c_user_taken_entries,
  1798.    max_user_taken_entries);
  1799. }
  1800. /* Nothing below here should touch the mmu hardware nor the mmu_entry
  1801.  * data structures.
  1802.  */
  1803. /* First the functions which the mid-level code uses to directly
  1804.  * manipulate the software page tables.  Some defines since we are
  1805.  * emulating the i386 page directory layout.
  1806.  */
  1807. #define PGD_PRESENT  0x001
  1808. #define PGD_RW       0x002
  1809. #define PGD_USER     0x004
  1810. #define PGD_ACCESSED 0x020
  1811. #define PGD_DIRTY    0x040
  1812. #define PGD_TABLE    (PGD_PRESENT | PGD_RW | PGD_USER | PGD_ACCESSED | PGD_DIRTY)
  1813. static int sun4c_pte_present(pte_t pte)
  1814. {
  1815. return ((pte_val(pte) & (_SUN4C_PAGE_PRESENT | _SUN4C_PAGE_PRIV)) != 0);
  1816. }
  1817. static void sun4c_pte_clear(pte_t *ptep) { *ptep = __pte(0); }
  1818. static int sun4c_pmd_bad(pmd_t pmd)
  1819. {
  1820. return (((pmd_val(pmd) & ~PAGE_MASK) != PGD_TABLE) ||
  1821. (!VALID_PAGE(virt_to_page(pmd_val(pmd)))));
  1822. }
  1823. static int sun4c_pmd_present(pmd_t pmd)
  1824. {
  1825. return ((pmd_val(pmd) & PGD_PRESENT) != 0);
  1826. }
  1827. static void sun4c_pmd_clear(pmd_t *pmdp) { *pmdp = __pmd(0); }
  1828. static int sun4c_pgd_none(pgd_t pgd) { return 0; }
  1829. static int sun4c_pgd_bad(pgd_t pgd) { return 0; }
  1830. static int sun4c_pgd_present(pgd_t pgd)         { return 1; }
  1831. static void sun4c_pgd_clear(pgd_t * pgdp) { }
  1832. /*
  1833.  * The following only work if pte_present() is true.
  1834.  * Undefined behaviour if not..
  1835.  */
  1836. static pte_t sun4c_pte_mkwrite(pte_t pte)
  1837. {
  1838. pte = __pte(pte_val(pte) | _SUN4C_PAGE_WRITE);
  1839. if (pte_val(pte) & _SUN4C_PAGE_MODIFIED)
  1840. pte = __pte(pte_val(pte) | _SUN4C_PAGE_SILENT_WRITE);
  1841. return pte;
  1842. }
  1843. static pte_t sun4c_pte_mkdirty(pte_t pte)
  1844. {
  1845. pte = __pte(pte_val(pte) | _SUN4C_PAGE_MODIFIED);
  1846. if (pte_val(pte) & _SUN4C_PAGE_WRITE)
  1847. pte = __pte(pte_val(pte) | _SUN4C_PAGE_SILENT_WRITE);
  1848. return pte;
  1849. }
  1850. static pte_t sun4c_pte_mkyoung(pte_t pte)
  1851. {
  1852. pte = __pte(pte_val(pte) | _SUN4C_PAGE_ACCESSED);
  1853. if (pte_val(pte) & _SUN4C_PAGE_READ)
  1854. pte = __pte(pte_val(pte) | _SUN4C_PAGE_SILENT_READ);
  1855. return pte;
  1856. }
  1857. /*
  1858.  * Conversion functions: convert a page and protection to a page entry,
  1859.  * and a page entry and page directory to the page they refer to.
  1860.  */
  1861. static pte_t sun4c_mk_pte(struct page *page, pgprot_t pgprot)
  1862. {
  1863. return __pte((page - mem_map) | pgprot_val(pgprot));
  1864. }
  1865. static pte_t sun4c_mk_pte_phys(unsigned long phys_page, pgprot_t pgprot)
  1866. {
  1867. return __pte((phys_page >> PAGE_SHIFT) | pgprot_val(pgprot));
  1868. }
  1869. static pte_t sun4c_mk_pte_io(unsigned long page, pgprot_t pgprot, int space)
  1870. {
  1871. return __pte(((page - PAGE_OFFSET) >> PAGE_SHIFT) | pgprot_val(pgprot));
  1872. }
  1873. static struct page *sun4c_pte_page(pte_t pte)
  1874. {
  1875. return (mem_map + (unsigned long)(pte_val(pte) & SUN4C_PFN_MASK));
  1876. }
  1877. static inline unsigned long sun4c_pmd_page(pmd_t pmd)
  1878. {
  1879. return (pmd_val(pmd) & PAGE_MASK);
  1880. }
  1881. static unsigned long sun4c_pgd_page(pgd_t pgd)
  1882. {
  1883. return 0;
  1884. }
  1885. /* to find an entry in a page-table-directory */
  1886. static inline pgd_t *sun4c_pgd_offset(struct mm_struct * mm, unsigned long address)
  1887. {
  1888. return mm->pgd + (address >> SUN4C_PGDIR_SHIFT);
  1889. }
  1890. /* Find an entry in the second-level page table.. */
  1891. static pmd_t *sun4c_pmd_offset(pgd_t * dir, unsigned long address)
  1892. {
  1893. return (pmd_t *) dir;
  1894. }
  1895. /* Find an entry in the third-level page table.. */ 
  1896. pte_t *sun4c_pte_offset(pmd_t * dir, unsigned long address)
  1897. {
  1898. return (pte_t *) sun4c_pmd_page(*dir) + ((address >> PAGE_SHIFT) & (SUN4C_PTRS_PER_PTE - 1));
  1899. }
  1900. static void sun4c_free_pte_slow(pte_t *pte)
  1901. {
  1902. free_page((unsigned long)pte);
  1903. }
  1904. static void sun4c_free_pgd_slow(pgd_t *pgd)
  1905. {
  1906. free_page((unsigned long)pgd);
  1907. }
  1908. static pgd_t *sun4c_get_pgd_fast(void)
  1909. {
  1910. unsigned long *ret;
  1911. if ((ret = pgd_quicklist) != NULL) {
  1912. pgd_quicklist = (unsigned long *)(*ret);
  1913. ret[0] = ret[1];
  1914. pgtable_cache_size--;
  1915. } else {
  1916. pgd_t *init;
  1917. ret = (unsigned long *)__get_free_page(GFP_KERNEL);
  1918. memset (ret, 0, (KERNBASE / SUN4C_PGDIR_SIZE) * sizeof(pgd_t));
  1919. init = sun4c_pgd_offset(&init_mm, 0);
  1920. memcpy (((pgd_t *)ret) + USER_PTRS_PER_PGD, init + USER_PTRS_PER_PGD,
  1921. (PTRS_PER_PGD - USER_PTRS_PER_PGD) * sizeof(pgd_t));
  1922. }
  1923. return (pgd_t *)ret;
  1924. }
  1925. static void sun4c_free_pgd_fast(pgd_t *pgd)
  1926. {
  1927. *(unsigned long *)pgd = (unsigned long) pgd_quicklist;
  1928. pgd_quicklist = (unsigned long *) pgd;
  1929. pgtable_cache_size++;
  1930. }
  1931. static pte_t *sun4c_pte_alloc_one(struct mm_struct *mm, unsigned long address)
  1932. {
  1933. pte_t *pte = (pte_t *)__get_free_page(GFP_KERNEL);
  1934. if (pte)
  1935. memset(pte, 0, PAGE_SIZE);
  1936. return pte;
  1937. }
  1938. pte_t *sun4c_pte_alloc_one_fast(struct mm_struct *mm, unsigned long address)
  1939. {
  1940. unsigned long *ret;
  1941. if ((ret = (unsigned long *)pte_quicklist) != NULL) {
  1942. pte_quicklist = (unsigned long *)(*ret);
  1943. ret[0] = ret[1];
  1944. pgtable_cache_size--;
  1945. }
  1946. return (pte_t *)ret;
  1947. }
  1948. static __inline__ void sun4c_free_pte_fast(pte_t *pte)
  1949. {
  1950. *(unsigned long *)pte = (unsigned long) pte_quicklist;
  1951. pte_quicklist = (unsigned long *) pte;
  1952. pgtable_cache_size++;
  1953. }
  1954. /*
  1955.  * allocating and freeing a pmd is trivial: the 1-entry pmd is
  1956.  * inside the pgd, so has no extra memory associated with it.
  1957.  */
  1958. static pmd_t *sun4c_pmd_alloc_one_fast(struct mm_struct *mm, unsigned long address)
  1959. {
  1960. BUG();
  1961. return NULL;
  1962. }
  1963. static void sun4c_free_pmd_fast(pmd_t * pmd)
  1964. {
  1965. }
  1966. static int sun4c_check_pgt_cache(int low, int high)
  1967. {
  1968. int freed = 0;
  1969. if (pgtable_cache_size > high) {
  1970. do {
  1971. if (pgd_quicklist)
  1972. sun4c_free_pgd_slow(sun4c_get_pgd_fast()), freed++;
  1973. if (pte_quicklist)
  1974. sun4c_free_pte_slow(sun4c_pte_alloc_one_fast(NULL, 0)), freed++;
  1975. } while (pgtable_cache_size > low);
  1976. }
  1977. return freed;
  1978. }
  1979. /* An experiment, turn off by default for now... -DaveM */
  1980. #define SUN4C_PRELOAD_PSEG
  1981. void sun4c_update_mmu_cache(struct vm_area_struct *vma, unsigned long address, pte_t pte)
  1982. {
  1983. unsigned long flags;
  1984. int pseg;
  1985. save_and_cli(flags);
  1986. address &= PAGE_MASK;
  1987. if ((pseg = sun4c_get_segmap(address)) == invalid_segment) {
  1988. struct sun4c_mmu_entry *entry = sun4c_user_strategy();
  1989. struct mm_struct *mm = vma->vm_mm;
  1990. unsigned long start, end;
  1991. entry->vaddr = start = (address & SUN4C_REAL_PGDIR_MASK);
  1992. entry->ctx = mm->context;
  1993. add_ring_ordered(sun4c_context_ring + mm->context, entry);
  1994. sun4c_put_segmap(entry->vaddr, entry->pseg);
  1995. end = start + SUN4C_REAL_PGDIR_SIZE;
  1996. while (start < end) {
  1997. #ifdef SUN4C_PRELOAD_PSEG
  1998. pgd_t *pgdp = sun4c_pgd_offset(mm, start);
  1999. pte_t *ptep;
  2000. if (!pgdp)
  2001. goto no_mapping;
  2002. ptep = sun4c_pte_offset((pmd_t *) pgdp, start);
  2003. if (!ptep || !(pte_val(*ptep) & _SUN4C_PAGE_PRESENT))
  2004. goto no_mapping;
  2005. sun4c_put_pte(start, pte_val(*ptep));
  2006. goto next;
  2007. no_mapping:
  2008. #endif
  2009. sun4c_put_pte(start, 0);
  2010. #ifdef SUN4C_PRELOAD_PSEG
  2011. next:
  2012. #endif
  2013. start += PAGE_SIZE;
  2014. }
  2015. #ifndef SUN4C_PRELOAD_PSEG
  2016. sun4c_put_pte(address, pte_val(pte));
  2017. #endif
  2018. restore_flags(flags);
  2019. return;
  2020. } else {
  2021. struct sun4c_mmu_entry *entry = &mmu_entry_pool[pseg];
  2022. remove_lru(entry);
  2023. add_lru(entry);
  2024. }
  2025. sun4c_put_pte(address, pte_val(pte));
  2026. restore_flags(flags);
  2027. }
  2028. extern void sparc_context_init(int);
  2029. extern unsigned long end;
  2030. extern unsigned long bootmem_init(unsigned long *pages_avail);
  2031. extern unsigned long last_valid_pfn;
  2032. extern void sun_serial_setup(void);
  2033. void __init sun4c_paging_init(void)
  2034. {
  2035. int i, cnt;
  2036. unsigned long kernel_end, vaddr;
  2037. extern struct resource sparc_iomap;
  2038. unsigned long end_pfn, pages_avail;
  2039. kernel_end = (unsigned long) &end;
  2040. kernel_end += (SUN4C_REAL_PGDIR_SIZE * 4);
  2041. kernel_end = SUN4C_REAL_PGDIR_ALIGN(kernel_end);
  2042. pages_avail = 0;
  2043. last_valid_pfn = bootmem_init(&pages_avail);
  2044. end_pfn = last_valid_pfn;
  2045. /* This does not logically belong here, but we need to
  2046.  * call it at the moment we are able to use the bootmem
  2047.  * allocator.
  2048.  */
  2049. sun_serial_setup();
  2050. sun4c_probe_mmu();
  2051. invalid_segment = (num_segmaps - 1);
  2052. sun4c_init_mmu_entry_pool();
  2053. sun4c_init_rings();
  2054. sun4c_init_map_kernelprom(kernel_end);
  2055. sun4c_init_clean_mmu(kernel_end);
  2056. sun4c_init_fill_kernel_ring(SUN4C_KERNEL_BUCKETS);
  2057. sun4c_init_lock_area(sparc_iomap.start, IOBASE_END);
  2058. sun4c_init_lock_area(DVMA_VADDR, DVMA_END);
  2059. sun4c_init_lock_areas();
  2060. sun4c_init_fill_user_ring();
  2061. sun4c_set_context(0);
  2062. memset(swapper_pg_dir, 0, PAGE_SIZE);
  2063. memset(pg0, 0, PAGE_SIZE);
  2064. memset(pg1, 0, PAGE_SIZE);
  2065. memset(pg2, 0, PAGE_SIZE);
  2066. memset(pg3, 0, PAGE_SIZE);
  2067. /* Save work later. */
  2068. vaddr = VMALLOC_START;
  2069. swapper_pg_dir[vaddr>>SUN4C_PGDIR_SHIFT] = __pgd(PGD_TABLE | (unsigned long) pg0);
  2070. vaddr += SUN4C_PGDIR_SIZE;
  2071. swapper_pg_dir[vaddr>>SUN4C_PGDIR_SHIFT] = __pgd(PGD_TABLE | (unsigned long) pg1);
  2072. vaddr += SUN4C_PGDIR_SIZE;
  2073. swapper_pg_dir[vaddr>>SUN4C_PGDIR_SHIFT] = __pgd(PGD_TABLE | (unsigned long) pg2);
  2074. vaddr += SUN4C_PGDIR_SIZE;
  2075. swapper_pg_dir[vaddr>>SUN4C_PGDIR_SHIFT] = __pgd(PGD_TABLE | (unsigned long) pg3);
  2076. sun4c_init_ss2_cache_bug();
  2077. sparc_context_init(num_contexts);
  2078. {
  2079. unsigned long zones_size[MAX_NR_ZONES];
  2080. unsigned long zholes_size[MAX_NR_ZONES];
  2081. unsigned long npages;
  2082. int znum;
  2083. for (znum = 0; znum < MAX_NR_ZONES; znum++)
  2084. zones_size[znum] = zholes_size[znum] = 0;
  2085. npages = max_low_pfn - (phys_base >> PAGE_SHIFT);
  2086. zones_size[ZONE_DMA] = npages;
  2087. zholes_size[ZONE_DMA] = npages - pages_avail;
  2088. npages = highend_pfn - max_low_pfn;
  2089. zones_size[ZONE_HIGHMEM] = npages;
  2090. zholes_size[ZONE_HIGHMEM] = npages - calc_highpages();
  2091. free_area_init_node(0, NULL, NULL, zones_size,
  2092.     phys_base, zholes_size);
  2093. }
  2094. cnt = 0;
  2095. for (i = 0; i < num_segmaps; i++)
  2096. if (mmu_entry_pool[i].locked)
  2097. cnt++;
  2098. max_user_taken_entries = num_segmaps - cnt - 40 - 1;
  2099. printk("SUN4C: %d mmu entries for the kerneln", cnt);
  2100. }
  2101. /* Load up routines and constants for sun4c mmu */
  2102. void __init ld_mmu_sun4c(void)
  2103. {
  2104. extern void ___xchg32_sun4c(void);
  2105. printk("Loading sun4c MMU routinesn");
  2106. /* First the constants */
  2107. BTFIXUPSET_SIMM13(pmd_shift, SUN4C_PMD_SHIFT);
  2108. BTFIXUPSET_SETHI(pmd_size, SUN4C_PMD_SIZE);
  2109. BTFIXUPSET_SETHI(pmd_mask, SUN4C_PMD_MASK);
  2110. BTFIXUPSET_SIMM13(pgdir_shift, SUN4C_PGDIR_SHIFT);
  2111. BTFIXUPSET_SETHI(pgdir_size, SUN4C_PGDIR_SIZE);
  2112. BTFIXUPSET_SETHI(pgdir_mask, SUN4C_PGDIR_MASK);
  2113. BTFIXUPSET_SIMM13(ptrs_per_pte, SUN4C_PTRS_PER_PTE);
  2114. BTFIXUPSET_SIMM13(ptrs_per_pmd, SUN4C_PTRS_PER_PMD);
  2115. BTFIXUPSET_SIMM13(ptrs_per_pgd, SUN4C_PTRS_PER_PGD);
  2116. BTFIXUPSET_SIMM13(user_ptrs_per_pgd, KERNBASE / SUN4C_PGDIR_SIZE);
  2117. BTFIXUPSET_INT(page_none, pgprot_val(SUN4C_PAGE_NONE));
  2118. BTFIXUPSET_INT(page_shared, pgprot_val(SUN4C_PAGE_SHARED));
  2119. BTFIXUPSET_INT(page_copy, pgprot_val(SUN4C_PAGE_COPY));
  2120. BTFIXUPSET_INT(page_readonly, pgprot_val(SUN4C_PAGE_READONLY));
  2121. BTFIXUPSET_INT(page_kernel, pgprot_val(SUN4C_PAGE_KERNEL));
  2122. page_kernel = pgprot_val(SUN4C_PAGE_KERNEL);
  2123. pg_iobits = _SUN4C_PAGE_PRESENT | _SUN4C_READABLE | _SUN4C_WRITEABLE |
  2124.     _SUN4C_PAGE_IO | _SUN4C_PAGE_NOCACHE;
  2125. /* Functions */
  2126. #ifndef CONFIG_SMP
  2127. BTFIXUPSET_CALL(___xchg32, ___xchg32_sun4c, BTFIXUPCALL_NORM);
  2128. #endif
  2129. BTFIXUPSET_CALL(do_check_pgt_cache, sun4c_check_pgt_cache, BTFIXUPCALL_NORM);
  2130. BTFIXUPSET_CALL(flush_cache_all, sun4c_flush_cache_all, BTFIXUPCALL_NORM);
  2131. if (sun4c_vacinfo.do_hwflushes) {
  2132. BTFIXUPSET_CALL(flush_cache_mm, sun4c_flush_cache_mm_hw, BTFIXUPCALL_NORM);
  2133. BTFIXUPSET_CALL(flush_cache_range, sun4c_flush_cache_range_hw, BTFIXUPCALL_NORM);
  2134. BTFIXUPSET_CALL(flush_cache_page, sun4c_flush_cache_page_hw, BTFIXUPCALL_NORM);
  2135. BTFIXUPSET_CALL(__flush_page_to_ram, sun4c_flush_page_to_ram_hw, BTFIXUPCALL_NORM);
  2136. BTFIXUPSET_CALL(flush_tlb_mm, sun4c_flush_tlb_mm_hw, BTFIXUPCALL_NORM);
  2137. BTFIXUPSET_CALL(flush_tlb_range, sun4c_flush_tlb_range_hw, BTFIXUPCALL_NORM);
  2138. BTFIXUPSET_CALL(flush_tlb_page, sun4c_flush_tlb_page_hw, BTFIXUPCALL_NORM);
  2139. BTFIXUPSET_CALL(free_task_struct, sun4c_free_task_struct_hw, BTFIXUPCALL_NORM);
  2140. BTFIXUPSET_CALL(switch_mm, sun4c_switch_mm_hw, BTFIXUPCALL_NORM);
  2141. BTFIXUPSET_CALL(destroy_context, sun4c_destroy_context_hw, BTFIXUPCALL_NORM);
  2142. } else {
  2143. BTFIXUPSET_CALL(flush_cache_mm, sun4c_flush_cache_mm_sw, BTFIXUPCALL_NORM);
  2144. BTFIXUPSET_CALL(flush_cache_range, sun4c_flush_cache_range_sw, BTFIXUPCALL_NORM);
  2145. BTFIXUPSET_CALL(flush_cache_page, sun4c_flush_cache_page_sw, BTFIXUPCALL_NORM);
  2146. BTFIXUPSET_CALL(__flush_page_to_ram, sun4c_flush_page_to_ram_sw, BTFIXUPCALL_NORM);
  2147. BTFIXUPSET_CALL(flush_tlb_mm, sun4c_flush_tlb_mm_sw, BTFIXUPCALL_NORM);
  2148. BTFIXUPSET_CALL(flush_tlb_range, sun4c_flush_tlb_range_sw, BTFIXUPCALL_NORM);
  2149. BTFIXUPSET_CALL(flush_tlb_page, sun4c_flush_tlb_page_sw, BTFIXUPCALL_NORM);
  2150. BTFIXUPSET_CALL(free_task_struct, sun4c_free_task_struct_sw, BTFIXUPCALL_NORM);
  2151. BTFIXUPSET_CALL(switch_mm, sun4c_switch_mm_sw, BTFIXUPCALL_NORM);
  2152. BTFIXUPSET_CALL(destroy_context, sun4c_destroy_context_sw, BTFIXUPCALL_NORM);
  2153. }
  2154. BTFIXUPSET_CALL(flush_tlb_all, sun4c_flush_tlb_all, BTFIXUPCALL_NORM);
  2155. BTFIXUPSET_CALL(flush_sig_insns, sun4c_flush_sig_insns, BTFIXUPCALL_NOP);
  2156. BTFIXUPSET_CALL(set_pte, sun4c_set_pte, BTFIXUPCALL_STO1O0);
  2157. BTFIXUPSET_CALL(pte_page, sun4c_pte_page, BTFIXUPCALL_NORM);
  2158. #if PAGE_SHIFT <= 12
  2159. BTFIXUPSET_CALL(pmd_page, sun4c_pmd_page, BTFIXUPCALL_ANDNINT(PAGE_SIZE - 1));
  2160. #else
  2161. BTFIXUPSET_CALL(pmd_page, sun4c_pmd_page, BTFIXUPCALL_NORM);
  2162. #endif
  2163. BTFIXUPSET_CALL(pte_present, sun4c_pte_present, BTFIXUPCALL_NORM);
  2164. BTFIXUPSET_CALL(pte_clear, sun4c_pte_clear, BTFIXUPCALL_STG0O0);
  2165. BTFIXUPSET_CALL(pmd_bad, sun4c_pmd_bad, BTFIXUPCALL_NORM);
  2166. BTFIXUPSET_CALL(pmd_present, sun4c_pmd_present, BTFIXUPCALL_NORM);
  2167. BTFIXUPSET_CALL(pmd_clear, sun4c_pmd_clear, BTFIXUPCALL_STG0O0);
  2168. BTFIXUPSET_CALL(pgd_none, sun4c_pgd_none, BTFIXUPCALL_RETINT(0));
  2169. BTFIXUPSET_CALL(pgd_bad, sun4c_pgd_bad, BTFIXUPCALL_RETINT(0));
  2170. BTFIXUPSET_CALL(pgd_present, sun4c_pgd_present, BTFIXUPCALL_RETINT(1));
  2171. BTFIXUPSET_CALL(pgd_clear, sun4c_pgd_clear, BTFIXUPCALL_NOP);
  2172. BTFIXUPSET_CALL(mk_pte, sun4c_mk_pte, BTFIXUPCALL_NORM);
  2173. BTFIXUPSET_CALL(mk_pte_phys, sun4c_mk_pte_phys, BTFIXUPCALL_NORM);
  2174. BTFIXUPSET_CALL(mk_pte_io, sun4c_mk_pte_io, BTFIXUPCALL_NORM);
  2175. BTFIXUPSET_INT(pte_modify_mask, _SUN4C_PAGE_CHG_MASK);
  2176. BTFIXUPSET_CALL(pmd_offset, sun4c_pmd_offset, BTFIXUPCALL_NORM);
  2177. BTFIXUPSET_CALL(pte_offset, sun4c_pte_offset, BTFIXUPCALL_NORM);
  2178. BTFIXUPSET_CALL(free_pte_fast, sun4c_free_pte_fast, BTFIXUPCALL_NORM);
  2179. BTFIXUPSET_CALL(pte_alloc_one, sun4c_pte_alloc_one, BTFIXUPCALL_NORM);
  2180. BTFIXUPSET_CALL(pte_alloc_one_fast, sun4c_pte_alloc_one_fast, BTFIXUPCALL_NORM);
  2181. BTFIXUPSET_CALL(free_pmd_fast, sun4c_free_pmd_fast, BTFIXUPCALL_NOP);
  2182. BTFIXUPSET_CALL(pmd_alloc_one_fast, sun4c_pmd_alloc_one_fast, BTFIXUPCALL_RETO0);
  2183. BTFIXUPSET_CALL(free_pgd_fast, sun4c_free_pgd_fast, BTFIXUPCALL_NORM);
  2184. BTFIXUPSET_CALL(get_pgd_fast, sun4c_get_pgd_fast, BTFIXUPCALL_NORM);
  2185. BTFIXUPSET_HALF(pte_writei, _SUN4C_PAGE_WRITE);
  2186. BTFIXUPSET_HALF(pte_dirtyi, _SUN4C_PAGE_MODIFIED);
  2187. BTFIXUPSET_HALF(pte_youngi, _SUN4C_PAGE_ACCESSED);
  2188. BTFIXUPSET_HALF(pte_wrprotecti, _SUN4C_PAGE_WRITE|_SUN4C_PAGE_SILENT_WRITE);
  2189. BTFIXUPSET_HALF(pte_mkcleani, _SUN4C_PAGE_MODIFIED|_SUN4C_PAGE_SILENT_WRITE);
  2190. BTFIXUPSET_HALF(pte_mkoldi, _SUN4C_PAGE_ACCESSED|_SUN4C_PAGE_SILENT_READ);
  2191. BTFIXUPSET_CALL(pte_mkwrite, sun4c_pte_mkwrite, BTFIXUPCALL_NORM);
  2192. BTFIXUPSET_CALL(pte_mkdirty, sun4c_pte_mkdirty, BTFIXUPCALL_NORM);
  2193. BTFIXUPSET_CALL(pte_mkyoung, sun4c_pte_mkyoung, BTFIXUPCALL_NORM);
  2194. BTFIXUPSET_CALL(update_mmu_cache, sun4c_update_mmu_cache, BTFIXUPCALL_NORM);
  2195. BTFIXUPSET_CALL(mmu_lockarea, sun4c_lockarea, BTFIXUPCALL_NORM);
  2196. BTFIXUPSET_CALL(mmu_unlockarea, sun4c_unlockarea, BTFIXUPCALL_NORM);
  2197. BTFIXUPSET_CALL(mmu_get_scsi_one, sun4c_get_scsi_one, BTFIXUPCALL_NORM);
  2198. BTFIXUPSET_CALL(mmu_get_scsi_sgl, sun4c_get_scsi_sgl, BTFIXUPCALL_NORM);
  2199. BTFIXUPSET_CALL(mmu_release_scsi_one, sun4c_release_scsi_one, BTFIXUPCALL_NORM);
  2200. BTFIXUPSET_CALL(mmu_release_scsi_sgl, sun4c_release_scsi_sgl, BTFIXUPCALL_NORM);
  2201. BTFIXUPSET_CALL(mmu_map_dma_area, sun4c_map_dma_area, BTFIXUPCALL_NORM);
  2202. BTFIXUPSET_CALL(mmu_unmap_dma_area, sun4c_unmap_dma_area, BTFIXUPCALL_NORM);
  2203. BTFIXUPSET_CALL(mmu_translate_dvma, sun4c_translate_dvma, BTFIXUPCALL_NORM);
  2204. /* Task struct and kernel stack allocating/freeing. */
  2205. BTFIXUPSET_CALL(alloc_task_struct, sun4c_alloc_task_struct, BTFIXUPCALL_NORM);
  2206. BTFIXUPSET_CALL(get_task_struct, sun4c_get_task_struct, BTFIXUPCALL_NORM);
  2207. BTFIXUPSET_CALL(mmu_info, sun4c_mmu_info, BTFIXUPCALL_NORM);
  2208. /* These should _never_ get called with two level tables. */
  2209. BTFIXUPSET_CALL(pgd_set, sun4c_pgd_set, BTFIXUPCALL_NOP);
  2210. BTFIXUPSET_CALL(pgd_page, sun4c_pgd_page, BTFIXUPCALL_RETO0);
  2211. BTFIXUPSET_CALL(pmd_set, sun4c_pmd_set, BTFIXUPCALL_NOP);
  2212. }