motor_ctl-3/Core/Src/adc.c

/**
  ******************************************************************************
  * File Name          : ADC.c
  * Description        : This file provides code for the configuration
  *                      of the ADC instances.
  ******************************************************************************
  ** This notice applies to any and all portions of this file
  * that are not between comment pairs USER CODE BEGIN and
  * USER CODE END. Other portions of this file, whether 
  * inserted by the user or by software development tools
  * are owned by their respective copyright owners.
  *
  * COPYRIGHT(c) 2019 STMicroelectronics
  *
  * Redistribution and use in source and binary forms, with or without modification,
  * are permitted provided that the following conditions are met:
  *   1. Redistributions of source code must retain the above copyright notice,
  *      this list of conditions and the following disclaimer.
  *   2. Redistributions in binary form must reproduce the above copyright notice,
  *      this list of conditions and the following disclaimer in the documentation
  *      and/or other materials provided with the distribution.
  *   3. Neither the name of STMicroelectronics nor the names of its contributors
  *      may be used to endorse or promote products derived from this software
  *      without specific prior written permission.
  *
  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  *
  ******************************************************************************
  */

/* Includes ------------------------------------------------------------------*/
#include "adc.h"
#include "gpio.h"
#include "dma.h"

/* USER CODE BEGIN 0 */
#include "ntc_sensor.h"
#include "tim.h"
#include "hall_sensor.h"
#include "MC_Globals.h"
#include "gas_sensor.h"
#include "torque_sensor.h"
#include "math_tools.h"

uint16_t ADC1_Result[ADC1_DATA_NUM] = {0};
uint16_t ADC1_Result_Filt[ADC1_DATA_NUM] = {0};
uint16_t ADC2_Result[ADC2_DATA_NUM] = {0};
uint16_t ADC2_Result_Filt[ADC2_DATA_NUM]= {0};
FlagStatus ADC2_ConvCpmplete_Flag = RESET;
ADC_SensorData_Struct_t ADC_SensorData = {0, 0};//力矩传感器和指拨传感器
ADC_3ShuntCurrent_OffSet_Struct_t ADC_3ShuntCurrent_OffSet = {32768, 32768, 32768};//三相电流零点
ADC_3ShuntCurrent_Struct_t ADC_3ShuntCurrent = {0};
ADC_3ShuntCurrent_Struct_t ADC_3ShuntCurrent_RMSValue = {0};
uint16_t uw_current_offset = 2048;//母线电流零点

/* USER CODE END 0 */

ADC_HandleTypeDef hadc1;
ADC_HandleTypeDef hadc2;
DMA_HandleTypeDef hdma_adc1;

