278 lines
7.5 KiB
C
278 lines
7.5 KiB
C
/**
|
||
******************************************************************************
|
||
* @file battery.c
|
||
* @author Lucien Senaneuch
|
||
* @version V1.0
|
||
* @date 16-mai-2016
|
||
* @brief Supervision de la tension batterie et detection de charge.
|
||
* Calcule le voltage de la batterie <20> interval r<>gulier.
|
||
* Converti le voltage batterie en signaux de commande - 2 -1 - 0.
|
||
* Configure une interruption externe pour d<>tecter le branchement
|
||
* du chargeur.
|
||
******************************************************************************
|
||
******************************************************************************
|
||
*/
|
||
|
||
#include <battery.h>
|
||
#include "system_dumby.h"
|
||
#include "motor.h"
|
||
#include <stm32f10x.h>
|
||
|
||
uint16_t PrescalerValue = 0;
|
||
uint16_t PWM_BATTERY_ON = 0xC0;
|
||
uint16_t PWM_BATTERY_OFF = 0;
|
||
TIM_TimeBaseInitTypeDef TIM_BaseTempsTimer;
|
||
TIM_OCInitTypeDef TIM_PWMConfigure;
|
||
|
||
ADC_InitTypeDef ADC_InitStructure;
|
||
DMA_InitTypeDef DMA_BAT_InitStructure;
|
||
__IO uint16_t ADCConvertedValue[VOLTAGE_BUFFER_SIZE];
|
||
|
||
/** @addtogroup Projects
|
||
* @{
|
||
*/
|
||
|
||
/** @addtogroup battery
|
||
* @{
|
||
*/
|
||
|
||
|
||
/** @addtogroup Init_GPIO_DMA_IT_Battery
|
||
* @{
|
||
*/
|
||
|
||
/**
|
||
* @brief Definis les GPIO necessaires pour la batterie.
|
||
*
|
||
* La fonction MAP_MotorPin va venir configurer le E/S du GPIO pour correspondre avec
|
||
* le sch<63>ma electrique en ressource. La fonction initialise aussi l'interruption EXTI
|
||
* de la d<>tection du chargeur.
|
||
*
|
||
* @note A3 en output alternate function.
|
||
* A0 et A4 en floating input.
|
||
* PB11 en floating input (EXTI)
|
||
*
|
||
* @param None
|
||
* @retval None
|
||
*
|
||
*/
|
||
|
||
void MAP_batteryPin(void)
|
||
{
|
||
GPIO_InitTypeDef Init_Structure;
|
||
NVIC_InitTypeDef NVIC_InitStructure;
|
||
EXTI_InitTypeDef EXTI_InitStructure;
|
||
|
||
Init_Structure.GPIO_Pin = GPIO_Pin_3;
|
||
Init_Structure.GPIO_Speed = GPIO_Speed_10MHz;
|
||
Init_Structure.GPIO_Mode = GPIO_Mode_AF_PP;
|
||
GPIO_Init(GPIOA, &Init_Structure);
|
||
|
||
// Configure les PIN A0,A4 en input floating.
|
||
Init_Structure.GPIO_Pin = GPIO_Pin_0|GPIO_Pin_4;
|
||
Init_Structure.GPIO_Mode = GPIO_Mode_AIN;
|
||
GPIO_Init(GPIOA, &Init_Structure);
|
||
|
||
// Configure PB11 en input pullup
|
||
Init_Structure.GPIO_Pin = GPIO_Pin_11;
|
||
Init_Structure.GPIO_Mode = GPIO_Mode_IPU;
|
||
GPIO_Init(GPIOB, &Init_Structure);
|
||
|
||
GPIO_EXTILineConfig(GPIO_PortSourceGPIOB, GPIO_PinSource11);
|
||
|
||
EXTI_InitStructure.EXTI_Line = EXTI_Line11;
|
||
EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt;
|
||
EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Rising;
|
||
EXTI_InitStructure.EXTI_LineCmd = ENABLE;
|
||
EXTI_Init(&EXTI_InitStructure);
|
||
|
||
NVIC_InitStructure.NVIC_IRQChannel = EXTI15_10_IRQn;
|
||
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 3;
|
||
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0;
|
||
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
|
||
NVIC_Init(&NVIC_InitStructure);
|
||
}
|
||
|
||
/**
|
||
* @brief Initialise la dma pour stocker les valeur dans ADCConvertedValue.
|
||
* On stockera 16 valeurs de fa<66>on <20> faire un moyennage.
|
||
*
|
||
* @param None
|
||
* @retval None
|
||
*
|
||
*/
|
||
|
||
void DMA_BAT(void)
|
||
{
|
||
/* DMA1 channel1 configuration ----------------------------------------------*/
|
||
DMA_DeInit(DMA1_Channel1);
|
||
DMA_BAT_InitStructure.DMA_PeripheralBaseAddr = (uint32_t)&(ADC1->DR); // ADC1_DR_Address;
|
||
DMA_BAT_InitStructure.DMA_MemoryBaseAddr = (uint32_t)&ADCConvertedValue;
|
||
DMA_BAT_InitStructure.DMA_DIR = DMA_DIR_PeripheralSRC;
|
||
DMA_BAT_InitStructure.DMA_BufferSize = VOLTAGE_BUFFER_SIZE; // voir schèmas ci dessus
|
||
DMA_BAT_InitStructure.DMA_PeripheralInc = DMA_PeripheralInc_Disable;
|
||
DMA_BAT_InitStructure.DMA_MemoryInc = DMA_MemoryInc_Enable;
|
||
DMA_BAT_InitStructure.DMA_PeripheralDataSize = DMA_PeripheralDataSize_HalfWord;
|
||
DMA_BAT_InitStructure.DMA_MemoryDataSize = DMA_MemoryDataSize_HalfWord;
|
||
DMA_BAT_InitStructure.DMA_Mode = DMA_Mode_Normal;
|
||
DMA_BAT_InitStructure.DMA_Priority = DMA_Priority_High;
|
||
DMA_BAT_InitStructure.DMA_M2M = DMA_M2M_Disable;
|
||
DMA_Init(DMA1_Channel1, &DMA_BAT_InitStructure);
|
||
|
||
DMA_Cmd(DMA1_Channel1, ENABLE);
|
||
DMA_ITConfig(DMA1_Channel1, DMA_IT_TC, ENABLE);
|
||
}
|
||
|
||
/**
|
||
* @}
|
||
*/
|
||
|
||
/** @addtogroup Lancer_acquisition
|
||
* @{
|
||
*/
|
||
/**
|
||
* @brief Demarrage des Acquisitions de la DMA.
|
||
*
|
||
* @param None
|
||
* @retval None
|
||
*
|
||
*/
|
||
|
||
void startACQDMA(void)
|
||
{
|
||
ADC_DMACmd(ADC1, ENABLE);
|
||
DMA_DeInit(DMA1_Channel1);
|
||
DMA_Init(DMA1_Channel1, &DMA_BAT_InitStructure);
|
||
DMA_Cmd(DMA1_Channel1, ENABLE);
|
||
DMA_ITConfig(DMA1_Channel1, DMA_IT_TC, ENABLE);
|
||
}
|
||
|
||
/**
|
||
* @brief Fonction de plus haut niveau qui initialisera la DMA et qui lancera une nouvelle acquisition.
|
||
* Cette fonction est appell<6C> <20> interval r<>gulier dans le systick. Cette fonction utilise startACQDMA.
|
||
*
|
||
* @param None
|
||
* @retval None
|
||
*
|
||
*/
|
||
|
||
void voltagePrepare(void)
|
||
{
|
||
DMA_BAT_InitStructure.DMA_BufferSize = VOLTAGE_BUFFER_SIZE;
|
||
|
||
ADC_RegularChannelConfig(ADC1, ADC_Channel_4, 1, ADC_SampleTime_55Cycles5);
|
||
ADC_Cmd(ADC1, ENABLE);
|
||
startACQDMA();
|
||
}
|
||
|
||
/**
|
||
* @}
|
||
*/
|
||
|
||
/** @addtogroup Init_GPIO_DMA_IT_Battery
|
||
* @{
|
||
*/
|
||
|
||
/**
|
||
* @brief Configuration et Calibration de l'ADC1 sur 1 channel.
|
||
* L'adc lira en mode continue.
|
||
*
|
||
* @param None
|
||
* @retval None
|
||
*
|
||
*/
|
||
|
||
void ADC1_CONFIG(void)
|
||
{
|
||
/* ADC1 configuration ------------------------------------------------------*/
|
||
ADC_InitStructure.ADC_Mode = ADC_Mode_Independent;
|
||
ADC_InitStructure.ADC_ScanConvMode = ENABLE;
|
||
ADC_InitStructure.ADC_ContinuousConvMode = ENABLE;
|
||
ADC_InitStructure.ADC_ExternalTrigConv = ADC_ExternalTrigConv_None;
|
||
ADC_InitStructure.ADC_DataAlign = ADC_DataAlign_Right;
|
||
ADC_InitStructure.ADC_NbrOfChannel = 1;
|
||
ADC_Init(ADC1, &ADC_InitStructure);
|
||
|
||
/* ADC1 regular channel1 configuration */
|
||
ADC_RegularChannelConfig(ADC1, ADC_Channel_0, 1, ADC_SampleTime_71Cycles5);
|
||
|
||
/* Start ADC1 Software Conversion */
|
||
ADC_Cmd(ADC1, ENABLE);
|
||
|
||
ADC_StartCalibration(ADC1);
|
||
/* Check the end of ADC1 calibration */
|
||
while(ADC_GetCalibrationStatus(ADC1));
|
||
|
||
ADC_SoftwareStartConvCmd(ADC1, ENABLE);
|
||
}
|
||
|
||
/**
|
||
* @brief Initialise l'interruption <20> la fin des acquisitions sur la DMA.
|
||
*
|
||
* @param None
|
||
* @retval None
|
||
*
|
||
*/
|
||
|
||
void INIT_IT_DMA(void)
|
||
{
|
||
NVIC_InitTypeDef NVIC_InitStructure;
|
||
|
||
/* Enable the USARTz Interrupt */
|
||
NVIC_InitStructure.NVIC_IRQChannel = DMA1_Channel1_IRQn;
|
||
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 2;
|
||
NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0;
|
||
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
|
||
NVIC_Init(&NVIC_InitStructure);
|
||
}
|
||
|
||
/**
|
||
* @}
|
||
*/
|
||
|
||
|
||
/** @addtogroup Handler
|
||
* @{
|
||
*/
|
||
|
||
|
||
/**
|
||
* @brief Interruption Handler. Qui va faire la moyenne des derni<6E>res
|
||
* acquisitions lorsque la DMA <20> rempli son buffer.
|
||
*
|
||
* @param None
|
||
* @retval None
|
||
*
|
||
*/
|
||
void DMA1_Channel1_IRQHandler(void)
|
||
{
|
||
//Test on DMA1 Channel1 Transfer Complete interrupt
|
||
if (DMA_GetITStatus(DMA1_IT_TC1))
|
||
{
|
||
Dumber.BatterieChecking=TRUE;
|
||
//Clear DMA1 Channel1 Half Transfer, Transfer Complete and Global interrupt pending bits
|
||
DMA_ClearITPendingBit(DMA1_IT_GL1);
|
||
}
|
||
}
|
||
|
||
/**
|
||
* @brief Interruption qui donne l'ordre d'<27>teindre le robot.
|
||
* L'IT se d<>clenche lorsque le chargeur est branch<63>.
|
||
*
|
||
* @param None
|
||
* @retval None
|
||
*
|
||
*/
|
||
void EXTI15_10_IRQHandler(void)
|
||
{
|
||
shutDown();
|
||
while (1);
|
||
}
|
||
|
||
/**
|
||
* @}
|
||
*/
|
||
|
||
/**
|
||
* @}
|
||
*/
|