95 lines
2.0 KiB
C
95 lines
2.0 KiB
C
/*
|
|
* Copyright (c) 2018 Intel Corporation
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <kernel.h>
|
|
#include <cmsis_os.h>
|
|
|
|
/**
|
|
* @brief Create and Initialize Message queue.
|
|
*/
|
|
osMessageQId osMessageCreate(const osMessageQDef_t *queue_def,
|
|
osThreadId thread_id)
|
|
{
|
|
if (queue_def == NULL) {
|
|
return NULL;
|
|
}
|
|
|
|
if (k_is_in_isr()) {
|
|
return NULL;
|
|
}
|
|
|
|
k_msgq_init(queue_def->msgq, queue_def->pool,
|
|
queue_def->item_sz, queue_def->queue_sz);
|
|
return (osMessageQId)(queue_def);
|
|
}
|
|
|
|
/**
|
|
* @brief Put a message to a Queue.
|
|
*/
|
|
osStatus osMessagePut(osMessageQId queue_id, uint32_t info, uint32_t millisec)
|
|
{
|
|
osMessageQDef_t *queue_def = (osMessageQDef_t *)queue_id;
|
|
int retval;
|
|
|
|
if (queue_def == NULL) {
|
|
return osErrorParameter;
|
|
}
|
|
|
|
if (millisec == 0U) {
|
|
retval = k_msgq_put(queue_def->msgq, (void *)&info, K_NO_WAIT);
|
|
} else if (millisec == osWaitForever) {
|
|
retval = k_msgq_put(queue_def->msgq, (void *)&info, K_FOREVER);
|
|
} else {
|
|
retval = k_msgq_put(queue_def->msgq, (void *)&info,
|
|
K_MSEC(millisec));
|
|
}
|
|
|
|
if (retval == 0) {
|
|
return osOK;
|
|
} else if (retval == -EAGAIN) {
|
|
return osErrorTimeoutResource;
|
|
} else {
|
|
return osErrorResource;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* @brief Get a message or Wait for a Message from a Queue.
|
|
*/
|
|
osEvent osMessageGet(osMessageQId queue_id, uint32_t millisec)
|
|
{
|
|
osMessageQDef_t *queue_def = (osMessageQDef_t *)queue_id;
|
|
uint32_t info;
|
|
osEvent evt = {0};
|
|
int retval;
|
|
|
|
if (queue_def == NULL) {
|
|
evt.status = osErrorParameter;
|
|
return evt;
|
|
}
|
|
|
|
if (millisec == 0U) {
|
|
retval = k_msgq_get(queue_def->msgq, &info, K_NO_WAIT);
|
|
} else if (millisec == osWaitForever) {
|
|
retval = k_msgq_get(queue_def->msgq, &info, K_FOREVER);
|
|
} else {
|
|
retval = k_msgq_get(queue_def->msgq, &info, K_MSEC(millisec));
|
|
}
|
|
|
|
if (retval == 0) {
|
|
evt.status = osEventMessage;
|
|
evt.value.v = info;
|
|
} else if (retval == -EAGAIN) {
|
|
evt.status = osEventTimeout;
|
|
} else if (retval == -ENOMSG) {
|
|
evt.status = osOK;
|
|
}
|
|
|
|
evt.def.message_id = queue_id;
|
|
|
|
return evt;
|
|
}
|