forked from Imagelibrary/rtems
@@ -76,7 +76,7 @@ typedef struct {
|
|||||||
/** This field indicates if nest level of signals being processed */
|
/** This field indicates if nest level of signals being processed */
|
||||||
uint32_t nest_level;
|
uint32_t nest_level;
|
||||||
/** Lock to protect this structure */
|
/** Lock to protect this structure */
|
||||||
ISR_lock_Control Lock;
|
ISR_LOCK_MEMBER( Lock )
|
||||||
} ASR_Information;
|
} ASR_Information;
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
|||||||
@@ -59,12 +59,21 @@ RTEMS_INLINE_ROUTINE void _ASR_Destroy( ASR_Information *asr )
|
|||||||
_ISR_lock_Destroy( &asr->Lock );
|
_ISR_lock_Destroy( &asr->Lock );
|
||||||
}
|
}
|
||||||
|
|
||||||
|
RTEMS_INLINE_ROUTINE void _ASR_Acquire_critical(
|
||||||
|
ASR_Information *asr,
|
||||||
|
ISR_lock_Context *lock_context
|
||||||
|
)
|
||||||
|
{
|
||||||
|
_ISR_lock_Acquire( &asr->Lock, lock_context );
|
||||||
|
}
|
||||||
|
|
||||||
RTEMS_INLINE_ROUTINE void _ASR_Acquire(
|
RTEMS_INLINE_ROUTINE void _ASR_Acquire(
|
||||||
ASR_Information *asr,
|
ASR_Information *asr,
|
||||||
ISR_lock_Context *lock_context
|
ISR_lock_Context *lock_context
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
_ISR_lock_ISR_disable_and_acquire( &asr->Lock, lock_context );
|
_ISR_lock_ISR_disable( lock_context );
|
||||||
|
_ASR_Acquire_critical( asr, lock_context );
|
||||||
}
|
}
|
||||||
|
|
||||||
RTEMS_INLINE_ROUTINE void _ASR_Release(
|
RTEMS_INLINE_ROUTINE void _ASR_Release(
|
||||||
@@ -75,27 +84,6 @@ RTEMS_INLINE_ROUTINE void _ASR_Release(
|
|||||||
_ISR_lock_Release_and_ISR_enable( &asr->Lock, lock_context );
|
_ISR_lock_Release_and_ISR_enable( &asr->Lock, lock_context );
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ASR_Swap_signals
|
|
||||||
*
|
|
||||||
* This routine atomically swaps the pending and posted signal
|
|
||||||
* sets. This is done when the thread alters its mode in such a
|
|
||||||
* way that the RTEMS_ASR disable/enable flag changes.
|
|
||||||
*/
|
|
||||||
RTEMS_INLINE_ROUTINE void _ASR_Swap_signals (
|
|
||||||
ASR_Information *asr
|
|
||||||
)
|
|
||||||
{
|
|
||||||
rtems_signal_set _signals;
|
|
||||||
ISR_lock_Context lock_context;
|
|
||||||
|
|
||||||
_ASR_Acquire( asr, &lock_context );
|
|
||||||
_signals = asr->signals_pending;
|
|
||||||
asr->signals_pending = asr->signals_posted;
|
|
||||||
asr->signals_posted = _signals;
|
|
||||||
_ASR_Release( asr, &lock_context );
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief ASR_Is_null_handler
|
* @brief ASR_Is_null_handler
|
||||||
*
|
*
|
||||||
@@ -109,38 +97,26 @@ RTEMS_INLINE_ROUTINE bool _ASR_Is_null_handler (
|
|||||||
return asr_handler == NULL;
|
return asr_handler == NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
RTEMS_INLINE_ROUTINE rtems_signal_set _ASR_Swap_signals( ASR_Information *asr )
|
||||||
* @brief ASR_Are_signals_pending
|
|
||||||
*
|
|
||||||
* This function returns TRUE if there are signals pending in the
|
|
||||||
* given RTEMS_ASR information record and FALSE otherwise.
|
|
||||||
*/
|
|
||||||
RTEMS_INLINE_ROUTINE bool _ASR_Are_signals_pending (
|
|
||||||
ASR_Information *asr
|
|
||||||
)
|
|
||||||
{
|
{
|
||||||
return asr->signals_posted != 0;
|
rtems_signal_set new_signals_posted;
|
||||||
|
ISR_lock_Context lock_context;
|
||||||
|
|
||||||
|
_ASR_Acquire( asr, &lock_context );
|
||||||
|
new_signals_posted = asr->signals_pending;
|
||||||
|
asr->signals_pending = asr->signals_posted;
|
||||||
|
asr->signals_posted = new_signals_posted;
|
||||||
|
_ASR_Release( asr, &lock_context );
|
||||||
|
|
||||||
|
return new_signals_posted;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief ASR_Post_signals
|
|
||||||
*
|
|
||||||
* This routine posts the given signals into the signal_set
|
|
||||||
* passed in. The result is returned to the user in signal_set.
|
|
||||||
*
|
|
||||||
* NOTE: This must be implemented as a macro.
|
|
||||||
*/
|
|
||||||
RTEMS_INLINE_ROUTINE void _ASR_Post_signals(
|
RTEMS_INLINE_ROUTINE void _ASR_Post_signals(
|
||||||
ASR_Information *asr,
|
|
||||||
rtems_signal_set signals,
|
rtems_signal_set signals,
|
||||||
rtems_signal_set *signal_set
|
rtems_signal_set *signal_set
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
ISR_lock_Context lock_context;
|
|
||||||
|
|
||||||
_ASR_Acquire( asr, &lock_context );
|
|
||||||
*signal_set |= signals;
|
*signal_set |= signals;
|
||||||
_ASR_Release( asr, &lock_context );
|
|
||||||
}
|
}
|
||||||
|
|
||||||
RTEMS_INLINE_ROUTINE rtems_signal_set _ASR_Get_posted_signals(
|
RTEMS_INLINE_ROUTINE rtems_signal_set _ASR_Get_posted_signals(
|
||||||
|
|||||||
@@ -38,25 +38,6 @@ extern "C" {
|
|||||||
*/
|
*/
|
||||||
/*{*/
|
/*{*/
|
||||||
|
|
||||||
/**
|
|
||||||
* The following enumerated type defines the list of
|
|
||||||
* remote signal operations.
|
|
||||||
*/
|
|
||||||
typedef enum {
|
|
||||||
SIGNAL_MP_SEND_REQUEST = 0,
|
|
||||||
SIGNAL_MP_SEND_RESPONSE = 1
|
|
||||||
} Signal_MP_Remote_operations;
|
|
||||||
|
|
||||||
/**
|
|
||||||
* The following data structure defines the packet used to perform
|
|
||||||
* remote signal operations.
|
|
||||||
*/
|
|
||||||
typedef struct {
|
|
||||||
rtems_packet_prefix Prefix;
|
|
||||||
Signal_MP_Remote_operations operation;
|
|
||||||
rtems_signal_set signal_in;
|
|
||||||
} Signal_MP_Packet;
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* @brief Signal_MP_Send_process_packet
|
* @brief Signal_MP_Send_process_packet
|
||||||
*
|
*
|
||||||
@@ -68,15 +49,11 @@ typedef struct {
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Signal MP Send Request Packet
|
* @brief Issues a remote rtems_signal_send() request.
|
||||||
*
|
|
||||||
* This routine performs a remote procedure call so that a
|
|
||||||
* directive operation can be initiated on another node.
|
|
||||||
*/
|
*/
|
||||||
rtems_status_code _Signal_MP_Send_request_packet (
|
rtems_status_code _Signal_MP_Send(
|
||||||
Signal_MP_Remote_operations operation,
|
rtems_id id,
|
||||||
Objects_Id task_id,
|
rtems_signal_set signal_set
|
||||||
rtems_signal_set signal_in
|
|
||||||
);
|
);
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
|||||||
@@ -22,8 +22,6 @@
|
|||||||
#include <rtems/rtems/signalimpl.h>
|
#include <rtems/rtems/signalimpl.h>
|
||||||
#include <rtems/rtems/asrimpl.h>
|
#include <rtems/rtems/asrimpl.h>
|
||||||
#include <rtems/rtems/tasks.h>
|
#include <rtems/rtems/tasks.h>
|
||||||
#include <rtems/score/isrlevel.h>
|
|
||||||
#include <rtems/score/threaddispatch.h>
|
|
||||||
#include <rtems/score/threadimpl.h>
|
#include <rtems/score/threadimpl.h>
|
||||||
|
|
||||||
void _Signal_Action_handler(
|
void _Signal_Action_handler(
|
||||||
@@ -52,8 +50,9 @@ void _Signal_Action_handler(
|
|||||||
asr = &api->Signal;
|
asr = &api->Signal;
|
||||||
signal_set = _ASR_Get_posted_signals( asr );
|
signal_set = _ASR_Get_posted_signals( asr );
|
||||||
|
|
||||||
if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */
|
if ( signal_set == 0 ) {
|
||||||
return;
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
asr->nest_level += 1;
|
asr->nest_level += 1;
|
||||||
rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode );
|
rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode );
|
||||||
@@ -74,11 +73,12 @@ rtems_status_code rtems_signal_catch(
|
|||||||
ASR_Information *asr;
|
ASR_Information *asr;
|
||||||
ISR_lock_Context lock_context;
|
ISR_lock_Context lock_context;
|
||||||
|
|
||||||
executing = _Thread_Get_executing();
|
_ISR_lock_ISR_disable( &lock_context );
|
||||||
api = (RTEMS_API_Control*)executing->API_Extensions[ THREAD_API_RTEMS ];
|
executing = _Thread_Executing;
|
||||||
|
api = executing->API_Extensions[ THREAD_API_RTEMS ];
|
||||||
asr = &api->Signal;
|
asr = &api->Signal;
|
||||||
|
|
||||||
_ASR_Acquire( asr, &lock_context );
|
_ASR_Acquire_critical( asr, &lock_context );
|
||||||
|
|
||||||
if ( !_ASR_Is_null_handler( asr_handler ) ) {
|
if ( !_ASR_Is_null_handler( asr_handler ) ) {
|
||||||
asr->mode_set = mode_set;
|
asr->mode_set = mode_set;
|
||||||
|
|||||||
@@ -24,13 +24,36 @@
|
|||||||
#include <rtems/score/threadimpl.h>
|
#include <rtems/score/threadimpl.h>
|
||||||
#include <rtems/score/threadqimpl.h>
|
#include <rtems/score/threadqimpl.h>
|
||||||
|
|
||||||
|
/**
|
||||||
|
* The following enumerated type defines the list of
|
||||||
|
* remote signal operations.
|
||||||
|
*/
|
||||||
|
typedef enum {
|
||||||
|
SIGNAL_MP_SEND_REQUEST = 0,
|
||||||
|
SIGNAL_MP_SEND_RESPONSE = 1
|
||||||
|
} Signal_MP_Remote_operations;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* The following data structure defines the packet used to perform
|
||||||
|
* remote signal operations.
|
||||||
|
*/
|
||||||
|
typedef struct {
|
||||||
|
rtems_packet_prefix Prefix;
|
||||||
|
Signal_MP_Remote_operations operation;
|
||||||
|
rtems_signal_set signal_set;
|
||||||
|
} Signal_MP_Packet;
|
||||||
|
|
||||||
RTEMS_STATIC_ASSERT(
|
RTEMS_STATIC_ASSERT(
|
||||||
sizeof(Signal_MP_Packet) <= MP_PACKET_MINIMUM_PACKET_SIZE,
|
sizeof(Signal_MP_Packet) <= MP_PACKET_MINIMUM_PACKET_SIZE,
|
||||||
Signal_MP_Packet
|
Signal_MP_Packet
|
||||||
);
|
);
|
||||||
|
|
||||||
static Signal_MP_Packet *_Signal_MP_Get_packet( void )
|
static Signal_MP_Packet *_Signal_MP_Get_packet( Objects_Id id )
|
||||||
{
|
{
|
||||||
|
if ( !_Thread_MP_Is_remote( id ) ) {
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
return (Signal_MP_Packet *) _MPCI_Get_packet();
|
return (Signal_MP_Packet *) _MPCI_Get_packet();
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -42,43 +65,31 @@ static Signal_MP_Packet *_Signal_MP_Get_packet( void )
|
|||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
|
|
||||||
rtems_status_code _Signal_MP_Send_request_packet (
|
rtems_status_code _Signal_MP_Send(
|
||||||
Signal_MP_Remote_operations operation,
|
rtems_id id,
|
||||||
Objects_Id task_id,
|
rtems_signal_set signal_set
|
||||||
rtems_signal_set signal_in
|
|
||||||
)
|
)
|
||||||
{
|
{
|
||||||
Signal_MP_Packet *the_packet;
|
Signal_MP_Packet *the_packet;
|
||||||
|
|
||||||
switch ( operation ) {
|
the_packet = _Signal_MP_Get_packet( id );
|
||||||
|
if ( the_packet == NULL ) {
|
||||||
|
return RTEMS_INVALID_ID;
|
||||||
|
}
|
||||||
|
|
||||||
case SIGNAL_MP_SEND_REQUEST:
|
|
||||||
|
|
||||||
the_packet = _Signal_MP_Get_packet();
|
|
||||||
the_packet->Prefix.the_class = MP_PACKET_SIGNAL;
|
the_packet->Prefix.the_class = MP_PACKET_SIGNAL;
|
||||||
the_packet->Prefix.length = sizeof ( Signal_MP_Packet );
|
the_packet->Prefix.length = sizeof( *the_packet );
|
||||||
the_packet->Prefix.to_convert = sizeof ( Signal_MP_Packet );
|
the_packet->Prefix.to_convert = sizeof( *the_packet );
|
||||||
the_packet->operation = operation;
|
the_packet->operation = SIGNAL_MP_SEND_REQUEST;
|
||||||
the_packet->Prefix.id = task_id;
|
the_packet->Prefix.id = id;
|
||||||
the_packet->signal_in = signal_in;
|
the_packet->signal_set = signal_set;
|
||||||
|
|
||||||
return _MPCI_Send_request_packet(
|
return (rtems_status_code) _MPCI_Send_request_packet(
|
||||||
_Objects_Get_node( task_id ),
|
_Objects_Get_node( id ),
|
||||||
&the_packet->Prefix,
|
&the_packet->Prefix,
|
||||||
STATES_READY, /* Not used */
|
STATES_READY,
|
||||||
RTEMS_TIMEOUT
|
RTEMS_TIMEOUT
|
||||||
);
|
);
|
||||||
break;
|
|
||||||
|
|
||||||
case SIGNAL_MP_SEND_RESPONSE:
|
|
||||||
break;
|
|
||||||
|
|
||||||
}
|
|
||||||
/*
|
|
||||||
* The following line is included to satisfy compilers which
|
|
||||||
* produce warnings when a function does not end with a return.
|
|
||||||
*/
|
|
||||||
return RTEMS_INTERNAL_ERROR;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void _Signal_MP_Send_response_packet (
|
static void _Signal_MP_Send_response_packet (
|
||||||
@@ -127,7 +138,7 @@ void _Signal_MP_Process_packet (
|
|||||||
|
|
||||||
the_packet->Prefix.return_code = rtems_signal_send(
|
the_packet->Prefix.return_code = rtems_signal_send(
|
||||||
the_packet->Prefix.id,
|
the_packet->Prefix.id,
|
||||||
the_packet->signal_in
|
the_packet->signal_set
|
||||||
);
|
);
|
||||||
|
|
||||||
_Signal_MP_Send_response_packet(
|
_Signal_MP_Send_response_packet(
|
||||||
|
|||||||
@@ -21,7 +21,7 @@
|
|||||||
#include <rtems/rtems/signalimpl.h>
|
#include <rtems/rtems/signalimpl.h>
|
||||||
#include <rtems/rtems/asrimpl.h>
|
#include <rtems/rtems/asrimpl.h>
|
||||||
#include <rtems/rtems/tasks.h>
|
#include <rtems/rtems/tasks.h>
|
||||||
#include <rtems/score/isr.h>
|
#include <rtems/score/threaddispatch.h>
|
||||||
#include <rtems/score/threadimpl.h>
|
#include <rtems/score/threadimpl.h>
|
||||||
|
|
||||||
rtems_status_code rtems_signal_send(
|
rtems_status_code rtems_signal_send(
|
||||||
@@ -30,49 +30,47 @@ rtems_status_code rtems_signal_send(
|
|||||||
)
|
)
|
||||||
{
|
{
|
||||||
Thread_Control *the_thread;
|
Thread_Control *the_thread;
|
||||||
Objects_Locations location;
|
ISR_lock_Context lock_context;
|
||||||
RTEMS_API_Control *api;
|
RTEMS_API_Control *api;
|
||||||
ASR_Information *asr;
|
ASR_Information *asr;
|
||||||
|
|
||||||
if ( !signal_set )
|
if ( signal_set == 0 ) {
|
||||||
return RTEMS_INVALID_NUMBER;
|
return RTEMS_INVALID_NUMBER;
|
||||||
|
}
|
||||||
|
|
||||||
the_thread = _Thread_Get( id, &location );
|
the_thread = _Thread_Get_interrupt_disable( id, &lock_context );
|
||||||
switch ( location ) {
|
|
||||||
|
if ( the_thread == NULL ) {
|
||||||
|
#if defined(RTEMS_MULTIPROCESSING)
|
||||||
|
return _Signal_MP_Send( id, signal_set );
|
||||||
|
#else
|
||||||
|
return RTEMS_INVALID_ID;
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
case OBJECTS_LOCAL:
|
|
||||||
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
|
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
|
||||||
asr = &api->Signal;
|
asr = &api->Signal;
|
||||||
|
|
||||||
if ( ! _ASR_Is_null_handler( asr->handler ) ) {
|
_ASR_Acquire_critical( asr, &lock_context );
|
||||||
|
|
||||||
|
if ( _ASR_Is_null_handler( asr->handler ) ) {
|
||||||
|
_ASR_Release( asr, &lock_context );
|
||||||
|
return RTEMS_NOT_DEFINED;
|
||||||
|
}
|
||||||
|
|
||||||
if ( asr->is_enabled ) {
|
if ( asr->is_enabled ) {
|
||||||
_ASR_Post_signals( asr, signal_set, &asr->signals_posted );
|
_ASR_Post_signals( signal_set, &asr->signals_posted );
|
||||||
|
_ASR_Release( asr, &lock_context );
|
||||||
_Thread_Add_post_switch_action(
|
_Thread_Add_post_switch_action(
|
||||||
the_thread,
|
the_thread,
|
||||||
&api->Signal_action,
|
&api->Signal_action,
|
||||||
_Signal_Action_handler
|
_Signal_Action_handler
|
||||||
);
|
);
|
||||||
|
_Thread_Dispatch();
|
||||||
} else {
|
} else {
|
||||||
_ASR_Post_signals( asr, signal_set, &asr->signals_pending );
|
_ASR_Post_signals( signal_set, &asr->signals_pending );
|
||||||
|
_ASR_Release( asr, &lock_context );
|
||||||
}
|
}
|
||||||
_Objects_Put( &the_thread->Object );
|
|
||||||
return RTEMS_SUCCESSFUL;
|
return RTEMS_SUCCESSFUL;
|
||||||
}
|
|
||||||
_Objects_Put( &the_thread->Object );
|
|
||||||
return RTEMS_NOT_DEFINED;
|
|
||||||
|
|
||||||
#if defined(RTEMS_MULTIPROCESSING)
|
|
||||||
case OBJECTS_REMOTE:
|
|
||||||
return _Signal_MP_Send_request_packet(
|
|
||||||
SIGNAL_MP_SEND_REQUEST,
|
|
||||||
id,
|
|
||||||
signal_set
|
|
||||||
);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
case OBJECTS_ERROR:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
return RTEMS_INVALID_ID;
|
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -99,8 +99,8 @@ rtems_status_code rtems_task_mode(
|
|||||||
|
|
||||||
if ( is_asr_enabled != asr->is_enabled ) {
|
if ( is_asr_enabled != asr->is_enabled ) {
|
||||||
asr->is_enabled = is_asr_enabled;
|
asr->is_enabled = is_asr_enabled;
|
||||||
_ASR_Swap_signals( asr );
|
|
||||||
if ( _ASR_Are_signals_pending( asr ) ) {
|
if ( _ASR_Swap_signals( asr ) != 0 ) {
|
||||||
needs_asr_dispatching = true;
|
needs_asr_dispatching = true;
|
||||||
_Thread_Add_post_switch_action(
|
_Thread_Add_post_switch_action(
|
||||||
executing,
|
executing,
|
||||||
|
|||||||
Reference in New Issue
Block a user