OpenCores
URL https://opencores.org/ocsvn/openrisc/openrisc/trunk

Subversion Repositories openrisc

[/] [openrisc/] [tags/] [gnu-src/] [newlib-1.18.0/] [newlib-1.18.0-or32-1.0rc2/] [newlib/] [libc/] [sys/] [linux/] [mq_receive.c] - Diff between revs 207 and 520

Only display areas with differences | Details | Blame | View Log

Rev 207 Rev 520
/* Copyright 2002, Red Hat Inc. */
/* Copyright 2002, Red Hat Inc. */
 
 
#include <mqueue.h>
#include <mqueue.h>
#include <fcntl.h>
#include <fcntl.h>
#include <errno.h>
#include <errno.h>
#include <sys/ipc.h>
#include <sys/ipc.h>
#include <sys/sem.h>
#include <sys/sem.h>
#include <string.h>
#include <string.h>
#define _LIBC 1
#define _LIBC 1
#include <sys/lock.h>
#include <sys/lock.h>
#undef _LIBC
#undef _LIBC
 
 
#include "mqlocal.h"
#include "mqlocal.h"
 
 
__LOCK_INIT(static, mq_rdbuf_lock);
__LOCK_INIT(static, mq_rdbuf_lock);
 
 
ssize_t
ssize_t
mq_receive (mqd_t msgid, char *msg, size_t msg_len, unsigned int *msg_prio)
mq_receive (mqd_t msgid, char *msg, size_t msg_len, unsigned int *msg_prio)
{
{
  struct libc_mq *info;
  struct libc_mq *info;
  struct sembuf sb2 = {2, 1, 0};
  struct sembuf sb2 = {2, 1, 0};
  struct sembuf sb3 = {3, -1, IPC_NOWAIT};
  struct sembuf sb3 = {3, -1, IPC_NOWAIT};
  struct sembuf sb5 = {5, 1, IPC_NOWAIT};
  struct sembuf sb5 = {5, 1, IPC_NOWAIT};
  ssize_t num_bytes;
  ssize_t num_bytes;
  int ipcflag;
  int ipcflag;
 
 
  info = __find_mq (msgid);
  info = __find_mq (msgid);
 
 
  if (info == NULL || (info->oflag & O_ACCMODE) == O_WRONLY)
  if (info == NULL || (info->oflag & O_ACCMODE) == O_WRONLY)
    {
    {
      errno = EBADF;
      errno = EBADF;
      return -1;
      return -1;
    }
    }
 
 
  if (msg_len < info->attr->mq_msgsize)
  if (msg_len < info->attr->mq_msgsize)
    {
    {
      errno = EMSGSIZE;
      errno = EMSGSIZE;
      return -1;
      return -1;
    }
    }
 
 
  __lock_acquire (mq_rdbuf_lock);
  __lock_acquire (mq_rdbuf_lock);
 
 
  ipcflag = (info->attr->mq_flags & O_NONBLOCK) ? IPC_NOWAIT : 0;
  ipcflag = (info->attr->mq_flags & O_NONBLOCK) ? IPC_NOWAIT : 0;
 
 
  semop (info->semid, &sb5, 1); /* increase number of readers */
  semop (info->semid, &sb5, 1); /* increase number of readers */
  num_bytes = msgrcv (info->msgqid, info->rdbuf, msg_len, -MQ_PRIO_MAX, ipcflag);
  num_bytes = msgrcv (info->msgqid, info->rdbuf, msg_len, -MQ_PRIO_MAX, ipcflag);
  sb5.sem_op = -1;
  sb5.sem_op = -1;
  semop (info->semid, &sb5, 1); /* decrease number of readers */
  semop (info->semid, &sb5, 1); /* decrease number of readers */
 
 
  if (num_bytes != (ssize_t)-1)
  if (num_bytes != (ssize_t)-1)
    {
    {
      semop (info->semid, &sb2, 1); /* add one to messages left to write */
      semop (info->semid, &sb2, 1); /* add one to messages left to write */
      semop (info->semid, &sb3, 1); /* subtract one from messages to read */
      semop (info->semid, &sb3, 1); /* subtract one from messages to read */
      memcpy (msg, info->rdbuf->text, num_bytes);
      memcpy (msg, info->rdbuf->text, num_bytes);
      if (msg_prio != NULL)
      if (msg_prio != NULL)
        *msg_prio = MQ_PRIO_MAX - info->rdbuf->type;
        *msg_prio = MQ_PRIO_MAX - info->rdbuf->type;
    }
    }
 
 
  __lock_release (mq_rdbuf_lock);
  __lock_release (mq_rdbuf_lock);
  return num_bytes;
  return num_bytes;
}
}
 
 
 
 
 
 
 
 
 
 
 
 
 
 

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.