VCU linelock regen implementation

PDU/firmware/Core/Inc/adc.h

@@ -34,11 +34,15 @@ extern "C" {
 
 extern ADC_HandleTypeDef hadc3;
 
+extern ADC_HandleTypeDef hadc5;
+extern DMA_HandleTypeDef hdma_adc5;
+
 /* USER CODE BEGIN Private defines */
 
 /* USER CODE END Private defines */
 
 void MX_ADC3_Init(void);
+void MX_ADC5_Init(void);
 
 /* USER CODE BEGIN Prototypes */
 

PDU/firmware/Core/Inc/dma.h

@@ -0,0 +1,25 @@
+/* USER CODE BEGIN Header */
+/**
+  ******************************************************************************
+  * @file    dma.h
+  * @brief   This file contains all the function prototypes for
+  *          the dma.c file
+  ******************************************************************************
+  */
+/* USER CODE END Header */
+#ifndef __DMA_H__
+#define __DMA_H__
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+
+#include "main.h"
+
+void MX_DMA_Init(void);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* __DMA_H__ */

PDU/firmware/Core/Inc/main.h

@@ -69,6 +69,8 @@ void Error_Handler(void);
 #define SW_BOARDS_GPIO_Port GPIOC
 #define SW_FANS_Pin GPIO_PIN_3
 #define SW_FANS_GPIO_Port GPIOC
+#define Line_Lock_EN_Pin GPIO_PIN_2
+#define Line_Lock_EN_GPIO_Port GPIOF
 #define PWM_TSSI_R_Pin GPIO_PIN_0
 #define PWM_TSSI_R_GPIO_Port GPIOA
 #define PWM_BRAKEL_Pin GPIO_PIN_1
@@ -79,6 +81,20 @@ void Error_Handler(void);
 #define SNS_TSSI_G_GPIO_Port GPIOB
 #define ST_TSSI_G_Pin GPIO_PIN_15
 #define ST_TSSI_G_GPIO_Port GPIOE
+#define SDWN_12_Sense_Pin GPIO_PIN_14
+#define SDWN_12_Sense_GPIO_Port GPIOB
+#define SDWN_13_Sense_Pin GPIO_PIN_15
+#define SDWN_13_Sense_GPIO_Port GPIOB
+#define SDWN_11_Sense_Pin GPIO_PIN_8
+#define SDWN_11_Sense_GPIO_Port GPIOD
+#define SDWN_15_Sense_Pin GPIO_PIN_9
+#define SDWN_15_Sense_GPIO_Port GPIOC
+#define SDWN_1_Sense_Pin GPIO_PIN_8
+#define SDWN_1_Sense_GPIO_Port GPIOA
+#define BSE_3_Pin GPIO_PIN_9
+#define BSE_3_GPIO_Port GPIOA
+#define SDWN_14_Sense_Pin GPIO_PIN_15
+#define SDWN_14_Sense_GPIO_Port GPIOA
 #define SW_BATT_FANS1_Pin GPIO_PIN_4
 #define SW_BATT_FANS1_GPIO_Port GPIOB
 #define SW_BATT_FANS2_Pin GPIO_PIN_5

PDU/firmware/Core/Inc/stm32g4xx_it.h

@@ -50,9 +50,10 @@ void NMI_Handler(void);
 void HardFault_Handler(void);
 void MemManage_Handler(void);
 void BusFault_Handler(void);
-void UsageFault_Handler(void);
-void DebugMon_Handler(void);
-void USB_LP_IRQHandler(void);
+void UsageFault_Handler(void);
+void DebugMon_Handler(void);
+void DMA2_Channel2_IRQHandler(void);
+void USB_LP_IRQHandler(void);
 void FDCAN1_IT0_IRQHandler(void);
 void FDCAN1_IT1_IRQHandler(void);
 void TIM20_UP_IRQHandler(void);

PDU/firmware/Core/Src/adc.c

@@ -24,7 +24,9 @@
 
 /* USER CODE END 0 */
 
-ADC_HandleTypeDef hadc3;
+ADC_HandleTypeDef hadc3;
+ADC_HandleTypeDef hadc5;
+DMA_HandleTypeDef hdma_adc5;
 
 /* ADC3 init function */
 void MX_ADC3_Init(void)
@@ -89,6 +91,71 @@ void MX_ADC3_Init(void)
   /* USER CODE END ADC3_Init 2 */
 
 }
