/*
|
/*
|
* Multiprocessing Support for the Message Queue Manager
|
* Multiprocessing Support for the Message Queue Manager
|
*
|
*
|
*
|
*
|
* COPYRIGHT (c) 1989-1999.
|
* COPYRIGHT (c) 1989-1999.
|
* On-Line Applications Research Corporation (OAR).
|
* On-Line Applications Research Corporation (OAR).
|
*
|
*
|
* The license and distribution terms for this file may be
|
* The license and distribution terms for this file may be
|
* found in the file LICENSE in this distribution or at
|
* found in the file LICENSE in this distribution or at
|
* http://www.OARcorp.com/rtems/license.html.
|
* http://www.OARcorp.com/rtems/license.html.
|
*
|
*
|
* $Id: msgmp.c,v 1.2 2001-09-27 11:59:19 chris Exp $
|
* $Id: msgmp.c,v 1.2 2001-09-27 11:59:19 chris Exp $
|
*/
|
*/
|
|
|
#include <rtems/system.h>
|
#include <rtems/system.h>
|
#include <rtems/rtems/status.h>
|
#include <rtems/rtems/status.h>
|
#include <rtems/rtems/message.h>
|
#include <rtems/rtems/message.h>
|
#include <rtems/score/mpci.h>
|
#include <rtems/score/mpci.h>
|
#include <rtems/rtems/msgmp.h>
|
#include <rtems/rtems/msgmp.h>
|
#include <rtems/score/object.h>
|
#include <rtems/score/object.h>
|
#include <rtems/rtems/options.h>
|
#include <rtems/rtems/options.h>
|
#include <rtems/score/thread.h>
|
#include <rtems/score/thread.h>
|
#include <rtems/score/watchdog.h>
|
#include <rtems/score/watchdog.h>
|
#include <rtems/rtems/support.h>
|
#include <rtems/rtems/support.h>
|
|
|
/*PAGE
|
/*PAGE
|
*
|
*
|
* _Message_queue_MP_Send_process_packet
|
* _Message_queue_MP_Send_process_packet
|
*
|
*
|
*/
|
*/
|
|
|
void _Message_queue_MP_Send_process_packet (
|
void _Message_queue_MP_Send_process_packet (
|
Message_queue_MP_Remote_operations operation,
|
Message_queue_MP_Remote_operations operation,
|
Objects_Id message_queue_id,
|
Objects_Id message_queue_id,
|
rtems_name name,
|
rtems_name name,
|
Objects_Id proxy_id
|
Objects_Id proxy_id
|
)
|
)
|
{
|
{
|
Message_queue_MP_Packet *the_packet;
|
Message_queue_MP_Packet *the_packet;
|
unsigned32 node;
|
unsigned32 node;
|
|
|
switch ( operation ) {
|
switch ( operation ) {
|
|
|
case MESSAGE_QUEUE_MP_ANNOUNCE_CREATE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_CREATE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_DELETE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_DELETE:
|
case MESSAGE_QUEUE_MP_EXTRACT_PROXY:
|
case MESSAGE_QUEUE_MP_EXTRACT_PROXY:
|
|
|
the_packet = _Message_queue_MP_Get_packet();
|
the_packet = _Message_queue_MP_Get_packet();
|
the_packet->Prefix.the_class = MP_PACKET_MESSAGE_QUEUE;
|
the_packet->Prefix.the_class = MP_PACKET_MESSAGE_QUEUE;
|
the_packet->Prefix.length = sizeof ( Message_queue_MP_Packet );
|
the_packet->Prefix.length = sizeof ( Message_queue_MP_Packet );
|
the_packet->Prefix.to_convert = sizeof ( Message_queue_MP_Packet );
|
the_packet->Prefix.to_convert = sizeof ( Message_queue_MP_Packet );
|
the_packet->operation = operation;
|
the_packet->operation = operation;
|
the_packet->Prefix.id = message_queue_id;
|
the_packet->Prefix.id = message_queue_id;
|
the_packet->name = name;
|
the_packet->name = name;
|
the_packet->proxy_id = proxy_id;
|
the_packet->proxy_id = proxy_id;
|
|
|
if ( operation == MESSAGE_QUEUE_MP_EXTRACT_PROXY )
|
if ( operation == MESSAGE_QUEUE_MP_EXTRACT_PROXY )
|
node = rtems_get_node( message_queue_id );
|
node = rtems_get_node( message_queue_id );
|
else
|
else
|
node = MPCI_ALL_NODES;
|
node = MPCI_ALL_NODES;
|
|
|
_MPCI_Send_process_packet( node, &the_packet->Prefix );
|
_MPCI_Send_process_packet( node, &the_packet->Prefix );
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_RECEIVE_REQUEST:
|
case MESSAGE_QUEUE_MP_RECEIVE_REQUEST:
|
case MESSAGE_QUEUE_MP_RECEIVE_RESPONSE:
|
case MESSAGE_QUEUE_MP_RECEIVE_RESPONSE:
|
case MESSAGE_QUEUE_MP_SEND_REQUEST:
|
case MESSAGE_QUEUE_MP_SEND_REQUEST:
|
case MESSAGE_QUEUE_MP_SEND_RESPONSE:
|
case MESSAGE_QUEUE_MP_SEND_RESPONSE:
|
case MESSAGE_QUEUE_MP_URGENT_REQUEST:
|
case MESSAGE_QUEUE_MP_URGENT_REQUEST:
|
case MESSAGE_QUEUE_MP_URGENT_RESPONSE:
|
case MESSAGE_QUEUE_MP_URGENT_RESPONSE:
|
case MESSAGE_QUEUE_MP_BROADCAST_REQUEST:
|
case MESSAGE_QUEUE_MP_BROADCAST_REQUEST:
|
case MESSAGE_QUEUE_MP_BROADCAST_RESPONSE:
|
case MESSAGE_QUEUE_MP_BROADCAST_RESPONSE:
|
case MESSAGE_QUEUE_MP_FLUSH_REQUEST:
|
case MESSAGE_QUEUE_MP_FLUSH_REQUEST:
|
case MESSAGE_QUEUE_MP_FLUSH_RESPONSE:
|
case MESSAGE_QUEUE_MP_FLUSH_RESPONSE:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_REQUEST:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_REQUEST:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_RESPONSE:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_RESPONSE:
|
break;
|
break;
|
|
|
}
|
}
|
}
|
}
|
|
|
/*PAGE
|
/*PAGE
|
*
|
*
|
* _Message_queue_MP_Send_request_packet
|
* _Message_queue_MP_Send_request_packet
|
*
|
*
|
*/
|
*/
|
|
|
rtems_status_code _Message_queue_MP_Send_request_packet (
|
rtems_status_code _Message_queue_MP_Send_request_packet (
|
Message_queue_MP_Remote_operations operation,
|
Message_queue_MP_Remote_operations operation,
|
Objects_Id message_queue_id,
|
Objects_Id message_queue_id,
|
void *buffer,
|
void *buffer,
|
unsigned32 *size_p,
|
unsigned32 *size_p,
|
rtems_option option_set,
|
rtems_option option_set,
|
rtems_interval timeout
|
rtems_interval timeout
|
)
|
)
|
{
|
{
|
Message_queue_MP_Packet *the_packet;
|
Message_queue_MP_Packet *the_packet;
|
|
|
switch ( operation ) {
|
switch ( operation ) {
|
|
|
case MESSAGE_QUEUE_MP_SEND_REQUEST:
|
case MESSAGE_QUEUE_MP_SEND_REQUEST:
|
case MESSAGE_QUEUE_MP_URGENT_REQUEST:
|
case MESSAGE_QUEUE_MP_URGENT_REQUEST:
|
case MESSAGE_QUEUE_MP_BROADCAST_REQUEST:
|
case MESSAGE_QUEUE_MP_BROADCAST_REQUEST:
|
case MESSAGE_QUEUE_MP_FLUSH_REQUEST:
|
case MESSAGE_QUEUE_MP_FLUSH_REQUEST:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_REQUEST:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_REQUEST:
|
|
|
the_packet = _Message_queue_MP_Get_packet();
|
the_packet = _Message_queue_MP_Get_packet();
|
the_packet->Prefix.the_class = MP_PACKET_MESSAGE_QUEUE;
|
the_packet->Prefix.the_class = MP_PACKET_MESSAGE_QUEUE;
|
the_packet->Prefix.length = sizeof(Message_queue_MP_Packet);
|
the_packet->Prefix.length = sizeof(Message_queue_MP_Packet);
|
if ( size_p )
|
if ( size_p )
|
the_packet->Prefix.length += *size_p;
|
the_packet->Prefix.length += *size_p;
|
the_packet->Prefix.to_convert = sizeof(Message_queue_MP_Packet);
|
the_packet->Prefix.to_convert = sizeof(Message_queue_MP_Packet);
|
|
|
/*
|
/*
|
* make sure message is not too big for our MPCI driver
|
* make sure message is not too big for our MPCI driver
|
* We have to check it here instead of waiting for MPCI because
|
* We have to check it here instead of waiting for MPCI because
|
* we are about to slam in the payload
|
* we are about to slam in the payload
|
*/
|
*/
|
|
|
if (the_packet->Prefix.length > _MPCI_table->maximum_packet_size) {
|
if (the_packet->Prefix.length > _MPCI_table->maximum_packet_size) {
|
_Thread_Enable_dispatch();
|
_Thread_Enable_dispatch();
|
return RTEMS_INVALID_SIZE;
|
return RTEMS_INVALID_SIZE;
|
}
|
}
|
|
|
if (! _Options_Is_no_wait(option_set))
|
if (! _Options_Is_no_wait(option_set))
|
the_packet->Prefix.timeout = timeout;
|
the_packet->Prefix.timeout = timeout;
|
|
|
the_packet->operation = operation;
|
the_packet->operation = operation;
|
the_packet->Prefix.id = message_queue_id;
|
the_packet->Prefix.id = message_queue_id;
|
the_packet->option_set = option_set;
|
the_packet->option_set = option_set;
|
|
|
/*
|
/*
|
* Copy the data into place if needed
|
* Copy the data into place if needed
|
*/
|
*/
|
|
|
if (buffer) {
|
if (buffer) {
|
the_packet->Buffer.size = *size_p;
|
the_packet->Buffer.size = *size_p;
|
_CORE_message_queue_Copy_buffer(
|
_CORE_message_queue_Copy_buffer(
|
buffer,
|
buffer,
|
the_packet->Buffer.buffer,
|
the_packet->Buffer.buffer,
|
*size_p
|
*size_p
|
);
|
);
|
}
|
}
|
|
|
return (rtems_status_code) _MPCI_Send_request_packet(
|
return (rtems_status_code) _MPCI_Send_request_packet(
|
rtems_get_node(message_queue_id),
|
rtems_get_node(message_queue_id),
|
&the_packet->Prefix,
|
&the_packet->Prefix,
|
STATES_WAITING_FOR_MESSAGE
|
STATES_WAITING_FOR_MESSAGE
|
);
|
);
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_RECEIVE_REQUEST:
|
case MESSAGE_QUEUE_MP_RECEIVE_REQUEST:
|
|
|
the_packet = _Message_queue_MP_Get_packet();
|
the_packet = _Message_queue_MP_Get_packet();
|
the_packet->Prefix.the_class = MP_PACKET_MESSAGE_QUEUE;
|
the_packet->Prefix.the_class = MP_PACKET_MESSAGE_QUEUE;
|
the_packet->Prefix.length = sizeof(Message_queue_MP_Packet);
|
the_packet->Prefix.length = sizeof(Message_queue_MP_Packet);
|
the_packet->Prefix.to_convert = sizeof(Message_queue_MP_Packet);
|
the_packet->Prefix.to_convert = sizeof(Message_queue_MP_Packet);
|
|
|
if (! _Options_Is_no_wait(option_set))
|
if (! _Options_Is_no_wait(option_set))
|
the_packet->Prefix.timeout = timeout;
|
the_packet->Prefix.timeout = timeout;
|
|
|
the_packet->operation = MESSAGE_QUEUE_MP_RECEIVE_REQUEST;
|
the_packet->operation = MESSAGE_QUEUE_MP_RECEIVE_REQUEST;
|
the_packet->Prefix.id = message_queue_id;
|
the_packet->Prefix.id = message_queue_id;
|
the_packet->option_set = option_set;
|
the_packet->option_set = option_set;
|
the_packet->size = 0; /* just in case of an error */
|
the_packet->size = 0; /* just in case of an error */
|
|
|
_Thread_Executing->Wait.return_argument = (unsigned32 *)buffer;
|
_Thread_Executing->Wait.return_argument = (unsigned32 *)buffer;
|
_Thread_Executing->Wait.return_argument_1 = size_p;
|
_Thread_Executing->Wait.return_argument_1 = size_p;
|
|
|
return (rtems_status_code) _MPCI_Send_request_packet(
|
return (rtems_status_code) _MPCI_Send_request_packet(
|
rtems_get_node(message_queue_id),
|
rtems_get_node(message_queue_id),
|
&the_packet->Prefix,
|
&the_packet->Prefix,
|
STATES_WAITING_FOR_MESSAGE
|
STATES_WAITING_FOR_MESSAGE
|
);
|
);
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_ANNOUNCE_CREATE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_CREATE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_DELETE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_DELETE:
|
case MESSAGE_QUEUE_MP_EXTRACT_PROXY:
|
case MESSAGE_QUEUE_MP_EXTRACT_PROXY:
|
case MESSAGE_QUEUE_MP_RECEIVE_RESPONSE:
|
case MESSAGE_QUEUE_MP_RECEIVE_RESPONSE:
|
case MESSAGE_QUEUE_MP_SEND_RESPONSE:
|
case MESSAGE_QUEUE_MP_SEND_RESPONSE:
|
case MESSAGE_QUEUE_MP_URGENT_RESPONSE:
|
case MESSAGE_QUEUE_MP_URGENT_RESPONSE:
|
case MESSAGE_QUEUE_MP_BROADCAST_RESPONSE:
|
case MESSAGE_QUEUE_MP_BROADCAST_RESPONSE:
|
case MESSAGE_QUEUE_MP_FLUSH_RESPONSE:
|
case MESSAGE_QUEUE_MP_FLUSH_RESPONSE:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_RESPONSE:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_RESPONSE:
|
break;
|
break;
|
}
|
}
|
|
|
return RTEMS_SUCCESSFUL;
|
return RTEMS_SUCCESSFUL;
|
}
|
}
|
|
|
/*PAGE
|
/*PAGE
|
*
|
*
|
* _Message_queue_MP_Send_response_packet
|
* _Message_queue_MP_Send_response_packet
|
*
|
*
|
*/
|
*/
|
|
|
void _Message_queue_MP_Send_response_packet (
|
void _Message_queue_MP_Send_response_packet (
|
Message_queue_MP_Remote_operations operation,
|
Message_queue_MP_Remote_operations operation,
|
Objects_Id message_queue_id,
|
Objects_Id message_queue_id,
|
Thread_Control *the_thread
|
Thread_Control *the_thread
|
)
|
)
|
{
|
{
|
Message_queue_MP_Packet *the_packet;
|
Message_queue_MP_Packet *the_packet;
|
|
|
switch ( operation ) {
|
switch ( operation ) {
|
|
|
case MESSAGE_QUEUE_MP_RECEIVE_RESPONSE:
|
case MESSAGE_QUEUE_MP_RECEIVE_RESPONSE:
|
case MESSAGE_QUEUE_MP_SEND_RESPONSE:
|
case MESSAGE_QUEUE_MP_SEND_RESPONSE:
|
case MESSAGE_QUEUE_MP_URGENT_RESPONSE:
|
case MESSAGE_QUEUE_MP_URGENT_RESPONSE:
|
case MESSAGE_QUEUE_MP_BROADCAST_RESPONSE:
|
case MESSAGE_QUEUE_MP_BROADCAST_RESPONSE:
|
case MESSAGE_QUEUE_MP_FLUSH_RESPONSE:
|
case MESSAGE_QUEUE_MP_FLUSH_RESPONSE:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_RESPONSE:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_RESPONSE:
|
|
|
the_packet = ( Message_queue_MP_Packet *) the_thread->receive_packet;
|
the_packet = ( Message_queue_MP_Packet *) the_thread->receive_packet;
|
|
|
/*
|
/*
|
* The packet being returned already contains the class, length, and
|
* The packet being returned already contains the class, length, and
|
* to_convert fields, therefore they are not set in this routine.
|
* to_convert fields, therefore they are not set in this routine.
|
*
|
*
|
* Exception: MESSAGE_QUEUE_MP_RECEIVE_RESPONSE needs payload length
|
* Exception: MESSAGE_QUEUE_MP_RECEIVE_RESPONSE needs payload length
|
* added to 'length'
|
* added to 'length'
|
*/
|
*/
|
the_packet->operation = operation;
|
the_packet->operation = operation;
|
the_packet->Prefix.id = the_packet->Prefix.source_tid;
|
the_packet->Prefix.id = the_packet->Prefix.source_tid;
|
|
|
if (operation == MESSAGE_QUEUE_MP_RECEIVE_RESPONSE)
|
if (operation == MESSAGE_QUEUE_MP_RECEIVE_RESPONSE)
|
the_packet->Prefix.length += the_packet->size;
|
the_packet->Prefix.length += the_packet->size;
|
|
|
_MPCI_Send_response_packet(
|
_MPCI_Send_response_packet(
|
rtems_get_node( the_packet->Prefix.source_tid ),
|
rtems_get_node( the_packet->Prefix.source_tid ),
|
&the_packet->Prefix
|
&the_packet->Prefix
|
);
|
);
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_ANNOUNCE_CREATE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_CREATE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_DELETE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_DELETE:
|
case MESSAGE_QUEUE_MP_EXTRACT_PROXY:
|
case MESSAGE_QUEUE_MP_EXTRACT_PROXY:
|
case MESSAGE_QUEUE_MP_RECEIVE_REQUEST:
|
case MESSAGE_QUEUE_MP_RECEIVE_REQUEST:
|
case MESSAGE_QUEUE_MP_SEND_REQUEST:
|
case MESSAGE_QUEUE_MP_SEND_REQUEST:
|
case MESSAGE_QUEUE_MP_URGENT_REQUEST:
|
case MESSAGE_QUEUE_MP_URGENT_REQUEST:
|
case MESSAGE_QUEUE_MP_BROADCAST_REQUEST:
|
case MESSAGE_QUEUE_MP_BROADCAST_REQUEST:
|
case MESSAGE_QUEUE_MP_FLUSH_REQUEST:
|
case MESSAGE_QUEUE_MP_FLUSH_REQUEST:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_REQUEST:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_REQUEST:
|
break;
|
break;
|
|
|
}
|
}
|
}
|
}
|
|
|
/*PAGE
|
/*PAGE
|
*
|
*
|
*
|
*
|
* _Message_queue_MP_Process_packet
|
* _Message_queue_MP_Process_packet
|
*
|
*
|
*/
|
*/
|
|
|
void _Message_queue_MP_Process_packet (
|
void _Message_queue_MP_Process_packet (
|
rtems_packet_prefix *the_packet_prefix
|
rtems_packet_prefix *the_packet_prefix
|
)
|
)
|
{
|
{
|
Message_queue_MP_Packet *the_packet;
|
Message_queue_MP_Packet *the_packet;
|
Thread_Control *the_thread;
|
Thread_Control *the_thread;
|
boolean ignored;
|
boolean ignored;
|
|
|
the_packet = (Message_queue_MP_Packet *) the_packet_prefix;
|
the_packet = (Message_queue_MP_Packet *) the_packet_prefix;
|
|
|
switch ( the_packet->operation ) {
|
switch ( the_packet->operation ) {
|
|
|
case MESSAGE_QUEUE_MP_ANNOUNCE_CREATE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_CREATE:
|
|
|
ignored = _Objects_MP_Allocate_and_open(
|
ignored = _Objects_MP_Allocate_and_open(
|
&_Message_queue_Information,
|
&_Message_queue_Information,
|
the_packet->name,
|
the_packet->name,
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
TRUE
|
TRUE
|
);
|
);
|
|
|
_MPCI_Return_packet( the_packet_prefix );
|
_MPCI_Return_packet( the_packet_prefix );
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_ANNOUNCE_DELETE:
|
case MESSAGE_QUEUE_MP_ANNOUNCE_DELETE:
|
|
|
_Objects_MP_Close( &_Message_queue_Information, the_packet->Prefix.id );
|
_Objects_MP_Close( &_Message_queue_Information, the_packet->Prefix.id );
|
|
|
_MPCI_Return_packet( the_packet_prefix );
|
_MPCI_Return_packet( the_packet_prefix );
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_EXTRACT_PROXY:
|
case MESSAGE_QUEUE_MP_EXTRACT_PROXY:
|
|
|
the_thread = _Thread_MP_Find_proxy( the_packet->proxy_id );
|
the_thread = _Thread_MP_Find_proxy( the_packet->proxy_id );
|
|
|
if (! _Thread_Is_null( the_thread ) )
|
if (! _Thread_Is_null( the_thread ) )
|
_Thread_queue_Extract( the_thread->Wait.queue, the_thread );
|
_Thread_queue_Extract( the_thread->Wait.queue, the_thread );
|
|
|
_MPCI_Return_packet( the_packet_prefix );
|
_MPCI_Return_packet( the_packet_prefix );
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_RECEIVE_REQUEST:
|
case MESSAGE_QUEUE_MP_RECEIVE_REQUEST:
|
|
|
the_packet->Prefix.return_code = rtems_message_queue_receive(
|
the_packet->Prefix.return_code = rtems_message_queue_receive(
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
the_packet->Buffer.buffer,
|
the_packet->Buffer.buffer,
|
&the_packet->size,
|
&the_packet->size,
|
the_packet->option_set,
|
the_packet->option_set,
|
the_packet->Prefix.timeout
|
the_packet->Prefix.timeout
|
);
|
);
|
|
|
if (! _Thread_Is_proxy_blocking( the_packet->Prefix.return_code ) )
|
if (! _Thread_Is_proxy_blocking( the_packet->Prefix.return_code ) )
|
_Message_queue_MP_Send_response_packet(
|
_Message_queue_MP_Send_response_packet(
|
MESSAGE_QUEUE_MP_RECEIVE_RESPONSE,
|
MESSAGE_QUEUE_MP_RECEIVE_RESPONSE,
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
_Thread_Executing
|
_Thread_Executing
|
);
|
);
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_RECEIVE_RESPONSE:
|
case MESSAGE_QUEUE_MP_RECEIVE_RESPONSE:
|
|
|
the_thread = _MPCI_Process_response( the_packet_prefix );
|
the_thread = _MPCI_Process_response( the_packet_prefix );
|
|
|
if (the_packet->Prefix.return_code == RTEMS_SUCCESSFUL) {
|
if (the_packet->Prefix.return_code == RTEMS_SUCCESSFUL) {
|
*(rtems_unsigned32 *)the_thread->Wait.return_argument_1 =
|
*(rtems_unsigned32 *)the_thread->Wait.return_argument_1 =
|
the_packet->size;
|
the_packet->size;
|
|
|
_CORE_message_queue_Copy_buffer(
|
_CORE_message_queue_Copy_buffer(
|
the_packet->Buffer.buffer,
|
the_packet->Buffer.buffer,
|
the_thread->Wait.return_argument,
|
the_thread->Wait.return_argument,
|
the_packet->size
|
the_packet->size
|
);
|
);
|
}
|
}
|
|
|
_MPCI_Return_packet( the_packet_prefix );
|
_MPCI_Return_packet( the_packet_prefix );
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_SEND_REQUEST:
|
case MESSAGE_QUEUE_MP_SEND_REQUEST:
|
|
|
the_packet->Prefix.return_code = rtems_message_queue_send(
|
the_packet->Prefix.return_code = rtems_message_queue_send(
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
the_packet->Buffer.buffer,
|
the_packet->Buffer.buffer,
|
the_packet->Buffer.size
|
the_packet->Buffer.size
|
);
|
);
|
|
|
_Message_queue_MP_Send_response_packet(
|
_Message_queue_MP_Send_response_packet(
|
MESSAGE_QUEUE_MP_SEND_RESPONSE,
|
MESSAGE_QUEUE_MP_SEND_RESPONSE,
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
_Thread_Executing
|
_Thread_Executing
|
);
|
);
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_SEND_RESPONSE:
|
case MESSAGE_QUEUE_MP_SEND_RESPONSE:
|
case MESSAGE_QUEUE_MP_URGENT_RESPONSE:
|
case MESSAGE_QUEUE_MP_URGENT_RESPONSE:
|
|
|
the_thread = _MPCI_Process_response( the_packet_prefix );
|
the_thread = _MPCI_Process_response( the_packet_prefix );
|
|
|
_MPCI_Return_packet( the_packet_prefix );
|
_MPCI_Return_packet( the_packet_prefix );
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_URGENT_REQUEST:
|
case MESSAGE_QUEUE_MP_URGENT_REQUEST:
|
|
|
the_packet->Prefix.return_code = rtems_message_queue_urgent(
|
the_packet->Prefix.return_code = rtems_message_queue_urgent(
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
the_packet->Buffer.buffer,
|
the_packet->Buffer.buffer,
|
the_packet->Buffer.size
|
the_packet->Buffer.size
|
);
|
);
|
|
|
_Message_queue_MP_Send_response_packet(
|
_Message_queue_MP_Send_response_packet(
|
MESSAGE_QUEUE_MP_URGENT_RESPONSE,
|
MESSAGE_QUEUE_MP_URGENT_RESPONSE,
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
_Thread_Executing
|
_Thread_Executing
|
);
|
);
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_BROADCAST_REQUEST:
|
case MESSAGE_QUEUE_MP_BROADCAST_REQUEST:
|
|
|
the_packet->Prefix.return_code = rtems_message_queue_broadcast(
|
the_packet->Prefix.return_code = rtems_message_queue_broadcast(
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
the_packet->Buffer.buffer,
|
the_packet->Buffer.buffer,
|
the_packet->Buffer.size,
|
the_packet->Buffer.size,
|
&the_packet->count
|
&the_packet->count
|
);
|
);
|
|
|
_Message_queue_MP_Send_response_packet(
|
_Message_queue_MP_Send_response_packet(
|
MESSAGE_QUEUE_MP_BROADCAST_RESPONSE,
|
MESSAGE_QUEUE_MP_BROADCAST_RESPONSE,
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
_Thread_Executing
|
_Thread_Executing
|
);
|
);
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_BROADCAST_RESPONSE:
|
case MESSAGE_QUEUE_MP_BROADCAST_RESPONSE:
|
case MESSAGE_QUEUE_MP_FLUSH_RESPONSE:
|
case MESSAGE_QUEUE_MP_FLUSH_RESPONSE:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_RESPONSE:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_RESPONSE:
|
|
|
the_thread = _MPCI_Process_response( the_packet_prefix );
|
the_thread = _MPCI_Process_response( the_packet_prefix );
|
|
|
*(unsigned32 *)the_thread->Wait.return_argument = the_packet->count;
|
*(unsigned32 *)the_thread->Wait.return_argument = the_packet->count;
|
|
|
_MPCI_Return_packet( the_packet_prefix );
|
_MPCI_Return_packet( the_packet_prefix );
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_FLUSH_REQUEST:
|
case MESSAGE_QUEUE_MP_FLUSH_REQUEST:
|
|
|
the_packet->Prefix.return_code = rtems_message_queue_flush(
|
the_packet->Prefix.return_code = rtems_message_queue_flush(
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
&the_packet->count
|
&the_packet->count
|
);
|
);
|
|
|
_Message_queue_MP_Send_response_packet(
|
_Message_queue_MP_Send_response_packet(
|
MESSAGE_QUEUE_MP_FLUSH_RESPONSE,
|
MESSAGE_QUEUE_MP_FLUSH_RESPONSE,
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
_Thread_Executing
|
_Thread_Executing
|
);
|
);
|
break;
|
break;
|
|
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_REQUEST:
|
case MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_REQUEST:
|
|
|
the_packet->Prefix.return_code = rtems_message_queue_get_number_pending(
|
the_packet->Prefix.return_code = rtems_message_queue_get_number_pending(
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
&the_packet->count
|
&the_packet->count
|
);
|
);
|
|
|
_Message_queue_MP_Send_response_packet(
|
_Message_queue_MP_Send_response_packet(
|
MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_RESPONSE,
|
MESSAGE_QUEUE_MP_GET_NUMBER_PENDING_RESPONSE,
|
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
_Thread_Executing
|
_Thread_Executing
|
);
|
);
|
break;
|
break;
|
|
|
}
|
}
|
}
|
}
|
|
|
/*PAGE
|
/*PAGE
|
*
|
*
|
* _Message_queue_MP_Send_object_was_deleted
|
* _Message_queue_MP_Send_object_was_deleted
|
*
|
*
|
*/
|
*/
|
|
|
void _Message_queue_MP_Send_object_was_deleted (
|
void _Message_queue_MP_Send_object_was_deleted (
|
Thread_Control *the_proxy
|
Thread_Control *the_proxy
|
)
|
)
|
{
|
{
|
the_proxy->receive_packet->return_code = RTEMS_OBJECT_WAS_DELETED;
|
the_proxy->receive_packet->return_code = RTEMS_OBJECT_WAS_DELETED;
|
|
|
_Message_queue_MP_Send_response_packet(
|
_Message_queue_MP_Send_response_packet(
|
MESSAGE_QUEUE_MP_RECEIVE_RESPONSE,
|
MESSAGE_QUEUE_MP_RECEIVE_RESPONSE,
|
the_proxy->Wait.id,
|
the_proxy->Wait.id,
|
the_proxy
|
the_proxy
|
);
|
);
|
}
|
}
|
|
|
/*PAGE
|
/*PAGE
|
*
|
*
|
* _Message_queue_MP_Send_extract_proxy
|
* _Message_queue_MP_Send_extract_proxy
|
*
|
*
|
*/
|
*/
|
|
|
void _Message_queue_MP_Send_extract_proxy (
|
void _Message_queue_MP_Send_extract_proxy (
|
Thread_Control *the_thread
|
Thread_Control *the_thread
|
)
|
)
|
{
|
{
|
_Message_queue_MP_Send_process_packet(
|
_Message_queue_MP_Send_process_packet(
|
MESSAGE_QUEUE_MP_EXTRACT_PROXY,
|
MESSAGE_QUEUE_MP_EXTRACT_PROXY,
|
the_thread->Wait.id,
|
the_thread->Wait.id,
|
(rtems_name) 0,
|
(rtems_name) 0,
|
the_thread->Object.id
|
the_thread->Object.id
|
);
|
);
|
}
|
}
|
|
|
/*PAGE
|
/*PAGE
|
*
|
*
|
* _Message_queue_MP_Get_packet
|
* _Message_queue_MP_Get_packet
|
*
|
*
|
*/
|
*/
|
|
|
Message_queue_MP_Packet *_Message_queue_MP_Get_packet ( void )
|
Message_queue_MP_Packet *_Message_queue_MP_Get_packet ( void )
|
{
|
{
|
return ( (Message_queue_MP_Packet *) _MPCI_Get_packet() );
|
return ( (Message_queue_MP_Packet *) _MPCI_Get_packet() );
|
}
|
}
|
|
|
|
|
/*PAGE
|
/*PAGE
|
*
|
*
|
* _Message_queue_Core_message_queue_mp_support
|
* _Message_queue_Core_message_queue_mp_support
|
*
|
*
|
* Input parameters:
|
* Input parameters:
|
* the_thread - the remote thread the message was submitted to
|
* the_thread - the remote thread the message was submitted to
|
* id - id of the message queue
|
* id - id of the message queue
|
*
|
*
|
* Output parameters: NONE
|
* Output parameters: NONE
|
*/
|
*/
|
|
|
void _Message_queue_Core_message_queue_mp_support (
|
void _Message_queue_Core_message_queue_mp_support (
|
Thread_Control *the_thread,
|
Thread_Control *the_thread,
|
Objects_Id id
|
Objects_Id id
|
)
|
)
|
{
|
{
|
the_thread->receive_packet->return_code = RTEMS_SUCCESSFUL;
|
the_thread->receive_packet->return_code = RTEMS_SUCCESSFUL;
|
|
|
_Message_queue_MP_Send_response_packet(
|
_Message_queue_MP_Send_response_packet(
|
MESSAGE_QUEUE_MP_RECEIVE_RESPONSE,
|
MESSAGE_QUEUE_MP_RECEIVE_RESPONSE,
|
id,
|
id,
|
the_thread
|
the_thread
|
);
|
);
|
}
|
}
|
|
|
/* end of file */
|
/* end of file */
|
|
|