122 lines
		
	
	
		
			3.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			122 lines
		
	
	
		
			3.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/* MN10300 Cache flushing routines
 | 
						|
 *
 | 
						|
 * Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
 | 
						|
 * Written by David Howells (dhowells@redhat.com)
 | 
						|
 *
 | 
						|
 * This program is free software; you can redistribute it and/or
 | 
						|
 * modify it under the terms of the GNU General Public Licence
 | 
						|
 * as published by the Free Software Foundation; either version
 | 
						|
 * 2 of the Licence, or (at your option) any later version.
 | 
						|
 */
 | 
						|
#include <linux/module.h>
 | 
						|
#include <linux/mm.h>
 | 
						|
#include <linux/mman.h>
 | 
						|
#include <linux/threads.h>
 | 
						|
#include <asm/page.h>
 | 
						|
#include <asm/pgtable.h>
 | 
						|
#include <asm/processor.h>
 | 
						|
#include <asm/cacheflush.h>
 | 
						|
#include <asm/io.h>
 | 
						|
#include <asm/uaccess.h>
 | 
						|
 | 
						|
EXPORT_SYMBOL(mn10300_icache_inv);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_inv);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_inv_range);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_inv_range2);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_inv_page);
 | 
						|
 | 
						|
#ifdef CONFIG_MN10300_CACHE_WBACK
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_flush);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_flush_inv);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_flush_inv_range);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_flush_inv_range2);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_flush_inv_page);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_flush_range);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_flush_range2);
 | 
						|
EXPORT_SYMBOL(mn10300_dcache_flush_page);
 | 
						|
#endif
 | 
						|
 | 
						|
/*
 | 
						|
 * write a page back from the dcache and invalidate the icache so that we can
 | 
						|
 * run code from it that we've just written into it
 | 
						|
 */
 | 
						|
void flush_icache_page(struct vm_area_struct *vma, struct page *page)
 | 
						|
{
 | 
						|
	mn10300_dcache_flush_page(page_to_phys(page));
 | 
						|
	mn10300_icache_inv();
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(flush_icache_page);
 | 
						|
 | 
						|
/*
 | 
						|
 * write some code we've just written back from the dcache and invalidate the
 | 
						|
 * icache so that we can run that code
 | 
						|
 */
 | 
						|
void flush_icache_range(unsigned long start, unsigned long end)
 | 
						|
{
 | 
						|
#ifdef CONFIG_MN10300_CACHE_WBACK
 | 
						|
	unsigned long addr, size, off;
 | 
						|
	struct page *page;
 | 
						|
	pgd_t *pgd;
 | 
						|
	pud_t *pud;
 | 
						|
	pmd_t *pmd;
 | 
						|
	pte_t *ppte, pte;
 | 
						|
 | 
						|
	for (; start < end; start += size) {
 | 
						|
		/* work out how much of the page to flush */
 | 
						|
		off = start & (PAGE_SIZE - 1);
 | 
						|
 | 
						|
		size = end - start;
 | 
						|
		if (size > PAGE_SIZE - off)
 | 
						|
			size = PAGE_SIZE - off;
 | 
						|
 | 
						|
		/* get the physical address the page is mapped to from the page
 | 
						|
		 * tables */
 | 
						|
		pgd = pgd_offset(current->mm, start);
 | 
						|
		if (!pgd || !pgd_val(*pgd))
 | 
						|
			continue;
 | 
						|
 | 
						|
		pud = pud_offset(pgd, start);
 | 
						|
		if (!pud || !pud_val(*pud))
 | 
						|
			continue;
 | 
						|
 | 
						|
		pmd = pmd_offset(pud, start);
 | 
						|
		if (!pmd || !pmd_val(*pmd))
 | 
						|
			continue;
 | 
						|
 | 
						|
		ppte = pte_offset_map(pmd, start);
 | 
						|
		if (!ppte)
 | 
						|
			continue;
 | 
						|
		pte = *ppte;
 | 
						|
		pte_unmap(ppte);
 | 
						|
 | 
						|
		if (pte_none(pte))
 | 
						|
			continue;
 | 
						|
 | 
						|
		page = pte_page(pte);
 | 
						|
		if (!page)
 | 
						|
			continue;
 | 
						|
 | 
						|
		addr = page_to_phys(page);
 | 
						|
 | 
						|
		/* flush the dcache and invalidate the icache coverage on that
 | 
						|
		 * region */
 | 
						|
		mn10300_dcache_flush_range2(addr + off, size);
 | 
						|
	}
 | 
						|
#endif
 | 
						|
 | 
						|
	mn10300_icache_inv();
 | 
						|
}
 | 
						|
EXPORT_SYMBOL(flush_icache_range);
 | 
						|
 | 
						|
/*
 | 
						|
 * allow userspace to flush the instruction cache
 | 
						|
 */
 | 
						|
asmlinkage long sys_cacheflush(unsigned long start, unsigned long end)
 | 
						|
{
 | 
						|
	if (end < start)
 | 
						|
		return -EINVAL;
 | 
						|
 | 
						|
	flush_icache_range(start, end);
 | 
						|
	return 0;
 | 
						|
}
 |