Maxim nexpaq / nexpaq_dev

Preliminary main mbed library for nexpaq development

TESTS/mbedmicro-rtos-mbed/queue/main.cpp@0:6c56fb4bc5f0, 2016-11-04 (annotated)

Committer:
nexpaq
Date:
Fri Nov 04 20:27:58 2016 +0000
Revision:
0:6c56fb4bc5f0
Moving to library for sharing updates

Who changed what in which revision?

UserRevisionLine numberNew contents of line
nexpaq 0:6c56fb4bc5f0 1 #include "mbed.h"
nexpaq 0:6c56fb4bc5f0 2 #include "greentea-client/test_env.h"
nexpaq 0:6c56fb4bc5f0 3 #include "rtos.h"
nexpaq 0:6c56fb4bc5f0 4
nexpaq 0:6c56fb4bc5f0 5 #if defined(MBED_RTOS_SINGLE_THREAD)
nexpaq 0:6c56fb4bc5f0 6 #error [NOT_SUPPORTED] test not supported
nexpaq 0:6c56fb4bc5f0 7 #endif
nexpaq 0:6c56fb4bc5f0 8
nexpaq 0:6c56fb4bc5f0 9 typedef struct {
nexpaq 0:6c56fb4bc5f0 10 float voltage; /* AD result of measured voltage */
nexpaq 0:6c56fb4bc5f0 11 float current; /* AD result of measured current */
nexpaq 0:6c56fb4bc5f0 12 uint32_t counter; /* A counter value */
nexpaq 0:6c56fb4bc5f0 13 } message_t;
nexpaq 0:6c56fb4bc5f0 14
nexpaq 0:6c56fb4bc5f0 15 #define CREATE_VOLTAGE(COUNTER) (COUNTER * 0.1) * 33
nexpaq 0:6c56fb4bc5f0 16 #define CREATE_CURRENT(COUNTER) (COUNTER * 0.1) * 11
nexpaq 0:6c56fb4bc5f0 17 #define QUEUE_SIZE 16
nexpaq 0:6c56fb4bc5f0 18 #define QUEUE_PUT_DELAY 100
nexpaq 0:6c56fb4bc5f0 19
nexpaq 0:6c56fb4bc5f0 20 /*
nexpaq 0:6c56fb4bc5f0 21 * The stack size is defined in cmsis_os.h mainly dependent on the underlying toolchain and
nexpaq 0:6c56fb4bc5f0 22 * the C standard library. For GCC, ARM_STD and IAR it is defined with a size of 2048 bytes
nexpaq 0:6c56fb4bc5f0 23 * and for ARM_MICRO 512. Because of reduce RAM size some targets need a reduced stacksize.
nexpaq 0:6c56fb4bc5f0 24 */
nexpaq 0:6c56fb4bc5f0 25 #if (defined(TARGET_STM32L053R8) || defined(TARGET_STM32L053C8)) && defined(TOOLCHAIN_GCC)
nexpaq 0:6c56fb4bc5f0 26 #define STACK_SIZE DEFAULT_STACK_SIZE/4
nexpaq 0:6c56fb4bc5f0 27 #elif (defined(TARGET_STM32F030R8)) && defined(TOOLCHAIN_GCC)
nexpaq 0:6c56fb4bc5f0 28 #define STACK_SIZE DEFAULT_STACK_SIZE/4
nexpaq 0:6c56fb4bc5f0 29 #elif (defined(TARGET_STM32F030R8)) && defined(TOOLCHAIN_IAR)
nexpaq 0:6c56fb4bc5f0 30 #define STACK_SIZE DEFAULT_STACK_SIZE/2
nexpaq 0:6c56fb4bc5f0 31 #elif (defined(TARGET_EFM32HG_STK3400)) && !defined(TOOLCHAIN_ARM_MICRO)
nexpaq 0:6c56fb4bc5f0 32 #define STACK_SIZE 512
nexpaq 0:6c56fb4bc5f0 33 #elif (defined(TARGET_EFM32LG_STK3600) || defined(TARGET_EFM32WG_STK3800) || defined(TARGET_EFM32PG_STK3401)) && !defined(TOOLCHAIN_ARM_MICRO)
nexpaq 0:6c56fb4bc5f0 34 #define STACK_SIZE 768
nexpaq 0:6c56fb4bc5f0 35 #elif (defined(TARGET_EFM32GG_STK3700)) && !defined(TOOLCHAIN_ARM_MICRO)
nexpaq 0:6c56fb4bc5f0 36 #define STACK_SIZE 1536
nexpaq 0:6c56fb4bc5f0 37 #elif defined(TARGET_MCU_NRF51822) || defined(TARGET_MCU_NRF52832)
nexpaq 0:6c56fb4bc5f0 38 #define STACK_SIZE 768
nexpaq 0:6c56fb4bc5f0 39 #else
nexpaq 0:6c56fb4bc5f0 40 #define STACK_SIZE DEFAULT_STACK_SIZE
nexpaq 0:6c56fb4bc5f0 41 #endif
nexpaq 0:6c56fb4bc5f0 42
nexpaq 0:6c56fb4bc5f0 43 MemoryPool<message_t, QUEUE_SIZE> mpool;
nexpaq 0:6c56fb4bc5f0 44 Queue<message_t, QUEUE_SIZE> queue;
nexpaq 0:6c56fb4bc5f0 45
nexpaq 0:6c56fb4bc5f0 46 /* Send Thread */
nexpaq 0:6c56fb4bc5f0 47 void send_thread (void const *argument) {
nexpaq 0:6c56fb4bc5f0 48 static uint32_t i = 10;
nexpaq 0:6c56fb4bc5f0 49 while (true) {
nexpaq 0:6c56fb4bc5f0 50 i++; // Fake data update
nexpaq 0:6c56fb4bc5f0 51 message_t *message = mpool.alloc();
nexpaq 0:6c56fb4bc5f0 52 message->voltage = CREATE_VOLTAGE(i);
nexpaq 0:6c56fb4bc5f0 53 message->current = CREATE_CURRENT(i);
nexpaq 0:6c56fb4bc5f0 54 message->counter = i;
nexpaq 0:6c56fb4bc5f0 55 queue.put(message);
nexpaq 0:6c56fb4bc5f0 56 Thread::wait(QUEUE_PUT_DELAY);
nexpaq 0:6c56fb4bc5f0 57 }
nexpaq 0:6c56fb4bc5f0 58 }
nexpaq 0:6c56fb4bc5f0 59
nexpaq 0:6c56fb4bc5f0 60 int main (void) {
nexpaq 0:6c56fb4bc5f0 61 GREENTEA_SETUP(20, "default_auto");
nexpaq 0:6c56fb4bc5f0 62
nexpaq 0:6c56fb4bc5f0 63 Thread thread(send_thread, NULL, osPriorityNormal, STACK_SIZE);
nexpaq 0:6c56fb4bc5f0 64 bool result = true;
nexpaq 0:6c56fb4bc5f0 65 int result_counter = 0;
nexpaq 0:6c56fb4bc5f0 66
nexpaq 0:6c56fb4bc5f0 67 while (true) {
nexpaq 0:6c56fb4bc5f0 68 osEvent evt = queue.get();
nexpaq 0:6c56fb4bc5f0 69 if (evt.status == osEventMessage) {
nexpaq 0:6c56fb4bc5f0 70 message_t *message = (message_t*)evt.value.p;
nexpaq 0:6c56fb4bc5f0 71 const float expected_voltage = CREATE_VOLTAGE(message->counter);
nexpaq 0:6c56fb4bc5f0 72 const float expected_current = CREATE_CURRENT(message->counter);
nexpaq 0:6c56fb4bc5f0 73 // Check using macros if received values correspond to values sent via queue
nexpaq 0:6c56fb4bc5f0 74 bool expected_values = (expected_voltage == message->voltage) &&
nexpaq 0:6c56fb4bc5f0 75 (expected_current == message->current);
nexpaq 0:6c56fb4bc5f0 76 result = result && expected_values;
nexpaq 0:6c56fb4bc5f0 77 const char *result_msg = expected_values ? "OK" : "FAIL";
nexpaq 0:6c56fb4bc5f0 78 printf("%3d %.2fV %.2fA ... [%s]\r\n", message->counter,
nexpaq 0:6c56fb4bc5f0 79 message->voltage,
nexpaq 0:6c56fb4bc5f0 80 message->current,
nexpaq 0:6c56fb4bc5f0 81 result_msg);
nexpaq 0:6c56fb4bc5f0 82 mpool.free(message);
nexpaq 0:6c56fb4bc5f0 83 if (result == false || ++result_counter == QUEUE_SIZE) {
nexpaq 0:6c56fb4bc5f0 84 break;
nexpaq 0:6c56fb4bc5f0 85 }
nexpaq 0:6c56fb4bc5f0 86 }
nexpaq 0:6c56fb4bc5f0 87 }
nexpaq 0:6c56fb4bc5f0 88 GREENTEA_TESTSUITE_RESULT(result);
nexpaq 0:6c56fb4bc5f0 89 return 0;
nexpaq 0:6c56fb4bc5f0 90 }