136 lines
4.4 KiB
C
136 lines
4.4 KiB
C
/*----------------------------------------------------------------------------
|
|
* CMSIS-RTOS 'main' function template
|
|
*---------------------------------------------------------------------------*/
|
|
#include "stm32f7xx_hal.h"
|
|
#include "RTE_Components.h"
|
|
#include CMSIS_device_header
|
|
#include "cmsis_os2.h"
|
|
#include "ext_led.h"
|
|
#include "ext_uart.h"
|
|
#include "ext_buttons.h"
|
|
#include "ext_keyboard.h"
|
|
#include "string.h"
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
|
|
#ifdef RTE_Compiler_EventRecorder
|
|
#include "EventRecorder.h"
|
|
#endif
|
|
|
|
osThreadId_t thread1,thread2;
|
|
osMessageQueueId_t msgQueue;
|
|
|
|
const osThreadAttr_t thread1_attr = {
|
|
.stack_size = 1024, // Create the thread stack size
|
|
.priority = osPriorityNormal, //Set initial thread priority to high
|
|
.name = "Producer",
|
|
};
|
|
const osThreadAttr_t thread2_attr = {
|
|
.stack_size = 1024, // Create the thread stack size
|
|
.priority = osPriorityNormal, //Set initial thread priority to high
|
|
.name = "Consumer",
|
|
};
|
|
|
|
const osMessageQueueAttr_t msgQueue_attr = {
|
|
.name = "MsgQueue",
|
|
};
|
|
|
|
|
|
//------------------------------------------------------------------------------
|
|
// Setup system clock to 216MHz
|
|
//------------------------------------------------------------------------------
|
|
void SystemClock_Config (void) {
|
|
RCC_ClkInitTypeDef RCC_ClkInitStruct;
|
|
RCC_OscInitTypeDef RCC_OscInitStruct;
|
|
|
|
/* Enable HSE Oscillator and activate PLL with HSE as source */
|
|
RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
|
|
RCC_OscInitStruct.HSEState = RCC_HSE_ON;
|
|
RCC_OscInitStruct.HSIState = RCC_HSI_OFF;
|
|
RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
|
|
RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
|
|
RCC_OscInitStruct.PLL.PLLM = 25;
|
|
RCC_OscInitStruct.PLL.PLLN = 432;
|
|
RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2;
|
|
RCC_OscInitStruct.PLL.PLLQ = 9;
|
|
HAL_RCC_OscConfig(&RCC_OscInitStruct);
|
|
|
|
/* Activate the OverDrive to reach the 216 MHz Frequency */
|
|
HAL_PWREx_EnableOverDrive();
|
|
|
|
/* Select PLL as system clock source and configure the HCLK, PCLK1 and PCLK2 clocks dividers */
|
|
RCC_ClkInitStruct.ClockType = (RCC_CLOCKTYPE_SYSCLK | RCC_CLOCKTYPE_HCLK | RCC_CLOCKTYPE_PCLK1 | RCC_CLOCKTYPE_PCLK2);
|
|
RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
|
|
RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
|
|
RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV4;
|
|
RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV2;
|
|
HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_7);
|
|
}
|
|
|
|
|
|
|
|
/*----------------------------------------------------------------------------
|
|
* Thread Producer
|
|
*---------------------------------------------------------------------------*/
|
|
__NO_RETURN static void Thread_Producer (void *argument) {
|
|
osMessageQueueId_t* queue = (osMessageQueueId_t*)argument;
|
|
uint32_t counter = 0;
|
|
|
|
for(;;) {
|
|
osStatus_t statusQueue = osMessageQueuePut(*queue, &counter, 1, 0);
|
|
if(statusQueue != osOK) {
|
|
// TODO generate error
|
|
}
|
|
counter++;
|
|
osDelay(100);
|
|
}
|
|
|
|
}
|
|
|
|
/*----------------------------------------------------------------------------
|
|
* Thread Consumer
|
|
*---------------------------------------------------------------------------*/
|
|
__NO_RETURN static void Thread_Consumer (void *argument) {
|
|
osMessageQueueId_t* queue = (osMessageQueueId_t*)argument;
|
|
uint8_t counter = 1;
|
|
|
|
for(;;) {
|
|
uint32_t msg;
|
|
osStatus_t statusQueue;
|
|
|
|
do {
|
|
statusQueue = osMessageQueueGet(*queue, &msg, NULL, 0);
|
|
printf("Value is %d\r\n", msg);
|
|
} while(statusQueue != osErrorResource);
|
|
if(++counter > 10) counter = 1;
|
|
osDelay(counter*100);
|
|
}
|
|
}
|
|
|
|
|
|
int main (void) {
|
|
|
|
// System Initialization
|
|
SystemClock_Config();
|
|
SystemCoreClockUpdate();
|
|
#ifdef RTE_Compiler_EventRecorder
|
|
// Initialize and start Event Recorder
|
|
// Ext_UART_Init(9600);
|
|
EventRecorderInitialize(EventRecordAll, 1U);
|
|
#endif
|
|
|
|
osKernelInitialize(); // Initialize CMSIS-RTOS
|
|
msgQueue = osMessageQueueNew(8, 4, &msgQueue_attr);
|
|
thread1 = osThreadNew(Thread_Producer, &msgQueue, &thread1_attr);
|
|
thread2 = osThreadNew(Thread_Consumer, &msgQueue, &thread2_attr);
|
|
|
|
//----------------------------------------------------------------------------------------------
|
|
// get names are placed for TraceAlyzer visualisation
|
|
//----------------------------------------------------------------------------------------------
|
|
osThreadGetName(thread1);
|
|
osThreadGetName(thread2);
|
|
osMessageQueueGetName(msgQueue);
|
|
osKernelStart(); // Start thread execution
|
|
for (;;) {}
|
|
}
|