/
cmsis_mailq.c
174 lines (147 loc) · 3.45 KB
/
cmsis_mailq.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
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
/*
* Copyright (c) 2018 Intel Corporation
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <kernel_structs.h>
#include <cmsis_os.h>
/**
* @brief Create and Initialize mail queue.
*/
osMailQId osMailCreate(const osMailQDef_t *queue_def, osThreadId thread_id)
{
if (queue_def == NULL) {
return NULL;
}
if (_is_in_isr()) {
return NULL;
}
k_mbox_init(queue_def->mbox);
return (osMailQId)(queue_def);
}
/**
* @brief Allocate a memory block from a mail.
*/
void *osMailAlloc(osMailQId queue_id, uint32_t millisec)
{
osMailQDef_t *queue_def = (osMailQDef_t *)queue_id;
char *ptr;
int retval;
if (queue_def == NULL) {
return NULL;
}
if (millisec == 0) {
retval = k_mem_slab_alloc(
(struct k_mem_slab *)(queue_def->pool),
(void **)&ptr, K_NO_WAIT);
} else if (millisec == osWaitForever) {
retval = k_mem_slab_alloc(
(struct k_mem_slab *)(queue_def->pool),
(void **)&ptr, K_FOREVER);
} else {
retval = k_mem_slab_alloc(
(struct k_mem_slab *)(queue_def->pool),
(void **)&ptr, millisec);
}
if (retval == 0) {
return ptr;
} else {
return NULL;
}
}
/**
* @brief Allocate a memory block from a mail and set memory block to zero.
*/
void *osMailCAlloc(osMailQId queue_id, uint32_t millisec)
{
osMailQDef_t *queue_def = (osMailQDef_t *)queue_id;
char *ptr;
int retval;
if (queue_def == NULL) {
return NULL;
}
if (millisec == 0) {
retval = k_mem_slab_alloc(
(struct k_mem_slab *)(queue_def->pool),
(void **)&ptr, K_NO_WAIT);
} else if (millisec == osWaitForever) {
retval = k_mem_slab_alloc(
(struct k_mem_slab *)(queue_def->pool),
(void **)&ptr, K_FOREVER);
} else {
retval = k_mem_slab_alloc(
(struct k_mem_slab *)(queue_def->pool),
(void **)&ptr, millisec);
}
if (retval == 0) {
memset(ptr, 0, queue_def->item_sz);
return ptr;
} else {
return NULL;
}
}
/**
* @brief Put a mail to a queue.
*/
osStatus osMailPut(osMailQId queue_id, void *mail)
{
osMailQDef_t *queue_def = (osMailQDef_t *)queue_id;
struct k_mbox_msg mmsg;
if (queue_def == NULL) {
return osErrorParameter;
}
if (mail == NULL) {
return osErrorValue;
}
memset(&mmsg, 0, sizeof(mmsg));
mmsg.tx_data = mail;
mmsg.rx_source_thread = K_ANY;
mmsg.tx_target_thread = K_ANY;
k_mbox_async_put(queue_def->mbox, &mmsg, NULL);
return osOK;
}
/**
* @brief Get a mail from a queue.
*/
osEvent osMailGet(osMailQId queue_id, uint32_t millisec)
{
osMailQDef_t *queue_def = (osMailQDef_t *)queue_id;
struct k_mbox_msg mmsg;
osEvent evt = {0};
int retval;
if (queue_def == NULL) {
evt.status = osErrorParameter;
return evt;
}
memset(&mmsg, 0, sizeof(mmsg));
mmsg.rx_source_thread = K_ANY;
mmsg.tx_target_thread = K_ANY;
if (millisec == 0) {
retval = k_mbox_get(queue_def->mbox, &mmsg, NULL, K_NO_WAIT);
} else if (millisec == osWaitForever) {
retval = k_mbox_get(queue_def->mbox, &mmsg, NULL, K_FOREVER);
} else {
retval = k_mbox_get(queue_def->mbox, &mmsg, NULL, millisec);
}
if (retval == 0) {
evt.status = osEventMail;
evt.value.p = mmsg.tx_data;
} else if (retval == -EAGAIN) {
evt.status = osEventTimeout;
} else if (retval == -ENOMSG) {
evt.status = osOK;
} else {
evt.status = osErrorValue;
}
evt.def.mail_id = queue_id;
return evt;
}
/**
* @brief Free a memory block from a mail.
*/
osStatus osMailFree(osMailQId queue_id, void *mail)
{
osMailQDef_t *queue_def = (osMailQDef_t *)queue_id;
k_mem_slab_free((struct k_mem_slab *)(queue_def->pool), (void *) &mail);
return osOK;
}