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
|
/* SPDX-License-Identifier: BSD-2-Clause */
/**
* @file
*
* @ingroup RTEMSTestSuites
*
* @brief This source file contains the implementation of the thread queue
* wrapper.
*/
/*
* Copyright (C) 2021 embedded brains GmbH (http://www.embedded-brains.de)
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include "tx-support.h"
#include <rtems/score/threadimpl.h>
#include <rtems/score/threadqimpl.h>
#include <string.h>
static void Extract(
Thread_queue_Queue *queue,
Thread_Control *thread,
Thread_queue_Context *queue_context
)
{
WrapThreadQueueContext *ctx;
ctx = (WrapThreadQueueContext *) thread->Wait.operations;
CallWithinISRSubmit( &ctx->isr_request );
if ( ctx->wrapped_ops ) {
thread->Wait.operations = ctx->wrapped_ops;
( *thread->Wait.operations->extract )( queue, thread, queue_context );
}
}
void WrapThreadQueueInitialize(
WrapThreadQueueContext *ctx,
void ( *handler )( void * ),
void *arg
)
{
memset( ctx, 0, sizeof( *ctx ) );
ctx->tq_ops.extract = Extract;
ctx->isr_request.handler = handler;
ctx->isr_request.arg = arg;
_Thread_queue_Initialize( &ctx->thread_queue, "Wrap" );
}
void WrapThreadQueueExtract(
WrapThreadQueueContext *ctx,
Thread_Control *thread
)
{
if ( thread->Wait.queue != NULL ) {
ctx->wrapped_ops = thread->Wait.operations;
thread->Wait.operations = &ctx->tq_ops;
} else {
Thread_queue_Context queue_context;
ctx->wrapped_ops = NULL;
_Thread_queue_Context_initialize( &queue_context );
_Thread_queue_Acquire( &ctx->thread_queue, &queue_context );
_Thread_Wait_flags_set(
thread,
THREAD_WAIT_CLASS_OBJECT | THREAD_WAIT_STATE_INTEND_TO_BLOCK
);
_Thread_Wait_claim( thread, &ctx->thread_queue.Queue );
_Thread_Wait_claim_finalize( thread, &ctx->tq_ops );
_Thread_queue_Release( &ctx->thread_queue, &queue_context );
}
}
void WrapThreadQueueDestroy( WrapThreadQueueContext *ctx )
{
_Thread_queue_Destroy( &ctx->thread_queue );
}
|