source: rtems/cpukit/score/include/rtems/score/coremsgimpl.h @ 7580995

/**
 * @file
 *
 * @brief Inlined Routines in the Core Message Handler
 *
 * This include file contains the static inline implementation of all
 * inlined routines in the Core Message Handler.
 */

/*
 *  COPYRIGHT (c) 1989-2009.
 *  On-Line Applications Research Corporation (OAR).
 *
 *  The license and distribution terms for this file may be
 *  found in the file LICENSE in this distribution or at
 *  http://www.rtems.org/license/LICENSE.
 */

#ifndef _RTEMS_SCORE_COREMSGIMPL_H
#define _RTEMS_SCORE_COREMSGIMPL_H

#include <rtems/score/coremsg.h>
#include <rtems/score/chainimpl.h>
#include <rtems/score/threaddispatch.h>
#include <rtems/score/threadqimpl.h>

#include <limits.h>
#include <string.h>

#ifdef __cplusplus
extern "C" {
#endif

/**
 * @addtogroup ScoreMessageQueue
 */
/**@{**/

/**
 *  @brief Used when appending messages onto a message queue.
 *
 *  This is the priority constant used when appending messages onto
 *  a message queue.
 */
#define  CORE_MESSAGE_QUEUE_SEND_REQUEST   INT_MAX

/**
 *  @brief Used when prepending messages onto a message queue.
 *
 *  This is the priority constant used when prepending messages onto
 *  a message queue.
 */
#define  CORE_MESSAGE_QUEUE_URGENT_REQUEST INT_MIN

/**
 *  @brief The modes in which a message may be submitted to a message queue.
 *
 *  The following type details the modes in which a message
 *  may be submitted to a message queue.  The message may be posted
 *  in a send or urgent fashion.
 *
 *  @note  All other values are message priorities.  Numerically smaller
 *         priorities indicate higher priority messages.
 */
typedef int CORE_message_queue_Submit_types;

/**
 *  @brief The possible set of Core Message Queue handler return statuses.
 *
 *  This enumerated type defines the possible set of Core Message
 *  Queue handler return statuses.
 */
typedef enum {
  /** This value indicates the operation completed sucessfully. */
  CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL,
  /** This value indicates that the message was too large for this queue. */
  CORE_MESSAGE_QUEUE_STATUS_INVALID_SIZE,
  /** This value indicates that there are too many messages pending. */
  CORE_MESSAGE_QUEUE_STATUS_TOO_MANY,
  /** This value indicates that a receive was unsuccessful. */
  CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED,
  /** This value indicates that a blocking send was unsuccessful. */
  CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT,
  /** This value indicates that the message queue being blocked upon
   *  was deleted while the thread was waiting.
   */
  CORE_MESSAGE_QUEUE_STATUS_WAS_DELETED,
  /** This value indicates that the thread had to timeout while waiting
   *  to receive a message because one did not become available.
   */
  CORE_MESSAGE_QUEUE_STATUS_TIMEOUT,
  /** This value indicates that a blocking receive was unsuccessful. */
  CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT
}   CORE_message_queue_Status;

/**
 *  @brief Core message queue last status value.
 *
 *  This is the last status value.
 */
#define CORE_MESSAGE_QUEUE_STATUS_LAST CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT

/**
 *  @brief Initialize a message queue.
 *
 *  This package is the implementation of the CORE Message Queue Handler.
 *  This core object provides task synchronization and communication functions
 *  via messages passed to queue objects.
 *
 *  This routine initializes @a the_message_queue
 *      based on the parameters passed.
 *
 *  @param[in] the_message_queue points to the message queue to initialize
 *  @param[in] discipline the blocking discipline
 *  @param[in] maximum_pending_messages is the maximum number of messages
 *         that will be allowed to pend at any given time
 *  @param[in] maximum_message_size is the size of largest message that
 *         may be sent to this message queue instance
 *
 *  @retval true if the message queue can be initialized.  In general,
 *         false will only be returned if memory for the pending
 *         messages cannot be allocated.
 */
bool _CORE_message_queue_Initialize(
  CORE_message_queue_Control     *the_message_queue,
  CORE_message_queue_Disciplines  discipline,
  uint32_t                        maximum_pending_messages,
  size_t                          maximum_message_size
);

void _CORE_message_queue_Do_close(
  CORE_message_queue_Control *the_message_queue,
#if defined(RTEMS_MULTIPROCESSING)
  Thread_queue_MP_callout     mp_callout,
  Objects_Id                  mp_id,
#endif
  ISR_lock_Context           *lock_context
);

/**
 *  @brief Close a message queue.
 *
 *  This package is the implementation of the CORE Message Queue Handler.
 *  This core object provides task synchronization and communication functions
 *  via messages passed to queue objects
 *
 *  This function closes a message by returning all allocated space and
 *  flushing @a the_message_queue's task wait queue.
 *
 *  @param[in] the_message_queue points to the message queue to close
 *  @param[in] mp_callout is the routine to call for each thread
 *         that is extracted from the set of waiting threads
 *  @param[in] mp_id the object identifier of the message queue object
 *  @param[in] lock_context The lock context of the
 *    _CORE_message_queue_Acquire() or _CORE_message_queue_Acquire_critical().
 */
#if defined(RTEMS_MULTIPROCESSING)
  #define _CORE_message_queue_Close( \
    the_message_queue, \
    mp_callout, \
    mp_id, \
    lock_context \
  ) \
    _CORE_message_queue_Do_close( \
      the_message_queue, \
      mp_callout, \
      mp_id, \
      lock_context \
    )
