refs #17 Add ADC driver.

OSURoboticsClub · Feb 10, 2015 · a60c6aa · a60c6aa
1 parent 70e299a
commit a60c6aa
Show file tree

Hide file tree

Showing 2 changed files with 36 additions and 0 deletions.
diff --git a/src/drivers/adc_device.hpp b/src/drivers/adc_device.hpp
@@ -0,0 +1,25 @@
+#ifndef ADC_DEVICE_HPP_
+#define ADC_DEVICE_HPP_
+
+#include <array>
+#include <cstdint>
+
+#include "hal.h"
+
+template <std::size_t num_ch, std::size_t buf_depth>
+class ADCDevice {
+public:
+  ADCDevice(ADCDriver *adcd, const ADCConversionGroup *adcgrpcfg, std::array<adcsample_t, num_ch*buf_depth> *samples, std::array<adcsample_t, num_ch> *avg_ch);
+
+protected:
+  void update(void);
+
+  ADCDriver *adcd;
+  const ADCConversionGroup *adcgrpcfg;
+  std::array<adcsample_t, num_ch*buf_depth> *samples;
+  std::array<adcsample_t, num_ch> *avg_ch;
+};
+
+#include "drivers/adc_device.tpp"
+
+#endif // ADC_DEVICE_HPP_
diff --git a/src/drivers/adc_device.tpp b/src/drivers/adc_device.tpp
@@ -0,0 +1,11 @@
+template <std::size_t num_ch, std::size_t buf_depth>
+ADCDevice<num_ch, buf_depth>::ADCDevice(ADCDriver *adcd, const ADCConversionGroup *adcgrpcfg, std::array<adcsample_t, num_ch*buf_depth> *samples, std::array<adcsample_t, num_ch> *avg_ch)
+  : adcd(adcd), adcgrpcfg(adcgrpcfg), samples(samples), avg_ch(avg_ch) {
+}
+
+template <std::size_t num_ch, std::size_t buf_depth>
+void ADCDevice<num_ch, buf_depth>::update(void) {
+  chSysLockFromIsr();
+  adcStartConversionI(adcd, adcgrpcfg, reinterpret_cast<adcsample_t*>(samples), buf_depth);
+  chSysUnlockFromIsr();
+}