mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-17 05:15:25 +03:00
23acf529d7
added MSP_ACC_TRIM stuff for android GUI. git-svn-id: https://afrodevices.googlecode.com/svn/trunk/baseflight@231 7c89a4a9-59b9-e629-4cfe-3a2d53b20e61
60 lines
2.3 KiB
C
Executable file
60 lines
2.3 KiB
C
Executable file
#include "board.h"
|
|
|
|
#define ADC_BATTERY 0
|
|
#define ADC_CURRENT 1
|
|
|
|
// static volatile uint16_t adc1Ch4Value = 0;
|
|
static volatile uint16_t adcValues[2];
|
|
|
|
void adcInit(drv_adc_config_t *init)
|
|
{
|
|
ADC_InitTypeDef ADC_InitStructure;
|
|
DMA_InitTypeDef DMA_InitStructure;
|
|
bool multiChannel = init->powerAdcChannel > 0;
|
|
|
|
// ADC assumes all the GPIO was already placed in 'AIN' mode
|
|
DMA_DeInit(DMA1_Channel1);
|
|
DMA_InitStructure.DMA_PeripheralBaseAddr = (uint32_t)&ADC1->DR;
|
|
DMA_InitStructure.DMA_MemoryBaseAddr = (uint32_t)adcValues;
|
|
DMA_InitStructure.DMA_DIR = DMA_DIR_PeripheralSRC;
|
|
DMA_InitStructure.DMA_BufferSize = multiChannel ? 2 : 1;
|
|
DMA_InitStructure.DMA_PeripheralInc = DMA_PeripheralInc_Disable;
|
|
DMA_InitStructure.DMA_MemoryInc = multiChannel ? DMA_MemoryInc_Enable : DMA_MemoryInc_Disable;
|
|
DMA_InitStructure.DMA_PeripheralDataSize = DMA_PeripheralDataSize_HalfWord;
|
|
DMA_InitStructure.DMA_MemoryDataSize = DMA_MemoryDataSize_HalfWord;
|
|
DMA_InitStructure.DMA_Mode = DMA_Mode_Circular;
|
|
DMA_InitStructure.DMA_Priority = DMA_Priority_High;
|
|
DMA_InitStructure.DMA_M2M = DMA_M2M_Disable;
|
|
DMA_Init(DMA1_Channel1, &DMA_InitStructure);
|
|
/* Enable DMA1 channel1 */
|
|
DMA_Cmd(DMA1_Channel1, ENABLE);
|
|
|
|
ADC_InitStructure.ADC_Mode = ADC_Mode_Independent;
|
|
ADC_InitStructure.ADC_ScanConvMode = multiChannel ? ENABLE : DISABLE;
|
|
ADC_InitStructure.ADC_ContinuousConvMode = ENABLE;
|
|
ADC_InitStructure.ADC_ExternalTrigConv = ADC_ExternalTrigConv_None;
|
|
ADC_InitStructure.ADC_DataAlign = ADC_DataAlign_Right;
|
|
ADC_InitStructure.ADC_NbrOfChannel = multiChannel ? 2 : 1;
|
|
ADC_Init(ADC1, &ADC_InitStructure);
|
|
|
|
ADC_RegularChannelConfig(ADC1, ADC_Channel_4, 1, ADC_SampleTime_28Cycles5);
|
|
if (multiChannel)
|
|
ADC_RegularChannelConfig(ADC1, init->powerAdcChannel, 2, ADC_SampleTime_28Cycles5);
|
|
ADC_DMACmd(ADC1, ENABLE);
|
|
|
|
ADC_Cmd(ADC1, ENABLE);
|
|
|
|
// Calibrate ADC
|
|
ADC_ResetCalibration(ADC1);
|
|
while(ADC_GetResetCalibrationStatus(ADC1));
|
|
ADC_StartCalibration(ADC1);
|
|
while(ADC_GetCalibrationStatus(ADC1));
|
|
|
|
// Fire off ADC
|
|
ADC_SoftwareStartConvCmd(ADC1, ENABLE);
|
|
}
|
|
|
|
uint16_t adcGetChannel(uint8_t channel)
|
|
{
|
|
return adcValues[channel];
|
|
}
|