Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

/*
 *  linux/arch/or32/mm/init.c
 *
 *  or32 version
 *    author(s): Matjaz Breskvar (phoenix@bsemi.com)
 *
 *  derived from cris, i386, m68k, ppc, sh ports.
 *
 *  changes:
 *  18. 11. 2003: Matjaz Breskvar (phoenix@bsemi.com)
 *    initial port to or32 architecture
 *
 *  22. 11. 2003: Matjaz Breskvar (phoenix@bsemi.com)
 *    cleanups, identical mapping for serial console
 */
 
#include <linux/signal.h>
#include <linux/sched.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/string.h>
#include <linux/types.h>
#include <linux/ptrace.h>
#include <linux/mman.h>
#include <linux/mm.h>
#include <linux/swap.h>
#include <linux/smp.h>
#include <linux/bootmem.h>
#include <linux/init.h>
#include <linux/delay.h>
#ifdef CONFIG_BLK_DEV_INITRD
#include <linux/blkdev.h>          /* for initrd_* */
#endif
 
#include <asm/system.h>
#include <asm/segment.h>
#include <asm/pgalloc.h>
#include <asm/pgtable.h>
#include <asm/dma.h>
#include <asm/io.h>
#include <asm/tlb.h>
#include <asm/mmu_context.h>
#include <asm/or32-hf.h>
#include <asm/kmap_types.h>
#include <asm/fixmap.h>
 
int mem_init_done = 0;
 
DEFINE_PER_CPU(struct mmu_gather, mmu_gathers);
 
void show_mem(void)
{
 
	int i,free = 0,total = 0,cached = 0, reserved = 0, nonshared = 0;
	int shared = 0;
 
	printk("\nMem-info:\n");
	show_free_areas();
	printk("Free swap:       %6ldkB\n",nr_swap_pages<<(PAGE_SHIFT-10));
	i = max_mapnr;
	while (i-- > 0) 
	{
		total++;
		if (PageReserved(mem_map+i))
			reserved++;
		else if (PageSwapCache(mem_map+i))
			cached++;
		else if (!page_count(mem_map+i))
			free++;
		else if (page_count(mem_map+i) == 1)
			nonshared++;
		else
			shared += page_count(mem_map+i) - 1;
	}
 
	printk("%d pages of RAM\n",total);
	printk("%d free pages\n",free);
	printk("%d reserved pages\n",reserved);
	printk("%d pages nonshared\n",nonshared);
	printk("%d pages shared\n",shared);
	printk("%d pages swap cached\n",cached);
}
 
pte_t *kmap_pte;
pgprot_t kmap_prot;
 
#define kmap_get_fixmap_pte(vaddr)					\
	pte_offset_kernel(pmd_offset(pgd_offset_k(vaddr), (vaddr)), (vaddr))
 
static void __init kmap_init(void)
{
	unsigned long kmap_vstart;
 
	/* cache the first kmap pte */
	kmap_vstart = __fix_to_virt(FIX_KMAP_BEGIN);
	kmap_pte = kmap_get_fixmap_pte(kmap_vstart);
 
	kmap_prot = PAGE_KERNEL;
}
 
static void __init fixrange_init (unsigned long start, unsigned long end, pgd_t *pgd_base)
{
        pgd_t *pgd;
	pmd_t *pmd;
	pte_t *pte;
	int i, j;
	unsigned long vaddr;
 
	vaddr = start;
	i = __pgd_offset(vaddr);
	j = __pmd_offset(vaddr);
	pgd = pgd_base + i;
 
	for ( ; (i < PTRS_PER_PGD) && (vaddr != end); pgd++, i++) {
		pmd = (pmd_t *)pgd;
 
		for (; (j < PTRS_PER_PMD) && (vaddr != end); pmd++, j++) {
			if (pmd_none(*pmd)) {
				pte = (pte_t *) alloc_bootmem_low_pages(PAGE_SIZE);
				set_pmd(pmd, __pmd(_KERNPG_TABLE + __pa(pte)));
				if (pte != pte_offset_kernel(pmd, 0))
					BUG();
			}
			vaddr += PMD_SIZE;
		}
		j = 0;
	}
}
 