/* ADC1 init function */
void MX_ADC1_Init(void)
{
  ADC_ChannelConfTypeDef sConfig;

    /**Common config 
    */
  hadc1.Instance = ADC1;
  hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
  hadc1.Init.ContinuousConvMode = DISABLE;
  hadc1.Init.DiscontinuousConvMode = DISABLE;
  hadc1.Init.ExternalTrigConv = ADC_SOFTWARE_START;
  hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
  hadc1.Init.NbrOfConversion = 9;
  if (HAL_ADC_Init(&hadc1) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Regular Channel   PCB温度
    */
  sConfig.Channel = ADC_CHANNEL_10;
  sConfig.Rank = ADC_REGULAR_RANK_1;
  sConfig.SamplingTime = ADC_SAMPLETIME_239CYCLES_5;
  if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Regular Channel   母线电压
    */
  sConfig.Channel = ADC_CHANNEL_11;  
  sConfig.Rank = ADC_REGULAR_RANK_2;
	sConfig.SamplingTime = ADC_SAMPLETIME_239CYCLES_5;
  if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Regular Channel   绕组温度
    */
  sConfig.Channel = ADC_CHANNEL_12;
  sConfig.Rank = ADC_REGULAR_RANK_3;
	sConfig.SamplingTime = ADC_SAMPLETIME_239CYCLES_5;
  if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Regular Channel   母线电流
    */
  sConfig.Channel = ADC_CHANNEL_13;
  sConfig.Rank = ADC_REGULAR_RANK_4;
	sConfig.SamplingTime = ADC_SAMPLETIME_7CYCLES_5;
  if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Regular Channel   力矩传感器
    */
  sConfig.Channel = ADC_CHANNEL_5;
  sConfig.Rank = ADC_REGULAR_RANK_5;
	sConfig.SamplingTime = ADC_SAMPLETIME_7CYCLES_5;
  if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Regular Channel   TE工作电压
    */
  sConfig.Channel = ADC_CHANNEL_7;   
  sConfig.Rank = ADC_REGULAR_RANK_6;
	sConfig.SamplingTime = ADC_SAMPLETIME_239CYCLES_5;
  if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Regular Channel   指拨输入
    */
  sConfig.Channel = ADC_CHANNEL_14;
  sConfig.Rank = ADC_REGULAR_RANK_7;
	sConfig.SamplingTime = ADC_SAMPLETIME_7CYCLES_5;
  if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Regular Channel   MCU温度
    */
  sConfig.Channel = ADC_CHANNEL_TEMPSENSOR;
  sConfig.Rank = ADC_REGULAR_RANK_8;
	sConfig.SamplingTime = ADC_SAMPLETIME_13CYCLES_5;
  if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Regular Channel   Vref
    */
  sConfig.Channel = ADC_CHANNEL_VREFINT;
  sConfig.Rank = ADC_REGULAR_RANK_9;
	sConfig.SamplingTime = ADC_SAMPLETIME_239CYCLES_5;
  if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

}
/* ADC2 init function */
void MX_ADC2_Init(void)
{
  ADC_InjectionConfTypeDef sConfigInjected;

    /**Common config 
    */
  hadc2.Instance = ADC2;
  hadc2.Init.ScanConvMode = ADC_SCAN_ENABLE;
  hadc2.Init.ContinuousConvMode = DISABLE;
  hadc2.Init.DiscontinuousConvMode = DISABLE;
  hadc2.Init.ExternalTrigConv = ADC_EXTERNALTRIGINJECCONV_EDGE_NONE;
  hadc2.Init.DataAlign = ADC_DATAALIGN_RIGHT;
  hadc2.Init.NbrOfConversion = 1;
  if (HAL_ADC_Init(&hadc2) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Injected Channel 
    */
  sConfigInjected.InjectedChannel = ADC_CHANNEL_0;
  sConfigInjected.InjectedRank = ADC_INJECTED_RANK_1;
  sConfigInjected.InjectedNbrOfConversion = 3;
  sConfigInjected.InjectedSamplingTime = ADC_SAMPLETIME_1CYCLE_5;
  sConfigInjected.ExternalTrigInjecConv = ADC_EXTERNALTRIGINJECCONV_T1_CC4;
  sConfigInjected.AutoInjectedConv = DISABLE;
  sConfigInjected.InjectedDiscontinuousConvMode = DISABLE;
  sConfigInjected.InjectedOffset = 0;
  if (HAL_ADCEx_InjectedConfigChannel(&hadc2, &sConfigInjected) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Injected Channel 
    */
  sConfigInjected.InjectedChannel = ADC_CHANNEL_1;
  sConfigInjected.InjectedRank = ADC_INJECTED_RANK_2;
  if (HAL_ADCEx_InjectedConfigChannel(&hadc2, &sConfigInjected) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

    /**Configure Injected Channel 
    */
  sConfigInjected.InjectedChannel = ADC_CHANNEL_2;
  sConfigInjected.InjectedRank = ADC_INJECTED_RANK_3;
  if (HAL_ADCEx_InjectedConfigChannel(&hadc2, &sConfigInjected) != HAL_OK)
  {
    _Error_Handler(__FILE__, __LINE__);
  }

}

void HAL_ADC_MspInit(ADC_HandleTypeDef* adcHandle)
{

  GPIO_InitTypeDef GPIO_InitStruct;
  if(adcHandle->Instance==ADC1)
  {
  /* USER CODE BEGIN ADC1_MspInit 0 */

  /* USER CODE END ADC1_MspInit 0 */
    /* ADC1 clock enable */
    __HAL_RCC_ADC1_CLK_ENABLE();
  
    /**ADC1 GPIO Configuration    
    PC0     ------> ADC1_IN10
    PC1     ------> ADC1_IN11
    PC2     ------> ADC1_IN12
    PC3     ------> ADC1_IN13
    PA5     ------> ADC1_IN5
    PA7     ------> ADC1_IN7
    PC4     ------> ADC1_IN14 
    */
    GPIO_InitStruct.Pin = GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2|GPIO_PIN_3 
                          |GPIO_PIN_4;
    GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
    HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);

    GPIO_InitStruct.Pin = GPIO_PIN_5|GPIO_PIN_7;
    GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
    HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);

    /* ADC1 DMA Init */
    /* ADC1 Init */
    hdma_adc1.Instance = DMA1_Channel1;
    hdma_adc1.Init.Direction = DMA_PERIPH_TO_MEMORY;
    hdma_adc1.Init.PeriphInc = DMA_PINC_DISABLE;
    hdma_adc1.Init.MemInc = DMA_MINC_ENABLE;
    hdma_adc1.Init.PeriphDataAlignment = DMA_PDATAALIGN_HALFWORD;
    hdma_adc1.Init.MemDataAlignment = DMA_MDATAALIGN_HALFWORD;
    hdma_adc1.Init.Mode = DMA_CIRCULAR;
    hdma_adc1.Init.Priority = DMA_PRIORITY_LOW;
    if (HAL_DMA_Init(&hdma_adc1) != HAL_OK)
    {
      _Error_Handler(__FILE__, __LINE__);
    }

    __HAL_LINKDMA(adcHandle,DMA_Handle,hdma_adc1);

  /* USER CODE BEGIN ADC1_MspInit 1 */

  /* USER CODE END ADC1_MspInit 1 */
  }
  else if(adcHandle->Instance==ADC2)
  {
  /* USER CODE BEGIN ADC2_MspInit 0 */

  /* USER CODE END ADC2_MspInit 0 */
    /* ADC2 clock enable */
    __HAL_RCC_ADC2_CLK_ENABLE();
  
    /**ADC2 GPIO Configuration    
    PA0-WKUP     ------> ADC2_IN0
    PA1     ------> ADC2_IN1
    PA2     ------> ADC2_IN2 
    */
    GPIO_InitStruct.Pin = GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2;
    GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
    HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
		
		/* ADC2 interrupt Init */
    HAL_NVIC_SetPriority(ADC1_2_IRQn, 1, 1);
    HAL_NVIC_EnableIRQ(ADC1_2_IRQn);
  /* USER CODE BEGIN ADC2_MspInit 1 */

  /* USER CODE END ADC2_MspInit 1 */
  }
}

void HAL_ADC_MspDeInit(ADC_HandleTypeDef* adcHandle)
{

  if(adcHandle->Instance==ADC1)
  {
  /* USER CODE BEGIN ADC1_MspDeInit 0 */

  /* USER CODE END ADC1_MspDeInit 0 */
    /* Peripheral clock disable */
    __HAL_RCC_ADC1_CLK_DISABLE();
  
    /**ADC1 GPIO Configuration    
    PC0     ------> ADC1_IN10
    PC1     ------> ADC1_IN11
    PC2     ------> ADC1_IN12
    PC3     ------> ADC1_IN13
    PA5     ------> ADC1_IN5
    PA7     ------> ADC1_IN7
    PC4     ------> ADC1_IN14 
    */
    HAL_GPIO_DeInit(GPIOC, GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2|GPIO_PIN_3 
                          |GPIO_PIN_4);

    HAL_GPIO_DeInit(GPIOA, GPIO_PIN_5|GPIO_PIN_7);

    /* ADC1 DMA DeInit */
    HAL_DMA_DeInit(adcHandle->DMA_Handle);
  /* USER CODE BEGIN ADC1_MspDeInit 1 */

  /* USER CODE END ADC1_MspDeInit 1 */
  }
  else if(adcHandle->Instance==ADC2)
  {
  /* USER CODE BEGIN ADC2_MspDeInit 0 */

  /* USER CODE END ADC2_MspDeInit 0 */
    /* Peripheral clock disable */
    __HAL_RCC_ADC2_CLK_DISABLE();
  
    /**ADC2 GPIO Configuration    
    PA0-WKUP     ------> ADC2_IN0
    PA1     ------> ADC2_IN1
    PA2     ------> ADC2_IN2 
    */
    HAL_GPIO_DeInit(GPIOA, GPIO_PIN_0|GPIO_PIN_1|GPIO_PIN_2);

  /* USER CODE BEGIN ADC2_MspDeInit 1 */

  /* USER CODE END ADC2_MspDeInit 1 */
  }
} 

/* USER CODE BEGIN 1 */
void ADC_Start(void)
{
	HAL_ADCEx_Calibration_Start(&hadc1);
	HAL_ADCEx_Calibration_Start(&hadc2);
  
	HAL_ADC_Start(&hadc1);
	HAL_ADC_Start(&hadc2);
	
  HAL_ADCEx_InjectedStart_IT(&hadc2);
	
	HAL_ADC_Start_DMA(&hadc1, (uint32_t *)ADC1_Result, ADC1_DATA_NUM);	
	__HAL_DMA_DISABLE_IT(hadc1.DMA_Handle, DMA_IT_HT);	
	
	HAL_TIM_Base_Start_IT(&PWM_TIMER);
	HAL_TIM_PWM_Start(&PWM_TIMER, TIM_CHANNEL_4);
	HAL_TIMEx_PWMN_Start(&PWM_TIMER, TIM_CHANNEL_4);
}

//更新三相电流采样值
void HAL_ADCEx_InjectedConvCpltCallback(ADC_HandleTypeDef* hadc)
{
	//更新3相电流采样值	
	ADC2_Result[ADC2_RANK_CURRENT_A] = HAL_ADCEx_InjectedGetValue(hadc,1) << 4;
	
	#if 1 //正常运行
	ADC2_Result[ADC2_RANK_CURRENT_B] = HAL_ADCEx_InjectedGetValue(hadc,2) << 4;
	#elif 1//模拟A、B相电流采样短路
	ADC2_Result[ADC2_RANK_CURRENT_B] = HAL_ADCEx_InjectedGetValue(hadc,1) << 4;
	#endif
	
	ADC2_Result[ADC2_RANK_CURRENT_C] = HAL_ADCEx_InjectedGetValue(hadc,3) << 4;
 
	//计算三相电流
	ADC_3ShuntCurrent.uw_phase_a = (int16_t)(ADC_3ShuntCurrent_OffSet.uw_phase_a_offset - ADC2_Result[ADC2_RANK_CURRENT_A]);
	#if 0 //模拟A相电流值比真实值大一倍
	ADC_3ShuntCurrent.uw_phase_a *= 2;
	#endif
	ADC_3ShuntCurrent.uw_phase_b = (int16_t)(ADC_3ShuntCurrent_OffSet.uw_phase_b_offset - ADC2_Result[ADC2_RANK_CURRENT_B]);
	ADC_3ShuntCurrent.uw_phase_c = (int16_t)(ADC_3ShuntCurrent_OffSet.uw_phase_c_offset - ADC2_Result[ADC2_RANK_CURRENT_C]);
	
	///计算三相电流有效值
	PhaseCurrent_CalRMSValue(ADC2_Result, &ADC_3ShuntCurrent_RMSValue);
	
	ADC2_ConvCpmplete_Flag = SET;
}

//更新ADC采样结果
void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef* hadc)
{
  #if 1
	static uint32_t PeriodTestCnt = 0;
	PeriodTestCnt++;
	if(PeriodTestCnt > 300)
	{
	  PeriodTestCnt = 0;
	}
	#endif
		
	int32_t Temp_32;
	static int32_t IdcFltSum = 0;
	static uint32_t T_Roil_Sum = 0;
	static uint16_t T_Roil_FiltCnt = 0;
	static uint32_t T_PCB_Sum = 0;
	static uint16_t T_PCB_FiltCnt = 0;
	
	//更新PCB温度
	T_PCB_Sum += ADC1_Result[ADC1_RANK_NTC_PCB];
	T_PCB_FiltCnt++;
	if(T_PCB_FiltCnt >= 2048)
	{
	  MC_RunInfo.T_PCB = GetNTCTempera(T_PCB_Sum >> 11);
		T_PCB_Sum = 0;
		T_PCB_FiltCnt = 0;
	}
	
	//更新母线电压 
	MC_RunInfo.BusVoltage = (uint32_t)ADC1_Result[ADC1_RANK_VIN] * 18507 >> 10;//3300 * 1256 / (4095 * 56)
	
	//更新绕组温度
	#if 1 //正常运行
	T_Roil_Sum += ADC1_Result[ADC1_RANK_NTC_ROIL];
	#elif 1 //模拟固定值
	T_Roil_Sum += 2000;
	#endif
	T_Roil_FiltCnt++;
	if(T_Roil_FiltCnt >= 2048)
	{
		MC_RunInfo.T_Roil = GetNTCTempera(T_Roil_Sum >> 11);
		T_Roil_Sum = 0;
		T_Roil_FiltCnt = 0;
	}
	
	//更新母线电流
	Temp_32 = (ADC1_Result[ADC1_RANK_CURRENT] - uw_current_offset) * 50000 >> 11;
	Temp_32 = (Temp_32 <= 0) ? 0 : Temp_32;
	IdcFltSum += ((Temp_32 << 10) - IdcFltSum) >> 8;
	MC_RunInfo.BusCurrent = IdcFltSum >> 10;
	
	//更新力矩传感器
	Temp_32 = (ADC1_Result[ADC1_RANK_TORQUE_SENSOR] - TorqueOffSetData.PresentData) * 100 / MC_TorqueCorrectParam.K;
	Temp_32 = ((Temp_32 <= 0) ? 0 : Temp_32);
	#if 1 //采用原始采集值
	ADC_SensorData.TorqueSensor = Temp_32;
	#else  //采用滤波值
	static int32_t TorqueFltSum = 0;
	TorqueFltSum += ((Temp_32 << 10) - TorqueFltSum) >> 8;
	ADC_SensorData.TorqueSensor = TorqueFltSum >> 10;
	#endif
		
	//更新TE工作电压
	MC_TE_SensorStatus.MCU_Voltage = (uint32_t)ADC1_Result[ADC1_RANK_3V3_TE] * 2 * 3300 >> 12;//3300 * 2 / 4095
	
	//更新指拨
	Temp_32 = ADC1_Result[ADC1_RANK_GAS] - GasSensor_OffSet;
	ADC_SensorData.GasSensor = (Temp_32 <= 0) ? 0 : Temp_32;
	
	//更新MCU温度
	Temp_32 = 3300 * ADC1_Result[ADC1_RANK_TP_MCU] >> 12;
	Temp_32 = (int32_t)1430 - Temp_32;
	MC_RunInfo.T_MCU = (uint8_t)((Temp_32 * 238 >> 10) + 25 + 40);
	
	//更新Vref
	
}

//ADC1和ADC2数据滑动滤波
void ADC_SensorData_Filt(uint16_t* p_ADC1_Result_Filt, uint16_t* p_ADC2_Result_Filt)
{
  static uint32_t PeriodTimeCnt = 0;
	static int32_t ADC1_FltSum[ADC1_DATA_NUM] = {0};
	static int32_t ADC2_FltSum[ADC2_DATA_NUM] = {0};
	uint8_t i;
	
	if((HAL_GetTick() - PeriodTimeCnt) >= 2)
	{
		for(i=0; i<ADC1_DATA_NUM; i++)
		{
		  ADC1_FltSum[i] += ((ADC1_Result[i] << 10) - ADC1_FltSum[i]) >> 8;
			p_ADC1_Result_Filt[i] = ADC1_FltSum[i] >> 10;
		}
		for(i=0; i<ADC2_DATA_NUM; i++)
		{
		  ADC2_FltSum[i] += ((ADC2_Result[i] << 10) - ADC2_FltSum[i]) >> 8;
			p_ADC2_Result_Filt[i] = ADC2_FltSum[i] >> 10;
		}
		
		PeriodTimeCnt = HAL_GetTick();
	}
}

//相电流有效值计算，有效值 = 最大值 * 0.707，运行频率15K
void PhaseCurrent_CalRMSValue(uint16_t* ADC2_Result, ADC_3ShuntCurrent_Struct_t* PhaseCurrent_RMS)
{
  static uint16_t	PhaseCurrentA_Max = 0;
	static uint16_t PhaseCurrentB_Max = 0;
	static uint16_t PhaseCurrentC_Max = 0;
	static uint16_t Count = 0;
	int16_t DataTemp;
	
	//计算A相电流峰值
	if(PhaseCurrentA_Max < ADC2_Result[ADC2_RANK_CURRENT_A])
	{
	  PhaseCurrentA_Max = ADC2_Result[ADC2_RANK_CURRENT_A];
	}
	//计算B相电流峰值
	if(PhaseCurrentB_Max < ADC2_Result[ADC2_RANK_CURRENT_B])
	{
	  PhaseCurrentB_Max = ADC2_Result[ADC2_RANK_CURRENT_B];
	}
	//计算C相电流峰值
	if(PhaseCurrentC_Max < ADC2_Result[ADC2_RANK_CURRENT_C])
	{
	  PhaseCurrentC_Max = ADC2_Result[ADC2_RANK_CURRENT_C];
	}
	
	Count++;
	if(Count >= 500)
	{
	  DataTemp = PhaseCurrentA_Max - ADC_3ShuntCurrent_OffSet.uw_phase_a_offset;
		PhaseCurrentA_Max = 0;
		PhaseCurrent_RMS->uw_phase_a = (abs(DataTemp) * 724) >> 10;
		DataTemp = PhaseCurrentB_Max - ADC_3ShuntCurrent_OffSet.uw_phase_b_offset;
		PhaseCurrentB_Max = 0;
		PhaseCurrent_RMS->uw_phase_b = (abs(DataTemp) * 724) >> 10;
		DataTemp = PhaseCurrentC_Max - ADC_3ShuntCurrent_OffSet.uw_phase_c_offset;
		PhaseCurrentC_Max = 0;
		PhaseCurrent_RMS->uw_phase_c = (abs(DataTemp) * 724) >> 10;
		Count = 0;
	}
	
}

/* USER CODE END 1 */

/**
  * @}
  */

/**
  * @}
  */

/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/