#else
  #define _CORE_message_queue_Close( \
    the_message_queue, \
    mp_callout, \
    mp_id, \
    lock_context \
  ) \
    _CORE_message_queue_Do_close( \
      the_message_queue, \
      lock_context \
    )
#endif

/**
 *  @brief Flush pending messages.
 *
 *  This package is the implementation of the CORE Message Queue Handler.
 *  This core object provides task synchronization and communication functions
 *  via messages passed to queue objects.
 *
 *  This function flushes @a the_message_queue's pending message queue.  The
 *  number of messages flushed from the queue is returned.
 *
 *  @param[in] the_message_queue points to the message queue to flush
 *  @param[in] lock_context The lock context of the interrupt disable.
 *
 *  @retval This method returns the number of message pending messages flushed.
 */
uint32_t   _CORE_message_queue_Flush(
  CORE_message_queue_Control *the_message_queue,
  ISR_lock_Context           *lock_context
);

#if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API)
/**
 *  @brief Flush waiting threads.
 *
 *  This function flushes the threads which are blocked on
 *  @a the_message_queue's pending message queue.  They are
 *  unblocked whether blocked sending or receiving. It returns
 *  the number of messages flushed from the queue.
 *
 *  @param[in] the_message_queue points to the message queue to flush
 *  @retval number of messages flushed from the queue
 */
  void _CORE_message_queue_Flush_waiting_threads(
    CORE_message_queue_Control *the_message_queue
  );
#endif

CORE_message_queue_Status _CORE_message_queue_Do_broadcast(
  CORE_message_queue_Control *the_message_queue,
  const void                 *buffer,
  size_t                      size,
#if defined(RTEMS_MULTIPROCESSING)
  Thread_queue_MP_callout     mp_callout,
  Objects_Id                  mp_id,
#endif
  uint32_t                   *count,
  ISR_lock_Context           *lock_context
);

/**
 *  @brief Broadcast a message to the message queue.
 *
 *  This package is the implementation of the CORE Message Queue Handler.
 *  This core object provides task synchronization and communication functions
 *  via messages passed to queue objects.
 *
 *  This function sends a message for every thread waiting on the queue and
 *  returns the number of threads made ready by the message.
 *
 *  @param[in] the_message_queue points to the message queue
 *  @param[in] buffer is the starting address of the message to broadcast
 *  @param[in] size is the size of the message being broadcast
 *  @param[in] mp_callout is the routine to invoke if
 *         a thread that is unblocked is actually a remote thread.
 *  @param[in] mp_id is the RTEMS object Id associated with this message queue.
 *         It is used when unblocking a remote thread.
 *  @param[out] count points to the variable that will contain the
 *         number of tasks that are sent this message
 *  @param[in] lock_context The lock context of the interrupt disable.
 *  @retval @a *count will contain the number of messages sent
 *  @retval indication of the successful completion or reason for failure
 */
#if defined(RTEMS_MULTIPROCESSING)
  #define _CORE_message_queue_Broadcast( \
    the_message_queue, \
    buffer, \
    size, \
    mp_callout, \
    mp_id, \
    count, \
    lock_context \
  ) \
    _CORE_message_queue_Do_broadcast( \
      the_message_queue, \
      buffer, \
      size, \
      mp_callout, \
      mp_id, \
      count, \
      lock_context \
    )
