First pass at full LL implementation

This commit is contained in:
Hierophect 2019-09-10 19:48:24 -04:00
parent 0d2e9c3762
commit 500b21c236
4 changed files with 93 additions and 109 deletions

View File

@ -33,6 +33,7 @@
#include "stm32f4xx_hal.h"
#include "stm32f4xx_ll_gpio.h"
#include "stm32f4xx_ll_adc.h"
#include "stm32f4xx_ll_bus.h"
//mp_raise_ValueError(translate("U dun goofed"));
@ -45,7 +46,6 @@ void common_hal_analogio_analogin_construct(analogio_analogin_obj_t* self,
}
//TODO: add ADC traits to structure?
//LL_AHB1_GRP1_EnableClock(LL_AHB1_GRP1_PERIPH_GPIOA); //required?
LL_GPIO_SetPinMode(pin_port(pin->number), pin_mask(pin->number), LL_GPIO_MODE_ANALOG);
LL_APB2_GRP1_EnableClock(LL_APB2_GRP1_PERIPH_ADC1); //TODO: conditional on ADC unit
claim_pin(pin);
@ -68,32 +68,28 @@ uint16_t common_hal_analogio_analogin_get_value(analogio_analogin_obj_t *self) {
// Something else might have used the ADC in a different way,
// so we completely re-initialize it.
//LL Implementation
if (LL_ADC_IsEnabled(ADC1) == 0)
{
LL_ADC_REG_SetTriggerSource(ADC1, LL_ADC_REG_TRIG_SOFTWARE);
LL_ADC_REG_SetContinuousMode(ADC1, LL_ADC_REG_CONV_SINGLE);
LL_ADC_REG_SetSequencerLength(ADC1, LL_ADC_REG_SEQ_SCAN_DISABLE);
LL_ADC_REG_SetSequencerRanks(ADC1, LL_ADC_REG_RANK_1, LL_ADC_CHANNEL_4);
LL_ADC_REG_SetSequencerRanks(ADC1, LL_ADC_REG_RANK_1, stm32_adc_channel(self->pin->adc));
//LL_ADC_REG_SetSequencerRanks(ADC1, LL_ADC_REG_RANK_1, LL_ADC_CHANNEL_4);
LL_ADC_SetChannelSamplingTime(ADC1, LL_ADC_CHANNEL_4, LL_ADC_SAMPLINGTIME_56CYCLES);
LL_ADC_SetChannelSamplingTime(ADC1, stm32_adc_channel(self->pin->adc), LL_ADC_SAMPLINGTIME_56CYCLES);
LL_ADC_EnableIT_OVR(ADC1);
}
LL_ADC_Enable(ADC1);
struct adc_sync_descriptor adc;
samd_peripherals_adc_setup(&adc, self->instance);
ConversionStartPoll_ADC_GrpRegular();
uint16_t uhADCxConvertedData = (__LL_ADC_DIGITAL_SCALE(LL_ADC_RESOLUTION_12B) + 1);
LL_ADC_REG_StartConversionSWStart(ADC1);
while (LL_ADC_IsActiveFlag_EOCS(ADC1) == 0) {}
/* Retrieve ADC conversion data */
/* (data scale corresponds to ADC resolution: 12 bits) */
uhADCxConvertedData = LL_ADC_REG_ReadConversionData12(ADC1);
// Shift the value to be 16 bit.
return value << 4;
return uhADCxConvertedData << 4;
}
float common_hal_analogio_analogin_get_reference_voltage(analogio_analogin_obj_t *self) {

View File

@ -31,77 +31,67 @@
#include "py/runtime.h"
#include "shared-bindings/analogio/AnalogOut.h"
#include "shared-bindings/audioio/AudioOut.h"
#include "shared-bindings/microcontroller/Pin.h"
#include "supervisor/shared/translate.h"
#include "atmel_start_pins.h"
#include "hal/include/hal_dac_sync.h"
#include "hpl/gclk/hpl_gclk_base.h"
#include "peripheral_clk_config.h"
#ifdef SAMD21
#include "hpl/pm/hpl_pm_base.h"
#endif
void common_hal_analogio_analogout_construct(analogio_analogout_obj_t* self,
const mcu_pin_obj_t *pin) {
#if defined(SAMD21) && !defined(PIN_PA02)
mp_raise_NotImplementedError(translate("No DAC on chip"));
#else
if (pin->number != PIN_PA02
#ifdef SAMD51
&& pin->number != PIN_PA05
#endif
) {
mp_raise_ValueError(translate("AnalogOut not supported on given pin"));
return;
}
// #if defined(SAMD21) && !defined(PIN_PA02)
// mp_raise_NotImplementedError(translate("No DAC on chip"));
// #else
// if (pin->number != PIN_PA02
// #ifdef SAMD51
// && pin->number != PIN_PA05
// #endif
// ) {
// mp_raise_ValueError(translate("AnalogOut not supported on given pin"));
// return;
// }
self->channel = 0;
#ifdef SAMD51
if (pin->number == PIN_PA05) {
self->channel = 1;
}
#endif
// self->channel = 0;
// #ifdef SAMD51
// if (pin->number == PIN_PA05) {
// self->channel = 1;
// }
// #endif
#ifdef SAMD51
hri_mclk_set_APBDMASK_DAC_bit(MCLK);
#endif
// #ifdef SAMD51
// hri_mclk_set_APBDMASK_DAC_bit(MCLK);
// #endif
#ifdef SAMD21
_pm_enable_bus_clock(PM_BUS_APBC, DAC);
#endif
// #ifdef SAMD21
// _pm_enable_bus_clock(PM_BUS_APBC, DAC);
// #endif
// SAMD21: This clock should be <= 12 MHz, per datasheet section 47.6.3.
// SAMD51: This clock should be <= 350kHz, per datasheet table 37-6.
_gclk_enable_channel(DAC_GCLK_ID, CONF_GCLK_DAC_SRC);
// // SAMD21: This clock should be <= 12 MHz, per datasheet section 47.6.3.
// // SAMD51: This clock should be <= 350kHz, per datasheet table 37-6.
// _gclk_enable_channel(DAC_GCLK_ID, CONF_GCLK_DAC_SRC);
// Don't double init the DAC on the SAMD51 when both outputs are in use. We use the free state
// of each output pin to determine DAC state.
int32_t result = ERR_NONE;
#ifdef SAMD51
if (!common_hal_mcu_pin_is_free(&pin_PA02) || !common_hal_mcu_pin_is_free(&pin_PA05)) {
#endif
// Fake the descriptor if the DAC is already initialized.
self->descriptor.device.hw = DAC;
#ifdef SAMD51
} else {
#endif
result = dac_sync_init(&self->descriptor, DAC);
#ifdef SAMD51
}
#endif
if (result != ERR_NONE) {
mp_raise_OSError(MP_EIO);
return;
}
claim_pin(pin);
// // Don't double init the DAC on the SAMD51 when both outputs are in use. We use the free state
// // of each output pin to determine DAC state.
// int32_t result = ERR_NONE;
// #ifdef SAMD51
// if (!common_hal_mcu_pin_is_free(&pin_PA02) || !common_hal_mcu_pin_is_free(&pin_PA05)) {
// #endif
// // Fake the descriptor if the DAC is already initialized.
// self->descriptor.device.hw = DAC;
// #ifdef SAMD51
// } else {
// #endif
// result = dac_sync_init(&self->descriptor, DAC);
// #ifdef SAMD51
// }
// #endif
// if (result != ERR_NONE) {
// mp_raise_OSError(MP_EIO);
// return;
// }
// claim_pin(pin);
gpio_set_pin_function(pin->number, GPIO_PIN_FUNCTION_B);
// gpio_set_pin_function(pin->number, GPIO_PIN_FUNCTION_B);
dac_sync_enable_channel(&self->descriptor, self->channel);
#endif
// dac_sync_enable_channel(&self->descriptor, self->channel);
// #endif
}
bool common_hal_analogio_analogout_deinited(analogio_analogout_obj_t *self) {
@ -109,47 +99,47 @@ bool common_hal_analogio_analogout_deinited(analogio_analogout_obj_t *self) {
}
void common_hal_analogio_analogout_deinit(analogio_analogout_obj_t *self) {
#if (defined(SAMD21) && defined(PIN_PA02)) || defined(SAMD51)
if (common_hal_analogio_analogout_deinited(self)) {
return;
}
dac_sync_disable_channel(&self->descriptor, self->channel);
reset_pin_number(PIN_PA02);
// Only deinit the DAC on the SAMD51 if both outputs are free.
#ifdef SAMD51
if (common_hal_mcu_pin_is_free(&pin_PA02) && common_hal_mcu_pin_is_free(&pin_PA05)) {
#endif
dac_sync_deinit(&self->descriptor);
#ifdef SAMD51
}
#endif
self->deinited = true;
// TODO(tannewt): Turn off the DAC clocks to save power.
#endif
// #if (defined(SAMD21) && defined(PIN_PA02)) || defined(SAMD51)
// if (common_hal_analogio_analogout_deinited(self)) {
// return;
// }
// dac_sync_disable_channel(&self->descriptor, self->channel);
// reset_pin_number(PIN_PA02);
// // Only deinit the DAC on the SAMD51 if both outputs are free.
// #ifdef SAMD51
// if (common_hal_mcu_pin_is_free(&pin_PA02) && common_hal_mcu_pin_is_free(&pin_PA05)) {
// #endif
// dac_sync_deinit(&self->descriptor);
// #ifdef SAMD51
// }
// #endif
// self->deinited = true;
// // TODO(tannewt): Turn off the DAC clocks to save power.
// #endif
}
void common_hal_analogio_analogout_set_value(analogio_analogout_obj_t *self,
uint16_t value) {
#if defined(SAMD21) && !defined(PIN_PA02)
return;
#endif
// Input is 16 bit so make sure and set LEFTADJ to 1 so it takes the top
// bits. This is currently done in asf4_conf/*/hpl_dac_config.h.
dac_sync_write(&self->descriptor, self->channel, &value, 1);
// #if defined(SAMD21) && !defined(PIN_PA02)
// return;
// #endif
// // Input is 16 bit so make sure and set LEFTADJ to 1 so it takes the top
// // bits. This is currently done in asf4_conf/*/hpl_dac_config.h.
// dac_sync_write(&self->descriptor, self->channel, &value, 1);
}
void analogout_reset(void) {
// audioout_reset also resets the DAC, and does a smooth ramp down to avoid clicks
// if it was enabled, so do that instead if AudioOut is enabled.
#if CIRCUITPY_AUDIOIO
audioout_reset();
#else
#ifdef SAMD21
while (DAC->STATUS.reg & DAC_STATUS_SYNCBUSY) {}
#endif
#ifdef SAMD51
while (DAC->SYNCBUSY.reg & DAC_SYNCBUSY_SWRST) {}
#endif
DAC->CTRLA.reg |= DAC_CTRLA_SWRST;
#endif
// #if CIRCUITPY_AUDIOIO
// audioout_reset();
// #else
// #ifdef SAMD21
// while (DAC->STATUS.reg & DAC_STATUS_SYNCBUSY) {}
// #endif
// #ifdef SAMD51
// while (DAC->SYNCBUSY.reg & DAC_SYNCBUSY_SWRST) {}
// #endif
// DAC->CTRLA.reg |= DAC_CTRLA_SWRST;
// #endif
}

View File

@ -29,13 +29,10 @@
#include "common-hal/microcontroller/Pin.h"
#include "hal/include/hal_dac_sync.h"
#include "py/obj.h"
typedef struct {
mp_obj_base_t base;
struct dac_sync_descriptor descriptor;
uint8_t channel;
bool deinited;
} analogio_analogout_obj_t;

View File

@ -17,6 +17,7 @@ CIRCUITPY_MINIMAL_BUILD = 1
CIRCUITPY_BOARD = 1
CIRCUITPY_DIGITALIO = 1
CIRCUITPY_ANALOGIO = 1
CIRCUITPY_MICROCONTROLLER = 1
CIRCUITPY_BUSIO = 1
CIRCUITPY_TIME = 1