tool/mbed/mbed-sdk/libraries/tests/rtos/cmsis/queue/main.cpp

   1 #include "mbed.h"
   2 #include "cmsis_os.h"
   3
   4 typedef struct {
   5     float    voltage;   /* AD result of measured voltage */
   6     float    current;   /* AD result of measured current */
   7     uint32_t counter;   /* A counter value               */
   8 } message_t;
   9
  10 osPoolDef(mpool, 16, message_t);
  11 osPoolId  mpool;
  12
  13 osMessageQDef(queue, 16, message_t);
  14 osMessageQId  queue;
  15
  16 void send_thread (void const *argument) {
  17     uint32_t i = 0;
  18     while (true) {
  19         i++; // fake data update
  20         message_t *message = (message_t*)osPoolAlloc(mpool);
  21         message->voltage = (i * 0.1) * 33;
  22         message->current = (i * 0.1) * 11;
  23         message->counter = i;
  24         osMessagePut(queue, (uint32_t)message, osWaitForever);
  25         osDelay(1000);
  26     }
  27 }
  28
  29 osThreadDef(send_thread, osPriorityNormal, DEFAULT_STACK_SIZE);
  30
  31 int main (void) {
  32     mpool = osPoolCreate(osPool(mpool));
  33     queue = osMessageCreate(osMessageQ(queue), NULL);
  34
  35     osThreadCreate(osThread(send_thread), NULL);
  36
  37     while (true) {
  38         osEvent evt = osMessageGet(queue, osWaitForever);
  39         if (evt.status == osEventMessage) {
  40             message_t *message = (message_t*)evt.value.p;
  41             printf("\nVoltage: %.2f V\n\r"   , message->voltage);
  42             printf("Current: %.2f A\n\r"     , message->current);
  43             printf("Number of cycles: %u\n\r", message->counter);
  44
  45             osPoolFree(mpool, message);
  46         }
  47     }
  48 }