410 lines
10 KiB
C
410 lines
10 KiB
C
/* USER CODE BEGIN Header */
|
||
/**
|
||
******************************************************************************
|
||
* @file stm32g4xx_it.c
|
||
* @brief Interrupt Service Routines.
|
||
******************************************************************************
|
||
* @attention
|
||
*
|
||
* Copyright (c) 2025 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 "main.h"
|
||
#include "stm32g4xx_it.h"
|
||
/* Private includes ----------------------------------------------------------*/
|
||
/* USER CODE BEGIN Includes */
|
||
#include "FBKW.h"
|
||
#include "injection.h"
|
||
#include "toothed_wheel.h"
|
||
|
||
/* USER CODE END Includes */
|
||
|
||
/* Private typedef -----------------------------------------------------------*/
|
||
/* USER CODE BEGIN TD */
|
||
|
||
/* USER CODE END TD */
|
||
|
||
/* 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 PV */
|
||
|
||
/* USER CODE END PV */
|
||
|
||
/* Private function prototypes -----------------------------------------------*/
|
||
/* USER CODE BEGIN PFP */
|
||
|
||
/* USER CODE END PFP */
|
||
|
||
/* Private user code ---------------------------------------------------------*/
|
||
/* USER CODE BEGIN 0 */
|
||
|
||
/* USER CODE END 0 */
|
||
|
||
/* External variables --------------------------------------------------------*/
|
||
extern DMA_HandleTypeDef hdma_adc1;
|
||
extern DMA_HandleTypeDef hdma_adc2;
|
||
extern DAC_HandleTypeDef hdac1;
|
||
extern FDCAN_HandleTypeDef hfdcan1;
|
||
extern RTC_HandleTypeDef hrtc;
|
||
extern TIM_HandleTypeDef htim1;
|
||
extern TIM_HandleTypeDef htim2;
|
||
extern TIM_HandleTypeDef htim3;
|
||
extern TIM_HandleTypeDef htim6;
|
||
extern TIM_HandleTypeDef htim15;
|
||
extern TIM_HandleTypeDef htim17;
|
||
extern UART_HandleTypeDef huart1;
|
||
/* USER CODE BEGIN EV */
|
||
|
||
/* USER CODE END EV */
|
||
|
||
/******************************************************************************/
|
||
/* Cortex-M4 Processor Interruption and Exception Handlers */
|
||
/******************************************************************************/
|
||
/**
|
||
* @brief This function handles Non maskable interrupt.
|
||
*/
|
||
void NMI_Handler(void)
|
||
{
|
||
/* USER CODE BEGIN NonMaskableInt_IRQn 0 */
|
||
|
||
/* USER CODE END NonMaskableInt_IRQn 0 */
|
||
/* USER CODE BEGIN NonMaskableInt_IRQn 1 */
|
||
while (1)
|
||
{
|
||
}
|
||
/* USER CODE END NonMaskableInt_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles Hard fault interrupt.
|
||
*/
|
||
void HardFault_Handler(void)
|
||
{
|
||
/* USER CODE BEGIN HardFault_IRQn 0 */
|
||
|
||
/* USER CODE END HardFault_IRQn 0 */
|
||
while (1)
|
||
{
|
||
/* USER CODE BEGIN W1_HardFault_IRQn 0 */
|
||
/* USER CODE END W1_HardFault_IRQn 0 */
|
||
}
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles Memory management fault.
|
||
*/
|
||
void MemManage_Handler(void)
|
||
{
|
||
/* USER CODE BEGIN MemoryManagement_IRQn 0 */
|
||
|
||
/* USER CODE END MemoryManagement_IRQn 0 */
|
||
while (1)
|
||
{
|
||
/* USER CODE BEGIN W1_MemoryManagement_IRQn 0 */
|
||
/* USER CODE END W1_MemoryManagement_IRQn 0 */
|
||
}
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles Prefetch fault, memory access fault.
|
||
*/
|
||
void BusFault_Handler(void)
|
||
{
|
||
/* USER CODE BEGIN BusFault_IRQn 0 */
|
||
|
||
/* USER CODE END BusFault_IRQn 0 */
|
||
while (1)
|
||
{
|
||
/* USER CODE BEGIN W1_BusFault_IRQn 0 */
|
||
/* USER CODE END W1_BusFault_IRQn 0 */
|
||
}
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles Undefined instruction or illegal state.
|
||
*/
|
||
void UsageFault_Handler(void)
|
||
{
|
||
/* USER CODE BEGIN UsageFault_IRQn 0 */
|
||
|
||
/* USER CODE END UsageFault_IRQn 0 */
|
||
while (1)
|
||
{
|
||
/* USER CODE BEGIN W1_UsageFault_IRQn 0 */
|
||
/* USER CODE END W1_UsageFault_IRQn 0 */
|
||
}
|
||
}
|
||
|
||
/**
|
||
* @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.
|
||
*/
|
||
void DebugMon_Handler(void)
|
||
{
|
||
/* USER CODE BEGIN DebugMonitor_IRQn 0 */
|
||
|
||
/* USER CODE END DebugMonitor_IRQn 0 */
|
||
/* USER CODE BEGIN DebugMonitor_IRQn 1 */
|
||
|
||
/* 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.
|
||
*/
|
||
void SysTick_Handler(void)
|
||
{
|
||
/* USER CODE BEGIN SysTick_IRQn 0 */
|
||
|
||
/* USER CODE END SysTick_IRQn 0 */
|
||
HAL_IncTick();
|
||
/* USER CODE BEGIN SysTick_IRQn 1 */
|
||
|
||
/* USER CODE END SysTick_IRQn 1 */
|
||
}
|
||
|
||
/******************************************************************************/
|
||
/* STM32G4xx Peripheral Interrupt Handlers */
|
||
/* Add here the Interrupt Handlers for the used peripherals. */
|
||
/* For the available peripheral interrupt handler names, */
|
||
/* please refer to the startup file (startup_stm32g4xx.s). */
|
||
/******************************************************************************/
|
||
|
||
/**
|
||
* @brief This function handles RTC wake-up interrupt through EXTI line 20.
|
||
*/
|
||
void RTC_WKUP_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN RTC_WKUP_IRQn 0 */
|
||
|
||
/* USER CODE END RTC_WKUP_IRQn 0 */
|
||
HAL_RTCEx_WakeUpTimerIRQHandler(&hrtc);
|
||
/* USER CODE BEGIN RTC_WKUP_IRQn 1 */
|
||
|
||
/* USER CODE END RTC_WKUP_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles DMA1 channel1 global interrupt.
|
||
*/
|
||
void DMA1_Channel1_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN DMA1_Channel1_IRQn 0 */
|
||
|
||
/* USER CODE END DMA1_Channel1_IRQn 0 */
|
||
HAL_DMA_IRQHandler(&hdma_adc2);
|
||
/* USER CODE BEGIN DMA1_Channel1_IRQn 1 */
|
||
|
||
/* USER CODE END DMA1_Channel1_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles DMA1 channel2 global interrupt.
|
||
*/
|
||
void DMA1_Channel2_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN DMA1_Channel2_IRQn 0 */
|
||
|
||
/* USER CODE END DMA1_Channel2_IRQn 0 */
|
||
HAL_DMA_IRQHandler(&hdma_adc1);
|
||
/* USER CODE BEGIN DMA1_Channel2_IRQn 1 */
|
||
|
||
/* USER CODE END DMA1_Channel2_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles FDCAN1 interrupt 0.
|
||
*/
|
||
void FDCAN1_IT0_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN FDCAN1_IT0_IRQn 0 */
|
||
|
||
/* USER CODE END FDCAN1_IT0_IRQn 0 */
|
||
HAL_FDCAN_IRQHandler(&hfdcan1);
|
||
/* USER CODE BEGIN FDCAN1_IT0_IRQn 1 */
|
||
|
||
/* USER CODE END FDCAN1_IT0_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles TIM1 break interrupt and TIM15 global interrupt.
|
||
*/
|
||
void TIM1_BRK_TIM15_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN TIM1_BRK_TIM15_IRQn 0 */
|
||
|
||
/* USER CODE END TIM1_BRK_TIM15_IRQn 0 */
|
||
HAL_TIM_IRQHandler(&htim1);
|
||
HAL_TIM_IRQHandler(&htim15);
|
||
/* USER CODE BEGIN TIM1_BRK_TIM15_IRQn 1 */
|
||
|
||
/* USER CODE END TIM1_BRK_TIM15_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles TIM1 trigger and commutation interrupts and TIM17 global interrupt.
|
||
*/
|
||
void TIM1_TRG_COM_TIM17_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN TIM1_TRG_COM_TIM17_IRQn 0 */
|
||
|
||
/* USER CODE END TIM1_TRG_COM_TIM17_IRQn 0 */
|
||
HAL_TIM_IRQHandler(&htim1);
|
||
HAL_TIM_IRQHandler(&htim17);
|
||
/* USER CODE BEGIN TIM1_TRG_COM_TIM17_IRQn 1 */
|
||
|
||
/* USER CODE END TIM1_TRG_COM_TIM17_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles TIM1 capture compare interrupt.
|
||
*/
|
||
void TIM1_CC_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN TIM1_CC_IRQn 0 */
|
||
// Latch once; prevents races while we manipulate SR.
|
||
uint32_t sr = TIM1->SR;
|
||
|
||
// --- Highest priority: END OF PULSE (CC4) ---
|
||
if (sr & TIM_SR_CC4IF) {
|
||
// For OC events it’s sufficient to clear the flag bit.
|
||
TIM1->SR = ~TIM_SR_CC4IF; // write-1-to-clear style: write SR with the inverse bit
|
||
INJ_END(); // keep it short
|
||
}
|
||
|
||
// --- Next: CCR1 (peak) ---
|
||
if (sr & TIM_SR_CC1IF) {
|
||
INJ_SET_DAC(2);
|
||
StartSampling();
|
||
TW_DEFER_BOI_EVAL(TIM2->CNT);
|
||
TIM1->SR = ~TIM_SR_CC1IF;
|
||
|
||
}
|
||
|
||
// --- Next: CCR2 (hold) ---
|
||
if (sr & TIM_SR_CC2IF) {
|
||
TIM1->SR = ~TIM_SR_CC2IF;
|
||
if (isInjecting) {
|
||
INJ_SET_DAC(1);
|
||
}
|
||
}
|
||
|
||
/*// --- Lowest: CCR3 (TRGO alignment / sample window end) ---
|
||
if (sr & TIM_SR_CC3IF) {
|
||
TIM1->SR = ~TIM_SR_CC3IF;
|
||
// keep this very light; avoid long math here
|
||
// If you don’t really need CC3 IRQ (only TRGO), disable CC3IE entirely.
|
||
}*/
|
||
return;
|
||
/* USER CODE END TIM1_CC_IRQn 0 */
|
||
HAL_TIM_IRQHandler(&htim1);
|
||
/* USER CODE BEGIN TIM1_CC_IRQn 1 */
|
||
|
||
/* USER CODE END TIM1_CC_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles TIM2 global interrupt.
|
||
*/
|
||
void TIM2_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN TIM2_IRQn 0 */
|
||
|
||
/* USER CODE END TIM2_IRQn 0 */
|
||
HAL_TIM_IRQHandler(&htim2);
|
||
/* USER CODE BEGIN TIM2_IRQn 1 */
|
||
|
||
/* USER CODE END TIM2_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles TIM3 global interrupt.
|
||
*/
|
||
void TIM3_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN TIM3_IRQn 0 */
|
||
|
||
/* USER CODE END TIM3_IRQn 0 */
|
||
HAL_TIM_IRQHandler(&htim3);
|
||
/* USER CODE BEGIN TIM3_IRQn 1 */
|
||
|
||
/* USER CODE END TIM3_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles USART1 global interrupt / USART1 wake-up interrupt through EXTI line 25.
|
||
*/
|
||
void USART1_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN USART1_IRQn 0 */
|
||
|
||
/* USER CODE END USART1_IRQn 0 */
|
||
HAL_UART_IRQHandler(&huart1);
|
||
/* USER CODE BEGIN USART1_IRQn 1 */
|
||
|
||
/* USER CODE END USART1_IRQn 1 */
|
||
}
|
||
|
||
/**
|
||
* @brief This function handles TIM6 global interrupt, DAC1 and DAC3 channel underrun error interrupts.
|
||
*/
|
||
void TIM6_DAC_IRQHandler(void)
|
||
{
|
||
/* USER CODE BEGIN TIM6_DAC_IRQn 0 */
|
||
|
||
/* USER CODE END TIM6_DAC_IRQn 0 */
|
||
HAL_TIM_IRQHandler(&htim6);
|
||
HAL_DAC_IRQHandler(&hdac1);
|
||
/* USER CODE BEGIN TIM6_DAC_IRQn 1 */
|
||
//FBKW_PIDInterrupt();
|
||
FBKW_service();
|
||
/* USER CODE END TIM6_DAC_IRQn 1 */
|
||
}
|
||
|
||
/* USER CODE BEGIN 1 */
|
||
|
||
/* USER CODE END 1 */
|