Subversion Repositories c0or1k

/*

 * Glue logic between posix mmap/munmap functions

 * and their L4 implementation.

 *

 * Copyright (C) 2007 Bahadir Balban

 */

#include <errno.h>

#include <stdio.h>

#include <sys/mman.h>

#include <sys/types.h>

#include <l4lib/ipcdefs.h>

#include <libposix.h>

/* FIXME: Implement the same separation that is in read.c write.c etc. such that

 * l4_syscall returns negative value and then the actual posix glue sets the errno

 * rather than the l4_syscall sets it itself

 */

struct mmap_descriptor {

        void *start;

        size_t length;

        int prot;

        int flags;

        int fd;

        off_t offset;

};

static inline void *l4_mmap(void *start, size_t length, int prot, int flags, int fd, off_t pgoffset)

{

        /* Not enough MRs for all arguments, therefore we fill in a structure */

        struct mmap_descriptor desc = {

                .start = start,

                .length = length,

                .prot = prot,

                .flags = flags,

                .fd = fd,

                .offset = pgoffset,

        };

        int ret;

        write_mr(L4SYS_ARG0, (unsigned long)&desc);

        /* Call pager with MMAP request. Check ipc error. */

        if ((ret = l4_sendrecv(pagerid, pagerid, L4_IPC_TAG_MMAP)) < 0) {

                print_err("%s: IPC Error: %d.\n", __FUNCTION__, ret);

                return PTR_ERR(ret);

        }

        if (IS_ERR(ret = l4_get_retval()))

                print_err("%s: MMAP Error: %d.\n", __FUNCTION__, ret);

        return (void *)ret;

}

void *mmap2(void *start, size_t length, int prot, int flags, int fd, off_t pgoffset)

{

        void *ret = l4_mmap(start, length, prot, flags, fd, pgoffset);

        if (IS_ERR(ret)) {

                errno = -(int)ret;

                return MAP_FAILED;

        }

        return ret;

}

void *mmap(void *start, size_t length, int prot, int flags, int fd, off_t offset)

{

        return mmap2(start, length, prot, flags, fd, __pfn(offset));

}

int l4_munmap(void *start, size_t length)

{

        int err;

        write_mr(L4SYS_ARG0, (unsigned long)start);

        write_mr(L4SYS_ARG1, length);

        /* Call pager with MMAP request. */

        if ((err = l4_sendrecv(pagerid, pagerid, L4_IPC_TAG_MUNMAP)) < 0) {

                print_err("%s: IPC Error: %d.\n", __FUNCTION__, err);

                return err;

        }

        /* Check if syscall itself was successful */

        if ((err = l4_get_retval()) < 0) {

                print_err("%s: MUNMAP Error: %d.\n", __FUNCTION__, err);

                return err;

        }

        return 0;

}

int munmap(void *start, size_t length)

{

        int ret = l4_munmap(start, length);

        /* If error, return positive error code */

        if (ret < 0) {

                errno = -ret;

                return -1;

        }

        return 0;

}

int l4_msync(void *start, size_t length, int flags)

{

        write_mr(L4SYS_ARG0, (unsigned long)start);

        write_mr(L4SYS_ARG1, length);

        write_mr(L4SYS_ARG2, flags);

        /* Call pager with MMAP request. */

        if ((errno = l4_sendrecv(pagerid, pagerid, L4_IPC_TAG_MSYNC)) < 0) {

                print_err("%s: IPC Error: %d.\n", __FUNCTION__, errno);

                return -1;

        }

        /* Check if syscall itself was successful */

        if ((errno = l4_get_retval()) < 0) {

                print_err("%s: MSYNC Error: %d.\n", __FUNCTION__, errno);

                return -1;

        }

        return 0;

}

int msync(void *start, size_t length, int flags)

{

        int ret = l4_msync(start, length, flags);

        if (ret < 0) {

                errno = -ret;

                return -1;

        }

        return 0;

}