+/* ADC5 init function */
+void MX_ADC5_Init(void)
+{
+
+  /* USER CODE BEGIN ADC5_Init 0 */
+
+  /* USER CODE END ADC5_Init 0 */
+
+  ADC_ChannelConfTypeDef sConfig = {0};
+
+  /* USER CODE BEGIN ADC5_Init 1 */
+
+  /* USER CODE END ADC5_Init 1 */
+
+  /** Common config
+  */
+  hadc5.Instance = ADC5;
+  hadc5.Init.ClockPrescaler = ADC_CLOCK_SYNC_PCLK_DIV2;
+  hadc5.Init.Resolution = ADC_RESOLUTION_12B;
+  hadc5.Init.DataAlign = ADC_DATAALIGN_RIGHT;
+  hadc5.Init.GainCompensation = 0;
+  hadc5.Init.ScanConvMode = ADC_SCAN_ENABLE;
+  hadc5.Init.EOCSelection = ADC_EOC_SINGLE_CONV;
+  hadc5.Init.LowPowerAutoWait = DISABLE;
+  hadc5.Init.ContinuousConvMode = DISABLE;
+  hadc5.Init.NbrOfConversion = 2;
+  hadc5.Init.DiscontinuousConvMode = DISABLE;
+  hadc5.Init.ExternalTrigConv = ADC_SOFTWARE_START;
+  hadc5.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;
+  hadc5.Init.DMAContinuousRequests = ENABLE;
+  hadc5.Init.Overrun = ADC_OVR_DATA_PRESERVED;
+  hadc5.Init.OversamplingMode = DISABLE;
+  if (HAL_ADC_Init(&hadc5) != HAL_OK)
+  {
+    Error_Handler();
+  }
+
+  /** Configure Regular Channel
+  */
+  sConfig.Channel = ADC_CHANNEL_1;
+  sConfig.Rank = ADC_REGULAR_RANK_1;
+  sConfig.SamplingTime = ADC_SAMPLETIME_247CYCLES_5;
+  sConfig.SingleDiff = ADC_SINGLE_ENDED;
+  sConfig.OffsetNumber = ADC_OFFSET_NONE;
+  sConfig.Offset = 0;
+  if (HAL_ADC_ConfigChannel(&hadc5, &sConfig) != HAL_OK)
+  {
+    Error_Handler();
+  }
+
+  /** Configure Regular Channel
+  */
+  sConfig.Channel = ADC_CHANNEL_2;
+  sConfig.Rank = ADC_REGULAR_RANK_2;
+  if (HAL_ADC_ConfigChannel(&hadc5, &sConfig) != HAL_OK)
+  {
+    Error_Handler();
+  }
+  /* USER CODE BEGIN ADC5_Init 2 */
+
+  /* USER CODE END ADC5_Init 2 */
+
+}
+
+static uint32_t HAL_RCC_ADC345_CLK_ENABLED=0;
 
 void HAL_ADC_MspInit(ADC_HandleTypeDef* adcHandle)
 {
@@ -111,7 +178,10 @@ void HAL_ADC_MspInit(ADC_HandleTypeDef* adcHandle)
     }
 
     /* ADC3 clock enable */
-    __HAL_RCC_ADC345_CLK_ENABLE();
+    HAL_RCC_ADC345_CLK_ENABLED++;
+    if(HAL_RCC_ADC345_CLK_ENABLED==1){
+      __HAL_RCC_ADC345_CLK_ENABLE();
+    }
 
     __HAL_RCC_GPIOB_CLK_ENABLE();
     /**ADC3 GPIO Configuration
@@ -126,6 +196,59 @@ void HAL_ADC_MspInit(ADC_HandleTypeDef* adcHandle)
 
   /* USER CODE END ADC3_MspInit 1 */
   }