#else
  #define _CORE_message_queue_Broadcast( \
    the_message_queue, \
    buffer, \
    size, \
    mp_callout, \
    mp_id, \
    count, \
    lock_context \
  ) \
    _CORE_message_queue_Do_broadcast( \
      the_message_queue, \
      buffer, \
      size, \
      count, \
      lock_context \
    )
#endif

CORE_message_queue_Status _CORE_message_queue_Do_submit(
  CORE_message_queue_Control       *the_message_queue,
  Thread_Control                   *executing,
  const void                       *buffer,
  size_t                            size,
#if defined(RTEMS_MULTIPROCESSING)
  Thread_queue_MP_callout           mp_callout,
  Objects_Id                        mp_id,
#endif
  CORE_message_queue_Submit_types   submit_type,
  bool                              wait,
  Watchdog_Interval                 timeout,
  ISR_lock_Context                 *lock_context
);

/**
 *  @brief Submit a message to the message queue.
 *
 *  This routine implements the send and urgent message functions. It
 *  processes a message that is to be submitted to the designated
 *  message queue.  The message will either be processed as a
 *  send message which it will be inserted at the rear of the queue
 *  or it will be processed as an urgent message which will be inserted
 *  at the front of the queue.
 *
 *  @param[in] the_message_queue points to the message queue
 *  @param[in] buffer is the starting address of the message to send
 *  @param[in] size is the size of the message being send
 *  @param[in] mp_callout is the routine to invoke if
 *         a thread that is unblocked is actually a remote thread.
 *  @param[in] mp_id is the RTEMS object Id associated with this message queue.
 *         It is used when unblocking a remote thread.
 *  @param[in] submit_type determines whether the message is prepended,
 *         appended, or enqueued in priority order.
 *  @param[in] wait indicates whether the calling thread is willing to block
 *         if the message queue is full.
 *  @param[in] timeout is the maximum number of clock ticks that the calling
 *         thread is willing to block if the message queue is full.
 *  @param[in] lock_context The lock context of the interrupt disable.
 *  @retval indication of the successful completion or reason for failure
 */
#if defined(RTEMS_MULTIPROCESSING)
  #define _CORE_message_queue_Submit( \
    the_message_queue, \
    executing, \
    buffer, \
    size, \
    mp_callout, \
    mp_id, \
    submit_type, \
    wait, \
    timeout, \
    lock_context \
  ) \
    _CORE_message_queue_Do_submit( \
      the_message_queue, \
      executing, \
      buffer, \
      size, \
      mp_callout, \
      mp_id, \
      submit_type, \
      wait, \
      timeout, \
      lock_context \
    )
#else
  #define _CORE_message_queue_Submit( \
    the_message_queue, \
    executing, \
    buffer, \
    size, \
    mp_callout, \
    mp_id, \
    submit_type, \
    wait, \
    timeout, \
    lock_context \
  ) \
    _CORE_message_queue_Do_submit( \
      the_message_queue, \
      executing, \
      buffer, \
      size, \
      submit_type, \
      wait, \
      timeout, \
      lock_context \
    )
#endif

/**
 *  @brief Size a message from the message queue.
 *
 *  This package is the implementation of the CORE Message Queue Handler.
 *  This core object provides task synchronization and communication functions
 *  via messages passed to queue objects.
 *
 *  This kernel routine dequeues a message, copies the message buffer to
 *  a given destination buffer, and frees the message buffer to the
 *  inactive message pool.  The thread will be blocked if wait is true,
 *  otherwise an error will be given to the thread if no messages are available.
 *
 *  @param[in] the_message_queue points to the message queue
 *  @param[in] id is the RTEMS object Id associated with this message queue.
 *         It is used when unblocking a remote thread.
 *  @param[in] buffer is the starting address of the message buffer to
 *         to be filled in with a message
 *  @param[in] size_p is a pointer to the size of the @a buffer and
 *         indicates the maximum size message that the caller can receive.
 *  @param[in] wait indicates whether the calling thread is willing to block
 *         if the message queue is empty.
 *  @param[in] timeout is the maximum number of clock ticks that the calling
 *         thread is willing to block if the message queue is empty.
 *  @param[in] lock_context The lock context of the interrupt disable.
 *
 *  @retval indication of the successful completion or reason for failure.
 *          On success, the location pointed to @a size_p will contain the
 *          size of the received message.
 *
 *  @note Returns message priority via return area in TCB.
 *
 *  - INTERRUPT LATENCY:
 *    + available
 *    + wait
 */
