Add FreeRTOS and SPI mes and UART output
This commit is contained in:
140
Core/Inc/FreeRTOSConfig.h
Normal file
140
Core/Inc/FreeRTOSConfig.h
Normal file
@@ -0,0 +1,140 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/*
|
||||
* FreeRTOS Kernel V10.3.1
|
||||
* Portion Copyright (C) 2017 Amazon.com, Inc. or its affiliates. All Rights Reserved.
|
||||
* Portion Copyright (C) 2019 StMicroelectronics, Inc. All Rights Reserved.
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining a copy of
|
||||
* this software and associated documentation files (the "Software"), to deal in
|
||||
* the Software without restriction, including without limitation the rights to
|
||||
* use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
|
||||
* the Software, and to permit persons to whom the Software is furnished to do so,
|
||||
* subject to the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be included in all
|
||||
* copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
|
||||
* FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
|
||||
* COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
|
||||
* IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
|
||||
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||
*
|
||||
* http://www.FreeRTOS.org
|
||||
* http://aws.amazon.com/freertos
|
||||
*
|
||||
* 1 tab == 4 spaces!
|
||||
*/
|
||||
/* USER CODE END Header */
|
||||
|
||||
#ifndef FREERTOS_CONFIG_H
|
||||
#define FREERTOS_CONFIG_H
|
||||
|
||||
/*-----------------------------------------------------------
|
||||
* Application specific definitions.
|
||||
*
|
||||
* These definitions should be adjusted for your particular hardware and
|
||||
* application requirements.
|
||||
*
|
||||
* These parameters and more are described within the 'configuration' section of the
|
||||
* FreeRTOS API documentation available on the FreeRTOS.org web site.
|
||||
*
|
||||
* See http://www.freertos.org/a00110.html
|
||||
*----------------------------------------------------------*/
|
||||
|
||||
/* USER CODE BEGIN Includes */
|
||||
/* Section where include file can be added */
|
||||
/* USER CODE END Includes */
|
||||
|
||||
/* Ensure definitions are only used by the compiler, and not by the assembler. */
|
||||
#if defined(__ICCARM__) || defined(__CC_ARM) || defined(__GNUC__)
|
||||
#include <stdint.h>
|
||||
extern uint32_t SystemCoreClock;
|
||||
void xPortSysTickHandler(void);
|
||||
#endif
|
||||
#define configENABLE_FPU 0
|
||||
#define configENABLE_MPU 0
|
||||
|
||||
#define configUSE_PREEMPTION 1
|
||||
#define configSUPPORT_STATIC_ALLOCATION 1
|
||||
#define configSUPPORT_DYNAMIC_ALLOCATION 1
|
||||
#define configUSE_IDLE_HOOK 0
|
||||
#define configUSE_TICK_HOOK 0
|
||||
#define configCPU_CLOCK_HZ ( SystemCoreClock )
|
||||
#define configTICK_RATE_HZ ((TickType_t)1000)
|
||||
#define configMAX_PRIORITIES ( 7 )
|
||||
#define configMINIMAL_STACK_SIZE ((uint16_t)128)
|
||||
#define configTOTAL_HEAP_SIZE ((size_t)3000)
|
||||
#define configMAX_TASK_NAME_LEN ( 16 )
|
||||
#define configUSE_16_BIT_TICKS 0
|
||||
#define configUSE_MUTEXES 1
|
||||
#define configQUEUE_REGISTRY_SIZE 8
|
||||
#define configUSE_PORT_OPTIMISED_TASK_SELECTION 1
|
||||
/* USER CODE BEGIN MESSAGE_BUFFER_LENGTH_TYPE */
|
||||
/* Defaults to size_t for backward compatibility, but can be changed
|
||||
if lengths will always be less than the number of bytes in a size_t. */
|
||||
#define configMESSAGE_BUFFER_LENGTH_TYPE size_t
|
||||
/* USER CODE END MESSAGE_BUFFER_LENGTH_TYPE */
|
||||
|
||||
/* Co-routine definitions. */
|
||||
#define configUSE_CO_ROUTINES 0
|
||||
#define configMAX_CO_ROUTINE_PRIORITIES ( 2 )
|
||||
|
||||
/* Set the following definitions to 1 to include the API function, or zero
|
||||
to exclude the API function. */
|
||||
#define INCLUDE_vTaskPrioritySet 1
|
||||
#define INCLUDE_uxTaskPriorityGet 1
|
||||
#define INCLUDE_vTaskDelete 1
|
||||
#define INCLUDE_vTaskCleanUpResources 0
|
||||
#define INCLUDE_vTaskSuspend 1
|
||||
#define INCLUDE_vTaskDelayUntil 0
|
||||
#define INCLUDE_vTaskDelay 1
|
||||
#define INCLUDE_xTaskGetSchedulerState 1
|
||||
|
||||
/* Cortex-M specific definitions. */
|
||||
#ifdef __NVIC_PRIO_BITS
|
||||
/* __BVIC_PRIO_BITS will be specified when CMSIS is being used. */
|
||||
#define configPRIO_BITS __NVIC_PRIO_BITS
|
||||
#else
|
||||
#define configPRIO_BITS 4
|
||||
#endif
|
||||
|
||||
/* The lowest interrupt priority that can be used in a call to a "set priority"
|
||||
function. */
|
||||
#define configLIBRARY_LOWEST_INTERRUPT_PRIORITY 15
|
||||
|
||||
/* The highest interrupt priority that can be used by any interrupt service
|
||||
routine that makes calls to interrupt safe FreeRTOS API functions. DO NOT CALL
|
||||
INTERRUPT SAFE FREERTOS API FUNCTIONS FROM ANY INTERRUPT THAT HAS A HIGHER
|
||||
PRIORITY THAN THIS! (higher priorities are lower numeric values. */
|
||||
#define configLIBRARY_MAX_SYSCALL_INTERRUPT_PRIORITY 5
|
||||
|
||||
/* Interrupt priorities used by the kernel port layer itself. These are generic
|
||||
to all Cortex-M ports, and do not rely on any particular library functions. */
|
||||
#define configKERNEL_INTERRUPT_PRIORITY ( configLIBRARY_LOWEST_INTERRUPT_PRIORITY << (8 - configPRIO_BITS) )
|
||||
/* !!!! configMAX_SYSCALL_INTERRUPT_PRIORITY must not be set to zero !!!!
|
||||
See http://www.FreeRTOS.org/RTOS-Cortex-M3-M4.html. */
|
||||
#define configMAX_SYSCALL_INTERRUPT_PRIORITY ( configLIBRARY_MAX_SYSCALL_INTERRUPT_PRIORITY << (8 - configPRIO_BITS) )
|
||||
|
||||
/* Normal assert() semantics without relying on the provision of an assert.h
|
||||
header file. */
|
||||
/* USER CODE BEGIN 1 */
|
||||
#define configASSERT( x ) if ((x) == 0) {taskDISABLE_INTERRUPTS(); for( ;; );}
|
||||
/* USER CODE END 1 */
|
||||
|
||||
/* Definitions that map the FreeRTOS port interrupt handlers to their CMSIS
|
||||
standard names. */
|
||||
#define vPortSVCHandler SVC_Handler
|
||||
#define xPortPendSVHandler PendSV_Handler
|
||||
|
||||
/* IMPORTANT: This define is commented when used with STM32Cube firmware, when the timebase source is SysTick,
|
||||
to prevent overwriting SysTick_Handler defined within STM32Cube HAL */
|
||||
|
||||
/* #define xPortSysTickHandler SysTick_Handler */
|
||||
|
||||
/* USER CODE BEGIN Defines */
|
||||
/* Section where parameter definitions can be added (for instance, to override default ones in FreeRTOS.h) */
|
||||
/* USER CODE END Defines */
|
||||
|
||||
#endif /* FREERTOS_CONFIG_H */
|
||||
@@ -51,12 +51,12 @@ void HardFault_Handler(void);
|
||||
void MemManage_Handler(void);
|
||||
void BusFault_Handler(void);
|
||||
void UsageFault_Handler(void);
|
||||
void SVC_Handler(void);
|
||||
void DebugMon_Handler(void);
|
||||
void PendSV_Handler(void);
|
||||
void SysTick_Handler(void);
|
||||
void DMA1_Channel2_IRQHandler(void);
|
||||
void DMA1_Channel3_IRQHandler(void);
|
||||
void DMA1_Channel4_IRQHandler(void);
|
||||
void SPI1_IRQHandler(void);
|
||||
/* USER CODE BEGIN EFP */
|
||||
|
||||
/* USER CODE END EFP */
|
||||
|
||||
74
Core/Src/freertos.c
Normal file
74
Core/Src/freertos.c
Normal file
@@ -0,0 +1,74 @@
|
||||
/* USER CODE BEGIN Header */
|
||||
/**
|
||||
******************************************************************************
|
||||
* File Name : freertos.c
|
||||
* Description : Code for freertos applications
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2022 STMicroelectronics.
|
||||
* All rights reserved.
|
||||
*
|
||||
* This software is licensed under terms that can be found in the LICENSE file
|
||||
* in the root directory of this software component.
|
||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
/* USER CODE END Header */
|
||||
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include "FreeRTOS.h"
|
||||
#include "task.h"
|
||||
#include "main.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 */
|
||||
|
||||
/* USER CODE END PM */
|
||||
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Variables */
|
||||
|
||||
/* USER CODE END Variables */
|
||||
|
||||
/* Private function prototypes -----------------------------------------------*/
|
||||
/* USER CODE BEGIN FunctionPrototypes */
|
||||
|
||||
/* USER CODE END FunctionPrototypes */
|
||||
|
||||
/* GetIdleTaskMemory prototype (linked to static allocation support) */
|
||||
void vApplicationGetIdleTaskMemory( StaticTask_t **ppxIdleTaskTCBBuffer, StackType_t **ppxIdleTaskStackBuffer, uint32_t *pulIdleTaskStackSize );
|
||||
|
||||
/* USER CODE BEGIN GET_IDLE_TASK_MEMORY */
|
||||
static StaticTask_t xIdleTaskTCBBuffer;
|
||||
static StackType_t xIdleStack[configMINIMAL_STACK_SIZE];
|
||||
|
||||
void vApplicationGetIdleTaskMemory( StaticTask_t **ppxIdleTaskTCBBuffer, StackType_t **ppxIdleTaskStackBuffer, uint32_t *pulIdleTaskStackSize )
|
||||
{
|
||||
*ppxIdleTaskTCBBuffer = &xIdleTaskTCBBuffer;
|
||||
*ppxIdleTaskStackBuffer = &xIdleStack[0];
|
||||
*pulIdleTaskStackSize = configMINIMAL_STACK_SIZE;
|
||||
/* place for user code */
|
||||
}
|
||||
/* USER CODE END GET_IDLE_TASK_MEMORY */
|
||||
|
||||
/* Private application code --------------------------------------------------*/
|
||||
/* USER CODE BEGIN Application */
|
||||
|
||||
/* USER CODE END Application */
|
||||
134
Core/Src/main.c
134
Core/Src/main.c
@@ -18,6 +18,7 @@
|
||||
/* USER CODE END Header */
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include "main.h"
|
||||
#include "cmsis_os.h"
|
||||
|
||||
/* Private includes ----------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Includes */
|
||||
@@ -26,12 +27,12 @@
|
||||
|
||||
/* Private typedef -----------------------------------------------------------*/
|
||||
/* USER CODE BEGIN PTD */
|
||||
#define CS1_ON() HAL_GPIO_WritePin(CS1_GPIO_Port, CS1_Pin, GPIO_PIN_SET)
|
||||
#define CS1_OFF() HAL_GPIO_WritePin(CS1_GPIO_Port, CS1_Pin, GPIO_PIN_RESET)
|
||||
#define CS2_ON() HAL_GPIO_WritePin(CS2_GPIO_Port, CS2_Pin, GPIO_PIN_SET)
|
||||
#define CS2_OFF() HAL_GPIO_WritePin(CS2_GPIO_Port, CS2_Pin, GPIO_PIN_RESET)
|
||||
#define CS3_ON() HAL_GPIO_WritePin(CS3_GPIO_Port, CS3_Pin, GPIO_PIN_SET)
|
||||
#define CS3_OFF() HAL_GPIO_WritePin(CS3_GPIO_Port, CS3_Pin, GPIO_PIN_RESET)
|
||||
#define CS1_OFF() HAL_GPIO_WritePin(CS1_GPIO_Port, CS1_Pin, GPIO_PIN_SET)
|
||||
#define CS1_ON() HAL_GPIO_WritePin(CS1_GPIO_Port, CS1_Pin, GPIO_PIN_RESET)
|
||||
#define CS2_OFF() HAL_GPIO_WritePin(CS2_GPIO_Port, CS2_Pin, GPIO_PIN_SET)
|
||||
#define CS2_ON() HAL_GPIO_WritePin(CS2_GPIO_Port, CS2_Pin, GPIO_PIN_RESET)
|
||||
#define CS3_OFF() HAL_GPIO_WritePin(CS3_GPIO_Port, CS3_Pin, GPIO_PIN_SET)
|
||||
#define CS3_ON() HAL_GPIO_WritePin(CS3_GPIO_Port, CS3_Pin, GPIO_PIN_RESET)
|
||||
#define RESET_ON() HAL_GPIO_WritePin(RESET_GPIO_Port, RESET_Pin, GPIO_PIN_SET)
|
||||
#define RESET_OFF() HAL_GPIO_WritePin(RESET_GPIO_Port, RESET_Pin, GPIO_PIN_RESET)
|
||||
/* USER CODE END PTD */
|
||||
@@ -51,7 +52,9 @@ DMA_HandleTypeDef hdma_spi1_rx;
|
||||
DMA_HandleTypeDef hdma_spi1_tx;
|
||||
|
||||
UART_HandleTypeDef huart1;
|
||||
DMA_HandleTypeDef hdma_usart1_tx;
|
||||
|
||||
osThreadId calcsUartTaskHandle;
|
||||
/* USER CODE BEGIN PV */
|
||||
|
||||
/* USER CODE END PV */
|
||||
@@ -62,13 +65,20 @@ static void MX_GPIO_Init(void);
|
||||
static void MX_SPI1_Init(void);
|
||||
static void MX_DMA_Init(void);
|
||||
static void MX_USART1_UART_Init(void);
|
||||
void StartCalcsUartTask(void const * argument);
|
||||
|
||||
/* USER CODE BEGIN PFP */
|
||||
|
||||
/* USER CODE END PFP */
|
||||
|
||||
/* Private user code ---------------------------------------------------------*/
|
||||
/* USER CODE BEGIN 0 */
|
||||
|
||||
uint8_t data_in[6] = {0};
|
||||
uint8_t data_out[6] = {0};
|
||||
uint8_t flag_receive = 0;
|
||||
uint8_t flag_cs = 0;
|
||||
xSemaphoreHandle mutex;
|
||||
xSemaphoreHandle semaphoreBin;
|
||||
/* USER CODE END 0 */
|
||||
|
||||
/**
|
||||
@@ -104,12 +114,63 @@ int main(void)
|
||||
MX_USART1_UART_Init();
|
||||
/* USER CODE BEGIN 2 */
|
||||
RESET_ON();
|
||||
HAL_Delay(100);
|
||||
/* USER CODE END 2 */
|
||||
|
||||
/* USER CODE BEGIN RTOS_MUTEX */
|
||||
/* add mutexes, ... */
|
||||
/* USER CODE END RTOS_MUTEX */
|
||||
|
||||
/* USER CODE BEGIN RTOS_SEMAPHORES */
|
||||
/* add semaphores, ... */
|
||||
/* USER CODE END RTOS_SEMAPHORES */
|
||||
|
||||
/* USER CODE BEGIN RTOS_TIMERS */
|
||||
/* start timers, add new ones, ... */
|
||||
/* USER CODE END RTOS_TIMERS */
|
||||
|
||||
/* USER CODE BEGIN RTOS_QUEUES */
|
||||
/* add queues, ... */
|
||||
/* USER CODE END RTOS_QUEUES */
|
||||
|
||||
/* Create the thread(s) */
|
||||
/* definition and creation of defaultTask */
|
||||
osThreadDef(calcsUartTask, StartCalcsUartTask, osPriorityNormal, 0, 128);
|
||||
calcsUartTaskHandle = osThreadCreate(osThread(calcsUartTask), NULL);
|
||||
|
||||
/* USER CODE BEGIN RTOS_THREADS */
|
||||
/* add threads, ... */
|
||||
/* USER CODE END RTOS_THREADS */
|
||||
mutex = xSemaphoreCreateMutex();
|
||||
vSemaphoreCreateBinary(semaphoreBin);
|
||||
/* Start scheduler */
|
||||
osKernelStart();
|
||||
|
||||
/* We should never get here as control is now taken by the scheduler */
|
||||
/* Infinite loop */
|
||||
/* USER CODE BEGIN WHILE */
|
||||
while (1)
|
||||
{
|
||||
flag_cs = 1;
|
||||
CS1_ON();
|
||||
HAL_SPI_Transmit_DMA(&hspi1, data_in, sizeof(data_in));
|
||||
while(!flag_receive) {
|
||||
}
|
||||
CS1_OFF();
|
||||
flag_receive = 0;
|
||||
flag_cs = 2;
|
||||
CS2_ON();
|
||||
HAL_SPI_Transmit_DMA(&hspi1, data_in, sizeof(data_in));
|
||||
while(!flag_receive) {
|
||||
}
|
||||
CS2_OFF();
|
||||
flag_receive = 0;
|
||||
flag_cs = 3;
|
||||
CS3_ON();
|
||||
HAL_SPI_Transmit_DMA(&hspi1, data_in, sizeof(data_in));
|
||||
while(!flag_receive) {
|
||||
}
|
||||
flag_receive = 0;
|
||||
/* USER CODE END WHILE */
|
||||
|
||||
/* USER CODE BEGIN 3 */
|
||||
@@ -245,11 +306,14 @@ static void MX_DMA_Init(void)
|
||||
|
||||
/* DMA interrupt init */
|
||||
/* DMA1_Channel2_IRQn interrupt configuration */
|
||||
HAL_NVIC_SetPriority(DMA1_Channel2_IRQn, 0, 0);
|
||||
HAL_NVIC_SetPriority(DMA1_Channel2_IRQn, 5, 0);
|
||||
HAL_NVIC_EnableIRQ(DMA1_Channel2_IRQn);
|
||||
/* DMA1_Channel3_IRQn interrupt configuration */
|
||||
HAL_NVIC_SetPriority(DMA1_Channel3_IRQn, 0, 0);
|
||||
HAL_NVIC_SetPriority(DMA1_Channel3_IRQn, 5, 0);
|
||||
HAL_NVIC_EnableIRQ(DMA1_Channel3_IRQn);
|
||||
/* DMA1_Channel4_IRQn interrupt configuration */
|
||||
HAL_NVIC_SetPriority(DMA1_Channel4_IRQn, 5, 0);
|
||||
HAL_NVIC_EnableIRQ(DMA1_Channel4_IRQn);
|
||||
|
||||
}
|
||||
|
||||
@@ -289,9 +353,59 @@ static void MX_GPIO_Init(void)
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN 4 */
|
||||
|
||||
void HAL_SPI_TxRxCpltCallback(SPI_HandleTypeDef *hspi)
|
||||
{
|
||||
if(hspi == &hspi1)
|
||||
{
|
||||
HAL_SPI_Receive_DMA(&hspi1, data_out, sizeof(data_out));
|
||||
flag_receive = 1;
|
||||
static portBASE_TYPE xHigherPriorityTaskWoken;
|
||||
xHigherPriorityTaskWoken = pdFALSE;
|
||||
xSemaphoreGiveFromISR(semaphoreBin, &xHigherPriorityTaskWoken);
|
||||
}
|
||||
}
|
||||
/* USER CODE END 4 */
|
||||
|
||||
/* USER CODE BEGIN Header_StartDefaultTask */
|
||||
/**
|
||||
* @brief Function implementing the defaultTask thread.
|
||||
* @param argument: Not used
|
||||
* @retval None
|
||||
*/
|
||||
/* USER CODE END Header_StartDefaultTask */
|
||||
void StartCalcsUartTask(void const * argument)
|
||||
{
|
||||
/* USER CODE BEGIN 5 */
|
||||
/* Infinite loop */
|
||||
for(;;)
|
||||
{
|
||||
xSemaphoreTake(semaphoreBin, portMAX_DELAY);
|
||||
if(flag_cs == 1) {
|
||||
if(xSemaphoreTake(mutex, portMAX_DELAY) == pdTRUE) {
|
||||
//ЗАПИСЬ ДЛЯ ПЕРВОГО ГИРОСКОПА
|
||||
HAL_UART_Transmit_DMA(&huart1, data_in, sizeof(data_in));
|
||||
}
|
||||
xSemaphoreGive(mutex);
|
||||
}
|
||||
else if(flag_cs == 2) {
|
||||
if(xSemaphoreTake(mutex, portMAX_DELAY) == pdTRUE ) {
|
||||
//ЗАПИСЬ ДЛЯ ВТОРОГО ГИРОСКОПА
|
||||
HAL_UART_Transmit_DMA(&huart1, data_in, sizeof(data_in));
|
||||
}
|
||||
xSemaphoreGive(mutex);
|
||||
}
|
||||
else if(flag_cs == 3) {
|
||||
if(xSemaphoreTake(mutex, portMAX_DELAY) == pdTRUE ) {
|
||||
//ЗАПИСЬ ДЛЯ ВТОРОГО ГИРОСКОПА
|
||||
HAL_UART_Transmit_DMA(&huart1, data_in, sizeof(data_in));
|
||||
}
|
||||
xSemaphoreGive(mutex);
|
||||
}
|
||||
osDelay(1);
|
||||
}
|
||||
/* USER CODE END 5 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function is executed in case of error occurrence.
|
||||
* @retval None
|
||||
|
||||
@@ -27,6 +27,8 @@ extern DMA_HandleTypeDef hdma_spi1_rx;
|
||||
|
||||
extern DMA_HandleTypeDef hdma_spi1_tx;
|
||||
|
||||
extern DMA_HandleTypeDef hdma_usart1_tx;
|
||||
|
||||
/* Private typedef -----------------------------------------------------------*/
|
||||
/* USER CODE BEGIN TD */
|
||||
|
||||
@@ -73,6 +75,8 @@ void HAL_MspInit(void)
|
||||
__HAL_RCC_PWR_CLK_ENABLE();
|
||||
|
||||
/* System interrupt init*/
|
||||
/* PendSV_IRQn interrupt configuration */
|
||||
HAL_NVIC_SetPriority(PendSV_IRQn, 15, 0);
|
||||
|
||||
/* USER CODE BEGIN MspInit 1 */
|
||||
|
||||
@@ -144,6 +148,9 @@ void HAL_SPI_MspInit(SPI_HandleTypeDef* hspi)
|
||||
|
||||
__HAL_LINKDMA(hspi,hdmatx,hdma_spi1_tx);
|
||||
|
||||
/* SPI1 interrupt Init */
|
||||
HAL_NVIC_SetPriority(SPI1_IRQn, 5, 0);
|
||||
HAL_NVIC_EnableIRQ(SPI1_IRQn);
|
||||
/* USER CODE BEGIN SPI1_MspInit 1 */
|
||||
|
||||
/* USER CODE END SPI1_MspInit 1 */
|
||||
@@ -177,6 +184,9 @@ void HAL_SPI_MspDeInit(SPI_HandleTypeDef* hspi)
|
||||
/* SPI1 DMA DeInit */
|
||||
HAL_DMA_DeInit(hspi->hdmarx);
|
||||
HAL_DMA_DeInit(hspi->hdmatx);
|
||||
|
||||
/* SPI1 interrupt DeInit */
|
||||
HAL_NVIC_DisableIRQ(SPI1_IRQn);
|
||||
/* USER CODE BEGIN SPI1_MspDeInit 1 */
|
||||
|
||||
/* USER CODE END SPI1_MspDeInit 1 */
|
||||
@@ -223,6 +233,24 @@ void HAL_UART_MspInit(UART_HandleTypeDef* huart)
|
||||
GPIO_InitStruct.Alternate = GPIO_AF7_USART1;
|
||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
||||
|
||||
/* USART1 DMA Init */
|
||||
/* USART1_TX Init */
|
||||
hdma_usart1_tx.Instance = DMA1_Channel4;
|
||||
hdma_usart1_tx.Init.Request = DMA_REQUEST_2;
|
||||
hdma_usart1_tx.Init.Direction = DMA_MEMORY_TO_PERIPH;
|
||||
hdma_usart1_tx.Init.PeriphInc = DMA_PINC_DISABLE;
|
||||
hdma_usart1_tx.Init.MemInc = DMA_MINC_ENABLE;
|
||||
hdma_usart1_tx.Init.PeriphDataAlignment = DMA_PDATAALIGN_BYTE;
|
||||
hdma_usart1_tx.Init.MemDataAlignment = DMA_MDATAALIGN_BYTE;
|
||||
hdma_usart1_tx.Init.Mode = DMA_NORMAL;
|
||||
hdma_usart1_tx.Init.Priority = DMA_PRIORITY_LOW;
|
||||
if (HAL_DMA_Init(&hdma_usart1_tx) != HAL_OK)
|
||||
{
|
||||
Error_Handler();
|
||||
}
|
||||
|
||||
__HAL_LINKDMA(huart,hdmatx,hdma_usart1_tx);
|
||||
|
||||
/* USER CODE BEGIN USART1_MspInit 1 */
|
||||
|
||||
/* USER CODE END USART1_MspInit 1 */
|
||||
@@ -252,6 +280,8 @@ void HAL_UART_MspDeInit(UART_HandleTypeDef* huart)
|
||||
*/
|
||||
HAL_GPIO_DeInit(GPIOA, GPIO_PIN_9|GPIO_PIN_10);
|
||||
|
||||
/* USART1 DMA DeInit */
|
||||
HAL_DMA_DeInit(huart->hdmatx);
|
||||
/* USER CODE BEGIN USART1_MspDeInit 1 */
|
||||
|
||||
/* USER CODE END USART1_MspDeInit 1 */
|
||||
|
||||
@@ -20,6 +20,8 @@
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include "main.h"
|
||||
#include "stm32l4xx_it.h"
|
||||
#include "FreeRTOS.h"
|
||||
#include "task.h"
|
||||
/* Private includes ----------------------------------------------------------*/
|
||||
/* USER CODE BEGIN Includes */
|
||||
/* USER CODE END Includes */
|
||||
@@ -57,6 +59,8 @@
|
||||
/* External variables --------------------------------------------------------*/
|
||||
extern DMA_HandleTypeDef hdma_spi1_rx;
|
||||
extern DMA_HandleTypeDef hdma_spi1_tx;
|
||||
extern SPI_HandleTypeDef hspi1;
|
||||
extern DMA_HandleTypeDef hdma_usart1_tx;
|
||||
/* USER CODE BEGIN EV */
|
||||
|
||||
/* USER CODE END EV */
|
||||
@@ -139,19 +143,6 @@ void UsageFault_Handler(void)
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles System service call via SWI instruction.
|
||||
*/
|
||||
void SVC_Handler(void)
|
||||
{
|
||||
/* USER CODE BEGIN SVCall_IRQn 0 */
|
||||
|
||||
/* USER CODE END SVCall_IRQn 0 */
|
||||
/* USER CODE BEGIN SVCall_IRQn 1 */
|
||||
|
||||
/* USER CODE END SVCall_IRQn 1 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles Debug monitor.
|
||||
*/
|
||||
@@ -165,19 +156,6 @@ void DebugMon_Handler(void)
|
||||
/* USER CODE END DebugMonitor_IRQn 1 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles Pendable request for system service.
|
||||
*/
|
||||
void PendSV_Handler(void)
|
||||
{
|
||||
/* USER CODE BEGIN PendSV_IRQn 0 */
|
||||
|
||||
/* USER CODE END PendSV_IRQn 0 */
|
||||
/* USER CODE BEGIN PendSV_IRQn 1 */
|
||||
|
||||
/* USER CODE END PendSV_IRQn 1 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles System tick timer.
|
||||
*/
|
||||
@@ -187,6 +165,14 @@ void SysTick_Handler(void)
|
||||
|
||||
/* USER CODE END SysTick_IRQn 0 */
|
||||
HAL_IncTick();
|
||||
#if (INCLUDE_xTaskGetSchedulerState == 1 )
|
||||
if (xTaskGetSchedulerState() != taskSCHEDULER_NOT_STARTED)
|
||||
{
|
||||
#endif /* INCLUDE_xTaskGetSchedulerState */
|
||||
xPortSysTickHandler();
|
||||
#if (INCLUDE_xTaskGetSchedulerState == 1 )
|
||||
}
|
||||
#endif /* INCLUDE_xTaskGetSchedulerState */
|
||||
/* USER CODE BEGIN SysTick_IRQn 1 */
|
||||
|
||||
/* USER CODE END SysTick_IRQn 1 */
|
||||
@@ -227,6 +213,34 @@ void DMA1_Channel3_IRQHandler(void)
|
||||
/* USER CODE END DMA1_Channel3_IRQn 1 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles DMA1 channel4 global interrupt.
|
||||
*/
|
||||
void DMA1_Channel4_IRQHandler(void)
|
||||
{
|
||||
/* USER CODE BEGIN DMA1_Channel4_IRQn 0 */
|
||||
|
||||
/* USER CODE END DMA1_Channel4_IRQn 0 */
|
||||
HAL_DMA_IRQHandler(&hdma_usart1_tx);
|
||||
/* USER CODE BEGIN DMA1_Channel4_IRQn 1 */
|
||||
|
||||
/* USER CODE END DMA1_Channel4_IRQn 1 */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function handles SPI1 global interrupt.
|
||||
*/
|
||||
void SPI1_IRQHandler(void)
|
||||
{
|
||||
/* USER CODE BEGIN SPI1_IRQn 0 */
|
||||
|
||||
/* USER CODE END SPI1_IRQn 0 */
|
||||
HAL_SPI_IRQHandler(&hspi1);
|
||||
/* USER CODE BEGIN SPI1_IRQn 1 */
|
||||
|
||||
/* USER CODE END SPI1_IRQn 1 */
|
||||
}
|
||||
|
||||
/* USER CODE BEGIN 1 */
|
||||
|
||||
/* USER CODE END 1 */
|
||||
|
||||
423
Core/ThreadSafe/newlib_lock_glue.c
Normal file
423
Core/ThreadSafe/newlib_lock_glue.c
Normal file
@@ -0,0 +1,423 @@
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file newlib_lock_glue.c
|
||||
* @author STMicroelectronics
|
||||
* @brief Implementation of newlib lock interface
|
||||
*
|
||||
* @details This file implements locking glue necessary to protect C library
|
||||
* functions and initialization of local static objects in C++.
|
||||
* Lock strategies are defined in stm32_lock.h that implements
|
||||
* different level of thread-safety.
|
||||
*
|
||||
* For more information about which C functions need which of these
|
||||
* low level functions, please consult the newlib libc manual,
|
||||
* see https://sourceware.org/newlib/libc.html
|
||||
*
|
||||
* For more information about the one-time construction API for C++,
|
||||
* see https://itanium-cxx-abi.github.io/cxx-abi/abi.html#once-ctor
|
||||
*
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2021 STMicroelectronics.
|
||||
* All rights reserved.
|
||||
*
|
||||
* This software is licensed under terms that can be found in the LICENSE file
|
||||
* in the root directory of this software component.
|
||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
#if !defined (__GNUC__) || defined (__CC_ARM)
|
||||
#error "newlib_lock_glue.c" should be used with GNU Compilers only
|
||||
#endif /* !defined (__GNUC__) || defined (__CC_ARM) */
|
||||
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include <cmsis_compiler.h>
|
||||
|
||||
/* Private functions ---------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Global Error_Handler
|
||||
*/
|
||||
__WEAK void Error_Handler(void)
|
||||
{
|
||||
/* Not used if it exists in project */
|
||||
while (1);
|
||||
}
|
||||
|
||||
#ifdef __SINGLE_THREAD__
|
||||
#warning C library is in single-threaded mode. Please take care when using C library functions in threaded contexts
|
||||
#else
|
||||
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include <newlib.h>
|
||||
#include <stdatomic.h>
|
||||
#include "stm32_lock.h"
|
||||
|
||||
/**
|
||||
* @defgroup _newlib_lock_functions newlib library locks
|
||||
* @see https://sourceware.org/newlib/libc.html
|
||||
* @{
|
||||
*/
|
||||
|
||||
#if __NEWLIB__ >= 3 && defined (_RETARGETABLE_LOCKING)
|
||||
#include <errno.h>
|
||||
#include <stdlib.h>
|
||||
#include <sys/lock.h>
|
||||
|
||||
/* Private macros ------------------------------------------------------------*/
|
||||
/** See struct __lock definition */
|
||||
#define STM32_LOCK_PARAMETER(lock) (&(lock)->lock_data)
|
||||
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
struct __lock
|
||||
{
|
||||
LockingData_t lock_data; /**< The STM32 lock instance */
|
||||
};
|
||||
|
||||
/** Implementing mutex from <a href="https://sourceware.org/git/?p=newlib-cygwin.git;a=blob_plain;f=newlib/libc/misc/lock.c">newlib/libc/misc/lock.c</a> */
|
||||
struct __lock __lock___sinit_recursive_mutex = { LOCKING_DATA_INIT };
|
||||
|
||||
/** Implementing mutex from <a href="https://sourceware.org/git/?p=newlib-cygwin.git;a=blob_plain;f=newlib/libc/misc/lock.c">newlib/libc/misc/lock.c</a> */
|
||||
struct __lock __lock___sfp_recursive_mutex = { LOCKING_DATA_INIT };
|
||||
|
||||
/** Implementing mutex from <a href="https://sourceware.org/git/?p=newlib-cygwin.git;a=blob_plain;f=newlib/libc/misc/lock.c">newlib/libc/misc/lock.c</a> */
|
||||
struct __lock __lock___atexit_recursive_mutex = { LOCKING_DATA_INIT };
|
||||
|
||||
/** Implementing mutex from <a href="https://sourceware.org/git/?p=newlib-cygwin.git;a=blob_plain;f=newlib/libc/misc/lock.c">newlib/libc/misc/lock.c</a> */
|
||||
struct __lock __lock___at_quick_exit_mutex = { LOCKING_DATA_INIT };
|
||||
|
||||
/** Implementing mutex from <a href="https://sourceware.org/git/?p=newlib-cygwin.git;a=blob_plain;f=newlib/libc/misc/lock.c">newlib/libc/misc/lock.c</a> */
|
||||
struct __lock __lock___malloc_recursive_mutex = { LOCKING_DATA_INIT };
|
||||
|
||||
/** Implementing mutex from <a href="https://sourceware.org/git/?p=newlib-cygwin.git;a=blob_plain;f=newlib/libc/misc/lock.c">newlib/libc/misc/lock.c</a> */
|
||||
struct __lock __lock___env_recursive_mutex = { LOCKING_DATA_INIT };
|
||||
|
||||
/** Implementing mutex from <a href="https://sourceware.org/git/?p=newlib-cygwin.git;a=blob_plain;f=newlib/libc/misc/lock.c">newlib/libc/misc/lock.c</a> */
|
||||
struct __lock __lock___tz_mutex = { LOCKING_DATA_INIT };
|
||||
|
||||
/** Implementing mutex from <a href="https://sourceware.org/git/?p=newlib-cygwin.git;a=blob_plain;f=newlib/libc/misc/lock.c">newlib/libc/misc/lock.c</a> */
|
||||
struct __lock __lock___dd_hash_mutex = { LOCKING_DATA_INIT };
|
||||
|
||||
/** Implementing mutex from <a href="https://sourceware.org/git/?p=newlib-cygwin.git;a=blob_plain;f=newlib/libc/misc/lock.c">newlib/libc/misc/lock.c</a> */
|
||||
struct __lock __lock___arc4random_mutex = { LOCKING_DATA_INIT };
|
||||
|
||||
/* Private functions ---------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Initialize lock
|
||||
* @param lock The lock
|
||||
*/
|
||||
void __retarget_lock_init(_LOCK_T *lock)
|
||||
{
|
||||
__retarget_lock_init_recursive(lock);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Initialize recursive lock
|
||||
* @param lock The lock
|
||||
*/
|
||||
void __retarget_lock_init_recursive(_LOCK_T *lock)
|
||||
{
|
||||
if (lock == NULL)
|
||||
{
|
||||
errno = EINVAL;
|
||||
return;
|
||||
}
|
||||
|
||||
*lock = (_LOCK_T)malloc(sizeof(struct __lock));
|
||||
if (*lock != NULL)
|
||||
{
|
||||
stm32_lock_init(STM32_LOCK_PARAMETER(*lock));
|
||||
return;
|
||||
}
|
||||
|
||||
/* Unable to allocate memory */
|
||||
STM32_LOCK_BLOCK();
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Close lock
|
||||
* @param lock The lock
|
||||
*/
|
||||
void __retarget_lock_close(_LOCK_T lock)
|
||||
{
|
||||
__retarget_lock_close_recursive(lock);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Close recursive lock
|
||||
* @param lock The lock
|
||||
*/
|
||||
void __retarget_lock_close_recursive(_LOCK_T lock)
|
||||
{
|
||||
free(lock);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Acquire lock
|
||||
* @param lock The lock
|
||||
*/
|
||||
void __retarget_lock_acquire(_LOCK_T lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
stm32_lock_acquire(STM32_LOCK_PARAMETER(lock));
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Acquire recursive lock
|
||||
* @param lock The lock
|
||||
*/
|
||||
void __retarget_lock_acquire_recursive(_LOCK_T lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
stm32_lock_acquire(STM32_LOCK_PARAMETER(lock));
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Try acquire lock
|
||||
* @param lock The lock
|
||||
* @return 0 always
|
||||
*/
|
||||
int __retarget_lock_try_acquire(_LOCK_T lock)
|
||||
{
|
||||
__retarget_lock_acquire(lock);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Try acquire recursive lock
|
||||
* @param lock The lock
|
||||
* @return 0 always
|
||||
*/
|
||||
int __retarget_lock_try_acquire_recursive(_LOCK_T lock)
|
||||
{
|
||||
__retarget_lock_acquire_recursive(lock);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release lock
|
||||
* @param lock The lock
|
||||
*/
|
||||
void __retarget_lock_release(_LOCK_T lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
stm32_lock_release(STM32_LOCK_PARAMETER(lock));
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release recursive lock
|
||||
* @param lock The lock
|
||||
*/
|
||||
void __retarget_lock_release_recursive(_LOCK_T lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
stm32_lock_release(STM32_LOCK_PARAMETER(lock));
|
||||
}
|
||||
|
||||
#else
|
||||
#warning This makes malloc, env, and TZ calls thread-safe, not the entire newlib
|
||||
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include <reent.h>
|
||||
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
/** Mutex used in __malloc_lock and __malloc_unlock */
|
||||
static LockingData_t __lock___malloc_recursive_mutex = LOCKING_DATA_INIT;
|
||||
|
||||
/** Mutex used in __env_lock and __env_unlock */
|
||||
static LockingData_t __lock___env_recursive_mutex = LOCKING_DATA_INIT;
|
||||
|
||||
/** Mutex used in __tz_lock and __tz_unlock */
|
||||
static LockingData_t __lock___tz_mutex = LOCKING_DATA_INIT;
|
||||
|
||||
/* Private functions ---------------------------------------------------------*/
|
||||
|
||||
#if __STD_C
|
||||
|
||||
/**
|
||||
* @brief Acquire malloc lock
|
||||
* @param reent The reentrance struct
|
||||
*/
|
||||
void __malloc_lock(struct _reent *reent)
|
||||
{
|
||||
STM32_LOCK_UNUSED(reent);
|
||||
stm32_lock_acquire(&__lock___malloc_recursive_mutex);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release malloc lock
|
||||
* @param reent The reentrance struct
|
||||
*/
|
||||
void __malloc_unlock(struct _reent *reent)
|
||||
{
|
||||
STM32_LOCK_UNUSED(reent);
|
||||
stm32_lock_release(&__lock___malloc_recursive_mutex);
|
||||
}
|
||||
|
||||
#else
|
||||
|
||||
/**
|
||||
* @brief Acquire malloc lock
|
||||
*/
|
||||
void __malloc_lock()
|
||||
{
|
||||
stm32_lock_acquire(&__lock___malloc_recursive_mutex);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release malloc lock
|
||||
*/
|
||||
void __malloc_unlock()
|
||||
{
|
||||
stm32_lock_release(&__lock___malloc_recursive_mutex);
|
||||
}
|
||||
#endif /* __STD_C */
|
||||
|
||||
/**
|
||||
* @brief Acquire env lock
|
||||
* @param reent The reentrance struct
|
||||
*/
|
||||
void __env_lock(struct _reent *reent)
|
||||
{
|
||||
STM32_LOCK_UNUSED(reent);
|
||||
stm32_lock_acquire(&__lock___env_recursive_mutex);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release env lock
|
||||
* @param reent The reentrance struct
|
||||
*/
|
||||
void __env_unlock(struct _reent *reent)
|
||||
{
|
||||
STM32_LOCK_UNUSED(reent);
|
||||
stm32_lock_release(&__lock___env_recursive_mutex);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Acquire tz lock
|
||||
*/
|
||||
void __tz_lock()
|
||||
{
|
||||
stm32_lock_acquire(&__lock___tz_mutex);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release tz lock
|
||||
*/
|
||||
void __tz_unlock()
|
||||
{
|
||||
stm32_lock_release(&__lock___tz_mutex);
|
||||
}
|
||||
|
||||
#endif /* __NEWLIB__ >= 3 && defined (_RETARGETABLE_LOCKING) */
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
|
||||
/**
|
||||
* @defgroup __cxa_guard_ GNU C++ one-time construction API
|
||||
* @see https://itanium-cxx-abi.github.io/cxx-abi/abi.html#once-ctor
|
||||
*
|
||||
* When building for C++, please make sure that <tt>-fno-threadsafe-statics</tt> is not passed to the compiler
|
||||
* @{
|
||||
*/
|
||||
|
||||
/* Private typedef -----------------------------------------------------------*/
|
||||
/** The guard object is created by the C++ compiler and is 32 bit for ARM EABI. */
|
||||
typedef struct
|
||||
{
|
||||
atomic_uchar initialized; /**< Indicate if object is initialized */
|
||||
uint8_t acquired; /**< Ensure non-recursive lock */
|
||||
uint16_t unused; /**< Padding */
|
||||
} __attribute__((packed)) CxaGuardObject_t;
|
||||
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
/** Mutex used in __cxa_guard_acquire, __cxa_guard_release and __cxa_guard_abort */
|
||||
static LockingData_t __cxa_guard_mutex = LOCKING_DATA_INIT;
|
||||
|
||||
/* Private functions ---------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Acquire __cxa_guard mutex
|
||||
* @param guard_object Guard object
|
||||
* @return 0 if object is initialized, else initialization of object required
|
||||
*/
|
||||
int __cxa_guard_acquire(CxaGuardObject_t *guard_object)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(guard_object);
|
||||
|
||||
if (atomic_load(&guard_object->initialized) == 0)
|
||||
{
|
||||
/* Object needs initialization, lock threading context */
|
||||
stm32_lock_acquire(&__cxa_guard_mutex);
|
||||
if (atomic_load(&guard_object->initialized) == 0)
|
||||
{
|
||||
/* Object needs initialization */
|
||||
if (guard_object->acquired)
|
||||
{
|
||||
/* Object initialization already in progress */
|
||||
STM32_LOCK_BLOCK();
|
||||
}
|
||||
|
||||
/* Lock acquired */
|
||||
guard_object->acquired = 1;
|
||||
return 1;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Object initialized in another thread */
|
||||
stm32_lock_release(&__cxa_guard_mutex);
|
||||
}
|
||||
}
|
||||
|
||||
/* Object already initialized */
|
||||
return 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Abort __cxa_guard mutex
|
||||
* @param guard_object Guard object
|
||||
*/
|
||||
void __cxa_guard_abort(CxaGuardObject_t *guard_object)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(guard_object);
|
||||
|
||||
if (guard_object->acquired)
|
||||
{
|
||||
/* Release lock */
|
||||
guard_object->acquired = 0;
|
||||
stm32_lock_release(&__cxa_guard_mutex);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Trying to release non-acquired lock */
|
||||
STM32_LOCK_BLOCK();
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release __cxa_guard mutex
|
||||
* @param guard_object Guard object
|
||||
*/
|
||||
void __cxa_guard_release(CxaGuardObject_t *guard_object)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(guard_object);
|
||||
|
||||
/* Object initialized */
|
||||
atomic_store(&guard_object->initialized, 1);
|
||||
|
||||
/* Release lock */
|
||||
__cxa_guard_abort(guard_object);
|
||||
}
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
#endif /* __SINGLE_THREAD__ */
|
||||
375
Core/ThreadSafe/stm32_lock.h
Normal file
375
Core/ThreadSafe/stm32_lock.h
Normal file
@@ -0,0 +1,375 @@
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file stm32_lock.h
|
||||
* @author STMicroelectronics
|
||||
* @brief STMicroelectronics lock mechanisms
|
||||
*
|
||||
* @details
|
||||
* This implementation supports the following strategies for handling
|
||||
* thread-safe locks. The strategy can be explicitly selected by
|
||||
* defining <tt>\STM32_THREAD_SAFE_STRATEGY = \<number></tt> in the project.
|
||||
* Please look at the '<toolchain/library>_lock_glue.c' file for more details.
|
||||
*
|
||||
* 1. User defined thread-safe implementation.
|
||||
* User defined solution for handling thread-safety.
|
||||
* <br>
|
||||
* <b>NOTE:</b> The stubs in stm32_lock_user.h needs to be implemented to gain
|
||||
* thread-safety.
|
||||
*
|
||||
* 2. [<b>DEFAULT</b>] Allow lock usage from interrupts.
|
||||
* This implementation will ensure thread-safety by disabling all interrupts
|
||||
* during e.g. calls to malloc.
|
||||
* <br>
|
||||
* <b>NOTE:</b> Disabling all interrupts creates interrupt latency which
|
||||
* might not be desired for this application!
|
||||
*
|
||||
* 3. Deny lock usage from interrupts.
|
||||
* This implementation assumes single thread of execution.
|
||||
* <br>
|
||||
* <b>NOTE:</b> Thread-safety dependent functions will enter an infinity loop
|
||||
* if used in interrupt context.
|
||||
*
|
||||
* 4. Allow lock usage from interrupts. Implemented using FreeRTOS locks.
|
||||
* This implementation will ensure thread-safety by entering RTOS ISR capable
|
||||
* critical sections during e.g. calls to malloc.
|
||||
* By default this implementation supports 2 levels of recursive locking.
|
||||
* Adding additional levels requires 4 bytes per lock per level of RAM.
|
||||
* <br>
|
||||
* <b>NOTE:</b> Interrupts with high priority are not disabled. This implies
|
||||
* that the lock is not thread-safe from high priority interrupts!
|
||||
*
|
||||
* 5. Deny lock usage from interrupts. Implemented using FreeRTOS locks.
|
||||
* This implementation will ensure thread-safety by suspending all tasks
|
||||
* during e.g. calls to malloc.
|
||||
* <br>
|
||||
* <b>NOTE:</b> Thread-safety dependent functions will enter an infinity loop
|
||||
* if used in interrupt context.
|
||||
*
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2021 STMicroelectronics.
|
||||
* All rights reserved.
|
||||
*
|
||||
* This software is licensed under terms that can be found in the LICENSE file
|
||||
* in the root directory of this software component.
|
||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
#ifndef __STM32_LOCK_H__
|
||||
#define __STM32_LOCK_H__
|
||||
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include <stdint.h>
|
||||
#include <stddef.h>
|
||||
#include <cmsis_compiler.h>
|
||||
|
||||
#ifndef STM32_THREAD_SAFE_STRATEGY
|
||||
#define STM32_THREAD_SAFE_STRATEGY 2 /**< Assume strategy 2 if not specified */
|
||||
#endif /* STM32_THREAD_SAFE_STRATEGY */
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif /* __cplusplus */
|
||||
|
||||
/* Function prototypes -------------------------------------------------------*/
|
||||
void Error_Handler(void);
|
||||
|
||||
/* Public macros -------------------------------------------------------------*/
|
||||
/** Blocks execution */
|
||||
#define STM32_LOCK_BLOCK() \
|
||||
do \
|
||||
{ \
|
||||
__disable_irq(); \
|
||||
Error_Handler(); \
|
||||
while (1); \
|
||||
} while (0)
|
||||
|
||||
/** Blocks execution if argument is NULL */
|
||||
#define STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(x) \
|
||||
do \
|
||||
{ \
|
||||
if ((x) == NULL) \
|
||||
{ \
|
||||
STM32_LOCK_BLOCK(); \
|
||||
} \
|
||||
} while (0)
|
||||
|
||||
/** Blocks execution if in interrupt context */
|
||||
#define STM32_LOCK_BLOCK_IF_INTERRUPT_CONTEXT() \
|
||||
do \
|
||||
{ \
|
||||
if (__get_IPSR()) \
|
||||
{ \
|
||||
STM32_LOCK_BLOCK(); \
|
||||
} \
|
||||
} while (0)
|
||||
|
||||
/** Hide unused parameter warning from compiler */
|
||||
#define STM32_LOCK_UNUSED(var) (void)var
|
||||
|
||||
/** Size of array */
|
||||
#define STM32_LOCK_ARRAY_SIZE(array) (sizeof(array) / sizeof((array)[0]))
|
||||
|
||||
#if STM32_THREAD_SAFE_STRATEGY == 1
|
||||
/*
|
||||
* User defined thread-safe implementation.
|
||||
*/
|
||||
|
||||
/* Includes ----------------------------------------------------------------*/
|
||||
/** STM32 lock API version */
|
||||
#define STM32_LOCK_API 1
|
||||
#include "stm32_lock_user.h"
|
||||
#undef STM32_LOCK_API
|
||||
|
||||
#elif STM32_THREAD_SAFE_STRATEGY == 2
|
||||
/*
|
||||
* Allow lock usage from interrupts.
|
||||
*/
|
||||
|
||||
/* Private defines ---------------------------------------------------------*/
|
||||
/** Initialize members in instance of <code>LockingData_t</code> structure */
|
||||
#define LOCKING_DATA_INIT { 0, 0 }
|
||||
|
||||
/* Private typedef ---------------------------------------------------------*/
|
||||
typedef struct
|
||||
{
|
||||
uint8_t flag; /**< Backup of PRIMASK.PM at nesting level 0 */
|
||||
uint8_t counter; /**< Nesting level */
|
||||
} LockingData_t;
|
||||
|
||||
/* Private functions -------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Initialize STM32 lock
|
||||
* @param lock The lock to init
|
||||
*/
|
||||
static inline void stm32_lock_init(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
lock->flag = 0;
|
||||
lock->counter = 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Acquire STM32 lock
|
||||
* @param lock The lock to acquire
|
||||
*/
|
||||
static inline void stm32_lock_acquire(LockingData_t *lock)
|
||||
{
|
||||
uint8_t flag = (uint8_t)(__get_PRIMASK() & 0x1); /* PRIMASK.PM */
|
||||
__disable_irq();
|
||||
__DSB();
|
||||
__ISB();
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
if (lock->counter == 0)
|
||||
{
|
||||
lock->flag = flag;
|
||||
}
|
||||
else if (lock->counter == UINT8_MAX)
|
||||
{
|
||||
STM32_LOCK_BLOCK();
|
||||
}
|
||||
lock->counter++;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release STM32 lock
|
||||
* @param lock The lock to release
|
||||
*/
|
||||
static inline void stm32_lock_release(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
if (lock->counter == 0)
|
||||
{
|
||||
STM32_LOCK_BLOCK();
|
||||
}
|
||||
lock->counter--;
|
||||
if (lock->counter == 0 && lock->flag == 0)
|
||||
{
|
||||
__enable_irq();
|
||||
}
|
||||
}
|
||||
|
||||
#elif STM32_THREAD_SAFE_STRATEGY == 3
|
||||
/*
|
||||
* Deny lock usage from interrupts.
|
||||
*/
|
||||
|
||||
/* Private defines ---------------------------------------------------------*/
|
||||
/** Initialize members in instance of <code>LockingData_t</code> structure */
|
||||
#define LOCKING_DATA_INIT 0
|
||||
|
||||
/* Private typedef ---------------------------------------------------------*/
|
||||
typedef uint8_t LockingData_t; /**< Unused */
|
||||
|
||||
/* Private functions -------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Initialize STM32 lock
|
||||
* @param lock The lock to init
|
||||
*/
|
||||
static inline void stm32_lock_init(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Acquire STM32 lock
|
||||
* @param lock The lock to acquire
|
||||
*/
|
||||
static inline void stm32_lock_acquire(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
STM32_LOCK_BLOCK_IF_INTERRUPT_CONTEXT();
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release ST lock
|
||||
* @param lock The lock to release
|
||||
*/
|
||||
static inline void stm32_lock_release(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
STM32_LOCK_BLOCK_IF_INTERRUPT_CONTEXT();
|
||||
}
|
||||
|
||||
#elif STM32_THREAD_SAFE_STRATEGY == 4
|
||||
/*
|
||||
* Allow lock usage from interrupts. Implemented using FreeRTOS locks.
|
||||
*/
|
||||
|
||||
/* Includes ----------------------------------------------------------------*/
|
||||
#include <FreeRTOS.h>
|
||||
#include <task.h>
|
||||
|
||||
#if defined (__GNUC__) && !defined (__CC_ARM) && configUSE_NEWLIB_REENTRANT == 0
|
||||
#warning Please set configUSE_NEWLIB_REENTRANT to 1 in FreeRTOSConfig.h, otherwise newlib will not be thread-safe
|
||||
#endif /* defined (__GNUC__) && !defined (__CC_ARM) && configUSE_NEWLIB_REENTRANT == 0 */
|
||||
|
||||
/* Private defines ---------------------------------------------------------*/
|
||||
/** Initialize members in instance of <code>LockingData_t</code> structure */
|
||||
#define LOCKING_DATA_INIT { {0, 0}, 0 }
|
||||
#define STM32_LOCK_MAX_NESTED_LEVELS 2 /**< Max nesting level of interrupts */
|
||||
typedef struct
|
||||
{
|
||||
uint32_t basepri[STM32_LOCK_MAX_NESTED_LEVELS];
|
||||
uint8_t nesting_level;
|
||||
} LockingData_t;
|
||||
|
||||
/* Private macros ----------------------------------------------------------*/
|
||||
/** Blocks execution if reached max nesting level */
|
||||
#define STM32_LOCK_ASSERT_VALID_NESTING_LEVEL(lock) \
|
||||
do \
|
||||
{ \
|
||||
if (lock->nesting_level >= STM32_LOCK_ARRAY_SIZE(lock->basepri)) \
|
||||
{ \
|
||||
STM32_LOCK_BLOCK(); \
|
||||
} \
|
||||
} while (0)
|
||||
|
||||
/* Private functions -------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Initialize STM32 lock
|
||||
* @param lock The lock to init
|
||||
*/
|
||||
static inline void stm32_lock_init(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
for (size_t i = 0; i < STM32_LOCK_ARRAY_SIZE(lock->basepri); i++)
|
||||
{
|
||||
lock->basepri[i] = 0;
|
||||
}
|
||||
lock->nesting_level = 0;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Acquire STM32 lock
|
||||
* @param lock The lock to acquire
|
||||
*/
|
||||
static inline void stm32_lock_acquire(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
STM32_LOCK_ASSERT_VALID_NESTING_LEVEL(lock);
|
||||
lock->basepri[lock->nesting_level++] = taskENTER_CRITICAL_FROM_ISR();
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release STM32 lock
|
||||
* @param lock The lock to release
|
||||
*/
|
||||
static inline void stm32_lock_release(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
lock->nesting_level--;
|
||||
STM32_LOCK_ASSERT_VALID_NESTING_LEVEL(lock);
|
||||
taskEXIT_CRITICAL_FROM_ISR(lock->basepri[lock->nesting_level]);
|
||||
}
|
||||
|
||||
#undef STM32_LOCK_ASSERT_VALID_NESTING_LEVEL
|
||||
#undef STM32_LOCK_MAX_NESTED_LEVELS
|
||||
|
||||
#elif STM32_THREAD_SAFE_STRATEGY == 5
|
||||
/*
|
||||
* Deny lock usage from interrupts. Implemented using FreeRTOS locks.
|
||||
*/
|
||||
|
||||
/* Includes ----------------------------------------------------------------*/
|
||||
#include <FreeRTOS.h>
|
||||
#include <task.h>
|
||||
#if defined (__GNUC__) && !defined (__CC_ARM) && configUSE_NEWLIB_REENTRANT == 0
|
||||
#warning Please set configUSE_NEWLIB_REENTRANT to 1 in FreeRTOSConfig.h, otherwise newlib will not be thread-safe
|
||||
#endif /* defined (__GNUC__) && !defined (__CC_ARM) && configUSE_NEWLIB_REENTRANT == 0 */
|
||||
|
||||
/* Private defines ---------------------------------------------------------*/
|
||||
/** Initialize members in instance of <code>LockingData_t</code> structure */
|
||||
#define LOCKING_DATA_INIT 0
|
||||
|
||||
/* Private typedef ---------------------------------------------------------*/
|
||||
typedef uint8_t LockingData_t; /**< Unused */
|
||||
|
||||
/* Private functions -------------------------------------------------------*/
|
||||
|
||||
/**
|
||||
* @brief Initialize STM32 lock
|
||||
* @param lock The lock to init
|
||||
*/
|
||||
static inline void stm32_lock_init(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Acquire STM32 lock
|
||||
* @param lock The lock to acquire
|
||||
*/
|
||||
static inline void stm32_lock_acquire(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
STM32_LOCK_BLOCK_IF_INTERRUPT_CONTEXT();
|
||||
vTaskSuspendAll();
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief Release STM32 lock
|
||||
* @param lock The lock to release
|
||||
*/
|
||||
static inline void stm32_lock_release(LockingData_t *lock)
|
||||
{
|
||||
STM32_LOCK_BLOCK_IF_NULL_ARGUMENT(lock);
|
||||
STM32_LOCK_BLOCK_IF_INTERRUPT_CONTEXT();
|
||||
xTaskResumeAll();
|
||||
}
|
||||
|
||||
#else
|
||||
#error Invalid STM32_THREAD_SAFE_STRATEGY specified
|
||||
#endif /* STM32_THREAD_SAFE_STRATEGY */
|
||||
|
||||
#ifdef __cplusplus
|
||||
} /* extern "C" */
|
||||
#endif /* __cplusplus */
|
||||
|
||||
#endif /* __STM32_LOCK_H__ */
|
||||
Reference in New Issue
Block a user