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
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
|
/**
* @file
*
* This include file contains the static inline implementation of the private
* inlined routines for POSIX condition variables.
*/
/*
* COPYRIGHT (c) 1989-2013.
* 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_POSIX_CONDIMPL_H
#define _RTEMS_POSIX_CONDIMPL_H
#include <errno.h>
#include <pthread.h>
#include <rtems/score/percpu.h>
#include <rtems/score/threadqimpl.h>
#ifdef __cplusplus
extern "C" {
#endif
typedef struct {
unsigned long flags;
Thread_queue_Syslock_queue Queue;
pthread_mutex_t *mutex;
} POSIX_Condition_variables_Control;
#define POSIX_CONDITION_VARIABLES_CLOCK_MONOTONIC 0x1UL
#define POSIX_CONDITION_VARIABLES_FLAGS_MASK 0x1UL
#define POSIX_CONDITION_VARIABLES_MAGIC 0x18dfb1feUL
/**
* Constant to indicate condition variable does not currently have
* a mutex assigned to it.
*/
#define POSIX_CONDITION_VARIABLES_NO_MUTEX NULL
#define POSIX_CONDITION_VARIABLES_TQ_OPERATIONS &_Thread_queue_Operations_FIFO
#define POSIX_CONDITION_VARIABLE_OF_THREAD_QUEUE_QUEUE( queue ) \
RTEMS_CONTAINER_OF( \
queue, POSIX_Condition_variables_Control, Queue.Queue )
/**
* The default condition variable attributes structure.
*/
extern const pthread_condattr_t _POSIX_Condition_variables_Default_attributes;
static inline POSIX_Condition_variables_Control *_POSIX_Condition_variables_Get(
pthread_cond_t *cond
)
{
return (POSIX_Condition_variables_Control *) cond;
}
RTEMS_INLINE_ROUTINE void _POSIX_Condition_variables_Initialize(
POSIX_Condition_variables_Control *the_cond,
const pthread_condattr_t *the_attr
)
{
unsigned long flags;
_Thread_queue_Queue_initialize( &the_cond->Queue.Queue, NULL );
the_cond->mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX;
flags = (uintptr_t) the_cond ^ POSIX_CONDITION_VARIABLES_MAGIC;
flags &= ~POSIX_CONDITION_VARIABLES_FLAGS_MASK;
if ( the_attr->clock == CLOCK_MONOTONIC ) {
flags |= POSIX_CONDITION_VARIABLES_CLOCK_MONOTONIC;
}
the_cond->flags = flags;
}
RTEMS_INLINE_ROUTINE void _POSIX_Condition_variables_Destroy(
POSIX_Condition_variables_Control *the_cond
)
{
the_cond->flags = ~the_cond->flags;
}
RTEMS_INLINE_ROUTINE clockid_t _POSIX_Condition_variables_Get_clock(
unsigned long flags
)
{
if ( ( flags & POSIX_CONDITION_VARIABLES_CLOCK_MONOTONIC ) != 0 ) {
return CLOCK_MONOTONIC;
}
return CLOCK_REALTIME;
}
RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Condition_variables_Acquire(
POSIX_Condition_variables_Control *the_cond,
Thread_queue_Context *queue_context
)
{
ISR_Level level;
Thread_Control *executing;
_Thread_queue_Context_ISR_disable( queue_context, level );
_Thread_queue_Context_set_ISR_level( queue_context, level );
executing = _Thread_Executing;
_Thread_queue_Queue_acquire_critical(
&the_cond->Queue.Queue,
&executing->Potpourri_stats,
&queue_context->Lock_context.Lock_context
);
return executing;
}
RTEMS_INLINE_ROUTINE void _POSIX_Condition_variables_Release(
POSIX_Condition_variables_Control *the_cond,
Thread_queue_Context *queue_context
)
{
_Thread_queue_Queue_release(
&the_cond->Queue.Queue,
&queue_context->Lock_context.Lock_context
);
}
/**
* @brief Implements wake up version of the "signal" operation.
*
* A support routine which implements guts of the broadcast and single task
* wake up version of the "signal" operation.
*/
int _POSIX_Condition_variables_Signal_support(
pthread_cond_t *cond,
bool is_broadcast
);
/**
* @brief POSIX condition variables wait support.
*
* A support routine which implements guts of the blocking, non-blocking, and
* timed wait version of condition variable wait routines.
*/
int _POSIX_Condition_variables_Wait_support(
pthread_cond_t *cond,
pthread_mutex_t *mutex,
const struct timespec *abstime
);
bool _POSIX_Condition_variables_Auto_initialization(
POSIX_Condition_variables_Control *the_cond
);
#define POSIX_CONDITION_VARIABLES_VALIDATE_OBJECT( the_cond, flags ) \
do { \
if ( ( the_cond ) == NULL ) { \
return EINVAL; \
} \
flags = ( the_cond )->flags; \
if ( \
( ( (uintptr_t) ( the_cond ) ^ POSIX_CONDITION_VARIABLES_MAGIC ) \
& ~POSIX_CONDITION_VARIABLES_FLAGS_MASK ) \
!= ( flags & ~POSIX_CONDITION_VARIABLES_FLAGS_MASK ) \
) { \
if ( !_POSIX_Condition_variables_Auto_initialization( the_cond ) ) { \
return EINVAL; \
} \
} \
} while ( 0 )
#ifdef __cplusplus
}
#endif
#endif
/* end of include file */
|
