1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
|
/**
* @file
*
* @ingroup RTEMSImplClassicSignal
*
* @brief This source file contains the implementation of
* rtems_signal_send().
*/
/*
* COPYRIGHT (c) 1989-2014.
* 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.
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include <rtems/rtems/signalimpl.h>
#include <rtems/rtems/tasksdata.h>
#include <rtems/score/threaddispatch.h>
#include <rtems/score/threadimpl.h>
#include <rtems/sysinit.h>
static void _Signal_Action_handler(
Thread_Control *executing,
Thread_Action *action,
ISR_lock_Context *lock_context
)
{
RTEMS_API_Control *api;
ASR_Information *asr;
rtems_signal_set signal_set;
rtems_mode prev_mode;
(void) action;
api = executing->API_Extensions[ THREAD_API_RTEMS ];
asr = &api->Signal;
/* Get and clear the pending signals */
signal_set = asr->signals_pending;
_Assert( signal_set != 0 );
asr->signals_pending = 0;
_Thread_State_release( executing, lock_context );
rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode );
/* Call the ASR handler in the ASR processing mode */
( *asr->handler )( signal_set );
rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode );
_Thread_State_acquire( executing, lock_context );
}
rtems_status_code rtems_signal_send(
rtems_id id,
rtems_signal_set signal_set
)
{
Thread_Control *the_thread;
ISR_lock_Context lock_context;
RTEMS_API_Control *api;
ASR_Information *asr;
if ( signal_set == 0 ) {
return RTEMS_INVALID_NUMBER;
}
the_thread = _Thread_Get( id, &lock_context );
if ( the_thread == NULL ) {
#if defined(RTEMS_MULTIPROCESSING)
return _Signal_MP_Send( id, signal_set );
#else
return RTEMS_INVALID_ID;
#endif
}
api = the_thread->API_Extensions[ THREAD_API_RTEMS ];
asr = &api->Signal;
_Thread_State_acquire_critical( the_thread, &lock_context );
if ( asr->handler == NULL ) {
_Thread_State_release( the_thread, &lock_context );
return RTEMS_NOT_DEFINED;
}
/* Make the signals of the set pending */
asr->signals_pending |= signal_set;
if ( asr->is_enabled ) {
Per_CPU_Control *cpu_self;
_Thread_Add_post_switch_action(
the_thread,
&api->Signal_action,
_Signal_Action_handler
);
cpu_self = _Thread_Dispatch_disable_critical( &lock_context );
_Thread_State_release( the_thread, &lock_context );
_Thread_Dispatch_enable( cpu_self );
} else {
_Thread_State_release( the_thread, &lock_context );
}
return RTEMS_SUCCESSFUL;
}
#if defined(RTEMS_MULTIPROCESSING)
static void _Signal_MP_Initialize( void )
{
_MPCI_Register_packet_processor(
MP_PACKET_SIGNAL,
_Signal_MP_Process_packet
);
}
RTEMS_SYSINIT_ITEM(
_Signal_MP_Initialize,
RTEMS_SYSINIT_CLASSIC_SIGNAL_MP,
RTEMS_SYSINIT_ORDER_MIDDLE
);
#endif
|
