-
Notifications
You must be signed in to change notification settings - Fork 11
/
retarget_os_rtos2.c
92 lines (79 loc) · 2.2 KB
/
retarget_os_rtos2.c
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
/*
* Copyright (C) 2023 ARM Limited or its affiliates. All rights reserved.
*
* SPDX-License-Identifier: Apache-2.0
*
* Licensed under the Apache License, Version 2.0 (the License); you may
* not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an AS IS BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#include <assert.h>
#include "retarget_os.h"
#include "cmsis_os2.h"
#include "cmsis_compiler.h"
/* Microlib does not support operating system functions */
#if !defined(__MICROLIB)
/* Check if the kernel has been initialized */
static uint32_t os_kernel_is_initialized (void) {
if (osKernelGetState() > osKernelInactive) {
return 1U;
} else {
return 0U;
}
}
/* Check if the kernel is running */
static uint32_t os_kernel_is_running (void) {
if (osKernelGetState() == osKernelRunning) {
return 1U;
} else {
return 0U;
}
}
/* Check if processor is in Thread or Handler mode */
static uint32_t is_thread_mode (void) {
if (__get_IPSR() == 0U) {
return 1U; /* Thread mode */
} else {
return 0U; /* Handler mode */
}
}
/* Define retarget mutex structure to hold mutex identifier */
struct rt_mutex_s {
osMutexId_t id;
};
/* Initialize mutex */
__USED int _mutex_initialize(rt_mutex_t *mutex) {
int result = 0;
if (os_kernel_is_initialized()) {
mutex->id = osMutexNew(NULL);
if (mutex->id != NULL) {
result = 1;
}
}
return result;
}
/* Acquire mutex */
__USED void _mutex_acquire(rt_mutex_t *mutex) {
if (os_kernel_is_running() && is_thread_mode()) {
(void)osMutexAcquire(mutex->id, osWaitForever);
}
}
/* Release mutex */
__USED void _mutex_release(rt_mutex_t *mutex) {
if (os_kernel_is_running() && is_thread_mode()) {
(void)osMutexRelease(mutex->id);
}
}
/* Free mutex */
__USED void _mutex_free(rt_mutex_t *mutex) {
(void)osMutexDelete(mutex->id);
}
#endif /* !defined(__MICROLIB) */