IQ.Pilot Release Commit @ 0798119

panda/board/stm32f4/lladc.h

@@ -0,0 +1,34 @@
+#include "lladc_declarations.h"
+
+void register_set(volatile uint32_t *addr, uint32_t val, uint32_t mask);
+
+void adc_init(ADC_TypeDef *adc) {
+  register_set(&(ADC->CCR), ADC_CCR_TSVREFE | ADC_CCR_VBATE, 0xC30000U);
+  register_set(&(adc->CR2), ADC_CR2_ADON, 0xFF7F0F03U);
+}
+
+static uint16_t adc_get_raw(const adc_signal_t *signal) {
+  // sample time
+  if (signal->channel < 10U) {
+    signal->adc->SMPR2 = ((uint32_t) signal->sample_time << (signal->channel * 3U));
+  } else {
+    signal->adc->SMPR1 = ((uint32_t) signal->sample_time << ((signal->channel - 10U) * 3U));
+  }
+
+  // select channel
+  signal->adc->JSQR = ((uint32_t) signal->channel << 15U);
+
+  // start conversion
+  signal->adc->SR &= ~(ADC_SR_JEOC);
+  signal->adc->CR2 |= ADC_CR2_JSWSTART;
+  uint32_t timeout = 0U;
+  while (!(signal->adc->SR & ADC_SR_JEOC)) {
+    if (++timeout > 100000U) { break; }
+  }
+
+  return signal->adc->JDR1;
+}
+
+uint16_t adc_get_mV(const adc_signal_t *signal) {
+  return (adc_get_raw(signal) * current_board->avdd_mV) / 4095U;
+}