mirror of
https://github.com/drasko/codezero.git
synced 2026-01-12 10:53:16 +01:00
121 lines
2.7 KiB
C
121 lines
2.7 KiB
C
/*
|
|
* This is the glue logic between posix shared memory functions
|
|
* and their L4 implementation.
|
|
*
|
|
* Copyright (C) 2007, 2008 Bahadir Balban
|
|
*/
|
|
#include <errno.h>
|
|
#include <stdio.h>
|
|
#include <sys/shm.h>
|
|
#include <sys/types.h>
|
|
#include <l4lib/arch/syscalls.h>
|
|
#include <l4lib/arch/syslib.h>
|
|
#include <l4lib/ipcdefs.h>
|
|
#include <l4/macros.h>
|
|
#include <libposix.h>
|
|
|
|
int l4_shmget(l4id_t key, int size, int shmflg)
|
|
{
|
|
int err;
|
|
|
|
write_mr(L4SYS_ARG0, key);
|
|
write_mr(L4SYS_ARG1, size);
|
|
write_mr(L4SYS_ARG2, shmflg);
|
|
|
|
/* Call pager with shmget() request. Check ipc error. */
|
|
if ((err = l4_sendrecv(PAGER_TID, PAGER_TID, L4_IPC_TAG_SHMGET)) < 0) {
|
|
print_err("%s: L4 IPC Error: %d.\n", __FUNCTION__, err);
|
|
return err;
|
|
}
|
|
/* Check if syscall itself was successful */
|
|
if (IS_ERR(err = l4_get_retval())) {
|
|
print_err("%s: SHMGET Error: %d.\n", __FUNCTION__, err);
|
|
return err;
|
|
}
|
|
|
|
/* Otherwise err has the positive id number */
|
|
return err;
|
|
}
|
|
|
|
void *l4_shmat(l4id_t shmid, const void *shmaddr, int shmflg)
|
|
{
|
|
int err;
|
|
|
|
write_mr(L4SYS_ARG0, shmid);
|
|
write_mr(L4SYS_ARG1, (unsigned long)shmaddr);
|
|
write_mr(L4SYS_ARG2, shmflg);
|
|
|
|
/* Call pager with shmget() request. Check ipc error. */
|
|
if ((err = l4_sendrecv(PAGER_TID, PAGER_TID, L4_IPC_TAG_SHMAT)) < 0) {
|
|
print_err("%s: L4 IPC Error: %d.\n", __FUNCTION__, err);
|
|
return PTR_ERR(err);
|
|
}
|
|
/* Check if syscall itself was successful */
|
|
if (IS_ERR(err = l4_get_retval())) {
|
|
print_err("%s: SHMAT Error: %d.\n", __FUNCTION__, err);
|
|
return PTR_ERR(err);
|
|
|
|
}
|
|
/* Obtain shm base. */
|
|
return (void *)err;
|
|
}
|
|
|
|
int l4_shmdt(const void *shmaddr)
|
|
{
|
|
int err;
|
|
|
|
write_mr(L4SYS_ARG0, (unsigned long)shmaddr);
|
|
|
|
/* Call pager with shmget() request. Check ipc error. */
|
|
if ((err = l4_sendrecv(PAGER_TID, PAGER_TID, L4_IPC_TAG_SHMDT)) < 0) {
|
|
print_err("%s: L4 IPC Error: %d.\n", __FUNCTION__, err);
|
|
return -1;
|
|
}
|
|
/* Check if syscall itself was successful */
|
|
if ((err = l4_get_retval()) < 0) {
|
|
print_err("%s: SHMDT Error: %d.\n", __FUNCTION__, err);
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int shmget(key_t key, size_t size, int shmflg)
|
|
{
|
|
int ret = l4_shmget(key, size, shmflg);
|
|
|
|
/* If error, return positive error code */
|
|
if (ret < 0) {
|
|
errno = -ret;
|
|
return -1;
|
|
}
|
|
/* else return value */
|
|
return ret;
|
|
}
|
|
|
|
void *shmat(int shmid, const void *shmaddr, int shmflg)
|
|
{
|
|
void *ret = l4_shmat(shmid, shmaddr, shmflg);
|
|
|
|
/* If error, return positive error code */
|
|
if (IS_ERR(ret)) {
|
|
errno = -((int)ret);
|
|
return PTR_ERR(-1);
|
|
}
|
|
/* else return value */
|
|
return ret;
|
|
}
|
|
|
|
int shmdt(const void *shmaddr)
|
|
{
|
|
int ret = l4_shmdt(shmaddr);
|
|
|
|
/* If error, return positive error code */
|
|
if (ret < 0) {
|
|
errno = -ret;
|
|
return -1;
|
|
}
|
|
/* else return value */
|
|
return ret;
|
|
}
|
|
|