static void __init zone_sizes_init(void)
{
	unsigned long zones_size[MAX_NR_ZONES] = {0, 0, 0};
	unsigned int max_dma, low;
 
	max_dma = virt_to_phys((char *)MAX_DMA_ADDRESS) >> PAGE_SHIFT;
	low = max_low_pfn;
 
	if (low < max_dma)
		zones_size[ZONE_DMA] = low;
	else {
		zones_size[ZONE_DMA] = max_dma;
		zones_size[ZONE_NORMAL] = low - max_dma;
	}
	free_area_init(zones_size);
}
 
static void __init identical_mapping(unsigned long start, unsigned long size,
				     unsigned long page_attrs)
{
 
	unsigned long vaddr, end;
	pgd_t *pgd, *pgd_base;
	int i, j, k;
	pmd_t *pmd;
	pte_t *pte, *pte_base;
 
	printk("Setting up identical mapping (0x%lx - 0x%lx)\n",
	       start, start + size);
 
	page_attrs |= _PAGE_ALL | _PAGE_SRE | _PAGE_SWE |
		_PAGE_SHARED | _PAGE_DIRTY | _PAGE_EXEC;
	/*
	 * This can be zero as well - no problem, in that case we exit
	 * the loops anyway due to the PTRS_PER_* conditions.
	 */
	end = start + size;
 
	pgd_base = swapper_pg_dir;
	i = __pgd_offset(start);
	pgd = pgd_base + i;
 
	for (; i < PTRS_PER_PGD; pgd++, i++) {
		vaddr = i*PGDIR_SIZE;
		if (end && (vaddr >= end))
			break;
		pmd = (pmd_t *)pgd;
 
		if (pmd != pmd_offset(pgd, 0))
			BUG();
		for (j = 0; j < PTRS_PER_PMD; pmd++, j++) {
			vaddr = i*PGDIR_SIZE + j*PMD_SIZE;
			if (end && (vaddr >= end))
				break;
 
			pte_base = pte = (pte_t *)alloc_bootmem_low_pages(PAGE_SIZE);
 
			for (k = 0; k < PTRS_PER_PTE; pte++, k++) {
				vaddr = i*PGDIR_SIZE + j*PMD_SIZE + k*PAGE_SIZE;
				if (end && (vaddr >= end))
					break;
				*pte = mk_pte_phys(vaddr, __pgprot(page_attrs));
			}
			set_pmd(pmd, __pmd(_KERNPG_TABLE + __pa(pte_base)));
 
			if (pte_base != pte_offset_kernel(pmd, 0))
			  BUG();
		}
	}
}
 
