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();

}