cpu/stm32/adc_f3: improve peripheral driver
- fix clock enable/disable bitfields - add management for ADC3 and ADC4 - improve calibration
This commit is contained in:
parent
a206df5399
commit
3d6b473cd7
@ -25,9 +25,8 @@
|
|||||||
#include "periph_conf.h"
|
#include "periph_conf.h"
|
||||||
#include "xtimer.h"
|
#include "xtimer.h"
|
||||||
|
|
||||||
#define SMP_SLOW (0x2) /*< Sampling time for slow channels
|
#define SMP_MIN (0x2) /*< Sampling time for slow channels
|
||||||
(0x2 = 4.5 ADC clock cycles) */
|
(0x2 = 4.5 ADC clock cycles) */
|
||||||
|
|
||||||
#ifdef ADC1_COMMON
|
#ifdef ADC1_COMMON
|
||||||
#define ADC_INSTANCE ADC1_COMMON
|
#define ADC_INSTANCE ADC1_COMMON
|
||||||
#else
|
#else
|
||||||
@ -41,7 +40,24 @@ static mutex_t locks[ADC_DEVS];
|
|||||||
|
|
||||||
static inline ADC_TypeDef *dev(adc_t line)
|
static inline ADC_TypeDef *dev(adc_t line)
|
||||||
{
|
{
|
||||||
return (ADC_TypeDef *)(ADC1_BASE + (adc_config[line].dev << 8));
|
switch (adc_config[line].dev) {
|
||||||
|
#ifdef ADC2_BASE
|
||||||
|
case 1:
|
||||||
|
return (ADC_TypeDef *)(ADC2_BASE);
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
#ifdef ADC34_COMMON
|
||||||
|
case 2:
|
||||||
|
return (ADC_TypeDef *)(ADC3_BASE);
|
||||||
|
break;
|
||||||
|
case 3:
|
||||||
|
return (ADC_TypeDef *)(ADC4_BASE);
|
||||||
|
break;
|
||||||
|
#endif
|
||||||
|
default:
|
||||||
|
return (ADC_TypeDef *)(ADC1_BASE);
|
||||||
|
break;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline void prep(adc_t line)
|
static inline void prep(adc_t line)
|
||||||
@ -50,7 +66,7 @@ static inline void prep(adc_t line)
|
|||||||
/* Enable the clock here only if it will be disabled by done, else just
|
/* Enable the clock here only if it will be disabled by done, else just
|
||||||
* enable it once in adc_init() */
|
* enable it once in adc_init() */
|
||||||
#if defined(RCC_AHBENR_ADC1EN)
|
#if defined(RCC_AHBENR_ADC1EN)
|
||||||
periph_clk_en(AHB, (RCC_AHBENR_ADC1EN << adc_config[line].dev));
|
periph_clk_en(AHB, RCC_AHBENR_ADC1EN);
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -59,7 +75,7 @@ static inline void done(adc_t line)
|
|||||||
/* On some STM32F3 ADC are grouped by paire (ADC12EN or ADC34EN) so
|
/* On some STM32F3 ADC are grouped by paire (ADC12EN or ADC34EN) so
|
||||||
* don't disable the clock as the other device may still use it. */
|
* don't disable the clock as the other device may still use it. */
|
||||||
#if defined(RCC_AHBENR_ADC1EN)
|
#if defined(RCC_AHBENR_ADC1EN)
|
||||||
periph_clk_dis(AHB, (RCC_AHBENR_ADC1EN << adc_config[line].dev));
|
periph_clk_dis(AHB, RCC_AHBENR_ADC1EN);
|
||||||
#endif
|
#endif
|
||||||
mutex_unlock(&locks[adc_config[line].dev]);
|
mutex_unlock(&locks[adc_config[line].dev]);
|
||||||
}
|
}
|
||||||
@ -75,20 +91,41 @@ int adc_init(adc_t line)
|
|||||||
prep(line);
|
prep(line);
|
||||||
/* On some STM32F3 ADC are grouped by paire (ADC12EN or ADC34EN) so
|
/* On some STM32F3 ADC are grouped by paire (ADC12EN or ADC34EN) so
|
||||||
* enable the clock only once here. */
|
* enable the clock only once here. */
|
||||||
#if !defined(RCC_AHBENR_ADC1EN)
|
#if defined(RCC_AHBENR_ADC12EN)
|
||||||
periph_clk_en(AHB, (RCC_AHBENR_ADC12EN << adc_config[line].dev));
|
if (adc_config[line].dev <= 1) {
|
||||||
|
periph_clk_en(AHB, RCC_AHBENR_ADC12EN);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
#if defined(RCC_AHBENR_ADC34EN)
|
||||||
|
if (adc_config[line].dev >= 2) {
|
||||||
|
periph_clk_en(AHB, RCC_AHBENR_ADC34EN);
|
||||||
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/* Setting ADC clock to HCLK/1 is only allowed if AHB clock
|
/* Setting ADC clock to HCLK/1 is only allowed if AHB clock
|
||||||
* prescaler is 1 */
|
* prescaler is 1 */
|
||||||
if (!(RCC->CFGR & RCC_CFGR_HPRE_3)) {
|
if (!(RCC->CFGR & RCC_CFGR_HPRE_3)) {
|
||||||
/* set ADC clock to HCLK/1 */
|
/* set ADC clock to HCLK/1 */
|
||||||
|
if (adc_config[line].dev <= 1) {
|
||||||
ADC_INSTANCE->CCR |= ADC_CCR_CKMODE_0;
|
ADC_INSTANCE->CCR |= ADC_CCR_CKMODE_0;
|
||||||
}
|
}
|
||||||
|
#ifdef ADC34_COMMON
|
||||||
|
if (adc_config[line].dev >= 2) {
|
||||||
|
ADC34_COMMON->CCR |= ADC_CCR_CKMODE_0;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
}
|
||||||
else {
|
else {
|
||||||
/* set ADC clock to HCLK/2 otherwise */
|
/* set ADC clock to HCLK/2 otherwise */
|
||||||
|
if (adc_config[line].dev <= 1) {
|
||||||
ADC_INSTANCE->CCR |= ADC_CCR_CKMODE_1;
|
ADC_INSTANCE->CCR |= ADC_CCR_CKMODE_1;
|
||||||
}
|
}
|
||||||
|
#ifdef ADC34_COMMON
|
||||||
|
if (adc_config[line].dev >= 2) {
|
||||||
|
ADC34_COMMON->CCR |= ADC_CCR_CKMODE_1;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
/* Configure the pin */
|
/* Configure the pin */
|
||||||
gpio_init_analog(adc_config[line].pin);
|
gpio_init_analog(adc_config[line].pin);
|
||||||
@ -99,8 +136,14 @@ int adc_init(adc_t line)
|
|||||||
dev(line)->CR |= ADC_CR_ADVREGEN;
|
dev(line)->CR |= ADC_CR_ADVREGEN;
|
||||||
xtimer_usleep(ADC_T_ADCVREG_STUP_US);
|
xtimer_usleep(ADC_T_ADCVREG_STUP_US);
|
||||||
|
|
||||||
/* Configure calibration for single ended input */
|
if (dev(line)->DIFSEL & (1 << adc_config[line].chan)) {
|
||||||
|
/* Configure calibration for differential inputs */
|
||||||
|
dev(line)->CR |= ADC_CR_ADCALDIF;
|
||||||
|
}
|
||||||
|
else {
|
||||||
|
/* Configure calibration for single ended inputs */
|
||||||
dev(line)->CR &= ~ADC_CR_ADCALDIF;
|
dev(line)->CR &= ~ADC_CR_ADCALDIF;
|
||||||
|
}
|
||||||
|
|
||||||
/* Start automatic calibration and wait for it to complete */
|
/* Start automatic calibration and wait for it to complete */
|
||||||
dev(line)->CR |= ADC_CR_ADCAL;
|
dev(line)->CR |= ADC_CR_ADCAL;
|
||||||
@ -117,20 +160,13 @@ int adc_init(adc_t line)
|
|||||||
dev(line)->SQR1 |= (0 & ADC_SQR1_L);
|
dev(line)->SQR1 |= (0 & ADC_SQR1_L);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Configure sampling time for the given channel (6 to 18) */
|
/* Configure sampling time for the given channel */
|
||||||
dev(line)->SMPR1 = (SMP_SLOW << ADC_SMPR1_SMP6_Pos)
|
if (adc_config[line].chan < 10) {
|
||||||
| (SMP_SLOW << ADC_SMPR1_SMP7_Pos)
|
dev(line)->SMPR1 = (SMP_MIN << (adc_config[line].chan * 3));
|
||||||
| (SMP_SLOW << ADC_SMPR1_SMP8_Pos)
|
}
|
||||||
| (SMP_SLOW << ADC_SMPR1_SMP9_Pos);
|
else {
|
||||||
dev(line)->SMPR2 = (SMP_SLOW << ADC_SMPR2_SMP10_Pos)
|
dev(line)->SMPR2 = (SMP_MIN << ((adc_config[line].chan - 10) * 3));
|
||||||
| (SMP_SLOW << ADC_SMPR2_SMP11_Pos)
|
}
|
||||||
| (SMP_SLOW << ADC_SMPR2_SMP12_Pos)
|
|
||||||
| (SMP_SLOW << ADC_SMPR2_SMP13_Pos)
|
|
||||||
| (SMP_SLOW << ADC_SMPR2_SMP14_Pos)
|
|
||||||
| (SMP_SLOW << ADC_SMPR2_SMP15_Pos)
|
|
||||||
| (SMP_SLOW << ADC_SMPR2_SMP16_Pos)
|
|
||||||
| (SMP_SLOW << ADC_SMPR2_SMP17_Pos)
|
|
||||||
| (SMP_SLOW << ADC_SMPR2_SMP18_Pos);
|
|
||||||
|
|
||||||
/* Power off and unlock device again */
|
/* Power off and unlock device again */
|
||||||
done(line);
|
done(line);
|
||||||
|
|||||||
Loading…
x
Reference in New Issue
Block a user