Subversion Repositories or1k

#include <linux/vmalloc.h>

#include <asm/pgalloc.h>

/* called with the page_table_lock held */

static inline void

remap_area_pte(pte_t * pte, unsigned long address, unsigned long size,

               unsigned long phys_addr, unsigned long flags)

{

        unsigned long end;

        address &= ~PMD_MASK;

        end = address + size;

        if (end > PMD_SIZE)

                end = PMD_SIZE;

        if (address >= end)

                BUG();

        do {

                if (!pte_none(*pte)) {

                        printk("remap_area_pte: page already exists\n");

                        BUG();

                }

                set_pte(pte,

                        mk_pte_phys(phys_addr,

                                    __pgprot(_PAGE_VALID | _PAGE_ASM |

                                             _PAGE_KRE | _PAGE_KWE | flags)));

                address += PAGE_SIZE;

                phys_addr += PAGE_SIZE;

                pte++;

        } while (address && (address < end));

}

/* called with the page_table_lock held */

static inline int

remap_area_pmd(pmd_t * pmd, unsigned long address, unsigned long size,

               unsigned long phys_addr, unsigned long flags)

{

        unsigned long end;

        address &= ~PGDIR_MASK;

        end = address + size;

        if (end > PGDIR_SIZE)

                end = PGDIR_SIZE;

        phys_addr -= address;

        if (address >= end)

                BUG();

        do {

                pte_t * pte = pte_alloc(&init_mm, pmd, address);

                if (!pte)

                        return -ENOMEM;

                remap_area_pte(pte, address, end - address,

                                     address + phys_addr, flags);

                address = (address + PMD_SIZE) & PMD_MASK;

                pmd++;

        } while (address && (address < end));

        return 0;

}

int

__alpha_remap_area_pages(unsigned long address, unsigned long phys_addr,

                         unsigned long size, unsigned long flags)

{

        pgd_t * dir;

        int error = 0;

        unsigned long end = address + size;

        phys_addr -= address;

        dir = pgd_offset(&init_mm, address);

        flush_cache_all();

        if (address >= end)

                BUG();

        spin_lock(&init_mm.page_table_lock);

        do {

                pmd_t *pmd;

                pmd = pmd_alloc(&init_mm, dir, address);

                error = -ENOMEM;

                if (!pmd)

                        break;

                if (remap_area_pmd(pmd, address, end - address,

                                   phys_addr + address, flags))

                        break;

                error = 0;

                address = (address + PGDIR_SIZE) & PGDIR_MASK;

                dir++;

        } while (address && (address < end));

        spin_unlock(&init_mm.page_table_lock);

        return error;

}