96cf620708
1. add TOS_CFG_LIBC_PRINTF_EN 1: enable printf to implement tos_kprintf when you call tos_kprintf(actually currently it's a MACRO rather than a function) , the libc will be invloved into the image, most of the time it means a larger image size. 0: disable printf, means tos_kprintf is defined as an empty MACRO most of the time, means you will not get a log output from the uart(currently we donnot have a console yet) but a smaller image size. 2. fix a bug of tos_mail_q and tos_priority_mail_q if we are post-ing a mail and there is[are] task[s] just pend-ing for the mail queue, the mail delivered to the pend-er will be a pointer, and probably it's a pointer to the local variable on the stack. Actually we should do a memcpy rather than a pointer assignment. for more details, see the patch.
256 lines
6.6 KiB
C
256 lines
6.6 KiB
C
/*----------------------------------------------------------------------------
|
|
* Tencent is pleased to support the open source community by making TencentOS
|
|
* available.
|
|
*
|
|
* Copyright (C) 2019 THL A29 Limited, a Tencent company. All rights reserved.
|
|
* If you have downloaded a copy of the TencentOS binary from Tencent, please
|
|
* note that the TencentOS binary is licensed under the BSD 3-Clause License.
|
|
*
|
|
* If you have downloaded a copy of the TencentOS source code from Tencent,
|
|
* please note that TencentOS source code is licensed under the BSD 3-Clause
|
|
* License, except for the third-party components listed below which are
|
|
* subject to different license terms. Your integration of TencentOS into your
|
|
* own projects may require compliance with the BSD 3-Clause License, as well
|
|
* as the other licenses applicable to the third-party components included
|
|
* within TencentOS.
|
|
*---------------------------------------------------------------------------*/
|
|
|
|
#include "tos.h"
|
|
|
|
#if TOS_CFG_MAIL_QUEUE_EN > 0u
|
|
|
|
__API__ k_err_t tos_mail_q_create(k_mail_q_t *mail_q, void *pool, size_t mail_cnt, size_t mail_size)
|
|
{
|
|
k_err_t err;
|
|
|
|
TOS_PTR_SANITY_CHECK(mail_q);
|
|
|
|
err = tos_ring_q_create(&mail_q->ring_q, pool, mail_cnt, mail_size);
|
|
if (err != K_ERR_NONE) {
|
|
return err;
|
|
}
|
|
|
|
pend_object_init(&mail_q->pend_obj);
|
|
|
|
#if TOS_CFG_OBJECT_VERIFY_EN > 0u
|
|
knl_object_init(&mail_q->knl_obj, KNL_OBJ_TYPE_MAIL_QUEUE);
|
|
#endif
|
|
#if TOS_CFG_MMHEAP_EN > 0u
|
|
knl_object_alloc_set_static(&mail_q->knl_obj);
|
|
#endif
|
|
|
|
return K_ERR_NONE;
|
|
}
|
|
|
|
__API__ k_err_t tos_mail_q_destroy(k_mail_q_t *mail_q)
|
|
{
|
|
TOS_CPU_CPSR_ALLOC();
|
|
k_err_t err;
|
|
|
|
TOS_PTR_SANITY_CHECK(mail_q);
|
|
TOS_OBJ_VERIFY(mail_q, KNL_OBJ_TYPE_MAIL_QUEUE);
|
|
|
|
#if TOS_CFG_MMHEAP_EN > 0u
|
|
if (!knl_object_alloc_is_static(&mail_q->knl_obj)) {
|
|
return K_ERR_OBJ_INVALID_ALLOC_TYPE;
|
|
}
|
|
#endif
|
|
|
|
TOS_CPU_INT_DISABLE();
|
|
|
|
err = tos_ring_q_destroy(&mail_q->ring_q);
|
|
if (err != K_ERR_NONE) {
|
|
TOS_CPU_INT_ENABLE();
|
|
return err;
|
|
}
|
|
|
|
if (!pend_is_nopending(&mail_q->pend_obj)) {
|
|
pend_wakeup_all(&mail_q->pend_obj, PEND_STATE_DESTROY);
|
|
}
|
|
|
|
pend_object_deinit(&mail_q->pend_obj);
|
|
|
|
#if TOS_CFG_OBJECT_VERIFY_EN > 0u
|
|
knl_object_deinit(&mail_q->knl_obj);
|
|
#endif
|
|
#if TOS_CFG_MMHEAP_EN > 0u
|
|
knl_object_alloc_reset(&mail_q->knl_obj);
|
|
#endif
|
|
|
|
TOS_CPU_INT_ENABLE();
|
|
knl_sched();
|
|
|
|
return K_ERR_NONE;
|
|
}
|
|
|
|
#if TOS_CFG_MMHEAP_EN > 0u
|
|
|
|
__API__ k_err_t tos_mail_q_create_dyn(k_mail_q_t *mail_q, size_t mail_cnt, size_t mail_size)
|
|
{
|
|
k_err_t err;
|
|
|
|
TOS_PTR_SANITY_CHECK(mail_q);
|
|
|
|
err = tos_ring_q_create_dyn(&mail_q->ring_q, mail_cnt, mail_size);
|
|
if (err != K_ERR_NONE) {
|
|
return err;
|
|
}
|
|
|
|
pend_object_init(&mail_q->pend_obj);
|
|
|
|
#if TOS_CFG_OBJECT_VERIFY_EN > 0u
|
|
knl_object_init(&mail_q->knl_obj, KNL_OBJ_TYPE_MAIL_QUEUE);
|
|
#endif
|
|
knl_object_alloc_set_dynamic(&mail_q->knl_obj);
|
|
|
|
return K_ERR_NONE;
|
|
}
|
|
|
|
__API__ k_err_t tos_mail_q_destroy_dyn(k_mail_q_t *mail_q)
|
|
{
|
|
TOS_CPU_CPSR_ALLOC();
|
|
k_err_t err;
|
|
|
|
TOS_PTR_SANITY_CHECK(mail_q);
|
|
TOS_OBJ_VERIFY(mail_q, KNL_OBJ_TYPE_MAIL_QUEUE);
|
|
|
|
if (!knl_object_alloc_is_dynamic(&mail_q->knl_obj)) {
|
|
return K_ERR_OBJ_INVALID_ALLOC_TYPE;
|
|
}
|
|
|
|
TOS_CPU_INT_DISABLE();
|
|
|
|
err = tos_ring_q_destroy_dyn(&mail_q->ring_q);
|
|
if (err != K_ERR_NONE) {
|
|
TOS_CPU_INT_ENABLE();
|
|
return err;
|
|
}
|
|
|
|
if (!pend_is_nopending(&mail_q->pend_obj)) {
|
|
pend_wakeup_all(&mail_q->pend_obj, PEND_STATE_DESTROY);
|
|
}
|
|
|
|
pend_object_deinit(&mail_q->pend_obj);
|
|
|
|
#if TOS_CFG_OBJECT_VERIFY_EN > 0u
|
|
knl_object_deinit(&mail_q->knl_obj);
|
|
#endif
|
|
knl_object_alloc_reset(&mail_q->knl_obj);
|
|
|
|
TOS_CPU_INT_ENABLE();
|
|
knl_sched();
|
|
|
|
return K_ERR_NONE;
|
|
}
|
|
|
|
#endif
|
|
|
|
__API__ k_err_t tos_mail_q_flush(k_mail_q_t *mail_q)
|
|
{
|
|
TOS_PTR_SANITY_CHECK(mail_q);
|
|
TOS_OBJ_VERIFY(mail_q, KNL_OBJ_TYPE_MAIL_QUEUE);
|
|
|
|
return tos_ring_q_flush(&mail_q->ring_q);
|
|
}
|
|
|
|
__API__ k_err_t tos_mail_q_pend(k_mail_q_t *mail_q, void *mail_buf, size_t *mail_size, k_tick_t timeout)
|
|
{
|
|
TOS_CPU_CPSR_ALLOC();
|
|
k_err_t err;
|
|
|
|
TOS_PTR_SANITY_CHECK(mail_q);
|
|
TOS_PTR_SANITY_CHECK(mail_buf);
|
|
TOS_OBJ_VERIFY(mail_q, KNL_OBJ_TYPE_MAIL_QUEUE);
|
|
|
|
TOS_CPU_INT_DISABLE();
|
|
|
|
if (tos_ring_q_dequeue(&mail_q->ring_q, mail_buf, mail_size) == K_ERR_NONE) {
|
|
TOS_CPU_INT_ENABLE();
|
|
return K_ERR_NONE;
|
|
}
|
|
|
|
if (timeout == TOS_TIME_NOWAIT) {
|
|
*mail_size = 0;
|
|
TOS_CPU_INT_ENABLE();
|
|
return K_ERR_PEND_NOWAIT;
|
|
}
|
|
|
|
if (knl_is_sched_locked()) {
|
|
TOS_CPU_INT_ENABLE();
|
|
return K_ERR_PEND_SCHED_LOCKED;
|
|
}
|
|
|
|
k_curr_task->mail = mail_buf;
|
|
pend_task_block(k_curr_task, &mail_q->pend_obj, timeout);
|
|
|
|
TOS_CPU_INT_ENABLE();
|
|
knl_sched();
|
|
|
|
err = pend_state2errno(k_curr_task->pend_state);
|
|
if (err == K_ERR_NONE) {
|
|
*mail_size = k_curr_task->mail_size;
|
|
k_curr_task->mail = K_NULL;
|
|
k_curr_task->mail_size = 0;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
__STATIC__ void mail_task_recv(k_task_t *task, void *mail_buf, size_t mail_size)
|
|
{
|
|
memcpy(task->mail, mail_buf, mail_size);
|
|
task->mail_size = mail_size;
|
|
pend_task_wakeup(task, PEND_STATE_POST);
|
|
}
|
|
|
|
__STATIC__ k_err_t mail_q_do_post(k_mail_q_t *mail_q, void *mail_buf, size_t mail_size, opt_post_t opt)
|
|
{
|
|
TOS_CPU_CPSR_ALLOC();
|
|
k_err_t err;
|
|
k_list_t *curr, *next;
|
|
|
|
TOS_PTR_SANITY_CHECK(mail_q);
|
|
TOS_PTR_SANITY_CHECK(mail_buf);
|
|
TOS_OBJ_VERIFY(mail_q, KNL_OBJ_TYPE_MAIL_QUEUE);
|
|
|
|
TOS_CPU_INT_DISABLE();
|
|
|
|
if (pend_is_nopending(&mail_q->pend_obj)) {
|
|
err = tos_ring_q_enqueue(&mail_q->ring_q, mail_buf, mail_size);
|
|
if (err != K_ERR_NONE) {
|
|
TOS_CPU_INT_ENABLE();
|
|
return err;
|
|
}
|
|
TOS_CPU_INT_ENABLE();
|
|
return K_ERR_NONE;
|
|
}
|
|
|
|
if (opt == OPT_POST_ONE) {
|
|
mail_task_recv(TOS_LIST_FIRST_ENTRY(&mail_q->pend_obj.list, k_task_t, pend_list),
|
|
mail_buf, mail_size);
|
|
} else { // OPT_POST_ALL
|
|
TOS_LIST_FOR_EACH_SAFE(curr, next, &mail_q->pend_obj.list) {
|
|
mail_task_recv(TOS_LIST_ENTRY(curr, k_task_t, pend_list),
|
|
mail_buf, mail_size);
|
|
}
|
|
}
|
|
|
|
TOS_CPU_INT_ENABLE();
|
|
knl_sched();
|
|
|
|
return K_ERR_NONE;
|
|
}
|
|
|
|
__API__ k_err_t tos_mail_q_post(k_mail_q_t *mail_q, void *mail_buf, size_t mail_size)
|
|
{
|
|
return mail_q_do_post(mail_q, mail_buf, mail_size, OPT_POST_ONE);
|
|
}
|
|
|
|
__API__ k_err_t tos_mail_q_post_all(k_mail_q_t *mail_q, void *mail_buf, size_t mail_size)
|
|
{
|
|
return mail_q_do_post(mail_q, mail_buf, mail_size, OPT_POST_ALL);
|
|
}
|
|
|
|
#endif
|
|
|