void _CORE_message_queue_Seize(
  CORE_message_queue_Control      *the_message_queue,
  Thread_Control                  *executing,
  Objects_Id                       id,
  void                            *buffer,
  size_t                          *size_p,
  bool                             wait,
  Watchdog_Interval                timeout,
  ISR_lock_Context                *lock_context
);

/**
 *  @brief Insert a message into the message queue.
 *
 *  This kernel routine inserts the specified message into the
 *  message queue.  It is assumed that the message has been filled
 *  in before this routine is called.
 *
 *  @param[in] the_message_queue points to the message queue
 *  @param[in] the_message is the message to enqueue
 *  @param[in] submit_type determines whether the message is prepended,
 *         appended, or enqueued in priority order.
 *
 *  - INTERRUPT LATENCY:
 *    + insert
 */
void _CORE_message_queue_Insert_message(
  CORE_message_queue_Control        *the_message_queue,
  CORE_message_queue_Buffer_control *the_message,
  CORE_message_queue_Submit_types    submit_type
);

/**
 * This routine sends a message to the end of the specified message queue.
 */
#define _CORE_message_queue_Send( \
  the_message_queue, \
  buffer, \
  size, \
  mp_callout, \
  mp_id, \
  wait, \
  timeout, \
  lock_context \
) \
  _CORE_message_queue_Submit( \
    the_message_queue, \
    _Thread_Executing, \
    buffer, \
    size, \
    mp_callout, \
    mp_id, \
    CORE_MESSAGE_QUEUE_SEND_REQUEST, \
    wait, \
    timeout, \
    lock_context \
  )

/**
 * This routine sends a message to the front of the specified message queue.
 */
#define _CORE_message_queue_Urgent( \
  the_message_queue, \
  buffer, \
  size, \
  mp_callout, \
  mp_id, \
  wait, \
  timeout, \
  lock_context \
) \
  _CORE_message_queue_Submit( \
    the_message_queue, \
    _Thread_Executing, \
    buffer, \
    size, \
    mp_callout, \
    mp_id, \
    CORE_MESSAGE_QUEUE_URGENT_REQUEST, \
    wait,\
    timeout, \
    lock_context \
 )

RTEMS_INLINE_ROUTINE void _CORE_message_queue_Acquire(
  CORE_message_queue_Control *the_message_queue,
  ISR_lock_Context           *lock_context
)
{
  _Thread_queue_Acquire( &the_message_queue->Wait_queue, lock_context );
}

RTEMS_INLINE_ROUTINE void _CORE_message_queue_Acquire_critical(
  CORE_message_queue_Control *the_message_queue,
  ISR_lock_Context           *lock_context
)
{
  _Thread_queue_Acquire_critical( &the_message_queue->Wait_queue, lock_context );
}

RTEMS_INLINE_ROUTINE void _CORE_message_queue_Release(
  CORE_message_queue_Control *the_message_queue,
  ISR_lock_Context           *lock_context
)
{
  _Thread_queue_Release( &the_message_queue->Wait_queue, lock_context );
}

/**
 * This routine copies the contents of the source message buffer
 * to the destination message buffer.
 */
RTEMS_INLINE_ROUTINE void _CORE_message_queue_Copy_buffer (
  const void *source,
  void       *destination,
  size_t      size
)
{
  memcpy(destination, source, size);
}

/**
 * This function allocates a message buffer from the inactive
 * message buffer chain.
 */
RTEMS_INLINE_ROUTINE CORE_message_queue_Buffer_control *
_CORE_message_queue_Allocate_message_buffer (
    CORE_message_queue_Control *the_message_queue
)
{
   return (CORE_message_queue_Buffer_control *)
     _Chain_Get_unprotected( &the_message_queue->Inactive_messages );
}

/**
 * This routine frees a message buffer to the inactive
 * message buffer chain.
 */
RTEMS_INLINE_ROUTINE void _CORE_message_queue_Free_message_buffer (
  CORE_message_queue_Control        *the_message_queue,
  CORE_message_queue_Buffer_control *the_message
)
{
  _Chain_Append_unprotected( &the_message_queue->Inactive_messages, &the_message->Node );
}

/**
 * This function returns the priority of @a the_message.
 *
 * @note It encapsulates the optional behavior that message priority is
 *       disabled if no API requires it.
 */
RTEMS_INLINE_ROUTINE int _CORE_message_queue_Get_message_priority (
  const CORE_message_queue_Buffer_control *the_message
)
{
  #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY)
    return the_message->priority;
  #else
    return 0;
  #endif
}

