| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690 |
- #include <stdio.h>
- #include <stdlib.h>
- #include "freertos/FreeRTOS.h"
- #include "freertos/task.h"
- #include "freertos/queue.h"
- #include "freertos/semphr.h"
- #include "freertos/ringbuf.h"
- #include "driver/timer.h"
- #include "esp_heap_caps.h"
- #include "esp_spi_flash.h"
- #include "unity.h"
- #include "test_utils.h"
- #include "esp_rom_sys.h"
- //Definitions used in multiple test cases
- #define TIMEOUT_TICKS 10
- #define NO_OF_RB_TYPES 3
- #define ITEM_HDR_SIZE 8
- #define SMALL_ITEM_SIZE 8
- #define LARGE_ITEM_SIZE (2 * SMALL_ITEM_SIZE)
- #define BUFFER_SIZE 160 //4Byte aligned size
- static const uint8_t small_item[SMALL_ITEM_SIZE] = { 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07};
- static const uint8_t large_item[LARGE_ITEM_SIZE] = { 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F,
- 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17};
- static RingbufHandle_t buffer_handles[NO_OF_RB_TYPES];
- static SemaphoreHandle_t done_sem;
- static void send_item_and_check(RingbufHandle_t handle, const uint8_t *item, size_t item_size, TickType_t ticks_to_wait, bool in_isr)
- {
- BaseType_t ret;
- if (in_isr) {
- ret = xRingbufferSendFromISR(handle, (void *)item, item_size, NULL);
- } else {
- ret = xRingbufferSend(handle, (void *)item, item_size, ticks_to_wait);
- }
- TEST_ASSERT_MESSAGE(ret == pdTRUE, "Failed to send item");
- }
- static void receive_check_and_return_item_no_split(RingbufHandle_t handle, const uint8_t *expected_data, size_t expected_size, TickType_t ticks_to_wait, bool in_isr)
- {
- //Receive item from no-split buffer
- size_t item_size;
- uint8_t *item;
- if (in_isr) {
- item = (uint8_t *)xRingbufferReceiveFromISR(handle, &item_size);
- } else {
- item = (uint8_t *)xRingbufferReceive(handle, &item_size, ticks_to_wait);
- }
- TEST_ASSERT_MESSAGE(item != NULL, "Failed to receive item");
- TEST_ASSERT_MESSAGE(item_size == expected_size, "Item size is incorrect");
- //Check data of received item
- for (int i = 0; i < item_size; i++) {
- TEST_ASSERT_MESSAGE(item[i] == expected_data[i], "Item data is invalid");
- }
- //Return item
- if (in_isr) {
- vRingbufferReturnItemFromISR(handle, (void *)item, NULL);
- } else {
- vRingbufferReturnItem(handle, (void *)item);
- }
- }
- static void receive_check_and_return_item_allow_split(RingbufHandle_t handle, const uint8_t *expected_data, size_t expected_size, TickType_t ticks_to_wait, bool in_isr)
- {
- //Receive item
- size_t item_size1, item_size2;
- uint8_t *item1, *item2;
- BaseType_t ret;
- if (in_isr) {
- ret = xRingbufferReceiveSplitFromISR(handle, (void**)&item1, (void **)&item2, &item_size1, &item_size2);
- } else {
- ret = xRingbufferReceiveSplit(handle, (void**)&item1, (void **)&item2, &item_size1, &item_size2, ticks_to_wait);
- }
- //= xRingbufferReceiveSplit(handle, (void**)&item1, (void **)&item2, &item_size1, &item_size2, ticks_to_wait);
- TEST_ASSERT_MESSAGE(ret == pdTRUE, "Failed to receive item");
- TEST_ASSERT_MESSAGE(item1 != NULL, "Failed to receive item");
- //Check data of received item(s) and return them
- if (item2 == NULL) {
- TEST_ASSERT_MESSAGE(item_size1 == expected_size, "Item size is incorrect");
- for (int i = 0; i < item_size1; i++) {
- TEST_ASSERT_MESSAGE(item1[i] == expected_data[i], "Item data is invalid");
- }
- //Return item
- if (in_isr) {
- vRingbufferReturnItemFromISR(handle, (void *)item1, NULL);
- } else {
- vRingbufferReturnItem(handle, (void *)item1);
- }
- } else {
- //Item was split
- TEST_ASSERT_MESSAGE(item_size1 + item_size2 == expected_size, "Total item size is incorrect");
- for (int i = 0; i < item_size1; i++) {
- TEST_ASSERT_MESSAGE(item1[i] == expected_data[i], "Head item data is invalid");
- }
- for (int i = 0; i < item_size2; i++) {
- TEST_ASSERT_MESSAGE(item2[i] == expected_data[item_size1 + i], "Head item data is invalid");
- }
- //Return Items
- if (in_isr) {
- vRingbufferReturnItemFromISR(handle, (void *)item1, NULL);
- vRingbufferReturnItemFromISR(handle, (void *)item2, NULL);
- } else {
- vRingbufferReturnItem(handle, (void *)item1);
- vRingbufferReturnItem(handle, (void *)item2);
- }
- }
- }
- static void receive_check_and_return_item_byte_buffer(RingbufHandle_t handle, const uint8_t *expected_data, size_t expected_size, TickType_t ticks_to_wait, bool in_isr)
- {
- //Receive item
- size_t item_size;
- uint8_t *item;
- if (in_isr) {
- item = (uint8_t *)xRingbufferReceiveUpToFromISR(handle, &item_size, expected_size);
- } else {
- item = (uint8_t *)xRingbufferReceiveUpTo(handle, &item_size, ticks_to_wait, expected_size); //Limit amount of bytes returned to the size of one item
- }
- TEST_ASSERT_MESSAGE(item != NULL, "Failed to receive item");
- //Check data of received item
- for (int i = 0; i < item_size; i++) {
- TEST_ASSERT_MESSAGE(item[i] == expected_data[i], "Item data is invalid");
- }
- //Return item
- if (in_isr) {
- vRingbufferReturnItemFromISR(handle, (void *)item, NULL);
- } else {
- vRingbufferReturnItem(handle, (void *)item);
- }
- //Check if item wrapped around
- if (item_size < expected_size) {
- //Item is wrapped, receive second portion
- size_t item_size2;
- uint8_t *item2;
- if (in_isr) {
- item2 = (uint8_t *)xRingbufferReceiveUpToFromISR(handle, &item_size2, expected_size - item_size);
- } else {
- item2 = (uint8_t *)xRingbufferReceiveUpTo(handle, &item_size2, ticks_to_wait, expected_size - item_size);
- }
- //= (uint8_t *)xRingbufferReceiveUpTo(handle, &item_size2, ticks_to_wait, expected_size - item_size);
- TEST_ASSERT_MESSAGE(item2 != NULL, "Failed to receive item");
- TEST_ASSERT_MESSAGE(item_size + item_size2 == expected_size, "Total item size is incorrect");
- for (int i = 0; i < item_size2; i++) {
- TEST_ASSERT_MESSAGE(item2[i] == expected_data[item_size + i], "Item data is invalid");
- }
- if (in_isr) {
- vRingbufferReturnItemFromISR(handle, (void *)item2, NULL);
- } else {
- vRingbufferReturnItem(handle, (void *)item2);
- }
- } else {
- TEST_ASSERT_MESSAGE(item_size == expected_size, "Item size is incorrect");
- }
- }
- /* ----------------- Basic ring buffer behavior tests cases --------------------
- * The following test cases will test basic send, receive, and wrap around
- * behavior of each type of ring buffer. Each test case will do the following
- * 1) Send multiple items (nearly fill the buffer)
- * 2) Receive and check the sent items (also prepares the buffer for a wrap around
- * 3) Send a final item that causes a wrap around
- * 4) Receive and check the wrapped item
- */
- TEST_CASE("Test ring buffer No-Split", "[esp_ringbuf]")
- {
- //Create buffer
- RingbufHandle_t buffer_handle = xRingbufferCreate(BUFFER_SIZE, RINGBUF_TYPE_NOSPLIT);
- TEST_ASSERT_MESSAGE(buffer_handle != NULL, "Failed to create ring buffer");
- //Calculate number of items to send. Aim to almost fill buffer to setup for wrap around
- int no_of_items = (BUFFER_SIZE - (ITEM_HDR_SIZE + SMALL_ITEM_SIZE)) / (ITEM_HDR_SIZE + SMALL_ITEM_SIZE);
- //Test sending items
- for (int i = 0; i < no_of_items; i++) {
- send_item_and_check(buffer_handle, small_item, SMALL_ITEM_SIZE, TIMEOUT_TICKS, false);
- }
- //Test receiving items
- for (int i = 0; i < no_of_items; i++) {
- receive_check_and_return_item_no_split(buffer_handle, small_item, SMALL_ITEM_SIZE, TIMEOUT_TICKS, false);
- }
- //Write pointer should be near the end, test wrap around
- UBaseType_t write_pos_before, write_pos_after;
- vRingbufferGetInfo(buffer_handle, NULL, NULL, &write_pos_before, NULL, NULL);
- //Send large item that causes wrap around
- send_item_and_check(buffer_handle, large_item, LARGE_ITEM_SIZE, TIMEOUT_TICKS, false);
- //Receive wrapped item
- receive_check_and_return_item_no_split(buffer_handle, large_item, LARGE_ITEM_SIZE, TIMEOUT_TICKS, false);
- vRingbufferGetInfo(buffer_handle, NULL, NULL, &write_pos_after, NULL, NULL);
- TEST_ASSERT_MESSAGE(write_pos_after < write_pos_before, "Failed to wrap around");
- //Cleanup
- vRingbufferDelete(buffer_handle);
- }
- TEST_CASE("Test ring buffer Allow-Split", "[esp_ringbuf]")
- {
- //Create buffer
- RingbufHandle_t buffer_handle = xRingbufferCreate(BUFFER_SIZE, RINGBUF_TYPE_ALLOWSPLIT);
- TEST_ASSERT_MESSAGE(buffer_handle != NULL, "Failed to create ring buffer");
- //Calculate number of items to send. Aim to almost fill buffer to setup for wrap around
- int no_of_items = (BUFFER_SIZE - (ITEM_HDR_SIZE + SMALL_ITEM_SIZE)) / (ITEM_HDR_SIZE + SMALL_ITEM_SIZE);
- //Test sending items
- for (int i = 0; i < no_of_items; i++) {
- send_item_and_check(buffer_handle, small_item, SMALL_ITEM_SIZE, TIMEOUT_TICKS, false);
- }
- //Test receiving items
- for (int i = 0; i < no_of_items; i++) {
- receive_check_and_return_item_allow_split(buffer_handle, small_item, SMALL_ITEM_SIZE, TIMEOUT_TICKS, false);
- }
- //Write pointer should be near the end, test wrap around
- UBaseType_t write_pos_before, write_pos_after;
- vRingbufferGetInfo(buffer_handle, NULL, NULL, &write_pos_before, NULL, NULL);
- //Send large item that causes wrap around
- send_item_and_check(buffer_handle, large_item, LARGE_ITEM_SIZE, TIMEOUT_TICKS, false);
- //Receive wrapped item
- receive_check_and_return_item_allow_split(buffer_handle, large_item, LARGE_ITEM_SIZE, TIMEOUT_TICKS, false);
- vRingbufferGetInfo(buffer_handle, NULL, NULL, &write_pos_after, NULL, NULL);
- TEST_ASSERT_MESSAGE(write_pos_after < write_pos_before, "Failed to wrap around");
- //Cleanup
- vRingbufferDelete(buffer_handle);
- }
- TEST_CASE("Test ring buffer Byte Buffer", "[esp_ringbuf]")
- {
- //Create buffer
- RingbufHandle_t buffer_handle = xRingbufferCreate(BUFFER_SIZE, RINGBUF_TYPE_BYTEBUF);
- TEST_ASSERT_MESSAGE(buffer_handle != NULL, "Failed to create ring buffer");
- //Calculate number of items to send. Aim to almost fill buffer to setup for wrap around
- int no_of_items = (BUFFER_SIZE - SMALL_ITEM_SIZE) / SMALL_ITEM_SIZE;
- //Test sending items
- for (int i = 0; i < no_of_items; i++) {
- send_item_and_check(buffer_handle, small_item, SMALL_ITEM_SIZE, TIMEOUT_TICKS, false);
- }
- //Test receiving items
- for (int i = 0; i < no_of_items; i++) {
- receive_check_and_return_item_byte_buffer(buffer_handle, small_item, SMALL_ITEM_SIZE, TIMEOUT_TICKS, false);
- }
- //Write pointer should be near the end, test wrap around
- UBaseType_t write_pos_before, write_pos_after;
- vRingbufferGetInfo(buffer_handle, NULL, NULL, &write_pos_before, NULL, NULL);
- //Send large item that causes wrap around
- send_item_and_check(buffer_handle, large_item, LARGE_ITEM_SIZE, TIMEOUT_TICKS, false);
- //Receive wrapped item
- receive_check_and_return_item_byte_buffer(buffer_handle, large_item, LARGE_ITEM_SIZE, TIMEOUT_TICKS, false);
- vRingbufferGetInfo(buffer_handle, NULL, NULL, &write_pos_after, NULL, NULL);
- TEST_ASSERT_MESSAGE(write_pos_after < write_pos_before, "Failed to wrap around");
- //Cleanup
- vRingbufferDelete(buffer_handle);
- }
- /* ----------------------- Ring buffer queue sets test ------------------------
- * The following test case will test receiving from ring buffers that have been
- * added to a queue set. The test case will do the following...
- * 1) Ring buffer of each type is created and added to the queue set
- * 2) A receiving task is created to select from the queue set and read from the appropriate ring buffer
- */
- static void queue_set_receiving_task(void *queue_set_handle)
- {
- QueueSetHandle_t queue_set = (QueueSetHandle_t)queue_set_handle;
- //Receive multiple items via queue set
- BaseType_t done = pdFALSE;
- int no_of_items = BUFFER_SIZE / SMALL_ITEM_SIZE;
- int items_rec_count[NO_OF_RB_TYPES] = {0};
- while (done != pdTRUE) {
- xQueueSetMemberHandle member = xQueueSelectFromSet(queue_set, TIMEOUT_TICKS);
- //Read from selected ring buffer
- if (xRingbufferCanRead(buffer_handles[0], member) == pdTRUE) {
- //No-split buffer
- receive_check_and_return_item_no_split(buffer_handles[0], small_item, SMALL_ITEM_SIZE, 0, false);
- items_rec_count[0] ++;
- } else if (xRingbufferCanRead(buffer_handles[1], member) == pdTRUE) {
- //Allow-split buffer
- receive_check_and_return_item_allow_split(buffer_handles[1], small_item, SMALL_ITEM_SIZE, 0, false);
- items_rec_count[1] ++;
- } else if (xRingbufferCanRead(buffer_handles[2], member) == pdTRUE){
- //Byte buffer
- receive_check_and_return_item_byte_buffer(buffer_handles[2], small_item, SMALL_ITEM_SIZE, 0, false);
- items_rec_count[2] ++;
- } else {
- TEST_ASSERT_MESSAGE( false, "Error with queue set member");
- }
- //Check for completion
- if (items_rec_count[0] == no_of_items &&
- items_rec_count[1] == no_of_items &&
- items_rec_count[2] == no_of_items) {
- done = pdTRUE;
- }
- }
- xSemaphoreGive(done_sem);
- vTaskDelete(NULL);
- }
- TEST_CASE("Test ring buffer with queue sets", "[esp_ringbuf]")
- {
- QueueSetHandle_t queue_set = xQueueCreateSet(NO_OF_RB_TYPES);
- done_sem = xSemaphoreCreateBinary();
- //Create ring buffer of each type, then add them to a queue set
- for (int i = 0; i < NO_OF_RB_TYPES; i++) {
- buffer_handles[i] = xRingbufferCreate(BUFFER_SIZE, i);
- TEST_ASSERT_MESSAGE(buffer_handles[i] != NULL, "Failed to create ring buffer");
- TEST_ASSERT_MESSAGE(xRingbufferAddToQueueSetRead(buffer_handles[i], queue_set) == pdPASS, "Failed to add to read queue set");
- }
- //Create a task to send items to each ring buffer
- int no_of_items = BUFFER_SIZE / SMALL_ITEM_SIZE;
- xTaskCreatePinnedToCore(queue_set_receiving_task, "rec tsk", 2048, (void *)queue_set, UNITY_FREERTOS_PRIORITY + 1 , NULL, 0);
- //Send multiple items to each type of ring buffer
- for (int i = 0; i < no_of_items; i++) {
- for (int j = 0; j < NO_OF_RB_TYPES; j++) {
- send_item_and_check(buffer_handles[j], small_item, SMALL_ITEM_SIZE, TIMEOUT_TICKS, false);
- }
- }
- xSemaphoreTake(done_sem, portMAX_DELAY);
- vSemaphoreDelete(done_sem);
- //Remove and delete ring buffers from queue sets
- for (int i = 0; i < NO_OF_RB_TYPES; i++) {
- TEST_ASSERT_MESSAGE(xRingbufferRemoveFromQueueSetRead(buffer_handles[i], queue_set) == pdTRUE, "Failed to remove from read queue set");
- vRingbufferDelete(buffer_handles[i]);
- }
- vQueueDelete(queue_set);
- }
- /* -------------------------- Test ring buffer ISR -----------------------------
- * The following test case tests ring buffer ISR API. A timer is used to trigger
- * the ISR. The test case will do the following
- * 1) ISR will be triggered periodically by timer
- * 2) The ISR will iterate through all ring buffer types where each iteration
- * will send then receive an item to a ring buffer.
- */
- #define TIMER_GROUP 0
- #define TIMER_NUMBER 0
- #define ISR_ITERATIONS ((BUFFER_SIZE / SMALL_ITEM_SIZE) * 2)
- intr_handle_t ringbuffer_isr_handle;
- static int buf_type;
- static int iterations;
- static void ringbuffer_isr(void *arg)
- {
- //Clear timer interrupt
- timer_group_clr_intr_status_in_isr(TIMER_GROUP_0, TIMER_0);
- timer_group_enable_alarm_in_isr(TIMER_GROUP_0, xPortGetCoreID());
- //Test sending to buffer from ISR from ISR
- if (buf_type < NO_OF_RB_TYPES) {
- send_item_and_check(buffer_handles[buf_type], (void *)small_item, SMALL_ITEM_SIZE, 0, true);
- }
- //Receive item from ISR
- if (buf_type == RINGBUF_TYPE_NOSPLIT) {
- //Test receive from ISR for no-split buffer
- receive_check_and_return_item_no_split(buffer_handles[buf_type], (void *)small_item, SMALL_ITEM_SIZE, 0, true);
- buf_type++;
- } else if (buf_type == RINGBUF_TYPE_ALLOWSPLIT) {
- //Test send from ISR to allow-split buffer
- receive_check_and_return_item_allow_split(buffer_handles[buf_type], (void *)small_item, SMALL_ITEM_SIZE, 0, true);
- buf_type++;
- } else if (buf_type == RINGBUF_TYPE_BYTEBUF) {
- //Test receive from ISR for byte buffer
- receive_check_and_return_item_byte_buffer(buffer_handles[buf_type], (void *)small_item, SMALL_ITEM_SIZE, 0, true);
- buf_type++;
- } else if (buf_type == NO_OF_RB_TYPES) {
- //Check if all iterations complete
- if (iterations < ISR_ITERATIONS) {
- iterations++;
- buf_type = 0; //Reset and iterate through each buffer type again
- return;
- } else {
- //Signal complete
- BaseType_t task_woken = pdFALSE;
- xSemaphoreGiveFromISR(done_sem, &task_woken);
- if (task_woken == pdTRUE) {
- buf_type++;
- portYIELD_FROM_ISR();
- }
- }
- }
- }
- static void setup_timer(void)
- {
- //Setup timer for ISR
- int timer_group = TIMER_GROUP;
- int timer_idx = TIMER_NUMBER;
- timer_config_t config;
- config.alarm_en = 1;
- config.auto_reload = 1;
- config.counter_dir = TIMER_COUNT_UP;
- config.divider = 10000;
- config.intr_type = TIMER_INTR_LEVEL;
- config.counter_en = TIMER_PAUSE;
- timer_init(timer_group, timer_idx, &config); //Configure timer
- timer_pause(timer_group, timer_idx); //Stop timer counter
- timer_set_counter_value(timer_group, timer_idx, 0x00000000ULL); //Load counter value
- timer_set_alarm_value(timer_group, timer_idx, 20); //Set alarm value
- timer_enable_intr(timer_group, timer_idx); //Enable timer interrupt
- timer_set_auto_reload(timer_group, timer_idx, 1); //Auto Reload
- timer_isr_register(timer_group, timer_idx, ringbuffer_isr, NULL, 0, &ringbuffer_isr_handle); //Set ISR handler
- }
- static void cleanup_timer(void)
- {
- timer_disable_intr(TIMER_GROUP, TIMER_NUMBER);
- esp_intr_free(ringbuffer_isr_handle);
- }
- TEST_CASE("Test ring buffer ISR", "[esp_ringbuf]")
- {
- for (int i = 0; i < NO_OF_RB_TYPES; i++) {
- buffer_handles[i] = xRingbufferCreate(BUFFER_SIZE, i);
- }
- done_sem = xSemaphoreCreateBinary();
- buf_type = 0;
- iterations = 0;
- setup_timer();
- //Start timer to trigger ISR
- timer_start(TIMER_GROUP, TIMER_NUMBER);
- //Wait for ISR to complete multiple iterations
- xSemaphoreTake(done_sem, portMAX_DELAY);
- //Cleanup
- cleanup_timer();
- vSemaphoreDelete(done_sem);
- for (int i = 0; i < NO_OF_RB_TYPES; i++) {
- vRingbufferDelete(buffer_handles[i]);
- }
- }
- /* ---------------------------- Test ring buffer SMP ---------------------------
- * The following test case tests each type of ring buffer in an SMP fashion. A
- * sending task and a receiving task is created. The sending task will split
- * a continuous piece of data into items of random length and send it to a ring
- * buffer. The receiving task will receive and check those items.
- * Every permutation of core pinning of the sending and receiving task will be
- * tested.
- */
- #define SRAND_SEED 3 //Arbitrarily chosen srand() seed
- #define SMP_TEST_ITERATIONS 4
- static const char continuous_data[] = {"A_very_long_string_that_will_be_split_into_"
- "items_of_random_lengths_and_sent_to_the_ring_"
- "buffer._The_maximum_random_length_will_also_"
- "be_increased_over_multiple_iterations_in_this"
- "_test"};
- #define CONT_DATA_LEN sizeof(continuous_data)
- //32-bit aligned size that guarantees a wrap around at some point
- #define CONT_DATA_TEST_BUFF_LEN (((CONT_DATA_LEN/2) + 0x03) & ~0x3)
- typedef struct {
- RingbufHandle_t buffer;
- RingbufferType_t type;
- } task_args_t;
- static SemaphoreHandle_t tasks_done;
- static SemaphoreHandle_t tx_done;
- static SemaphoreHandle_t rx_done;
- static void send_to_buffer(RingbufHandle_t buffer, size_t max_item_size)
- {
- for (int iter = 0; iter < SMP_TEST_ITERATIONS; iter++) {
- size_t bytes_sent = 0; //Number of data bytes sent in this iteration
- size_t next_item_size; //Size of next item to send
- while (bytes_sent < CONT_DATA_LEN) {
- //Get size of next item
- next_item_size = rand() % (max_item_size + 1);
- if (next_item_size + bytes_sent > CONT_DATA_LEN) {
- next_item_size = CONT_DATA_LEN - bytes_sent;
- }
- //Send item
- TEST_ASSERT_MESSAGE(xRingbufferSend(buffer, (void *)&(continuous_data[bytes_sent]), next_item_size, TIMEOUT_TICKS) == pdTRUE, "Failed to send an item");
- bytes_sent += next_item_size;
- }
- xSemaphoreGive(tx_done);
- xSemaphoreTake(rx_done, portMAX_DELAY);
- }
- }
- static void read_from_buffer(RingbufHandle_t buffer, RingbufferType_t buf_type, size_t max_rec_size)
- {
- for (int iter = 0; iter < SMP_TEST_ITERATIONS; iter++) {
- size_t bytes_rec = 0; //Number of data bytes received in this iteration
- while (bytes_rec < CONT_DATA_LEN) {
- size_t item_size, item_size2; //Possible for allow split buffers to receive two items
- char *item_data, *item_data2;
- //Select appropriate receive function for type of ring buffer
- if (buf_type == RINGBUF_TYPE_NOSPLIT) {
- item_data = (char *)xRingbufferReceive(buffer, &item_size, TIMEOUT_TICKS);
- } else if (buf_type == RINGBUF_TYPE_ALLOWSPLIT) {
- BaseType_t ret = xRingbufferReceiveSplit(buffer, (void **)&item_data, (void **)&item_data2, &item_size, &item_size2, TIMEOUT_TICKS);
- TEST_ASSERT_MESSAGE(ret == pdTRUE, "Failed to receive any item");
- } else {
- item_data = (char *)xRingbufferReceiveUpTo(buffer, &item_size, TIMEOUT_TICKS, max_rec_size);
- }
- //Check received item and return it
- TEST_ASSERT_MESSAGE(item_data != NULL, "Failed to receive an item");
- if (buf_type == RINGBUF_TYPE_BYTEBUF) {
- TEST_ASSERT_MESSAGE(item_size <= max_rec_size, "Received data exceeds max size");
- }
- for (int i = 0; i < item_size; i++) {
- //Check item_data is valid
- TEST_ASSERT_MESSAGE(item_data[i] == continuous_data[bytes_rec + i], "Received data is corrupted");
- }
- bytes_rec += item_size;
- vRingbufferReturnItem(buffer, item_data);
- if (buf_type == RINGBUF_TYPE_ALLOWSPLIT && item_data2 != NULL) {
- //Check item_data2 is valid
- for (int i = 0; i < item_size2; i++) {
- TEST_ASSERT_MESSAGE(item_data2[i] == continuous_data[bytes_rec + i], "Received split data is corrupted");
- }
- bytes_rec += item_size2;
- vRingbufferReturnItem(buffer, item_data2);
- }
- }
- TEST_ASSERT_MESSAGE(bytes_rec == CONT_DATA_LEN, "Total length of received data is incorrect");
- xSemaphoreGive(rx_done);
- xSemaphoreTake(tx_done, portMAX_DELAY);
- }
- }
- static void send_task(void *args)
- {
- RingbufHandle_t buffer = ((task_args_t *)args)->buffer;
- size_t max_item_len = xRingbufferGetMaxItemSize(buffer);
- //Test sending short length items
- send_to_buffer(buffer, 1);
- //Test sending mid length items
- send_to_buffer(buffer, max_item_len/2);
- //Test sending long length items
- send_to_buffer(buffer, max_item_len);
- vTaskDelete(NULL);
- }
- static void rec_task(void *args)
- {
- RingbufHandle_t buffer = ((task_args_t *)args)->buffer;
- size_t max_rec_len = xRingbufferGetMaxItemSize(buffer);
- //Test receiving short length items
- read_from_buffer(buffer, ((task_args_t *)args)->type, 1);
- //Test receiving mid length items
- read_from_buffer(buffer, ((task_args_t *)args)->type, max_rec_len/2);
- //Test receiving long length items
- read_from_buffer(buffer, ((task_args_t *)args)->type, max_rec_len);
- xSemaphoreGive(tasks_done);
- vTaskDelete(NULL);
- }
- static void setup(void)
- {
- esp_rom_printf("Size of test data: %d\n", CONT_DATA_LEN);
- tx_done = xSemaphoreCreateBinary(); //Semaphore to indicate send is done for a particular iteration
- rx_done = xSemaphoreCreateBinary(); //Semaphore to indicate receive is done for a particular iteration
- tasks_done = xSemaphoreCreateBinary(); //Semaphore used to to indicate send and receive tasks completed running
- srand(SRAND_SEED); //Seed RNG
- }
- static void cleanup(void)
- {
- //Cleanup
- vSemaphoreDelete(tx_done);
- vSemaphoreDelete(rx_done);
- vSemaphoreDelete(tasks_done);
- }
- TEST_CASE("Test ring buffer SMP", "[esp_ringbuf]")
- {
- setup();
- //Iterate through buffer types (No split, split, then byte buff)
- for (RingbufferType_t buf_type = 0; buf_type < RINGBUF_TYPE_MAX; buf_type++) {
- //Create buffer
- task_args_t task_args;
- task_args.buffer = xRingbufferCreate(CONT_DATA_TEST_BUFF_LEN, buf_type); //Create buffer of selected type
- task_args.type = buf_type;
- TEST_ASSERT_MESSAGE(task_args.buffer != NULL, "Failed to create ring buffer");
- for (int prior_mod = -1; prior_mod < 2; prior_mod++) { //Test different relative priorities
- //Test every permutation of core affinity
- for (int send_core = 0; send_core < portNUM_PROCESSORS; send_core++) {
- for (int rec_core = 0; rec_core < portNUM_PROCESSORS; rec_core ++) {
- esp_rom_printf("Type: %d, PM: %d, SC: %d, RC: %d\n", buf_type, prior_mod, send_core, rec_core);
- xTaskCreatePinnedToCore(send_task, "send tsk", 2048, (void *)&task_args, 10 + prior_mod, NULL, send_core);
- xTaskCreatePinnedToCore(rec_task, "rec tsk", 2048, (void *)&task_args, 10, NULL, rec_core);
- xSemaphoreTake(tasks_done, portMAX_DELAY);
- vTaskDelay(5); //Allow idle to clean up
- }
- }
- }
- //Delete ring buffer
- vRingbufferDelete(task_args.buffer);
- vTaskDelay(10);
- }
- cleanup();
- }
- #if ( configSUPPORT_STATIC_ALLOCATION == 1 )
- TEST_CASE("Test static ring buffer SMP", "[esp_ringbuf]")
- {
- setup();
- //Iterate through buffer types (No split, split, then byte buff)
- for (RingbufferType_t buf_type = 0; buf_type < RINGBUF_TYPE_MAX; buf_type++) {
- StaticRingbuffer_t *buffer_struct;
- uint8_t *buffer_storage;
- //Allocate memory and create semaphores
- #if CONFIG_SPIRAM_USE_CAPS_ALLOC //When SPIRAM can only be allocated using heap_caps_malloc()
- buffer_struct = (StaticRingbuffer_t *)heap_caps_malloc(sizeof(StaticRingbuffer_t), MALLOC_CAP_SPIRAM);
- buffer_storage = (uint8_t *)heap_caps_malloc(sizeof(uint8_t)*CONT_DATA_TEST_BUFF_LEN, MALLOC_CAP_SPIRAM);
- #else //Case where SPIRAM is disabled or when SPIRAM is allocatable through malloc()
- buffer_struct = (StaticRingbuffer_t *)malloc(sizeof(StaticRingbuffer_t));
- buffer_storage = (uint8_t *)malloc(sizeof(uint8_t)*CONT_DATA_TEST_BUFF_LEN);
- #endif
- TEST_ASSERT(buffer_struct != NULL && buffer_storage != NULL);
- //Create buffer
- task_args_t task_args;
- task_args.buffer = xRingbufferCreateStatic(CONT_DATA_TEST_BUFF_LEN, buf_type, buffer_storage, buffer_struct); //Create buffer of selected type
- task_args.type = buf_type;
- TEST_ASSERT_MESSAGE(task_args.buffer != NULL, "Failed to create ring buffer");
- for (int prior_mod = -1; prior_mod < 2; prior_mod++) { //Test different relative priorities
- //Test every permutation of core affinity
- for (int send_core = 0; send_core < portNUM_PROCESSORS; send_core++) {
- for (int rec_core = 0; rec_core < portNUM_PROCESSORS; rec_core ++) {
- esp_rom_printf("Type: %d, PM: %d, SC: %d, RC: %d\n", buf_type, prior_mod, send_core, rec_core);
- xTaskCreatePinnedToCore(send_task, "send tsk", 2048, (void *)&task_args, 10 + prior_mod, NULL, send_core);
- xTaskCreatePinnedToCore(rec_task, "rec tsk", 2048, (void *)&task_args, 10, NULL, rec_core);
- xSemaphoreTake(tasks_done, portMAX_DELAY);
- vTaskDelay(5); //Allow idle to clean up
- }
- }
- }
- //Delete ring buffer
- vRingbufferDelete(task_args.buffer);
- //Deallocate memory
- free(buffer_storage);
- free(buffer_struct);
- vTaskDelay(10);
- }
- cleanup();
- }
- #endif
- /* -------------------------- Test ring buffer IRAM ------------------------- */
- static IRAM_ATTR __attribute__((noinline)) bool iram_ringbuf_test(void)
- {
- bool result = true;
- RingbufHandle_t handle = xRingbufferCreate(CONT_DATA_TEST_BUFF_LEN, RINGBUF_TYPE_NOSPLIT);
- result = result && (handle != NULL);
- spi_flash_guard_get()->start(); // Disables flash cache
- xRingbufferGetMaxItemSize(handle);
- spi_flash_guard_get()->end(); // Re-enables flash cache
- vRingbufferDelete(handle);
- return result;
- }
- TEST_CASE("Test ringbuffer functions work with flash cache disabled", "[esp_ringbuf]")
- {
- TEST_ASSERT( iram_ringbuf_test() );
- }
|