void __init paging_init(void)
{
	extern void tlb_init(void);
 
	unsigned long vaddr, end;
	pgd_t *pgd, *pgd_base;
	int i, j, k;
	pmd_t *pmd;
	pte_t *pte, *pte_base;
 
	printk("Setting up paging and PTEs.\n");
 
	/* clear out the init_mm.pgd that will contain the kernel's mappings */
 
	for(i = 0; i < PTRS_PER_PGD; i++)
		swapper_pg_dir[i] = __pgd(0);
 
	/* make sure the current pgd table points to something sane
	 * (even if it is most probably not used until the next 
	 *  switch_mm)
	 */
         current_pgd = init_mm.pgd;
 
         /* initialise the TLB (tlb.c) */
         tlb_init();
 
	/*
	 * This can be zero as well - no problem, in that case we exit
	 * the loops anyway due to the PTRS_PER_* conditions.
	 */
	end = (unsigned long)__va(max_low_pfn*PAGE_SIZE);
 
	pgd_base = swapper_pg_dir;
	i = __pgd_offset(PAGE_OFFSET);
	pgd = pgd_base + i;
 
	for (; i < PTRS_PER_PGD; pgd++, i++) {
		vaddr = i*PGDIR_SIZE;
		if (end && (vaddr >= end))
			break;
		pmd = (pmd_t *)pgd;
 
		if (pmd != pmd_offset(pgd, 0))
			BUG();
		for (j = 0; j < PTRS_PER_PMD; pmd++, j++) {
			vaddr = i*PGDIR_SIZE + j*PMD_SIZE;
			if (end && (vaddr >= end))
				break;
 
			pte_base = pte = (pte_t *)alloc_bootmem_low_pages(PAGE_SIZE);
 
			for (k = 0; k < PTRS_PER_PTE; pte++, k++) {
				vaddr = i*PGDIR_SIZE + j*PMD_SIZE + k*PAGE_SIZE;
				if (end && (vaddr >= end))
					break;
#ifdef CONFIG_OR32_GUARD_PROTECTED_CORE
				{
					extern char _e_protected_core;
					unsigned long page_attrs, offset;
 
					offset = i*PGDIR_SIZE + j*PMD_SIZE;
					page_attrs = _PAGE_ALL | _PAGE_SRE | 
						_PAGE_SHARED | _PAGE_DIRTY | _PAGE_EXEC;
 
					/* make all but first and last page of .text and .rodata
					 * sections write protected.
					 */
					if ((vaddr > (PAGE_SIZE + offset)) && 
					    ((vaddr + PAGE_SIZE) < ((unsigned long)&(_e_protected_core))))
						*pte = mk_pte_phys(__pa(vaddr), __pgprot(page_attrs));
					else
						*pte = mk_pte_phys(__pa(vaddr), PAGE_KERNEL);
				}
#else
				*pte = mk_pte_phys(__pa(vaddr), PAGE_KERNEL);
#endif /* CONFIG_OR32_GUARD_PROTECTED_CORE */
			}
			set_pmd(pmd, __pmd(_KERNPG_TABLE + __pa(pte_base)));
 
			if (pte_base != pte_offset_kernel(pmd, 0))
			  BUG();
		}
	}
 
#ifdef CONFIG_OR32_GUARD_PROTECTED_CORE
	{
	        extern char _e_protected_core;
 
		printk("write protecting ro sections (0x%lx - 0x%lx)\n", 
	               PAGE_OFFSET + PAGE_SIZE, PAGE_MASK&((unsigned long)&(_e_protected_core)));
	}
#endif /* CONFIG_OR32_GUARD_PROTECTED_CORE */
 
	/* __PHX__: fixme, 
	 * - detect units via UPR,
	 * - set up only apropriate mappings
	 * - make oeth_probe not poke around if ethernet is not present in upr
	 *   or make sure that it doesn't kill of the kernel when no oeth 
	 *   present
	 */
 
	/* map the UART address space */
	identical_mapping(0x80000000, 0x10000000, _PAGE_CI | 
			  _PAGE_URE | _PAGE_UWE);
	identical_mapping(0x92000000, 0x2000, _PAGE_CI | 
			  _PAGE_URE | _PAGE_UWE);
	identical_mapping(0xb8070000, 0x2000, _PAGE_CI | 
			  _PAGE_URE | _PAGE_UWE);
	identical_mapping(0x97000000, 0x2000, _PAGE_CI | 
			  _PAGE_URE | _PAGE_UWE);
	identical_mapping(0x99000000, 0x1000000, _PAGE_CI | 
			  _PAGE_URE | _PAGE_UWE);
	identical_mapping(0x93000000, 0x2000, _PAGE_CI | 
			  _PAGE_URE | _PAGE_UWE);
	identical_mapping(0xa6000000, 0x100000, _PAGE_CI | 
			  _PAGE_URE | _PAGE_UWE);
	identical_mapping(0x1e50000, 0x150000, _PAGE_CI | 
			  _PAGE_URE | _PAGE_UWE);
 
	zone_sizes_init();
 
	/*
	 * Fixed mappings, only the page table structure has to be
	 * created - mappings will be set by set_fixmap():
	 */
	vaddr = __fix_to_virt(__end_of_fixed_addresses - 1) & PMD_MASK;
	fixrange_init(vaddr, 0, pgd_base);
 
 
	/*
	 * enable EA translations via PT mechanism
	 */
 
	/* self modifing code ;) */
	{
	  extern unsigned long dtlb_miss_handler;
	  extern unsigned long itlb_miss_handler;
 
	  unsigned long *dtlb_vector = __va(0x900);
	  unsigned long *itlb_vector = __va(0xa00);
 
	  printk("dtlb_miss_handler %p\n", &dtlb_miss_handler);
	  *dtlb_vector = ((unsigned long)&dtlb_miss_handler - 
			  (unsigned long)dtlb_vector) >> 2;
 
  	  printk("itlb_miss_handler %p\n", &itlb_miss_handler);
	  *itlb_vector = ((unsigned long)&itlb_miss_handler - 
			  (unsigned long)itlb_vector) >> 2;
	}
	kmap_init();
}
 
 
/* References to section boundaries */
 