/**
 * This function sets the priority of @a the_message.
 *
 * @note It encapsulates the optional behavior that message priority is
 *       disabled if no API requires it.
 */
RTEMS_INLINE_ROUTINE void _CORE_message_queue_Set_message_priority (
  CORE_message_queue_Buffer_control *the_message,
  int                                priority
)
{
  #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY)
    the_message->priority = priority;
  #endif
}

/**
 * This function removes the first message from the_message_queue
 * and returns a pointer to it.
 */
RTEMS_INLINE_ROUTINE
  CORE_message_queue_Buffer_control *_CORE_message_queue_Get_pending_message (
  CORE_message_queue_Control *the_message_queue
)
{
  return (CORE_message_queue_Buffer_control *)
    _Chain_Get_unprotected( &the_message_queue->Pending_messages );
}

#if defined(RTEMS_SCORE_COREMSG_ENABLE_NOTIFICATION)
  /**
   * This function returns true if notification is enabled on this message
   * queue and false otherwise.
   */
  RTEMS_INLINE_ROUTINE bool _CORE_message_queue_Is_notify_enabled (
    CORE_message_queue_Control *the_message_queue
  )
  {
    return (the_message_queue->notify_handler != NULL);
  }
#endif

/**
 * This routine initializes the notification information for
 * @a the_message_queue.
 */
#if defined(RTEMS_SCORE_COREMSG_ENABLE_NOTIFICATION)
  RTEMS_INLINE_ROUTINE void _CORE_message_queue_Set_notify (
    CORE_message_queue_Control        *the_message_queue,
    CORE_message_queue_Notify_Handler  the_handler,
    void                              *the_argument
  )
  {
    the_message_queue->notify_handler  = the_handler;
    the_message_queue->notify_argument = the_argument;
  }
#else
  /* turn it into nothing if not enabled */
  #define _CORE_message_queue_Set_notify( \
           the_message_queue, the_handler, the_argument )
#endif

RTEMS_INLINE_ROUTINE Thread_Control *_CORE_message_queue_Do_dequeue_receiver(
  CORE_message_queue_Control      *the_message_queue,
  const void                      *buffer,
  size_t                           size,
#if defined(RTEMS_MULTIPROCESSING)
  Thread_queue_MP_callout          mp_callout,
  Objects_Id                       mp_id,
#endif
  CORE_message_queue_Submit_types  submit_type,
  ISR_lock_Context                *lock_context
)
{
  Thread_Control *the_thread;

  /*
   *  If there are pending messages, then there can't be threads
   *  waiting for us to send them a message.
   *
   *  NOTE: This check is critical because threads can block on
   *        send and receive and this ensures that we are broadcasting
   *        the message to threads waiting to receive -- not to send.
   */
  if ( the_message_queue->number_of_pending_messages != 0 ) {
    return NULL;
  }

  /*
   *  There must be no pending messages if there is a thread waiting to
   *  receive a message.
   */
  the_thread = _Thread_queue_First_locked(
    &the_message_queue->Wait_queue,
    the_message_queue->operations
  );
  if ( the_thread == NULL ) {
    return NULL;
  }

   *(size_t *) the_thread->Wait.return_argument = size;
   the_thread->Wait.count = (uint32_t) submit_type;

  _CORE_message_queue_Copy_buffer(
    buffer,
    the_thread->Wait.return_argument_second.mutable_object,
    size
  );

  _Thread_queue_Extract_critical(
    &the_message_queue->Wait_queue.Queue,
    the_message_queue->operations,
    the_thread,
    mp_callout,
    mp_id,
    lock_context
  );

  return the_thread;
}

#if defined(RTEMS_MULTIPROCESSING)
  #define _CORE_message_queue_Dequeue_receiver( \
    the_message_queue, \
    buffer, \
    size, \
    mp_callout, \
    mp_id, \
    submit_type, \
    lock_context \
  ) \
    _CORE_message_queue_Do_dequeue_receiver( \
      the_message_queue, \
      buffer, \
      size, \
      mp_callout, \
      mp_id, \
      submit_type, \
      lock_context \
    )
#else
  #define _CORE_message_queue_Dequeue_receiver( \
    the_message_queue, \
    buffer, \
    size, \
    mp_callout, \
    mp_id, \
    submit_type, \
    lock_context \
  ) \
    _CORE_message_queue_Do_dequeue_receiver( \
      the_message_queue, \
      buffer, \
      size, \
      submit_type, \
      lock_context \
    )
#endif

/** @} */

#ifdef __cplusplus
}
#endif

#endif
/* end of include file */