Subversion Repositories or1k

/*  $Id: modutil.c,v 1.1.1.1 2004-04-15 01:33:42 phoenix Exp $

 *  arch/sparc64/mm/modutil.c

 *

 *  Copyright (C) 1997,1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)

 *  Based upon code written by Linus Torvalds and others.

 */

#include <linux/slab.h>

#include <linux/vmalloc.h>

#include <asm/uaccess.h>

#include <asm/system.h>

static struct vm_struct *modvmlist = NULL;

void __module_unmap(void *addr, int free_area_pages)

{

        struct vm_struct **p, *tmp;

        if (!addr)

                return;

        if ((PAGE_SIZE-1) & (unsigned long) addr) {

                printk("Trying to unmap module with bad address (%p)\n", addr);

                return;

        }

        for (p = &modvmlist ; (tmp = *p) ; p = &tmp->next) {

                if (tmp->addr == addr) {

                        *p = tmp->next;

                        if (free_area_pages)

                                vmfree_area_pages(VMALLOC_VMADDR(tmp->addr),

                                                  tmp->size);

                        kfree(tmp);

                        return;

                }

        }

        printk("Trying to unmap nonexistent module vm area (%p)\n", addr);

}

void module_unmap(void *addr)

{

        __module_unmap(addr, 1);

}

void *module_map (unsigned long size)

{

        void * addr;

        struct vm_struct **p, *tmp, *area;

        size = PAGE_ALIGN(size);

        if (!size || size > MODULES_LEN)

                return NULL;

        addr = (void *) MODULES_VADDR;

        for (p = &modvmlist; (tmp = *p) ; p = &tmp->next) {

                if (size + (unsigned long) addr < (unsigned long) tmp->addr)

                        break;

                addr = (void *) (tmp->size + (unsigned long) tmp->addr);

        }

        if ((unsigned long) addr + size >= MODULES_END)

                return NULL;

        area = (struct vm_struct *) kmalloc(sizeof(*area), GFP_KERNEL);

        if (!area)

                return NULL;

        area->size = size + PAGE_SIZE;

        area->addr = addr;

        area->next = *p;

        *p = area;

        if (vmalloc_area_pages(VMALLOC_VMADDR(addr), size, GFP_KERNEL, PAGE_KERNEL)) {

                __module_unmap(addr, 0);

                return NULL;

        }

        return addr;

}