OSStatus mico_rtos_pop_from_queue( mico_queue_t* queue, void* message, uint32_t timeout_ms )
{
kstat_t ret;
size_t msg_len;
ret = krhino_buf_queue_recv(*((kbuf_queue_t **)queue), krhino_ms_to_ticks(timeout_ms), message, &msg_len);
if (ret == RHINO_SUCCESS) {
return kNoErr;
}
return kGeneralErr;
}
static void task_buf_queue_entry(void *arg)
{
kstat_t ret;
size_t size;
ret = krhino_buf_queue_recv(&test_buf_queue, RHINO_WAIT_FOREVER,
(void *)buf_queue_recv, &size);
if ((ret == RHINO_SUCCESS) && (*(uint8_t *)buf_queue_recv == 0x5a)) {
notify_flag = 0x5a;
krhino_buf_queue_del(&test_buf_queue);
krhino_task_dyn_del(krhino_cur_task_get());
}
}
static void buf_queue_recv_param_test(void)
{
kstat_t ret;
size_t size;
ksem_t sem;
memset(&sem, 0, sizeof(ksem_t));
ret = krhino_buf_queue_recv(NULL, RHINO_WAIT_FOREVER, &g_test_recv_msg0, &size);
BUFQUEUE_VAL_CHK(ret == RHINO_NULL_PTR);
ret = krhino_buf_queue_recv(&g_test_bufqueue0, RHINO_WAIT_FOREVER, NULL, &size);
BUFQUEUE_VAL_CHK(ret == RHINO_NULL_PTR);
ret = krhino_buf_queue_recv(&g_test_bufqueue0, RHINO_WAIT_FOREVER,
&g_test_recv_msg0, NULL);
BUFQUEUE_VAL_CHK(ret == RHINO_NULL_PTR);
krhino_sem_create(& sem, "test_sem ", 0);
ret = krhino_buf_queue_recv((kbuf_queue_t *)&sem, RHINO_WAIT_FOREVER,
&g_test_recv_msg0, &size);
BUFQUEUE_VAL_CHK(ret == RHINO_KOBJ_TYPE_ERR);
krhino_sem_del(&sem);
}
int aos_queue_recv(aos_queue_t *queue, unsigned int ms, void *msg,
unsigned int *size)
{
int ret;
if (queue == NULL) {
return -EINVAL;
}
ret = krhino_buf_queue_recv(queue->hdl, MS2TICK(ms), msg, size);
if (ret == RHINO_SUCCESS) {
return 0;
}
ERRNO_MAPPING(ret);
}
/*
* \internal Read data from usart interface
*
* \param[in] descr The pointer to an io descriptor
* \param[in] buf A buffer to read data to
* \param[in] length The size of a buffer
* \param[in] timeout The millisecond of timeout
*
* \return The number of bytes read.
*/
static int32_t usart_async_read(struct io_descriptor *const io_descr, uint8_t *const buf, const uint16_t length, uint32_t timeout)
{
uint16_t was_read = 0;
uint32_t num;
size_t rev_size = 0;
int32_t ret;
struct usart_os_descriptor *descr = CONTAINER_OF(io_descr, struct usart_os_descriptor, io);
ASSERT(descr && buf && length);
if (aos_mutex_lock(&descr->rx_mutex, AOS_WAIT_FOREVER) != 0) {
return -1;
}
while (was_read < length) {
ret = krhino_buf_queue_recv(&descr->kbuf, timeout, &buf[was_read], &rev_size);
if((ret == 0) && (rev_size == 1)) {
was_read++;
} else {
break;
}
}
aos_mutex_unlock(&descr->rx_mutex);
return (int32_t)was_read;
}
static void task_queue0_entry(void *arg)
{
kstat_t ret;
size_t size;
int count = 0;
size_t msg;
/* err param test */
ret = krhino_buf_queue_create(&g_test_bufqueue0, "test_bufqueue0",
(void *)g_test_bufqueue_buf0,
TEST_BUFQUEUE_BUF0_SIZE, 0);
BUFQUEUE_VAL_CHK(ret == RHINO_INV_PARAM);
ret = krhino_buf_queue_create(&g_test_bufqueue0, "test_bufqueue0",
(void *)g_test_bufqueue_buf0,
TEST_BUFQUEUE_BUF0_SIZE, TEST_BUFQUEUE_MSG_MAX);
BUFQUEUE_VAL_CHK(ret == RHINO_SUCCESS);
ret = krhino_fix_buf_queue_create(&g_test_bufqueue1, "test_bufqueue1",
(void *)g_test_bufqueue_buf1, sizeof(size_t), 2);
BUFQUEUE_VAL_CHK(ret == RHINO_SUCCESS);
msg = 0x11;
ret = krhino_buf_queue_send(&g_test_bufqueue1, &msg, sizeof(size_t));
BUFQUEUE_VAL_CHK(ret == RHINO_SUCCESS);
ret = krhino_buf_queue_send(&g_test_bufqueue1, &msg, sizeof(size_t));
BUFQUEUE_VAL_CHK(ret == RHINO_SUCCESS);
ret = krhino_buf_queue_send(&g_test_bufqueue1, &msg, sizeof(size_t));
BUFQUEUE_VAL_CHK(ret == RHINO_BUF_QUEUE_FULL);
(void)krhino_buf_queue_recv(&g_test_bufqueue1, RHINO_NO_WAIT, &msg, &size);
(void)krhino_buf_queue_recv(&g_test_bufqueue1, RHINO_NO_WAIT, &msg, &size);
ret = krhino_buf_queue_recv(&g_test_bufqueue1, 1, &msg, &size);
BUFQUEUE_VAL_CHK(ret == RHINO_BLK_TIMEOUT);
/* check krhino_buf_queue_recv */
buf_queue_recv_param_test();
buf_queue_send_param_test();
/* check RHINO_NO_WAIT */
ret = krhino_buf_queue_recv(&g_test_bufqueue0, RHINO_NO_WAIT, &g_test_recv_msg0,
&size);
BUFQUEUE_VAL_CHK(ret == RHINO_NO_PEND_WAIT);
/* check sched disalbe */
ret = krhino_sched_disable();
BUFQUEUE_VAL_CHK(ret == RHINO_SUCCESS);
ret = krhino_buf_queue_recv(&g_test_bufqueue0, RHINO_WAIT_FOREVER,
&g_test_recv_msg0, &size);
BUFQUEUE_VAL_CHK(ret == RHINO_SCHED_DISABLE);
ret = krhino_sched_enable();
BUFQUEUE_VAL_CHK(ret == RHINO_SUCCESS);
ret = krhino_task_dyn_create(&task_1_test, "task_bufqueue1_test", 0,
TEST_BUFQUEUE_SND_TASK_LOW_RPI,
0, TASK_TEST_STACK_SIZE, task_queue1_entry, 1);
BUFQUEUE_VAL_CHK(ret == RHINO_SUCCESS);
do {
ret = krhino_buf_queue_recv(&g_test_bufqueue0, RHINO_WAIT_FOREVER,
g_test_recv_msg0, &size);
BUFQUEUE_VAL_CHK(ret == RHINO_SUCCESS);
memset(g_test_send_msg0, send_char[count], TEST_BUFQUEUE_MSG_MAX);
ret = memcmp(g_test_send_msg0, g_test_recv_msg0, size);
count ++;
} while (count < TEST_BUFQUEUE_MSG_NUM);
ret = krhino_task_dyn_create(&task_2_test, "task_bufqueue2_test", 0,
TEST_BUFQUEUE_SND_TASK_HIGH_RPI,
0, TASK_TEST_STACK_SIZE, task_queue2_entry, 1);
BUFQUEUE_VAL_CHK(ret == RHINO_SUCCESS);
krhino_task_sleep(RHINO_CONFIG_TICKS_PER_SECOND / 10);
count = 0;
do {
ret = krhino_buf_queue_recv(&g_test_bufqueue0, RHINO_WAIT_FOREVER,
g_test_recv_msg0, &size);
BUFQUEUE_VAL_CHK(ret == RHINO_SUCCESS);
memset(g_test_send_msg1, send_char[count], TEST_BUFQUEUE_MSG_MAX);
ret = memcmp(g_test_send_msg1, g_test_recv_msg0, size);
count ++;
} while (count < TEST_BUFQUEUE_MSG_NUM);
if (test_case_check_err == 0) {
test_case_success++;
PRINT_RESULT("buf queue recv", PASS);
} else {
test_case_check_err = 0;
test_case_fail++;
PRINT_RESULT("buf queue recv", FAIL);
}
next_test_case_notify();
krhino_task_dyn_del(task_0_test);
}
