CMSIS_5/CMSIS/RTOS2/RTX/Examples/MsgQueue/main.c

/* -------------------------------------------------------------------------- 
 * Copyright (c) 2013-2016 ARM Limited. All rights reserved.
 *
 * SPDX-License-Identifier: Apache-2.0
 *
 * Licensed under the Apache License, Version 2.0 (the License); you may
 * not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 * www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an AS IS BASIS, WITHOUT
 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *
 *      Name:    main.c
 *      Purpose: RTX example program
 *
 *---------------------------------------------------------------------------*/

#include <stdio.h>

#include "RTE_Components.h"
#include  CMSIS_device_header
#include "cmsis_os2.h"

#ifdef RTE_Compiler_EventRecorder
#include "EventRecorder.h"
#endif

int main (void);
void app_main (void *argument);
void app_msg (void *argument);

typedef struct msg_s {
  uint8_t cmd;
  uint8_t len;
  uint8_t data[8];
} msg_t;

static osMessageQueueId_t msgQueue;

static const osThreadAttr_t msgAttr = {
  .stack_size = 400U
};

/*----------------------------------------------------------------------------
 * Application main thread
 *---------------------------------------------------------------------------*/

void app_main (void *argument) {
  (void)argument;

  osStatus_t status;
  uint32_t cnt = 0UL; 
  msg_t msg = {
    .cmd = 1U,
    .len = 4U,
    .data = { 0 }
  };

  while(1) {
    // Produce a new message and put it to the queue
    ++cnt;
    *((uint32_t*)msg.data) = cnt;
    status = osMessageQueuePut(msgQueue, &msg, 0U, osWaitForever);
    if (status != osOK) {
      printf("app_main: osMessageQueuePut failed.\n");
    }

    // Defer message creation
    status = osDelay(osMessageQueueGetCount(msgQueue)*100U);
    if (status != osOK) {
      printf("app_main: osDelay failed.\n");
    }
  }
}

/*----------------------------------------------------------------------------
 * Application message receiver thread
 *---------------------------------------------------------------------------*/

void app_msg (void *argument) {
  (void)argument;

  osStatus_t status;
  uint32_t cnt;
  msg_t msg;

  while(1) {
    // Defer message processing
    status = osDelay(osMessageQueueGetSpace(msgQueue)*100U);
    if (status != osOK) {
      printf("app_msg: osDelay failed.\n");
    }

    // Wait forever until a message could be received
    status = osMessageQueueGet(msgQueue, &msg, NULL, osWaitForever);
    if (status != osOK) {
      printf("app_msg: osMessageQueuePut failed.\n");
    } else {
      if (msg.len == 4U) {
        cnt = *((uint32_t*)msg.data);
      }
      printf("app_msg: received [cmd = %d, data = 0x%0X]\n", msg.cmd, cnt);
    }
  }
}

/*----------------------------------------------------------------------------
 * Main entry
 *---------------------------------------------------------------------------*/

int main (void) {

  // System Initialization
  SystemCoreClockUpdate();
#ifdef RTE_Compiler_EventRecorder
  // Initialize and start Event Recorder
  EventRecorderInitialize(EventRecordError, 1U);
  EventRecorderEnable    (EventRecordAll, 0xFE, 0xFE); 
#endif
  // ...

  osKernelInitialize();                                   // Initialize CMSIS-RTOS
  osThreadNew(app_main, NULL, NULL);                      // Create application main thread
  osThreadNew(app_msg, NULL, &msgAttr);                   // Create message receiver thread
  msgQueue = osMessageQueueNew(10, sizeof(msg_t), NULL);  // Create message queue for up to 10 messages of type msg_t
  osKernelStart();                                        // Start thread execution
  for (;;) {}
}