+  else if(adcHandle->Instance==ADC5)
+  {
+  /* USER CODE BEGIN ADC5_MspInit 0 */
+
+  /* USER CODE END ADC5_MspInit 0 */
+
+  /** Initializes the peripherals clocks
+  */
+    PeriphClkInit.PeriphClockSelection = RCC_PERIPHCLK_ADC345;
+    PeriphClkInit.Adc345ClockSelection = RCC_ADC345CLKSOURCE_SYSCLK;
+    if (HAL_RCCEx_PeriphCLKConfig(&PeriphClkInit) != HAL_OK)
+    {
+      Error_Handler();
+    }
+
+    /* ADC5 clock enable */
+    HAL_RCC_ADC345_CLK_ENABLED++;
+    if(HAL_RCC_ADC345_CLK_ENABLED==1){
+      __HAL_RCC_ADC345_CLK_ENABLE();
+    }
+
+    __HAL_RCC_GPIOA_CLK_ENABLE();
+    /**ADC5 GPIO Configuration
+    PA8     ------> ADC5_IN1
+    PA9     ------> ADC5_IN2
+    */
+    GPIO_InitStruct.Pin = SDWN_1_Sense_Pin|BSE_3_Pin;
+    GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
+    GPIO_InitStruct.Pull = GPIO_NOPULL;
+    HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
+
+    /* ADC5 DMA Init */
+    /* ADC5 Init */
+    hdma_adc5.Instance = DMA2_Channel2;
+    hdma_adc5.Init.Request = DMA_REQUEST_ADC5;
+    hdma_adc5.Init.Direction = DMA_PERIPH_TO_MEMORY;
+    hdma_adc5.Init.PeriphInc = DMA_PINC_DISABLE;
+    hdma_adc5.Init.MemInc = DMA_MINC_ENABLE;
+    hdma_adc5.Init.PeriphDataAlignment = DMA_PDATAALIGN_HALFWORD;
+    hdma_adc5.Init.MemDataAlignment = DMA_MDATAALIGN_HALFWORD;
+    hdma_adc5.Init.Mode = DMA_CIRCULAR;
+    hdma_adc5.Init.Priority = DMA_PRIORITY_MEDIUM;
+    if (HAL_DMA_Init(&hdma_adc5) != HAL_OK)
+    {
+      Error_Handler();
+    }
+
+    __HAL_LINKDMA(adcHandle,DMA_Handle,hdma_adc5);
+
+  /* USER CODE BEGIN ADC5_MspInit 1 */
+
+  /* USER CODE END ADC5_MspInit 1 */
+  }
 }
 
 void HAL_ADC_MspDeInit(ADC_HandleTypeDef* adcHandle)
@@ -137,7 +260,10 @@ void HAL_ADC_MspDeInit(ADC_HandleTypeDef* adcHandle)
 
   /* USER CODE END ADC3_MspDeInit 0 */
     /* Peripheral clock disable */
-    __HAL_RCC_ADC345_CLK_DISABLE();
+    HAL_RCC_ADC345_CLK_ENABLED--;
+    if(HAL_RCC_ADC345_CLK_ENABLED==0){
+      __HAL_RCC_ADC345_CLK_DISABLE();
+    }
 
     /**ADC3 GPIO Configuration
     PB0     ------> ADC3_IN12
@@ -148,6 +274,30 @@ void HAL_ADC_MspDeInit(ADC_HandleTypeDef* adcHandle)
 
   /* USER CODE END ADC3_MspDeInit 1 */
   }
+  else if(adcHandle->Instance==ADC5)
+  {
+  /* USER CODE BEGIN ADC5_MspDeInit 0 */
+
+  /* USER CODE END ADC5_MspDeInit 0 */
+    /* Peripheral clock disable */
+    HAL_RCC_ADC345_CLK_ENABLED--;
+    if(HAL_RCC_ADC345_CLK_ENABLED==0){
+      __HAL_RCC_ADC345_CLK_DISABLE();
+    }
+
+    /**ADC5 GPIO Configuration
+    PA8     ------> ADC5_IN1
+    PA9     ------> ADC5_IN2
+    */
+    HAL_GPIO_DeInit(GPIOA, SDWN_1_Sense_Pin|BSE_3_Pin);
+
+    /* ADC5 DMA DeInit */
+    HAL_DMA_DeInit(adcHandle->DMA_Handle);
+
+  /* USER CODE BEGIN ADC5_MspDeInit 1 */
+
+  /* USER CODE END ADC5_MspDeInit 1 */
+  }
 }
 
 /* USER CODE BEGIN 1 */