source/adc.cpp


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42

#include "adc.hpp"

const GPTConfig ADCd::m_gpt_config = {
  .frequency    =  1000000,
  .callback     =  NULL,
  .cr2          =  TIM_CR2_MMS_1,   /* MMS = 010 = TRGO on Update Event.    */
  .dier         =  0
};

void ADCd::start()
{
    initPins();
    gptStart(m_gptd, &m_gpt_config);

    m_adc_config.difsel = 0;
    m_adc_config.adcdinst = this;

    adcStart(m_adcd, &m_adc_config);
    adcSTM32EnableVREF(m_adcd);
}

adcsample_t *ADCd::getSamples(adcsample_t *buffer, size_t count)
{
    m_is_adc_finished = false;
    adcStartConversion(m_adcd, &m_adc_group_config, buffer, count);
    gptStartContinuous(m_gptd, 100); // 10kHz
    while (!m_is_adc_finished);
    return buffer;
}

void ADCd::initPins()
{
    palSetPadMode(GPIOA, 0, PAL_MODE_INPUT_ANALOG);
}

void ADCd::adcEndCallback(ADCDriver *adcd)
{
    auto *_this = reinterpret_cast<const ADCdConfig *>(adcd->config)->adcdinst;
    gptStopTimer(_this->m_gptd);
    _this->m_is_adc_finished = true;
}