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

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*  $Id: init.c,v 1.207 2001/11/30 06:55:39 davem Exp $
  2.  *  arch/sparc64/mm/init.c
  3.  *
  4.  *  Copyright (C) 1996-1999 David S. Miller (davem@caip.rutgers.edu)
  5.  *  Copyright (C) 1997-1999 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
  6.  */
  7.  
  8. #include <linux/config.h>
  9. #include <linux/kernel.h>
  10. #include <linux/sched.h>
  11. #include <linux/string.h>
  12. #include <linux/init.h>
  13. #include <linux/bootmem.h>
  14. #include <linux/mm.h>
  15. #include <linux/slab.h>
  16. #include <linux/blk.h>
  17. #include <linux/swap.h>
  18. #include <linux/swapctl.h>
  19. #include <linux/pagemap.h>
  20. #include <linux/fs.h>
  21. #include <linux/seq_file.h>
  22. #include <asm/head.h>
  23. #include <asm/system.h>
  24. #include <asm/page.h>
  25. #include <asm/pgalloc.h>
  26. #include <asm/pgtable.h>
  27. #include <asm/oplib.h>
  28. #include <asm/iommu.h>
  29. #include <asm/io.h>
  30. #include <asm/uaccess.h>
  31. #include <asm/mmu_context.h>
  32. #include <asm/dma.h>
  33. #include <asm/starfire.h>
  34. #include <asm/tlb.h>
  35. #include <asm/spitfire.h>
  36. mmu_gather_t mmu_gathers[NR_CPUS];
  37. extern void device_scan(void);
  38. struct sparc_phys_banks sp_banks[SPARC_PHYS_BANKS];
  39. unsigned long *sparc64_valid_addr_bitmap;
  40. /* Ugly, but necessary... -DaveM */
  41. unsigned long phys_base;
  42. enum ultra_tlb_layout tlb_type = spitfire;
  43. /* get_new_mmu_context() uses "cache + 1".  */
  44. spinlock_t ctx_alloc_lock = SPIN_LOCK_UNLOCKED;
  45. unsigned long tlb_context_cache = CTX_FIRST_VERSION - 1;
  46. #define CTX_BMAP_SLOTS (1UL << (CTX_VERSION_SHIFT - 6))
  47. unsigned long mmu_context_bmap[CTX_BMAP_SLOTS];
  48. /* References to section boundaries */
  49. extern char __init_begin, __init_end, _start, _end, etext, edata;
  50. /* Initial ramdisk setup */
  51. extern unsigned int sparc_ramdisk_image;
  52. extern unsigned int sparc_ramdisk_size;
  53. struct page *mem_map_zero;
  54. int bigkernel = 0;
  55. int do_check_pgt_cache(int low, int high)
  56. {
  57.         int freed = 0;
  58. if (pgtable_cache_size > high) {
  59. do {
  60. #ifdef CONFIG_SMP
  61. if (pgd_quicklist)
  62. free_pgd_slow(get_pgd_fast()), freed++;
  63. #endif
  64. if (pte_quicklist[0])
  65. free_pte_slow(pte_alloc_one_fast(NULL, 0)), freed++;
  66. if (pte_quicklist[1])
  67. free_pte_slow(pte_alloc_one_fast(NULL, 1 << (PAGE_SHIFT + 10))), freed++;
  68. } while (pgtable_cache_size > low);
  69. }
  70. #ifndef CONFIG_SMP 
  71.         if (pgd_cache_size > high / 4) {
  72. struct page *page, *page2;
  73.                 for (page2 = NULL, page = (struct page *)pgd_quicklist; page;) {
  74.                         if ((unsigned long)page->pprev_hash == 3) {
  75.                                 if (page2)
  76.                                         page2->next_hash = page->next_hash;
  77.                                 else
  78.                                         (struct page *)pgd_quicklist = page->next_hash;
  79.                                 page->next_hash = NULL;
  80.                                 page->pprev_hash = NULL;
  81.                                 pgd_cache_size -= 2;
  82.                                 __free_page(page);
  83.                                 freed++;
  84.                                 if (page2)
  85.                                         page = page2->next_hash;
  86.                                 else
  87.                                         page = (struct page *)pgd_quicklist;
  88.                                 if (pgd_cache_size <= low / 4)
  89.                                         break;
  90.                                 continue;
  91.                         }
  92.                         page2 = page;
  93.                         page = page->next_hash;
  94.                 }
  95.         }
  96. #endif
  97.         return freed;
  98. }
  99. extern void __update_mmu_cache(struct vm_area_struct *, unsigned long, pte_t);
  100. #ifdef CONFIG_DEBUG_DCFLUSH
  101. atomic_t dcpage_flushes = ATOMIC_INIT(0);
  102. #ifdef CONFIG_SMP
  103. atomic_t dcpage_flushes_xcall = ATOMIC_INIT(0);
  104. #endif
  105. #endif
  106. __inline__ void flush_dcache_page_impl(struct page *page)
  107. {
  108. #ifdef CONFIG_DEBUG_DCFLUSH
  109. atomic_inc(&dcpage_flushes);
  110. #endif
  111. #if (L1DCACHE_SIZE > PAGE_SIZE)
  112. __flush_dcache_page(page->virtual,
  113.     ((tlb_type == spitfire) &&
  114.      page->mapping != NULL));
  115. #else
  116. if (page->mapping != NULL &&
  117.     tlb_type == spitfire)
  118. __flush_icache_page(__pa(page->virtual));
  119. #endif
  120. }
  121. #define PG_dcache_dirty PG_arch_1
  122. #define dcache_dirty_cpu(page) 
  123. (((page)->flags >> 24) & (NR_CPUS - 1UL))
  124. static __inline__ void set_dcache_dirty(struct page *page)
  125. {
  126. unsigned long mask = smp_processor_id();
  127. unsigned long non_cpu_bits = (1UL << 24UL) - 1UL;
  128. mask = (mask << 24) | (1UL << PG_dcache_dirty);
  129. __asm__ __volatile__("1:nt"
  130.      "ldx [%2], %%g7nt"
  131.      "and %%g7, %1, %%g5nt"
  132.      "or %%g5, %0, %%g5nt"
  133.      "casx [%2], %%g7, %%g5nt"
  134.      "cmp %%g7, %%g5nt"
  135.      "bne,pn %%xcc, 1bnt"
  136.      " membar #StoreLoad | #StoreStore"
  137.      : /* no outputs */
  138.      : "r" (mask), "r" (non_cpu_bits), "r" (&page->flags)
  139.      : "g5", "g7");
  140. }
  141. static __inline__ void clear_dcache_dirty_cpu(struct page *page, unsigned long cpu)
  142. {
  143. unsigned long mask = (1UL << PG_dcache_dirty);
  144. __asm__ __volatile__("! test_and_clear_dcache_dirtyn"
  145.      "1:nt"
  146.      "ldx [%2], %%g7nt"
  147.      "srlx %%g7, 24, %%g5nt"
  148.      "cmp %%g5, %0nt"
  149.      "bne,pn %%icc, 2fnt"
  150.      " andn %%g7, %1, %%g5nt"
  151.      "casx [%2], %%g7, %%g5nt"
  152.      "cmp %%g7, %%g5nt"
  153.      "bne,pn %%xcc, 1bnt"
  154.      " membar #StoreLoad | #StoreStoren"
  155.      "2:"
  156.      : /* no outputs */
  157.      : "r" (cpu), "r" (mask), "r" (&page->flags)
  158.      : "g5", "g7");
  159. }
  160. void update_mmu_cache(struct vm_area_struct *vma, unsigned long address, pte_t pte)
  161. {
  162. struct page *page = pte_page(pte);
  163. unsigned long pg_flags;
  164. if (VALID_PAGE(page) &&
  165.     page->mapping &&
  166.     ((pg_flags = page->flags) & (1UL << PG_dcache_dirty))) {
  167. int cpu = (pg_flags >> 24);
  168. /* This is just to optimize away some function calls
  169.  * in the SMP case.
  170.  */
  171. if (cpu == smp_processor_id())
  172. flush_dcache_page_impl(page);
  173. else
  174. smp_flush_dcache_page_impl(page, cpu);
  175. clear_dcache_dirty_cpu(page, cpu);
  176. }
  177. __update_mmu_cache(vma, address, pte);
  178. }
  179. void flush_dcache_page(struct page *page)
  180. {
  181. int dirty = test_bit(PG_dcache_dirty, &page->flags);
  182. int dirty_cpu = dcache_dirty_cpu(page);
  183. if (page->mapping &&
  184.     page->mapping->i_mmap == NULL &&
  185.     page->mapping->i_mmap_shared == NULL) {
  186. if (dirty) {
  187. if (dirty_cpu == smp_processor_id())
  188. return;
  189. smp_flush_dcache_page_impl(page, dirty_cpu);
  190. }
  191. set_dcache_dirty(page);
  192. } else {
  193. /* We could delay the flush for the !page->mapping
  194.  * case too.  But that case is for exec env/arg
  195.  * pages and those are %99 certainly going to get
  196.  * faulted into the tlb (and thus flushed) anyways.
  197.  */
  198. flush_dcache_page_impl(page);
  199. }
  200. }
  201. void flush_icache_range(unsigned long start, unsigned long end)
  202. {
  203. /* Cheetah has coherent I-cache. */
  204. if (tlb_type == spitfire) {
  205. unsigned long kaddr;
  206. for (kaddr = start; kaddr < end; kaddr += PAGE_SIZE)
  207. __flush_icache_page(__get_phys(kaddr));
  208. }
  209. }
  210. void show_mem(void)
  211. {
  212. printk("Mem-info:n");
  213. show_free_areas();
  214. printk("Free swap:       %6dkBn",
  215.        nr_swap_pages << (PAGE_SHIFT-10));
  216. printk("%ld pages of RAMn", num_physpages);
  217. printk("%d free pagesn", nr_free_pages());
  218. printk("%d pages in page table cachen",pgtable_cache_size);
  219. #ifndef CONFIG_SMP
  220. printk("%d entries in page dir cachen",pgd_cache_size);
  221. #endif
  222. show_buffers();
  223. }
  224. void mmu_info(struct seq_file *m)
  225. {
  226. if (tlb_type == cheetah)
  227. seq_printf(m, "MMU Typet: Cheetahn");
  228. else if (tlb_type == cheetah_plus)
  229. seq_printf(m, "MMU Typet: Cheetah+n");
  230. else if (tlb_type == spitfire)
  231. seq_printf(m, "MMU Typet: Spitfiren");
  232. else
  233. seq_printf(m, "MMU Typet: ???n");
  234. #ifdef CONFIG_DEBUG_DCFLUSH
  235. seq_printf(m, "DCPageFlushest: %dn",
  236.    atomic_read(&dcpage_flushes));
  237. #ifdef CONFIG_SMP
  238. seq_printf(m, "DCPageFlushesXCt: %dn",
  239.    atomic_read(&dcpage_flushes_xcall));
  240. #endif /* CONFIG_SMP */
  241. #endif /* CONFIG_DEBUG_DCFLUSH */
  242. }
  243. struct linux_prom_translation {
  244. unsigned long virt;
  245. unsigned long size;
  246. unsigned long data;
  247. };
  248. extern unsigned long prom_boot_page;
  249. extern void prom_remap(unsigned long physpage, unsigned long virtpage, int mmu_ihandle);
  250. extern int prom_get_mmu_ihandle(void);
  251. extern void register_prom_callbacks(void);
  252. /* Exported for SMP bootup purposes. */
  253. unsigned long kern_locked_tte_data;
  254. void __init early_pgtable_allocfail(char *type)
  255. {
  256. prom_printf("inherit_prom_mappings: Cannot alloc kernel %s.n", type);
  257. prom_halt();
  258. }
  259. #define BASE_PAGE_SIZE 8192
  260. static pmd_t *prompmd;
  261. /*
  262.  * Translate PROM's mapping we capture at boot time into physical address.
  263.  * The second parameter is only set from prom_callback() invocations.
  264.  */
  265. unsigned long prom_virt_to_phys(unsigned long promva, int *error)
  266. {
  267. pmd_t *pmdp = prompmd + ((promva >> 23) & 0x7ff);
  268. pte_t *ptep;
  269. unsigned long base;
  270. if (pmd_none(*pmdp)) {
  271. if (error)
  272. *error = 1;
  273. return(0);
  274. }
  275. ptep = (pte_t *)pmd_page(*pmdp) + ((promva >> 13) & 0x3ff);
  276. if (!pte_present(*ptep)) {
  277. if (error)
  278. *error = 1;
  279. return(0);
  280. }
  281. if (error) {
  282. *error = 0;
  283. return(pte_val(*ptep));
  284. }
  285. base = pte_val(*ptep) & _PAGE_PADDR;
  286. return(base + (promva & (BASE_PAGE_SIZE - 1)));
  287. }
  288. static void inherit_prom_mappings(void)
  289. {
  290. struct linux_prom_translation *trans;
  291. unsigned long phys_page, tte_vaddr, tte_data;
  292. void (*remap_func)(unsigned long, unsigned long, int);
  293. pmd_t *pmdp;
  294. pte_t *ptep;
  295. int node, n, i, tsz;
  296. extern unsigned int obp_iaddr_patch[2], obp_daddr_patch[2];
  297. node = prom_finddevice("/virtual-memory");
  298. n = prom_getproplen(node, "translations");
  299. if (n == 0 || n == -1) {
  300. prom_printf("Couldn't get translation propertyn");
  301. prom_halt();
  302. }
  303. n += 5 * sizeof(struct linux_prom_translation);
  304. for (tsz = 1; tsz < n; tsz <<= 1)
  305. /* empty */;
  306. trans = __alloc_bootmem(tsz, SMP_CACHE_BYTES, 0UL);
  307. if (trans == NULL) {
  308. prom_printf("inherit_prom_mappings: Cannot alloc translations.n");
  309. prom_halt();
  310. }
  311. memset(trans, 0, tsz);
  312. if ((n = prom_getproperty(node, "translations", (char *)trans, tsz)) == -1) {
  313. prom_printf("Couldn't get translation propertyn");
  314. prom_halt();
  315. }
  316. n = n / sizeof(*trans);
  317. /*
  318.  * The obp translations are saved based on 8k pagesize, since obp can use
  319.  * a mixture of pagesizes. Misses to the 0xf0000000 - 0x100000000, ie obp 
  320.  * range, are handled in entry.S and do not use the vpte scheme (see rant
  321.  * in inherit_locked_prom_mappings()).
  322.  */
  323. #define OBP_PMD_SIZE 2048
  324. prompmd = __alloc_bootmem(OBP_PMD_SIZE, OBP_PMD_SIZE, 0UL);
  325. if (prompmd == NULL)
  326. early_pgtable_allocfail("pmd");
  327. memset(prompmd, 0, OBP_PMD_SIZE);
  328. for (i = 0; i < n; i++) {
  329. unsigned long vaddr;
  330. if (trans[i].virt >= LOW_OBP_ADDRESS && trans[i].virt < HI_OBP_ADDRESS) {
  331. for (vaddr = trans[i].virt;
  332.      ((vaddr < trans[i].virt + trans[i].size) && 
  333.      (vaddr < HI_OBP_ADDRESS));
  334.      vaddr += BASE_PAGE_SIZE) {
  335. unsigned long val;
  336. pmdp = prompmd + ((vaddr >> 23) & 0x7ff);
  337. if (pmd_none(*pmdp)) {
  338. ptep = __alloc_bootmem(BASE_PAGE_SIZE,
  339.        BASE_PAGE_SIZE,
  340.        0UL);
  341. if (ptep == NULL)
  342. early_pgtable_allocfail("pte");
  343. memset(ptep, 0, BASE_PAGE_SIZE);
  344. pmd_set(pmdp, ptep);
  345. }
  346. ptep = (pte_t *)pmd_page(*pmdp) +
  347. ((vaddr >> 13) & 0x3ff);
  348. val = trans[i].data;
  349. /* Clear diag TTE bits. */
  350. if (tlb_type == spitfire)
  351. val &= ~0x0003fe0000000000UL;
  352. set_pte (ptep, __pte(val | _PAGE_MODIFIED));
  353. trans[i].data += BASE_PAGE_SIZE;
  354. }
  355. }
  356. }
  357. phys_page = __pa(prompmd);
  358. obp_iaddr_patch[0] |= (phys_page >> 10);
  359. obp_iaddr_patch[1] |= (phys_page & 0x3ff);
  360. flushi((long)&obp_iaddr_patch[0]);
  361. obp_daddr_patch[0] |= (phys_page >> 10);
  362. obp_daddr_patch[1] |= (phys_page & 0x3ff);
  363. flushi((long)&obp_daddr_patch[0]);
  364. /* Now fixup OBP's idea about where we really are mapped. */
  365. prom_printf("Remapping the kernel... ");
  366. /* Spitfire Errata #32 workaround */
  367. __asm__ __volatile__("stxa %0, [%1] %2nt"
  368.      "flush %%g6"
  369.      : /* No outputs */
  370.      : "r" (0),
  371.      "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
  372. switch (tlb_type) {
  373. default:
  374. case spitfire:
  375. phys_page = spitfire_get_dtlb_data(sparc64_highest_locked_tlbent());
  376. break;
  377. case cheetah:
  378. case cheetah_plus:
  379. phys_page = cheetah_get_litlb_data(sparc64_highest_locked_tlbent());
  380. break;
  381. };
  382. phys_page &= _PAGE_PADDR;
  383. phys_page += ((unsigned long)&prom_boot_page -
  384.       (unsigned long)KERNBASE);
  385. if (tlb_type == spitfire) {
  386. /* Lock this into i/d tlb entry 59 */
  387. __asm__ __volatile__(
  388. "stxa %%g0, [%2] %3nt"
  389. "stxa %0, [%1] %4nt"
  390. "membar #Syncnt"
  391. "flush %%g6nt"
  392. "stxa %%g0, [%2] %5nt"
  393. "stxa %0, [%1] %6nt"
  394. "membar #Syncnt"
  395. "flush %%g6"
  396. : : "r" (phys_page | _PAGE_VALID | _PAGE_SZ8K | _PAGE_CP |
  397.  _PAGE_CV | _PAGE_P | _PAGE_L | _PAGE_W),
  398. "r" (59 << 3), "r" (TLB_TAG_ACCESS),
  399. "i" (ASI_DMMU), "i" (ASI_DTLB_DATA_ACCESS),
  400. "i" (ASI_IMMU), "i" (ASI_ITLB_DATA_ACCESS)
  401. : "memory");
  402. } else if (tlb_type == cheetah || tlb_type == cheetah_plus) {
  403. /* Lock this into i/d tlb-0 entry 11 */
  404. __asm__ __volatile__(
  405. "stxa %%g0, [%2] %3nt"
  406. "stxa %0, [%1] %4nt"
  407. "membar #Syncnt"
  408. "flush %%g6nt"
  409. "stxa %%g0, [%2] %5nt"
  410. "stxa %0, [%1] %6nt"
  411. "membar #Syncnt"
  412. "flush %%g6"
  413. : : "r" (phys_page | _PAGE_VALID | _PAGE_SZ8K | _PAGE_CP |
  414.  _PAGE_CV | _PAGE_P | _PAGE_L | _PAGE_W),
  415. "r" ((0 << 16) | (11 << 3)), "r" (TLB_TAG_ACCESS),
  416. "i" (ASI_DMMU), "i" (ASI_DTLB_DATA_ACCESS),
  417. "i" (ASI_IMMU), "i" (ASI_ITLB_DATA_ACCESS)
  418. : "memory");
  419. } else {
  420. /* Implement me :-) */
  421. BUG();
  422. }
  423. tte_vaddr = (unsigned long) KERNBASE;
  424. /* Spitfire Errata #32 workaround */
  425. __asm__ __volatile__("stxa %0, [%1] %2nt"
  426.      "flush %%g6"
  427.      : /* No outputs */
  428.      : "r" (0),
  429.      "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
  430. if (tlb_type == spitfire)
  431. tte_data = spitfire_get_dtlb_data(sparc64_highest_locked_tlbent());
  432. else
  433. tte_data = cheetah_get_ldtlb_data(sparc64_highest_locked_tlbent());
  434. kern_locked_tte_data = tte_data;
  435. remap_func = (void *)  ((unsigned long) &prom_remap -
  436. (unsigned long) &prom_boot_page);
  437. /* Spitfire Errata #32 workaround */
  438. __asm__ __volatile__("stxa %0, [%1] %2nt"
  439.      "flush %%g6"
  440.      : /* No outputs */
  441.      : "r" (0),
  442.      "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
  443. remap_func((tlb_type == spitfire ?
  444.     (spitfire_get_dtlb_data(sparc64_highest_locked_tlbent()) & _PAGE_PADDR) :
  445.     (cheetah_get_litlb_data(sparc64_highest_locked_tlbent()) & _PAGE_PADDR)),
  446.    (unsigned long) KERNBASE,
  447.    prom_get_mmu_ihandle());
  448. if (bigkernel)
  449. remap_func(((tte_data + 0x400000) & _PAGE_PADDR),
  450. (unsigned long) KERNBASE + 0x400000, prom_get_mmu_ihandle());
  451. /* Flush out that temporary mapping. */
  452. spitfire_flush_dtlb_nucleus_page(0x0);
  453. spitfire_flush_itlb_nucleus_page(0x0);
  454. /* Now lock us back into the TLBs via OBP. */
  455. prom_dtlb_load(sparc64_highest_locked_tlbent(), tte_data, tte_vaddr);
  456. prom_itlb_load(sparc64_highest_locked_tlbent(), tte_data, tte_vaddr);
  457. if (bigkernel) {
  458. prom_dtlb_load(sparc64_highest_locked_tlbent()-1, tte_data + 0x400000, 
  459. tte_vaddr + 0x400000);
  460. prom_itlb_load(sparc64_highest_locked_tlbent()-1, tte_data + 0x400000, 
  461. tte_vaddr + 0x400000);
  462. }
  463. /* Re-read translations property. */
  464. if ((n = prom_getproperty(node, "translations", (char *)trans, tsz)) == -1) {
  465. prom_printf("Couldn't get translation propertyn");
  466. prom_halt();
  467. }
  468. n = n / sizeof(*trans);
  469. for (i = 0; i < n; i++) {
  470. unsigned long vaddr = trans[i].virt;
  471. unsigned long size = trans[i].size;
  472. if (vaddr < 0xf0000000UL) {
  473. unsigned long avoid_start = (unsigned long) KERNBASE;
  474. unsigned long avoid_end = avoid_start + (4 * 1024 * 1024);
  475. if (bigkernel)
  476. avoid_end += (4 * 1024 * 1024);
  477. if (vaddr < avoid_start) {
  478. unsigned long top = vaddr + size;
  479. if (top > avoid_start)
  480. top = avoid_start;
  481. prom_unmap(top - vaddr, vaddr);
  482. }
  483. if ((vaddr + size) > avoid_end) {
  484. unsigned long bottom = vaddr;
  485. if (bottom < avoid_end)
  486. bottom = avoid_end;
  487. prom_unmap((vaddr + size) - bottom, bottom);
  488. }
  489. }
  490. }
  491. prom_printf("done.n");
  492. register_prom_callbacks();
  493. }
  494. /* The OBP specifications for sun4u mark 0xfffffffc00000000 and
  495.  * upwards as reserved for use by the firmware (I wonder if this
  496.  * will be the same on Cheetah...).  We use this virtual address
  497.  * range for the VPTE table mappings of the nucleus so we need
  498.  * to zap them when we enter the PROM.  -DaveM
  499.  */
  500. static void __flush_nucleus_vptes(void)
  501. {
  502. unsigned long prom_reserved_base = 0xfffffffc00000000UL;
  503. int i;
  504. /* Only DTLB must be checked for VPTE entries. */
  505. if (tlb_type == spitfire) {
  506. for (i = 0; i < 63; i++) {
  507. unsigned long tag;
  508. /* Spitfire Errata #32 workaround */
  509. __asm__ __volatile__("stxa %0, [%1] %2nt"
  510.      "flush %%g6"
  511.      : /* No outputs */
  512.      : "r" (0),
  513.      "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
  514. tag = spitfire_get_dtlb_tag(i);
  515. if (((tag & ~(PAGE_MASK)) == 0) &&
  516.     ((tag &  (PAGE_MASK)) >= prom_reserved_base)) {
  517. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  518.      "membar #Sync"
  519.      : /* no outputs */
  520.      : "r" (TLB_TAG_ACCESS), "i" (ASI_DMMU));
  521. spitfire_put_dtlb_data(i, 0x0UL);
  522. }
  523. }
  524. } else if (tlb_type == cheetah || tlb_type == cheetah_plus) {
  525. for (i = 0; i < 512; i++) {
  526. unsigned long tag = cheetah_get_dtlb_tag(i, 2);
  527. if ((tag & ~PAGE_MASK) == 0 &&
  528.     (tag & PAGE_MASK) >= prom_reserved_base) {
  529. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  530.      "membar #Sync"
  531.      : /* no outputs */
  532.      : "r" (TLB_TAG_ACCESS), "i" (ASI_DMMU));
  533. cheetah_put_dtlb_data(i, 0x0UL, 2);
  534. }
  535. if (tlb_type != cheetah_plus)
  536. continue;
  537. tag = cheetah_get_dtlb_tag(i, 3);
  538. if ((tag & ~PAGE_MASK) == 0 &&
  539.     (tag & PAGE_MASK) >= prom_reserved_base) {
  540. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  541.      "membar #Sync"
  542.      : /* no outputs */
  543.      : "r" (TLB_TAG_ACCESS), "i" (ASI_DMMU));
  544. cheetah_put_dtlb_data(i, 0x0UL, 3);
  545. }
  546. }
  547. } else {
  548. /* Implement me :-) */
  549. BUG();
  550. }
  551. }
  552. static int prom_ditlb_set;
  553. struct prom_tlb_entry {
  554. int tlb_ent;
  555. unsigned long tlb_tag;
  556. unsigned long tlb_data;
  557. };
  558. struct prom_tlb_entry prom_itlb[16], prom_dtlb[16];
  559. void prom_world(int enter)
  560. {
  561. unsigned long pstate;
  562. int i;
  563. if (!enter)
  564. set_fs(current->thread.current_ds);
  565. if (!prom_ditlb_set)
  566. return;
  567. /* Make sure the following runs atomically. */
  568. __asm__ __volatile__("flushwnt"
  569.      "rdpr %%pstate, %0nt"
  570.      "wrpr %0, %1, %%pstate"
  571.      : "=r" (pstate)
  572.      : "i" (PSTATE_IE));
  573. if (enter) {
  574. /* Kick out nucleus VPTEs. */
  575. __flush_nucleus_vptes();
  576. /* Install PROM world. */
  577. for (i = 0; i < 16; i++) {
  578. if (prom_dtlb[i].tlb_ent != -1) {
  579. __asm__ __volatile__("stxa %0, [%1] %2nt"
  580.      "membar #Sync"
  581. : : "r" (prom_dtlb[i].tlb_tag), "r" (TLB_TAG_ACCESS),
  582. "i" (ASI_DMMU));
  583. if (tlb_type == spitfire)
  584. spitfire_put_dtlb_data(prom_dtlb[i].tlb_ent,
  585.        prom_dtlb[i].tlb_data);
  586. else if (tlb_type == cheetah || tlb_type == cheetah_plus)
  587. cheetah_put_ldtlb_data(prom_dtlb[i].tlb_ent,
  588.        prom_dtlb[i].tlb_data);
  589. }
  590. if (prom_itlb[i].tlb_ent != -1) {
  591. __asm__ __volatile__("stxa %0, [%1] %2nt"
  592.      "membar #Sync"
  593.      : : "r" (prom_itlb[i].tlb_tag),
  594.      "r" (TLB_TAG_ACCESS),
  595.      "i" (ASI_IMMU));
  596. if (tlb_type == spitfire)
  597. spitfire_put_itlb_data(prom_itlb[i].tlb_ent,
  598.        prom_itlb[i].tlb_data);
  599. else if (tlb_type == cheetah || tlb_type == cheetah_plus)
  600. cheetah_put_litlb_data(prom_itlb[i].tlb_ent,
  601.        prom_itlb[i].tlb_data);
  602. }
  603. }
  604. } else {
  605. for (i = 0; i < 16; i++) {
  606. if (prom_dtlb[i].tlb_ent != -1) {
  607. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  608.      "membar #Sync"
  609. : : "r" (TLB_TAG_ACCESS), "i" (ASI_DMMU));
  610. if (tlb_type == spitfire)
  611. spitfire_put_dtlb_data(prom_dtlb[i].tlb_ent, 0x0UL);
  612. else
  613. cheetah_put_ldtlb_data(prom_dtlb[i].tlb_ent, 0x0UL);
  614. }
  615. if (prom_itlb[i].tlb_ent != -1) {
  616. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  617.      "membar #Sync"
  618.      : : "r" (TLB_TAG_ACCESS),
  619.      "i" (ASI_IMMU));
  620. if (tlb_type == spitfire)
  621. spitfire_put_itlb_data(prom_itlb[i].tlb_ent, 0x0UL);
  622. else
  623. cheetah_put_litlb_data(prom_itlb[i].tlb_ent, 0x0UL);
  624. }
  625. }
  626. }
  627. __asm__ __volatile__("wrpr %0, 0, %%pstate"
  628.      : : "r" (pstate));
  629. }
  630. void inherit_locked_prom_mappings(int save_p)
  631. {
  632. int i;
  633. int dtlb_seen = 0;
  634. int itlb_seen = 0;
  635. /* Fucking losing PROM has more mappings in the TLB, but
  636.  * it (conveniently) fails to mention any of these in the
  637.  * translations property.  The only ones that matter are
  638.  * the locked PROM tlb entries, so we impose the following
  639.  * irrecovable rule on the PROM, it is allowed 8 locked
  640.  * entries in the ITLB and 8 in the DTLB.
  641.  *
  642.  * Supposedly the upper 16GB of the address space is
  643.  * reserved for OBP, BUT I WISH THIS WAS DOCUMENTED
  644.  * SOMEWHERE!!!!!!!!!!!!!!!!!  Furthermore the entire interface
  645.  * used between the client program and the firmware on sun5
  646.  * systems to coordinate mmu mappings is also COMPLETELY
  647.  * UNDOCUMENTED!!!!!! Thanks S(t)un!
  648.  */
  649. if (save_p) {
  650. for (i = 0; i < 16; i++) {
  651. prom_itlb[i].tlb_ent = -1;
  652. prom_dtlb[i].tlb_ent = -1;
  653. }
  654. }
  655. if (tlb_type == spitfire) {
  656. int high = SPITFIRE_HIGHEST_LOCKED_TLBENT - bigkernel;
  657. for (i = 0; i < high; i++) {
  658. unsigned long data;
  659. /* Spitfire Errata #32 workaround */
  660. __asm__ __volatile__("stxa %0, [%1] %2nt"
  661.      "flush %%g6"
  662.      : /* No outputs */
  663.      : "r" (0),
  664.      "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
  665. data = spitfire_get_dtlb_data(i);
  666. if ((data & (_PAGE_L|_PAGE_VALID)) == (_PAGE_L|_PAGE_VALID)) {
  667. unsigned long tag;
  668. /* Spitfire Errata #32 workaround */
  669. __asm__ __volatile__("stxa %0, [%1] %2nt"
  670.      "flush %%g6"
  671.      : /* No outputs */
  672.      : "r" (0),
  673.      "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
  674. tag = spitfire_get_dtlb_tag(i);
  675. if (save_p) {
  676. prom_dtlb[dtlb_seen].tlb_ent = i;
  677. prom_dtlb[dtlb_seen].tlb_tag = tag;
  678. prom_dtlb[dtlb_seen].tlb_data = data;
  679. }
  680. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  681.      "membar #Sync"
  682.      : : "r" (TLB_TAG_ACCESS), "i" (ASI_DMMU));
  683. spitfire_put_dtlb_data(i, 0x0UL);
  684. dtlb_seen++;
  685. if (dtlb_seen > 15)
  686. break;
  687. }
  688. }
  689. for (i = 0; i < high; i++) {
  690. unsigned long data;
  691. /* Spitfire Errata #32 workaround */
  692. __asm__ __volatile__("stxa %0, [%1] %2nt"
  693.      "flush %%g6"
  694.      : /* No outputs */
  695.      : "r" (0),
  696.      "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
  697. data = spitfire_get_itlb_data(i);
  698. if ((data & (_PAGE_L|_PAGE_VALID)) == (_PAGE_L|_PAGE_VALID)) {
  699. unsigned long tag;
  700. /* Spitfire Errata #32 workaround */
  701. __asm__ __volatile__("stxa %0, [%1] %2nt"
  702.      "flush %%g6"
  703.      : /* No outputs */
  704.      : "r" (0),
  705.      "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
  706. tag = spitfire_get_itlb_tag(i);
  707. if (save_p) {
  708. prom_itlb[itlb_seen].tlb_ent = i;
  709. prom_itlb[itlb_seen].tlb_tag = tag;
  710. prom_itlb[itlb_seen].tlb_data = data;
  711. }
  712. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  713.      "membar #Sync"
  714.      : : "r" (TLB_TAG_ACCESS), "i" (ASI_IMMU));
  715. spitfire_put_itlb_data(i, 0x0UL);
  716. itlb_seen++;
  717. if (itlb_seen > 15)
  718. break;
  719. }
  720. }
  721. } else if (tlb_type == cheetah || tlb_type == cheetah_plus) {
  722. int high = CHEETAH_HIGHEST_LOCKED_TLBENT - bigkernel;
  723. for (i = 0; i < high; i++) {
  724. unsigned long data;
  725. data = cheetah_get_ldtlb_data(i);
  726. if ((data & (_PAGE_L|_PAGE_VALID)) == (_PAGE_L|_PAGE_VALID)) {
  727. unsigned long tag;
  728. tag = cheetah_get_ldtlb_tag(i);
  729. if (save_p) {
  730. prom_dtlb[dtlb_seen].tlb_ent = i;
  731. prom_dtlb[dtlb_seen].tlb_tag = tag;
  732. prom_dtlb[dtlb_seen].tlb_data = data;
  733. }
  734. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  735.      "membar #Sync"
  736.      : : "r" (TLB_TAG_ACCESS), "i" (ASI_DMMU));
  737. cheetah_put_ldtlb_data(i, 0x0UL);
  738. dtlb_seen++;
  739. if (dtlb_seen > 15)
  740. break;
  741. }
  742. }
  743. for (i = 0; i < high; i++) {
  744. unsigned long data;
  745. data = cheetah_get_litlb_data(i);
  746. if ((data & (_PAGE_L|_PAGE_VALID)) == (_PAGE_L|_PAGE_VALID)) {
  747. unsigned long tag;
  748. tag = cheetah_get_litlb_tag(i);
  749. if (save_p) {
  750. prom_itlb[itlb_seen].tlb_ent = i;
  751. prom_itlb[itlb_seen].tlb_tag = tag;
  752. prom_itlb[itlb_seen].tlb_data = data;
  753. }
  754. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  755.      "membar #Sync"
  756.      : : "r" (TLB_TAG_ACCESS), "i" (ASI_IMMU));
  757. cheetah_put_litlb_data(i, 0x0UL);
  758. itlb_seen++;
  759. if (itlb_seen > 15)
  760. break;
  761. }
  762. }
  763. } else {
  764. /* Implement me :-) */
  765. BUG();
  766. }
  767. if (save_p)
  768. prom_ditlb_set = 1;
  769. }
  770. /* Give PROM back his world, done during reboots... */
  771. void prom_reload_locked(void)
  772. {
  773. int i;
  774. for (i = 0; i < 16; i++) {
  775. if (prom_dtlb[i].tlb_ent != -1) {
  776. __asm__ __volatile__("stxa %0, [%1] %2nt"
  777.      "membar #Sync"
  778. : : "r" (prom_dtlb[i].tlb_tag), "r" (TLB_TAG_ACCESS),
  779. "i" (ASI_DMMU));
  780. if (tlb_type == spitfire)
  781. spitfire_put_dtlb_data(prom_dtlb[i].tlb_ent,
  782.        prom_dtlb[i].tlb_data);
  783. else if (tlb_type == cheetah || tlb_type == cheetah_plus)
  784. cheetah_put_ldtlb_data(prom_dtlb[i].tlb_ent,
  785.       prom_dtlb[i].tlb_data);
  786. }
  787. if (prom_itlb[i].tlb_ent != -1) {
  788. __asm__ __volatile__("stxa %0, [%1] %2nt"
  789.      "membar #Sync"
  790.      : : "r" (prom_itlb[i].tlb_tag),
  791.      "r" (TLB_TAG_ACCESS),
  792.      "i" (ASI_IMMU));
  793. if (tlb_type == spitfire)
  794. spitfire_put_itlb_data(prom_itlb[i].tlb_ent,
  795.        prom_itlb[i].tlb_data);
  796. else
  797. cheetah_put_litlb_data(prom_itlb[i].tlb_ent,
  798.        prom_itlb[i].tlb_data);
  799. }
  800. }
  801. }
  802. void __flush_dcache_range(unsigned long start, unsigned long end)
  803. {
  804. unsigned long va;
  805. if (tlb_type == spitfire) {
  806. int n = 0;
  807. for (va = start; va < end; va += 32) {
  808. spitfire_put_dcache_tag(va & 0x3fe0, 0x0);
  809. if (++n >= 512)
  810. break;
  811. }
  812. } else {
  813. start = __pa(start);
  814. end = __pa(end);
  815. for (va = start; va < end; va += 32)
  816. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  817.      "membar #Sync"
  818.      : /* no outputs */
  819.      : "r" (va),
  820.        "i" (ASI_DCACHE_INVALIDATE));
  821. }
  822. }
  823. void __flush_cache_all(void)
  824. {
  825. /* Cheetah should be fine here too. */
  826. if (tlb_type == spitfire) {
  827. unsigned long va;
  828. flushw_all();
  829. for (va =  0; va < (PAGE_SIZE << 1); va += 32)
  830. spitfire_put_icache_tag(va, 0x0);
  831. __asm__ __volatile__("flush %g6");
  832. }
  833. }
  834. /* If not locked, zap it. */
  835. void __flush_tlb_all(void)
  836. {
  837. unsigned long pstate;
  838. int i;
  839. __asm__ __volatile__("flushwnt"
  840.      "rdpr %%pstate, %0nt"
  841.      "wrpr %0, %1, %%pstate"
  842.      : "=r" (pstate)
  843.      : "i" (PSTATE_IE));
  844. if (tlb_type == spitfire) {
  845. for (i = 0; i < 64; i++) {
  846. /* Spitfire Errata #32 workaround */
  847. __asm__ __volatile__("stxa %0, [%1] %2nt"
  848.      "flush %%g6"
  849.      : /* No outputs */
  850.      : "r" (0),
  851.      "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
  852. if (!(spitfire_get_dtlb_data(i) & _PAGE_L)) {
  853. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  854.      "membar #Sync"
  855.      : /* no outputs */
  856.      : "r" (TLB_TAG_ACCESS), "i" (ASI_DMMU));
  857. spitfire_put_dtlb_data(i, 0x0UL);
  858. }
  859. /* Spitfire Errata #32 workaround */
  860. __asm__ __volatile__("stxa %0, [%1] %2nt"
  861.      "flush %%g6"
  862.      : /* No outputs */
  863.      : "r" (0),
  864.      "r" (PRIMARY_CONTEXT), "i" (ASI_DMMU));
  865. if (!(spitfire_get_itlb_data(i) & _PAGE_L)) {
  866. __asm__ __volatile__("stxa %%g0, [%0] %1nt"
  867.      "membar #Sync"
  868.      : /* no outputs */
  869.      : "r" (TLB_TAG_ACCESS), "i" (ASI_IMMU));
  870. spitfire_put_itlb_data(i, 0x0UL);
  871. }
  872. }
  873. } else if (tlb_type == cheetah || tlb_type == cheetah_plus) {
  874. cheetah_flush_dtlb_all();
  875. cheetah_flush_itlb_all();
  876. }
  877. __asm__ __volatile__("wrpr %0, 0, %%pstate"
  878.      : : "r" (pstate));
  879. }
  880. /* Caller does TLB context flushing on local CPU if necessary.
  881.  * The caller also ensures that CTX_VALID(mm->context) is false.
  882.  *
  883.  * We must be careful about boundary cases so that we never
  884.  * let the user have CTX 0 (nucleus) or we ever use a CTX
  885.  * version of zero (and thus NO_CONTEXT would not be caught
  886.  * by version mis-match tests in mmu_context.h).
  887.  */
  888. void get_new_mmu_context(struct mm_struct *mm)
  889. {
  890. unsigned long ctx, new_ctx;
  891. spin_lock(&ctx_alloc_lock);
  892. ctx = CTX_HWBITS(tlb_context_cache + 1);
  893. new_ctx = find_next_zero_bit(mmu_context_bmap, 1UL << CTX_VERSION_SHIFT, ctx);
  894. if (new_ctx >= (1UL << CTX_VERSION_SHIFT)) {
  895. new_ctx = find_next_zero_bit(mmu_context_bmap, ctx, 1);
  896. if (new_ctx >= ctx) {
  897. int i;
  898. new_ctx = (tlb_context_cache & CTX_VERSION_MASK) +
  899. CTX_FIRST_VERSION;
  900. if (new_ctx == 1)
  901. new_ctx = CTX_FIRST_VERSION;
  902. /* Don't call memset, for 16 entries that's just
  903.  * plain silly...
  904.  */
  905. mmu_context_bmap[0] = 3;
  906. mmu_context_bmap[1] = 0;
  907. mmu_context_bmap[2] = 0;
  908. mmu_context_bmap[3] = 0;
  909. for (i = 4; i < CTX_BMAP_SLOTS; i += 4) {
  910. mmu_context_bmap[i + 0] = 0;
  911. mmu_context_bmap[i + 1] = 0;
  912. mmu_context_bmap[i + 2] = 0;
  913. mmu_context_bmap[i + 3] = 0;
  914. }
  915. goto out;
  916. }
  917. }
  918. mmu_context_bmap[new_ctx>>6] |= (1UL << (new_ctx & 63));
  919. new_ctx |= (tlb_context_cache & CTX_VERSION_MASK);
  920. out:
  921. tlb_context_cache = new_ctx;
  922. spin_unlock(&ctx_alloc_lock);
  923. mm->context = new_ctx;
  924. }
  925. #ifndef CONFIG_SMP
  926. struct pgtable_cache_struct pgt_quicklists;
  927. #endif
  928. /* OK, we have to color these pages. The page tables are accessed
  929.  * by non-Dcache enabled mapping in the VPTE area by the dtlb_backend.S
  930.  * code, as well as by PAGE_OFFSET range direct-mapped addresses by 
  931.  * other parts of the kernel. By coloring, we make sure that the tlbmiss 
  932.  * fast handlers do not get data from old/garbage dcache lines that 
  933.  * correspond to an old/stale virtual address (user/kernel) that 
  934.  * previously mapped the pagetable page while accessing vpte range 
  935.  * addresses. The idea is that if the vpte color and PAGE_OFFSET range 
  936.  * color is the same, then when the kernel initializes the pagetable 
  937.  * using the later address range, accesses with the first address
  938.  * range will see the newly initialized data rather than the garbage.
  939.  */
  940. #if (L1DCACHE_SIZE > PAGE_SIZE) /* is there D$ aliasing problem */
  941. #define DC_ALIAS_SHIFT 1
  942. #else
  943. #define DC_ALIAS_SHIFT 0
  944. #endif
  945. pte_t *pte_alloc_one(struct mm_struct *mm, unsigned long address)
  946. {
  947. struct page *page = alloc_pages(GFP_KERNEL, DC_ALIAS_SHIFT);
  948. unsigned long color = VPTE_COLOR(address);
  949. if (page) {
  950. unsigned long *to_free;
  951. unsigned long paddr;
  952. pte_t *pte;
  953. #if (L1DCACHE_SIZE > PAGE_SIZE) /* is there D$ aliasing problem */
  954. set_page_count((page + 1), 1);
  955. #endif
  956. paddr = (unsigned long) page_address(page);
  957. memset((char *)paddr, 0, (PAGE_SIZE << DC_ALIAS_SHIFT));
  958. if (!color) {
  959. pte = (pte_t *) paddr;
  960. to_free = (unsigned long *) (paddr + PAGE_SIZE);
  961. } else {
  962. pte = (pte_t *) (paddr + PAGE_SIZE);
  963. to_free = (unsigned long *) paddr;
  964. }
  965. #if (L1DCACHE_SIZE > PAGE_SIZE) /* is there D$ aliasing problem */
  966. /* Now free the other one up, adjust cache size. */
  967. *to_free = (unsigned long) pte_quicklist[color ^ 0x1];
  968. pte_quicklist[color ^ 0x1] = to_free;
  969. pgtable_cache_size++;
  970. #endif
  971. return pte;
  972. }
  973. return NULL;
  974. }
  975. void sparc_ultra_dump_itlb(void)
  976. {
  977.         int slot;
  978. if (tlb_type == spitfire) {
  979. printk ("Contents of itlb: ");
  980. for (slot = 0; slot < 14; slot++) printk ("    ");
  981. printk ("%2x:%016lx,%016lxn",
  982. 0,
  983. spitfire_get_itlb_tag(0), spitfire_get_itlb_data(0));
  984. for (slot = 1; slot < 64; slot+=3) {
  985. printk ("%2x:%016lx,%016lx %2x:%016lx,%016lx %2x:%016lx,%016lxn", 
  986. slot,
  987. spitfire_get_itlb_tag(slot), spitfire_get_itlb_data(slot),
  988. slot+1,
  989. spitfire_get_itlb_tag(slot+1), spitfire_get_itlb_data(slot+1),
  990. slot+2,
  991. spitfire_get_itlb_tag(slot+2), spitfire_get_itlb_data(slot+2));
  992. }
  993. } else if (tlb_type == cheetah || tlb_type == cheetah_plus) {
  994. printk ("Contents of itlb0:n");
  995. for (slot = 0; slot < 16; slot+=2) {
  996. printk ("%2x:%016lx,%016lx %2x:%016lx,%016lxn",
  997. slot,
  998. cheetah_get_litlb_tag(slot), cheetah_get_litlb_data(slot),
  999. slot+1,
  1000. cheetah_get_litlb_tag(slot+1), cheetah_get_litlb_data(slot+1));
  1001. }
  1002. printk ("Contents of itlb2:n");
  1003. for (slot = 0; slot < 128; slot+=2) {
  1004. printk ("%2x:%016lx,%016lx %2x:%016lx,%016lxn",
  1005. slot,
  1006. cheetah_get_itlb_tag(slot), cheetah_get_itlb_data(slot),
  1007. slot+1,
  1008. cheetah_get_itlb_tag(slot+1), cheetah_get_itlb_data(slot+1));
  1009. }
  1010. }
  1011. }
  1012. void sparc_ultra_dump_dtlb(void)
  1013. {
  1014.         int slot;
  1015. if (tlb_type == spitfire) {
  1016. printk ("Contents of dtlb: ");
  1017. for (slot = 0; slot < 14; slot++) printk ("    ");
  1018. printk ("%2x:%016lx,%016lxn", 0,
  1019. spitfire_get_dtlb_tag(0), spitfire_get_dtlb_data(0));
  1020. for (slot = 1; slot < 64; slot+=3) {
  1021. printk ("%2x:%016lx,%016lx %2x:%016lx,%016lx %2x:%016lx,%016lxn", 
  1022. slot,
  1023. spitfire_get_dtlb_tag(slot), spitfire_get_dtlb_data(slot),
  1024. slot+1,
  1025. spitfire_get_dtlb_tag(slot+1), spitfire_get_dtlb_data(slot+1),
  1026. slot+2,
  1027. spitfire_get_dtlb_tag(slot+2), spitfire_get_dtlb_data(slot+2));
  1028. }
  1029. } else if (tlb_type == cheetah || tlb_type == cheetah_plus) {
  1030. printk ("Contents of dtlb0:n");
  1031. for (slot = 0; slot < 16; slot+=2) {
  1032. printk ("%2x:%016lx,%016lx %2x:%016lx,%016lxn",
  1033. slot,
  1034. cheetah_get_ldtlb_tag(slot), cheetah_get_ldtlb_data(slot),
  1035. slot+1,
  1036. cheetah_get_ldtlb_tag(slot+1), cheetah_get_ldtlb_data(slot+1));
  1037. }
  1038. printk ("Contents of dtlb2:n");
  1039. for (slot = 0; slot < 512; slot+=2) {
  1040. printk ("%2x:%016lx,%016lx %2x:%016lx,%016lxn",
  1041. slot,
  1042. cheetah_get_dtlb_tag(slot, 2), cheetah_get_dtlb_data(slot, 2),
  1043. slot+1,
  1044. cheetah_get_dtlb_tag(slot+1, 2), cheetah_get_dtlb_data(slot+1, 2));
  1045. }
  1046. if (tlb_type == cheetah_plus) {
  1047. printk ("Contents of dtlb3:n");
  1048. for (slot = 0; slot < 512; slot+=2) {
  1049. printk ("%2x:%016lx,%016lx %2x:%016lx,%016lxn",
  1050. slot,
  1051. cheetah_get_dtlb_tag(slot, 3), cheetah_get_dtlb_data(slot, 3),
  1052. slot+1,
  1053. cheetah_get_dtlb_tag(slot+1, 3), cheetah_get_dtlb_data(slot+1, 3));
  1054. }
  1055. }
  1056. }
  1057. }
  1058. extern unsigned long cmdline_memory_size;
  1059. unsigned long __init bootmem_init(unsigned long *pages_avail)
  1060. {
  1061. unsigned long bootmap_size, start_pfn, end_pfn;
  1062. unsigned long end_of_phys_memory = 0UL;
  1063. unsigned long bootmap_pfn, bytes_avail, size;
  1064. int i;
  1065. bytes_avail = 0UL;
  1066. for (i = 0; sp_banks[i].num_bytes != 0; i++) {
  1067. end_of_phys_memory = sp_banks[i].base_addr +
  1068. sp_banks[i].num_bytes;
  1069. bytes_avail += sp_banks[i].num_bytes;
  1070. if (cmdline_memory_size) {
  1071. if (bytes_avail > cmdline_memory_size) {
  1072. unsigned long slack = bytes_avail - cmdline_memory_size;
  1073. bytes_avail -= slack;
  1074. end_of_phys_memory -= slack;
  1075. sp_banks[i].num_bytes -= slack;
  1076. if (sp_banks[i].num_bytes == 0) {
  1077. sp_banks[i].base_addr = 0xdeadbeef;
  1078. } else {
  1079. sp_banks[i+1].num_bytes = 0;
  1080. sp_banks[i+1].base_addr = 0xdeadbeef;
  1081. }
  1082. break;
  1083. }
  1084. }
  1085. }
  1086. *pages_avail = bytes_avail >> PAGE_SHIFT;
  1087. /* Start with page aligned address of last symbol in kernel
  1088.  * image.  The kernel is hard mapped below PAGE_OFFSET in a
  1089.  * 4MB locked TLB translation.
  1090.  */
  1091. start_pfn  = PAGE_ALIGN((unsigned long) &_end) -
  1092. ((unsigned long) KERNBASE);
  1093. /* Adjust up to the physical address where the kernel begins. */
  1094. start_pfn += phys_base;
  1095. /* Now shift down to get the real physical page frame number. */
  1096. start_pfn >>= PAGE_SHIFT;
  1097. bootmap_pfn = start_pfn;
  1098. end_pfn = end_of_phys_memory >> PAGE_SHIFT;
  1099. #ifdef CONFIG_BLK_DEV_INITRD
  1100. /* Now have to check initial ramdisk, so that bootmap does not overwrite it */
  1101. if (sparc_ramdisk_image) {
  1102. if (sparc_ramdisk_image >= (unsigned long)&_end - 2 * PAGE_SIZE)
  1103. sparc_ramdisk_image -= KERNBASE;
  1104. initrd_start = sparc_ramdisk_image + phys_base;
  1105. initrd_end = initrd_start + sparc_ramdisk_size;
  1106. if (initrd_end > end_of_phys_memory) {
  1107. printk(KERN_CRIT "initrd extends beyond end of memory "
  1108.                    "(0x%016lx > 0x%016lx)ndisabling initrdn",
  1109.        initrd_end, end_of_phys_memory);
  1110. initrd_start = 0;
  1111. }
  1112. if (initrd_start) {
  1113. if (initrd_start >= (start_pfn << PAGE_SHIFT) &&
  1114.     initrd_start < (start_pfn << PAGE_SHIFT) + 2 * PAGE_SIZE)
  1115. bootmap_pfn = PAGE_ALIGN (initrd_end) >> PAGE_SHIFT;
  1116. }
  1117. }
  1118. #endif
  1119. /* Initialize the boot-time allocator. */
  1120. max_pfn = max_low_pfn = end_pfn;
  1121. min_low_pfn = phys_base >> PAGE_SHIFT;
  1122. bootmap_size = init_bootmem_node(NODE_DATA(0), bootmap_pfn, phys_base>>PAGE_SHIFT, end_pfn);
  1123. /* Now register the available physical memory with the
  1124.  * allocator.
  1125.  */
  1126. for (i = 0; sp_banks[i].num_bytes != 0; i++)
  1127. free_bootmem(sp_banks[i].base_addr,
  1128.      sp_banks[i].num_bytes);
  1129. #ifdef CONFIG_BLK_DEV_INITRD
  1130. if (initrd_start) {
  1131. size = initrd_end - initrd_start;
  1132. /* Resert the initrd image area. */
  1133. reserve_bootmem(initrd_start, size);
  1134. *pages_avail -= PAGE_ALIGN(size) >> PAGE_SHIFT;
  1135. initrd_start += PAGE_OFFSET;
  1136. initrd_end += PAGE_OFFSET;
  1137. }
  1138. #endif
  1139. /* Reserve the kernel text/data/bss. */
  1140. size = (start_pfn << PAGE_SHIFT) - phys_base;
  1141. reserve_bootmem(phys_base, size);
  1142. *pages_avail -= PAGE_ALIGN(size) >> PAGE_SHIFT;
  1143. /* Reserve the bootmem map.   We do not account for it
  1144.  * in pages_avail because we will release that memory
  1145.  * in free_all_bootmem.
  1146.  */
  1147. size = bootmap_size;
  1148. reserve_bootmem((bootmap_pfn << PAGE_SHIFT), size);
  1149. *pages_avail -= PAGE_ALIGN(size) >> PAGE_SHIFT;
  1150. return end_pfn;
  1151. }
  1152. /* paging_init() sets up the page tables */
  1153. extern void sun_serial_setup(void);
  1154. extern void cheetah_ecache_flush_init(void);
  1155. static unsigned long last_valid_pfn;
  1156. void __init paging_init(void)
  1157. {
  1158. extern pmd_t swapper_pmd_dir[1024];
  1159. extern unsigned int sparc64_vpte_patchme1[1];
  1160. extern unsigned int sparc64_vpte_patchme2[1];
  1161. unsigned long alias_base = phys_base + PAGE_OFFSET;
  1162. unsigned long second_alias_page = 0;
  1163. unsigned long pt, flags, end_pfn, pages_avail;
  1164. unsigned long shift = alias_base - ((unsigned long)KERNBASE);
  1165. unsigned long real_end;
  1166. set_bit(0, mmu_context_bmap);
  1167. real_end = (unsigned long)&_end;
  1168. if ((real_end > ((unsigned long)KERNBASE + 0x400000)))
  1169. bigkernel = 1;
  1170. #ifdef CONFIG_BLK_DEV_INITRD
  1171. if (sparc_ramdisk_image)
  1172. real_end = (PAGE_ALIGN(real_end) + PAGE_ALIGN(sparc_ramdisk_size));
  1173. #endif
  1174. /* We assume physical memory starts at some 4mb multiple,
  1175.  * if this were not true we wouldn't boot up to this point
  1176.  * anyways.
  1177.  */
  1178. pt  = phys_base | _PAGE_VALID | _PAGE_SZ4MB;
  1179. pt |= _PAGE_CP | _PAGE_CV | _PAGE_P | _PAGE_L | _PAGE_W;
  1180. __save_and_cli(flags);
  1181. if (tlb_type == spitfire) {
  1182. __asm__ __volatile__(
  1183. " stxa %1, [%0] %3n"
  1184. " stxa %2, [%5] %4n"
  1185. " membar #Syncn"
  1186. " flush %%g6n"
  1187. " nopn"
  1188. " nopn"
  1189. " nopn"
  1190. : /* No outputs */
  1191. : "r" (TLB_TAG_ACCESS), "r" (alias_base), "r" (pt),
  1192.   "i" (ASI_DMMU), "i" (ASI_DTLB_DATA_ACCESS), "r" (61 << 3)
  1193. : "memory");
  1194. if (real_end >= KERNBASE + 0x340000) {
  1195. second_alias_page = alias_base + 0x400000;
  1196. __asm__ __volatile__(
  1197. " stxa %1, [%0] %3n"
  1198. " stxa %2, [%5] %4n"
  1199. " membar #Syncn"
  1200. " flush %%g6n"
  1201. " nopn"
  1202. " nopn"
  1203. " nopn"
  1204. : /* No outputs */
  1205. : "r" (TLB_TAG_ACCESS), "r" (second_alias_page), "r" (pt + 0x400000),
  1206.   "i" (ASI_DMMU), "i" (ASI_DTLB_DATA_ACCESS), "r" (60 << 3)
  1207. : "memory");
  1208. }
  1209. } else if (tlb_type == cheetah || tlb_type == cheetah_plus) {
  1210. __asm__ __volatile__(
  1211. " stxa %1, [%0] %3n"
  1212. " stxa %2, [%5] %4n"
  1213. " membar #Syncn"
  1214. " flush %%g6n"
  1215. " nopn"
  1216. " nopn"
  1217. " nopn"
  1218. : /* No outputs */
  1219. : "r" (TLB_TAG_ACCESS), "r" (alias_base), "r" (pt),
  1220.   "i" (ASI_DMMU), "i" (ASI_DTLB_DATA_ACCESS), "r" ((0<<16) | (13<<3))
  1221. : "memory");
  1222. if (real_end >= KERNBASE + 0x340000) {
  1223. second_alias_page = alias_base + 0x400000;
  1224. __asm__ __volatile__(
  1225. " stxa %1, [%0] %3n"
  1226. " stxa %2, [%5] %4n"
  1227. " membar #Syncn"
  1228. " flush %%g6n"
  1229. " nopn"
  1230. " nopn"
  1231. " nopn"
  1232. : /* No outputs */
  1233. : "r" (TLB_TAG_ACCESS), "r" (second_alias_page), "r" (pt + 0x400000),
  1234.   "i" (ASI_DMMU), "i" (ASI_DTLB_DATA_ACCESS), "r" ((0<<16) | (12<<3))
  1235. : "memory");
  1236. }
  1237. }
  1238. __restore_flags(flags);
  1239. /* Now set kernel pgd to upper alias so physical page computations
  1240.  * work.
  1241.  */
  1242. init_mm.pgd += ((shift) / (sizeof(pgd_t)));
  1243. memset(swapper_pmd_dir, 0, sizeof(swapper_pmd_dir));
  1244. /* Now can init the kernel/bad page tables. */
  1245. pgd_set(&swapper_pg_dir[0], swapper_pmd_dir + (shift / sizeof(pgd_t)));
  1246. sparc64_vpte_patchme1[0] |= (pgd_val(init_mm.pgd[0]) >> 10);
  1247. sparc64_vpte_patchme2[0] |= (pgd_val(init_mm.pgd[0]) & 0x3ff);
  1248. flushi((long)&sparc64_vpte_patchme1[0]);
  1249. /* Setup bootmem... */
  1250. pages_avail = 0;
  1251. last_valid_pfn = end_pfn = bootmem_init(&pages_avail);
  1252. #ifdef CONFIG_SUN_SERIAL
  1253. /* This does not logically belong here, but we need to
  1254.  * call it at the moment we are able to use the bootmem
  1255.  * allocator.
  1256.  */
  1257. sun_serial_setup();
  1258. #endif
  1259. /* Inherit non-locked OBP mappings. */
  1260. inherit_prom_mappings();
  1261. /* Ok, we can use our TLB miss and window trap handlers safely.
  1262.  * We need to do a quick peek here to see if we are on StarFire
  1263.  * or not, so setup_tba can setup the IRQ globals correctly (it
  1264.  * needs to get the hard smp processor id correctly).
  1265.  */
  1266. {
  1267. extern void setup_tba(int);
  1268. setup_tba(this_is_starfire);
  1269. }
  1270. inherit_locked_prom_mappings(1);
  1271. /* We only created DTLB mapping of this stuff. */
  1272. spitfire_flush_dtlb_nucleus_page(alias_base);
  1273. if (second_alias_page)
  1274. spitfire_flush_dtlb_nucleus_page(second_alias_page);
  1275. __flush_tlb_all();
  1276. {
  1277. unsigned long zones_size[MAX_NR_ZONES];
  1278. unsigned long zholes_size[MAX_NR_ZONES];
  1279. unsigned long npages;
  1280. int znum;
  1281. for (znum = 0; znum < MAX_NR_ZONES; znum++)
  1282. zones_size[znum] = zholes_size[znum] = 0;
  1283. npages = end_pfn - (phys_base >> PAGE_SHIFT);
  1284. zones_size[ZONE_DMA] = npages;
  1285. zholes_size[ZONE_DMA] = npages - pages_avail;
  1286. free_area_init_node(0, NULL, NULL, zones_size,
  1287.     phys_base, zholes_size);
  1288. }
  1289. device_scan();
  1290. }
  1291. /* Ok, it seems that the prom can allocate some more memory chunks
  1292.  * as a side effect of some prom calls we perform during the
  1293.  * boot sequence.  My most likely theory is that it is from the
  1294.  * prom_set_traptable() call, and OBP is allocating a scratchpad
  1295.  * for saving client program register state etc.
  1296.  */
  1297. void __init sort_memlist(struct linux_mlist_p1275 *thislist)
  1298. {
  1299. int swapi = 0;
  1300. int i, mitr;
  1301. unsigned long tmpaddr, tmpsize;
  1302. unsigned long lowest;
  1303. for (i = 0; thislist[i].theres_more != 0; i++) {
  1304. lowest = thislist[i].start_adr;
  1305. for (mitr = i+1; thislist[mitr-1].theres_more != 0; mitr++)
  1306. if (thislist[mitr].start_adr < lowest) {
  1307. lowest = thislist[mitr].start_adr;
  1308. swapi = mitr;
  1309. }
  1310. if (lowest == thislist[i].start_adr)
  1311. continue;
  1312. tmpaddr = thislist[swapi].start_adr;
  1313. tmpsize = thislist[swapi].num_bytes;
  1314. for (mitr = swapi; mitr > i; mitr--) {
  1315. thislist[mitr].start_adr = thislist[mitr-1].start_adr;
  1316. thislist[mitr].num_bytes = thislist[mitr-1].num_bytes;
  1317. }
  1318. thislist[i].start_adr = tmpaddr;
  1319. thislist[i].num_bytes = tmpsize;
  1320. }
  1321. }
  1322. void __init rescan_sp_banks(void)
  1323. {
  1324. struct linux_prom64_registers memlist[64];
  1325. struct linux_mlist_p1275 avail[64], *mlist;
  1326. unsigned long bytes, base_paddr;
  1327. int num_regs, node = prom_finddevice("/memory");
  1328. int i;
  1329. num_regs = prom_getproperty(node, "available",
  1330.     (char *) memlist, sizeof(memlist));
  1331. num_regs = (num_regs / sizeof(struct linux_prom64_registers));
  1332. for (i = 0; i < num_regs; i++) {
  1333. avail[i].start_adr = memlist[i].phys_addr;
  1334. avail[i].num_bytes = memlist[i].reg_size;
  1335. avail[i].theres_more = &avail[i + 1];
  1336. }
  1337. avail[i - 1].theres_more = NULL;
  1338. sort_memlist(avail);
  1339. mlist = &avail[0];
  1340. i = 0;
  1341. bytes = mlist->num_bytes;
  1342. base_paddr = mlist->start_adr;
  1343.   
  1344. sp_banks[0].base_addr = base_paddr;
  1345. sp_banks[0].num_bytes = bytes;
  1346. while (mlist->theres_more != NULL){
  1347. i++;
  1348. mlist = mlist->theres_more;
  1349. bytes = mlist->num_bytes;
  1350. if (i >= SPARC_PHYS_BANKS-1) {
  1351. printk ("The machine has more banks than "
  1352. "this kernel can supportn"
  1353. "Increase the SPARC_PHYS_BANKS "
  1354. "setting (currently %d)n",
  1355. SPARC_PHYS_BANKS);
  1356. i = SPARC_PHYS_BANKS-1;
  1357. break;
  1358. }
  1359.     
  1360. sp_banks[i].base_addr = mlist->start_adr;
  1361. sp_banks[i].num_bytes = mlist->num_bytes;
  1362. }
  1363. i++;
  1364. sp_banks[i].base_addr = 0xdeadbeefbeefdeadUL;
  1365. sp_banks[i].num_bytes = 0;
  1366. for (i = 0; sp_banks[i].num_bytes != 0; i++)
  1367. sp_banks[i].num_bytes &= PAGE_MASK;
  1368. }
  1369. static void __init taint_real_pages(void)
  1370. {
  1371. struct sparc_phys_banks saved_sp_banks[SPARC_PHYS_BANKS];
  1372. int i;
  1373. for (i = 0; i < SPARC_PHYS_BANKS; i++) {
  1374. saved_sp_banks[i].base_addr =
  1375. sp_banks[i].base_addr;
  1376. saved_sp_banks[i].num_bytes =
  1377. sp_banks[i].num_bytes;
  1378. }
  1379. rescan_sp_banks();
  1380. /* Find changes discovered in the sp_bank rescan and
  1381.  * reserve the lost portions in the bootmem maps.
  1382.  */
  1383. for (i = 0; saved_sp_banks[i].num_bytes; i++) {
  1384. unsigned long old_start, old_end;
  1385. old_start = saved_sp_banks[i].base_addr;
  1386. old_end = old_start +
  1387. saved_sp_banks[i].num_bytes;
  1388. while (old_start < old_end) {
  1389. int n;
  1390. for (n = 0; sp_banks[n].num_bytes; n++) {
  1391. unsigned long new_start, new_end;
  1392. new_start = sp_banks[n].base_addr;
  1393. new_end = new_start + sp_banks[n].num_bytes;
  1394. if (new_start <= old_start &&
  1395.     new_end >= (old_start + PAGE_SIZE)) {
  1396. set_bit (old_start >> 22,
  1397.  sparc64_valid_addr_bitmap);
  1398. goto do_next_page;
  1399. }
  1400. }
  1401. reserve_bootmem(old_start, PAGE_SIZE);
  1402. do_next_page:
  1403. old_start += PAGE_SIZE;
  1404. }
  1405. }
  1406. }
  1407. void __init mem_init(void)
  1408. {
  1409. unsigned long codepages, datapages, initpages;
  1410. unsigned long addr, last;
  1411. int i;
  1412. i = last_valid_pfn >> ((22 - PAGE_SHIFT) + 6);
  1413. i += 1;
  1414. sparc64_valid_addr_bitmap = (unsigned long *)
  1415. __alloc_bootmem(i << 3, SMP_CACHE_BYTES, 0UL);
  1416. if (sparc64_valid_addr_bitmap == NULL) {
  1417. prom_printf("mem_init: Cannot alloc valid_addr_bitmap.n");
  1418. prom_halt();
  1419. }
  1420. memset(sparc64_valid_addr_bitmap, 0, i << 3);
  1421. addr = PAGE_OFFSET + phys_base;
  1422. last = PAGE_ALIGN((unsigned long)&_end) -
  1423. ((unsigned long) KERNBASE);
  1424. last += PAGE_OFFSET + phys_base;
  1425. while (addr < last) {
  1426. set_bit(__pa(addr) >> 22, sparc64_valid_addr_bitmap);
  1427. addr += PAGE_SIZE;
  1428. }
  1429. taint_real_pages();
  1430. max_mapnr = last_valid_pfn - (phys_base >> PAGE_SHIFT);
  1431. high_memory = __va(last_valid_pfn << PAGE_SHIFT);
  1432. num_physpages = free_all_bootmem() - 1;
  1433. /*
  1434.  * Set up the zero page, mark it reserved, so that page count
  1435.  * is not manipulated when freeing the page from user ptes.
  1436.  */
  1437. mem_map_zero = _alloc_pages(GFP_KERNEL, 0);
  1438. if (mem_map_zero == NULL) {
  1439. prom_printf("paging_init: Cannot alloc zero page.n");
  1440. prom_halt();
  1441. }
  1442. SetPageReserved(mem_map_zero);
  1443. clear_page(page_address(mem_map_zero));
  1444. codepages = (((unsigned long) &etext) - ((unsigned long)&_start));
  1445. codepages = PAGE_ALIGN(codepages) >> PAGE_SHIFT;
  1446. datapages = (((unsigned long) &edata) - ((unsigned long)&etext));
  1447. datapages = PAGE_ALIGN(datapages) >> PAGE_SHIFT;
  1448. initpages = (((unsigned long) &__init_end) - ((unsigned long) &__init_begin));
  1449. initpages = PAGE_ALIGN(initpages) >> PAGE_SHIFT;
  1450. #ifndef CONFIG_SMP
  1451. {
  1452. /* Put empty_pg_dir on pgd_quicklist */
  1453. extern pgd_t empty_pg_dir[1024];
  1454. unsigned long addr = (unsigned long)empty_pg_dir;
  1455. unsigned long alias_base = phys_base + PAGE_OFFSET -
  1456. (long)(KERNBASE);
  1457. memset(empty_pg_dir, 0, sizeof(empty_pg_dir));
  1458. addr += alias_base;
  1459. free_pgd_fast((pgd_t *)addr);
  1460. num_physpages++;
  1461. }
  1462. #endif
  1463. printk("Memory: %uk available (%ldk kernel code, %ldk data, %ldk init) [%016lx,%016lx]n",
  1464.        nr_free_pages() << (PAGE_SHIFT-10),
  1465.        codepages << (PAGE_SHIFT-10),
  1466.        datapages << (PAGE_SHIFT-10), 
  1467.        initpages << (PAGE_SHIFT-10), 
  1468.        PAGE_OFFSET, (last_valid_pfn << PAGE_SHIFT));
  1469. if (tlb_type == cheetah || tlb_type == cheetah_plus)
  1470. cheetah_ecache_flush_init();
  1471. }
  1472. void free_initmem (void)
  1473. {
  1474. unsigned long addr, initend;
  1475. /*
  1476.  * The init section is aligned to 8k in vmlinux.lds. Page align for >8k pagesizes.
  1477.  */
  1478. addr = PAGE_ALIGN((unsigned long)(&__init_begin));
  1479. initend = (unsigned long)(&__init_end) & PAGE_MASK;
  1480. for (; addr < initend; addr += PAGE_SIZE) {
  1481. unsigned long page;
  1482. struct page *p;
  1483. page = (addr +
  1484. ((unsigned long) __va(phys_base)) -
  1485. ((unsigned long) KERNBASE));
  1486. p = virt_to_page(page);
  1487. ClearPageReserved(p);
  1488. set_page_count(p, 1);
  1489. __free_page(p);
  1490. num_physpages++;
  1491. }
  1492. }
  1493. #ifdef CONFIG_BLK_DEV_INITRD
  1494. void free_initrd_mem(unsigned long start, unsigned long end)
  1495. {
  1496. if (start < end)
  1497. printk ("Freeing initrd memory: %ldk freedn", (end - start) >> 10);
  1498. for (; start < end; start += PAGE_SIZE) {
  1499. struct page *p = virt_to_page(start);
  1500. ClearPageReserved(p);
  1501. set_page_count(p, 1);
  1502. __free_page(p);
  1503. num_physpages++;
  1504. }
  1505. }
  1506. #endif
  1507. void si_meminfo(struct sysinfo *val)
  1508. {
  1509. val->totalram = num_physpages;
  1510. val->sharedram = 0;
  1511. val->freeram = nr_free_pages();
  1512. val->bufferram = atomic_read(&buffermem_pages);
  1513. /* These are always zero on Sparc64. */
  1514. val->totalhigh = 0;
  1515. val->freehigh = 0;
  1516. val->mem_unit = PAGE_SIZE;
  1517. }