forked from Imagelibrary/rtems
e366f774a7
Add the special thread queue name _Thread_queue_Object_name to mark thread queues embedded in an object with identifier. Using the special thread state STATES_THREAD_QUEUE_WITH_IDENTIFIER is not reliable for this purpose since the thread wait information and thread state are protected by different SMP locks in separate critical sections. Remove STATES_THREAD_QUEUE_WITH_IDENTIFIER. Add and use _Thread_queue_Object_initialize(). Update #2858.
148 lines
4.1 KiB
C
148 lines
4.1 KiB
C
/**
|
|
* @file
|
|
*
|
|
* @brief CORE Message Queue Submit
|
|
*
|
|
* @ingroup ScoreMessageQueue
|
|
*/
|
|
|
|
/*
|
|
* 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.
|
|
*/
|
|
|
|
#if HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include <rtems/score/coremsgimpl.h>
|
|
#include <rtems/score/objectimpl.h>
|
|
#include <rtems/score/isr.h>
|
|
#include <rtems/score/threadimpl.h>
|
|
#include <rtems/score/statesimpl.h>
|
|
#include <rtems/score/wkspace.h>
|
|
|
|
Status_Control _CORE_message_queue_Submit(
|
|
CORE_message_queue_Control *the_message_queue,
|
|
Thread_Control *executing,
|
|
const void *buffer,
|
|
size_t size,
|
|
CORE_message_queue_Submit_types submit_type,
|
|
bool wait,
|
|
Thread_queue_Context *queue_context
|
|
)
|
|
{
|
|
CORE_message_queue_Buffer_control *the_message;
|
|
Thread_Control *the_thread;
|
|
|
|
if ( size > the_message_queue->maximum_message_size ) {
|
|
_CORE_message_queue_Release( the_message_queue, queue_context );
|
|
return STATUS_MESSAGE_INVALID_SIZE;
|
|
}
|
|
|
|
/*
|
|
* Is there a thread currently waiting on this message queue?
|
|
*/
|
|
|
|
the_thread = _CORE_message_queue_Dequeue_receiver(
|
|
the_message_queue,
|
|
buffer,
|
|
size,
|
|
submit_type,
|
|
queue_context
|
|
);
|
|
if ( the_thread != NULL ) {
|
|
return STATUS_SUCCESSFUL;
|
|
}
|
|
|
|
/*
|
|
* No one waiting on the message queue at this time, so attempt to
|
|
* queue the message up for a future receive.
|
|
*/
|
|
the_message =
|
|
_CORE_message_queue_Allocate_message_buffer( the_message_queue );
|
|
if ( the_message ) {
|
|
_CORE_message_queue_Insert_message(
|
|
the_message_queue,
|
|
the_message,
|
|
buffer,
|
|
size,
|
|
submit_type
|
|
);
|
|
|
|
#if defined(RTEMS_SCORE_COREMSG_ENABLE_NOTIFICATION)
|
|
/*
|
|
* According to POSIX, does this happen before or after the message
|
|
* is actually enqueued. It is logical to think afterwards, because
|
|
* the message is actually in the queue at this point.
|
|
*/
|
|
if (
|
|
the_message_queue->number_of_pending_messages == 1
|
|
&& the_message_queue->notify_handler != NULL
|
|
) {
|
|
( *the_message_queue->notify_handler )(
|
|
the_message_queue,
|
|
queue_context
|
|
);
|
|
} else {
|
|
_CORE_message_queue_Release( the_message_queue, queue_context );
|
|
}
|
|
#else
|
|
_CORE_message_queue_Release( the_message_queue, queue_context );
|
|
#endif
|
|
|
|
return STATUS_SUCCESSFUL;
|
|
}
|
|
|
|
#if !defined(RTEMS_SCORE_COREMSG_ENABLE_BLOCKING_SEND)
|
|
_CORE_message_queue_Release( the_message_queue, queue_context );
|
|
return STATUS_TOO_MANY;
|
|
#else
|
|
/*
|
|
* No message buffers were available so we may need to return an
|
|
* overflow error or block the sender until the message is placed
|
|
* on the queue.
|
|
*/
|
|
if ( !wait ) {
|
|
_CORE_message_queue_Release( the_message_queue, queue_context );
|
|
return STATUS_TOO_MANY;
|
|
}
|
|
|
|
/*
|
|
* Do NOT block on a send if the caller is in an ISR. It is
|
|
* deadly to block in an ISR.
|
|
*/
|
|
if ( _ISR_Is_in_progress() ) {
|
|
_CORE_message_queue_Release( the_message_queue, queue_context );
|
|
return STATUS_MESSAGE_QUEUE_WAIT_IN_ISR;
|
|
}
|
|
|
|
/*
|
|
* WARNING!! executing should NOT be used prior to this point.
|
|
* Thus the unusual choice to open a new scope and declare
|
|
* it as a variable. Doing this emphasizes how dangerous it
|
|
* would be to use this variable prior to here.
|
|
*/
|
|
executing->Wait.return_argument_second.immutable_object = buffer;
|
|
executing->Wait.option = (uint32_t) size;
|
|
executing->Wait.count = submit_type;
|
|
|
|
_Thread_queue_Context_set_thread_state(
|
|
queue_context,
|
|
STATES_WAITING_FOR_MESSAGE
|
|
);
|
|
_Thread_queue_Context_set_do_nothing_enqueue_callout( queue_context );
|
|
_Thread_queue_Enqueue(
|
|
&the_message_queue->Wait_queue.Queue,
|
|
the_message_queue->operations,
|
|
executing,
|
|
queue_context
|
|
);
|
|
return _Thread_Wait_get_status( executing );
|
|
#endif
|
|
}
|