extern char _stext, _etext, _edata, __bss_start, _end;
extern char __init_begin, __init_end;
 
/*unsigned long loops_per_usec;  Removed by JPB*/
 
static int __init free_pages_init(void)
{
	int reservedpages, pfn;
 
	/* this will put all low memory onto the freelists */
	totalram_pages = free_all_bootmem();
 
	reservedpages = 0;
	for (pfn = 0; pfn < max_low_pfn; pfn++) {
		/*
		 * Only count reserved RAM pages
		 */
		if (PageReserved(mem_map+pfn))
			reservedpages++;
	}
 
	return reservedpages;
}
 
static void __init set_max_mapnr_init(void)
{
        max_mapnr = num_physpages = max_low_pfn;
}
 
void __init mem_init(void)
{
	int codesize, reservedpages, datasize, initsize;
 
	phx_warn("mem_map %p", mem_map);
	if (!mem_map)
		BUG();
 
	set_max_mapnr_init();
 
	high_memory = (void *) __va(max_low_pfn * PAGE_SIZE);
 
	/* clear the zero-page */
	phx_printk("empty_zero_page %p", empty_zero_page);
	memset((void*)empty_zero_page, 0, PAGE_SIZE);
 
	reservedpages = free_pages_init();
 
	codesize =  (unsigned long) &_etext - (unsigned long) &_stext;
	datasize =  (unsigned long) &_edata - (unsigned long) &_etext;
	initsize =  (unsigned long) &__init_end - (unsigned long) &__init_begin;
 
	printk(KERN_INFO "Memory: %luk/%luk available (%dk kernel code, %dk reserved, %dk data, %dk init, %ldk highmem)\n",
		(unsigned long) nr_free_pages() << (PAGE_SHIFT-10),
		max_mapnr << (PAGE_SHIFT-10),
		codesize >> 10,
		reservedpages << (PAGE_SHIFT-10),
		datasize >> 10,
		initsize >> 10,
		(unsigned long) (0 << (PAGE_SHIFT-10))
	       );
 
	mem_init_done = 1;
	return;
}
 
#ifdef CONFIG_BLK_DEV_INITRD
void free_initrd_mem(unsigned long start, unsigned long end)
{
	printk (KERN_INFO "Freeing initrd memory: %ldk freed\n", (end - start) >> 10);
 
	for (; start < end; start += PAGE_SIZE) {
		ClearPageReserved(virt_to_page(start));
		init_page_count(virt_to_page(start));
		free_page(start);
		totalram_pages++;
	}
}
#endif
 
void free_initmem(void)
{
        unsigned long addr;
 
        addr = (unsigned long)(&__init_begin);
        for (; addr < (unsigned long)(&__init_end); addr += PAGE_SIZE) {
                ClearPageReserved(virt_to_page(addr));
                init_page_count(virt_to_page(addr));
                free_page(addr);
                totalram_pages++;
        }
        printk (KERN_INFO "Freeing unused kernel memory: %luk freed\n", 
		((unsigned long)&__init_end - (unsigned long)&__init_begin) >> 10);
}
 
/*
 * Associate a virtual page frame with a given physical page frame 
 * and protection flags for that frame.
 */ 
static void set_pte_pfn(unsigned long vaddr, unsigned long pfn, pgprot_t flags)
{
	pgd_t *pgd;
	pud_t *pud;
	pmd_t *pmd;
	pte_t *pte;
 
	pgd = swapper_pg_dir + pgd_index(vaddr);
	if (pgd_none(*pgd)) {
		BUG();
		return;
	}
	pud = pud_offset(pgd, vaddr);
	if (pud_none(*pud)) {
		BUG();
		return;
	}
	pmd = pmd_offset(pud, vaddr);
	if (pmd_none(*pmd)) {
		BUG();
		return;
	}
	pte = pte_offset_kernel(pmd, vaddr);
	/* <pfn,flags> stored as-is, to permit clearing entries */
	set_pte(pte, pfn_pte(pfn, flags));
}
 
void __set_fixmap (enum fixed_addresses idx, unsigned long phys, pgprot_t flags)
{
	unsigned long address = __fix_to_virt(idx);
 
	if (idx >= __end_of_fixed_addresses) {
		BUG();
		return;
	}
	set_pte_pfn(address, phys >> PAGE_SHIFT, flags);
	flush_tlb_all();
}