Subversion Repositories openrisc

/*
 *  NOTE:  The structure of the routines is identical to that of POSIX
 *         Message_queues to leave the option of having unnamed message
 *         queues at a future date.  They are currently not part of the
 *         POSIX standard but unnamed message_queues are.  This is also 
 *         the reason for the apparently unnecessary tracking of 
 *         the process_shared attribute.  [In addition to the fact that
 *         it would be trivial to add pshared to the mq_attr structure
 *         and have process private message queues.]
 *
 *         This code ignores the O_RDONLY/O_WRONLY/O_RDWR flag at open
 *         time.
 *
 *  $Id: mqueuesendsupp.c,v 1.2 2001-09-27 11:59:17 chris Exp $
 */
 
#include <stdarg.h>
 
#include <pthread.h>
#include <limits.h>
#include <errno.h>
#include <fcntl.h>
#include <mqueue.h>
 
#include <rtems/system.h>
#include <rtems/score/watchdog.h>
#include <rtems/posix/seterr.h>
#include <rtems/posix/mqueue.h>
#include <rtems/posix/time.h>
 
#ifndef MQ_PRIO_MAX
#define MQ_PRIO_MAX 32
#endif
 
/*PAGE
 *
 *  _POSIX_Message_queue_Send_support
 */
 
int _POSIX_Message_queue_Send_support(
  mqd_t               mqdes,
  const char         *msg_ptr,
  unsigned32          msg_len,
  unsigned32          msg_prio,
  Watchdog_Interval   timeout
)
{
  register POSIX_Message_queue_Control *the_mq;
  Objects_Locations                     location;
 
  /*
   * Validate the priority.
   * XXX - Do not validate msg_prio is not less than 0.
   */
 
  if ( msg_prio > MQ_PRIO_MAX )
    set_errno_and_return_minus_one( EINVAL );
 
  the_mq = _POSIX_Message_queue_Get( mqdes, &location );
 
  switch ( location ) {
    case OBJECTS_ERROR:
      set_errno_and_return_minus_one( EBADF );
 
    case OBJECTS_REMOTE:
      _Thread_Dispatch();
      return POSIX_MP_NOT_IMPLEMENTED();
      set_errno_and_return_minus_one( EINVAL );
 
    case OBJECTS_LOCAL:
      if ( (the_mq->oflag & O_ACCMODE) == O_RDONLY ) {
        _Thread_Enable_dispatch();
        set_errno_and_return_minus_one( EBADF );
      }
 
      _CORE_message_queue_Submit(
        &the_mq->Message_queue,
        (void *) msg_ptr,
        msg_len,
        mqdes,      /* mqd_t is an object id */
#if defined(RTEMS_MULTIPROCESSING)
        NULL,      /* XXX _POSIX_Message_queue_Core_message_queue_mp_support*/
#else
        NULL,
#endif
        _POSIX_Message_queue_Priority_to_core( msg_prio ),
         (the_mq->oflag & O_NONBLOCK) ? FALSE : TRUE, 
        timeout    /* no timeout */
      );
 
      _Thread_Enable_dispatch();
      if ( !_Thread_Executing->Wait.return_code )
        return 0;
 
      set_errno_and_return_minus_one(
        _POSIX_Message_queue_Translate_core_message_queue_return_code(
          _Thread_Executing->Wait.return_code
        )
      );
  }
  return POSIX_BOTTOM_REACHED();
}