aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
authorAlexey Luchko <luch@airdog.com>2014-11-26 21:50:36 +0200
committerAlexey Luchko <luch@airdog.com>2014-11-26 22:37:46 +0200
commit2808c8848795b7ebca02211aa9f66a65005f4669 (patch)
treed5f93d45fa4299ae3366d5070da9e652dceaedc1
parent591ccce97e9b9da362e0a8b4a3970bb9c233ce49 (diff)
downloadpx4-firmware-2808c8848795b7ebca02211aa9f66a65005f4669.tar.gz
px4-firmware-2808c8848795b7ebca02211aa9f66a65005f4669.tar.bz2
px4-firmware-2808c8848795b7ebca02211aa9f66a65005f4669.zip
src/drivers/boards/AirDogFMU/init.c
-rw-r--r--src/drivers/boards/AirDogFMU/init.c26
1 files changed, 18 insertions, 8 deletions
diff --git a/src/drivers/boards/AirDogFMU/init.c b/src/drivers/boards/AirDogFMU/init.c
index 5193e9a70..c265b1fca 100644
--- a/src/drivers/boards/AirDogFMU/init.c
+++ b/src/drivers/boards/AirDogFMU/init.c
@@ -209,14 +209,6 @@ static struct sdio_dev_s *sdio;
__EXPORT int nsh_archinitialize(void)
{
- /* configure power supply control/sense pins */
- stm32_configgpio(GPIO_ADC_BATT_CURRENT);
- stm32_configgpio(GPIO_ADC_BATT_VOLTAGE);
- stm32_configgpio(GPIO_ADC_SENS_VOLTAGE);
-
- stm32_configgpio(GPIO_VDD_3V3_SENSORS_EN);
- stm32_configgpio(GPIO_VDD_BRICK_VALID);
-
/* configure debug button pin */
stm32_configgpio(GPIO_DEBUG_BTN);
@@ -321,3 +313,21 @@ __EXPORT int nsh_archinitialize(void)
return OK;
}
+
+static void
+adc_init()
+{
+#define ADC1_N_X(channel) (GPIO_ADC1_IN ## channel)
+#define ADC1_N(channel) ADC1_N_X(channel)
+
+ /* sense pins */
+ stm32_configgpio(ADC1_N(ADC_BATTERY_CURRENT_CHANNEL));
+ stm32_configgpio(ADC1_N(ADC_BATTERY_VOLTAGE_CHANNEL));
+ stm32_configgpio(ADC1_N(ADC_SENSORS_VOLTAGE_CHANNEL));
+
+ /* power supply control pins */
+ stm32_configgpio(GPIO_VDD_3V3_SENSORS_EN);
+ stm32_configgpio(GPIO_VDD_BRICK_VALID);
+#undef ADC1_N_X
+#undef ADC1_N
+}