diff --git a/firmware/target/arm/adc-as3514.c b/firmware/target/arm/adc-as3514.c
index 77d6545..ddf413b 100644
--- a/firmware/target/arm/adc-as3514.c
+++ b/firmware/target/arm/adc-as3514.c
@@ -24,8 +24,15 @@
#include "as3514.h"

/* Read 10-bit channel data */
+
unsigned short adc_read(int channel)
{
+ _adc_read(channel);
+ return _adc_read(channel);
+}
+
+unsigned short _adc_read(int channel)
+{
unsigned short data = 0;

if ((unsigned)channel < NUM_ADC_CHANNELS)