diff options
Diffstat (limited to 'Projects/NUCLEO-WB35CE/Applications/FreeRTOS/FreeRTOS_Queues/Src/main.c')
| -rw-r--r-- | Projects/NUCLEO-WB35CE/Applications/FreeRTOS/FreeRTOS_Queues/Src/main.c | 355 |
1 files changed, 355 insertions, 0 deletions
diff --git a/Projects/NUCLEO-WB35CE/Applications/FreeRTOS/FreeRTOS_Queues/Src/main.c b/Projects/NUCLEO-WB35CE/Applications/FreeRTOS/FreeRTOS_Queues/Src/main.c new file mode 100644 index 000000000..126a89e34 --- /dev/null +++ b/Projects/NUCLEO-WB35CE/Applications/FreeRTOS/FreeRTOS_Queues/Src/main.c @@ -0,0 +1,355 @@ +/* USER CODE BEGIN Header */ +/** + ****************************************************************************** + * @file FreeRTOS/FreeRTOS_Queues/Src/main.c + * @author MCD Application Team + * @brief Main program body + ****************************************************************************** + * @attention + * + * <h2><center>© Copyright (c) 2019 STMicroelectronics. + * All rights reserved.</center></h2> + * + * This software component is licensed by ST under Ultimate Liberty license + * SLA0044, the "License"; You may not use this file except in compliance with + * the License. You may obtain a copy of the License at: + * www.st.com/SLA0044 + * + ****************************************************************************** + */ +/* USER CODE END Header */ + +/* Includes ------------------------------------------------------------------*/ +#include "main.h" +#include "cmsis_os.h" + +/* Private includes ----------------------------------------------------------*/ +/* USER CODE BEGIN Includes */ + +/* USER CODE END Includes */ + +/* Private typedef -----------------------------------------------------------*/ +/* USER CODE BEGIN PTD */ + +/* USER CODE END PTD */ + +/* Private define ------------------------------------------------------------*/ +/* USER CODE BEGIN PD */ + +/* USER CODE END PD */ + +/* Private macro -------------------------------------------------------------*/ +/* USER CODE BEGIN PM */ +#define blckqSTACK_SIZE configMINIMAL_STACK_SIZE +/* USER CODE END PM */ + +/* Private variables ---------------------------------------------------------*/ +osThreadId MessageQueueProHandle; +osThreadId MessageQueueConHandle; +osMessageQId osQueueHandle; +/* USER CODE BEGIN PV */ +uint32_t ProducerValue = 0, ConsumerValue = 0; +__IO uint32_t ProducerErrors = 0, ConsumerErrors = 0; +/* USER CODE END PV */ + +/* Private function prototypes -----------------------------------------------*/ +void SystemClock_Config(void); +void MessageQueueProducer(void const * argument); +void MessageQueueConsumer(void const * argument); + +/* USER CODE BEGIN PFP */ + +/* USER CODE END PFP */ + +/* Private user code ---------------------------------------------------------*/ +/* USER CODE BEGIN 0 */ + +/* USER CODE END 0 */ + +/** + * @brief The application entry point. + * @retval int + */ +int main(void) +{ + /* USER CODE BEGIN 1 */ + /* STM32WBxx HAL library initialization: + - Configure the Flash prefetch + - Systick timer is configured by default as source of time base, but user + can eventually implement his proper time base source (a general purpose + timer for example or other time source), keeping in mind that Time base + duration should be kept 1ms since PPP_TIMEOUT_VALUEs are defined and + handled in milliseconds basis. + - Set NVIC Group Priority to 4 + - Low Level Initialization + */ + /* USER CODE END 1 */ + + /* MCU Configuration--------------------------------------------------------*/ + + /* Reset of all peripherals, Initializes the Flash interface and the Systick. */ + HAL_Init(); + + /* USER CODE BEGIN Init */ + + /* USER CODE END Init */ + + /* Configure the system clock */ + SystemClock_Config(); + + /* USER CODE BEGIN SysInit */ + /* Initialize LEDs */ + BSP_LED_Init(LED2); + BSP_LED_Init(LED3); + + /* USER CODE END SysInit */ + + /* Initialize all configured peripherals */ + /* USER CODE BEGIN 2 */ + + /* USER CODE END 2 */ + + /* USER CODE BEGIN RTOS_MUTEX */ + + /* USER CODE END RTOS_MUTEX */ + + /* USER CODE BEGIN RTOS_SEMAPHORES */ + + /* USER CODE END RTOS_SEMAPHORES */ + + /* USER CODE BEGIN RTOS_TIMERS */ + + /* USER CODE END RTOS_TIMERS */ + + /* Create the queue(s) */ + /* definition and creation of osQueue */ + osMessageQDef(osQueue, 1, uint16_t); + osQueueHandle = osMessageCreate(osMessageQ(osQueue), NULL); + + /* USER CODE BEGIN RTOS_QUEUES */ + + /* USER CODE END RTOS_QUEUES */ + + /* Create the thread(s) */ + /* definition and creation of MessageQueuePro */ + osThreadDef(MessageQueuePro, MessageQueueProducer, osPriorityBelowNormal, 0, 128); + MessageQueueProHandle = osThreadCreate(osThread(MessageQueuePro), NULL); + + /* definition and creation of MessageQueueCon */ + osThreadDef(MessageQueueCon, MessageQueueConsumer, osPriorityBelowNormal, 0, 128); + MessageQueueConHandle = osThreadCreate(osThread(MessageQueueCon), NULL); + + /* USER CODE BEGIN RTOS_THREADS */ + + /* USER CODE END RTOS_THREADS */ + + /* Start scheduler */ + osKernelStart(); + + /* We should never get here as control is now taken by the scheduler */ + /* Infinite loop */ + /* USER CODE BEGIN WHILE */ + while (1) + { + /* USER CODE END WHILE */ + + /* USER CODE BEGIN 3 */ + } + /* USER CODE END 3 */ +} + +/** + * @brief System Clock Configuration + * @retval None + */ +void SystemClock_Config(void) +{ + RCC_OscInitTypeDef RCC_OscInitStruct = {0}; + RCC_ClkInitTypeDef RCC_ClkInitStruct = {0}; + RCC_PeriphCLKInitTypeDef PeriphClkInitStruct = {0}; + + /** Configure the main internal regulator output voltage + */ + __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1); + /** Initializes the CPU, AHB and APB busses clocks + */ + RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI|RCC_OSCILLATORTYPE_MSI; + RCC_OscInitStruct.HSIState = RCC_HSI_ON; + RCC_OscInitStruct.MSIState = RCC_MSI_ON; + RCC_OscInitStruct.HSICalibrationValue = RCC_HSICALIBRATION_DEFAULT; + RCC_OscInitStruct.MSICalibrationValue = RCC_MSICALIBRATION_DEFAULT; + RCC_OscInitStruct.MSIClockRange = RCC_MSIRANGE_6; + RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON; + RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_MSI; + RCC_OscInitStruct.PLL.PLLM = RCC_PLLM_DIV1; + RCC_OscInitStruct.PLL.PLLN = 32; + RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2; + RCC_OscInitStruct.PLL.PLLR = RCC_PLLR_DIV2; + RCC_OscInitStruct.PLL.PLLQ = RCC_PLLQ_DIV2; + if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK) + { + Error_Handler(); + } + /** Configure the SYSCLKSource, HCLK, PCLK1 and PCLK2 clocks dividers + */ + RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK4|RCC_CLOCKTYPE_HCLK2 + |RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK + |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2; + RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK; + RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1; + RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV1; + RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1; + RCC_ClkInitStruct.AHBCLK2Divider = RCC_SYSCLK_DIV2; + RCC_ClkInitStruct.AHBCLK4Divider = RCC_SYSCLK_DIV1; + + if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_3) != HAL_OK) + { + Error_Handler(); + } + /** Initializes the peripherals clocks + */ + PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_SMPS; + PeriphClkInitStruct.SmpsClockSelection = RCC_SMPSCLKSOURCE_HSI; + PeriphClkInitStruct.SmpsDivSelection = RCC_SMPSCLKDIV_RANGE1; + if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct) != HAL_OK) + { + Error_Handler(); + } + /* USER CODE BEGIN Smps */ + + /* USER CODE END Smps */ +} + +/* USER CODE BEGIN 4 */ + +/* USER CODE END 4 */ + +/* USER CODE BEGIN Header_MessageQueueProducer */ +/** + * @brief Function implementing the MessageQueuePro thread. + * @param argument: Not used + * @retval None + */ +/* USER CODE END Header_MessageQueueProducer */ +void MessageQueueProducer(void const * argument) +{ + /* USER CODE BEGIN 5 */ + /* Infinite loop */ + for (;;) + { + if (osMessagePut(osQueueHandle, ProducerValue, 100) != osOK) + { + ++ProducerErrors; + + /* Toggle LED3 to indicate error */ + BSP_LED_Toggle(LED3); + } + else + { + /* Increment the variable we are going to post next time round. The + consumer will expect the numbers to follow in numerical order */ + ++ProducerValue; + + /* Toggle LED2 to indicate a correct number received */ + BSP_LED_Toggle(LED2); + osDelay(1000); + } + } + /* USER CODE END 5 */ +} + +/* USER CODE BEGIN Header_MessageQueueConsumer */ +/** +* @brief Function implementing the MessageQueueCon thread. + * @param argument: Not used + * @retval None + */ +/* USER CODE END Header_MessageQueueConsumer */ +void MessageQueueConsumer(void const * argument) +{ + /* USER CODE BEGIN MessageQueueConsumer */ + osEvent event; + + for (;;) + { + /* Get the message from the queue */ + event = osMessageGet(osQueueHandle, 100); + + if (event.status == osEventMessage) + { + if (event.value.v != ConsumerValue) + { + /* Catch-up */ + ConsumerValue = event.value.v; + + ++ConsumerErrors; + + /* Toggle LED3 to indicate error */ + BSP_LED_Toggle(LED3); + } + else + { + /* Increment the value we expect to remove from the queue next time + round */ + ++ConsumerValue; + } + } + } + /* USER CODE END MessageQueueConsumer */ +} + +/** + * @brief Period elapsed callback in non blocking mode + * @note This function is called when TIM17 interrupt took place, inside + * HAL_TIM_IRQHandler(). It makes a direct call to HAL_IncTick() to increment + * a global variable "uwTick" used as application time base. + * @param htim : TIM handle + * @retval None + */ +void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) +{ + /* USER CODE BEGIN Callback 0 */ + + /* USER CODE END Callback 0 */ + if (htim->Instance == TIM17) { + HAL_IncTick(); + } + /* USER CODE BEGIN Callback 1 */ + + /* USER CODE END Callback 1 */ +} + +/** + * @brief This function is executed in case of error occurrence. + * @retval None + */ +void Error_Handler(void) +{ + /* USER CODE BEGIN Error_Handler_Debug */ + /* User can add his own implementation to report the HAL error return state */ + + /* USER CODE END Error_Handler_Debug */ +} + +#ifdef USE_FULL_ASSERT +/** + * @brief Reports the name of the source file and the source line number + * where the assert_param error has occurred. + * @param file: pointer to the source file name + * @param line: assert_param error line source number + * @retval None + */ +void assert_failed(uint8_t *file, uint32_t line) +{ + /* USER CODE BEGIN 6 */ + /* User can add his own implementation to report the file name and line number, + tex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */ + + /* Infinite loop */ + while (1) + {} + /* USER CODE END 6 */ +} +#endif /* USE_FULL_ASSERT */ + +/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/ |