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); }