From f39a9d151088ac61fed6233200485930ed4d702b Mon Sep 17 00:00:00 2001 From: pmantoine Date: Fri, 14 Oct 2022 18:55:12 +0800 Subject: [PATCH] SAMD21 ADCee fixes --- DCCTimerSAMD.cpp | 69 +++++++++++++++++++++++++++++++++--------------- MotorDrivers.h | 3 ++- 2 files changed, 49 insertions(+), 23 deletions(-) diff --git a/DCCTimerSAMD.cpp b/DCCTimerSAMD.cpp index 802c7e7..481f623 100644 --- a/DCCTimerSAMD.cpp +++ b/DCCTimerSAMD.cpp @@ -30,6 +30,8 @@ #include "DCCTimer.h" #include +#include +#include INTERRUPT_CALLBACK interruptHandler=0; @@ -161,20 +163,46 @@ int * ADCee::analogvals = NULL; int ADCee::init(uint8_t pin) { uint id = pin - A0; + int value = 0; if (id > NUM_ADC_INPUTS) return -1023; - analogReadResolution(12); // Consistent with settings in ADCee::begin below - int value = analogRead(pin); + + // Dummy read using Arduino library + analogReadResolution(12); + value = analogRead(pin); + + // Reconfigure ADC + ADC->CTRLA.bit.ENABLE = 0; // disable ADC + while( ADC->STATUS.bit.SYNCBUSY == 1 ); // wait for synchronization + + ADC->CTRLB.reg &= 0b1111100011001111; // mask PRESCALER and RESSEL bits + ADC->CTRLB.reg |= ADC_CTRLB_PRESCALER_DIV64 | // divide Clock by 16 + ADC_CTRLB_RESSEL_12BIT; // Result 12 bits, 10 bits possible + ADC->AVGCTRL.reg = ADC_AVGCTRL_SAMPLENUM_1 | // take 1 sample at a time + ADC_AVGCTRL_ADJRES(0x00ul); // adjusting result by 0 + ADC->SAMPCTRL.reg = 0x00ul; // sampling Time Length = 0 + ADC->CTRLA.bit.ENABLE = 1; // enable ADC + while( ADC->STATUS.bit.SYNCBUSY == 1 ); // wait for synchronization + + // Permanently configure SAMD IO MUX for that pin + pinPeripheral(pin, PIO_ANALOG); + ADC->INPUTCTRL.bit.MUXPOS = g_APinDescription[pin].ulADCChannelNumber; // Selection for the positive ADC input + + // Start conversion + ADC->SWTRIG.bit.START = 1; + + // Wait for the conversion to be ready + while (ADC->INTFLAG.bit.RESRDY == 0); // Waiting for conversion to complete + + // Read the value + value = ADC->RESULT.reg; + if (analogvals == NULL) analogvals = (int *)calloc(NUM_ADC_INPUTS+1, sizeof(int)); analogvals[id] = value; usedpins |= (1<INPUTCTRL.bit.MUXPOS = g_APinDescription[pin].ulADCChannelNumber; // Selection for the positive ADC input - return value; } int16_t ADCee::ADCmax() { @@ -207,8 +235,6 @@ void ADCee::scan() { return; // no result, continue to wait // found value analogvals[id] = ADC->RESULT.reg; - // Clear the Data Ready flag - ADC->INTFLAG.reg = ADC_INTFLAG_RESRDY; // advance at least one track // for scope debug TrackManager::track[1]->setBrake(0); waiting = false; @@ -226,8 +252,8 @@ void ADCee::scan() { while (true) { if (mask & usedpins) { // start new ADC aquire on id - ADC->INPUTCTRL.bit.MUXPOS = g_APinDescription[id].ulADCChannelNumber; // Selection for the positive ADC input - // Start conversion + ADC->INPUTCTRL.bit.MUXPOS = g_APinDescription[id + A0].ulADCChannelNumber; // Selection for the positive ADC input + // Start conversion ADC->SWTRIG.bit.START = 1; // for scope debug TrackManager::track[1]->setBrake(1); waiting = true; @@ -249,19 +275,18 @@ void ADCee::begin() { // Set up ADC to do faster reads... default for Arduino Zero platform configs is 436uS, // and we need sub-58uS. This code sets it to a read speed of around 5-6uS, and enables // 12-bit mode - ADC->CTRLA.bit.ENABLE = 0; // disable ADC - while( ADC->STATUS.bit.SYNCBUSY == 1 ); // wait for synchronization + // Reconfigure ADC + ADC->CTRLA.bit.ENABLE = 0; // disable ADC + while( ADC->STATUS.bit.SYNCBUSY == 1 ); // wait for synchronization - ADC->CTRLB.reg &= 0b1111100011001111; // mask PRESCALER and RESSEL bits - ADC->CTRLB.reg |= ADC_CTRLB_PRESCALER_DIV16 | // divide Clock by 16 - ADC_CTRLB_RESSEL_12BIT; // Result is 12 bits, 10 bits possible - - ADC->AVGCTRL.reg = ADC_AVGCTRL_SAMPLENUM_1 | // take 1 sample at a time - ADC_AVGCTRL_ADJRES(0x00ul); // adjusting result by 0 - ADC->SAMPCTRL.reg = 0x00; // sampling Time Length = 0 - - ADC->CTRLA.bit.ENABLE = 1; // enable ADC - while(ADC->STATUS.bit.SYNCBUSY == 1); // wait for synchronization + ADC->CTRLB.reg &= 0b1111100011001111; // mask PRESCALER and RESSEL bits + ADC->CTRLB.reg |= ADC_CTRLB_PRESCALER_DIV64 | // divide Clock by 16 + ADC_CTRLB_RESSEL_12BIT; // Result 12 bits, 10 bits possible + ADC->AVGCTRL.reg = ADC_AVGCTRL_SAMPLENUM_1 | // take 1 sample at a time + ADC_AVGCTRL_ADJRES(0x00ul); // adjusting result by 0 + ADC->SAMPCTRL.reg = 0x00ul; // sampling Time Length = 0 + ADC->CTRLA.bit.ENABLE = 1; // enable ADC + while( ADC->STATUS.bit.SYNCBUSY == 1 ); // wait for synchronization interrupts(); } #endif diff --git a/MotorDrivers.h b/MotorDrivers.h index 7f217ce..ae556ca 100644 --- a/MotorDrivers.h +++ b/MotorDrivers.h @@ -59,7 +59,7 @@ // Arduino STANDARD Motor Shield, used on different architectures: -#if defined(ARDUINO_ARCH_SAMD) +#if defined(ARDUINO_ARCH_SAMD) || defined(ARDUINO_ARCH_STM32) // Setup for SAMD21 Sparkfun DEV board using Arduino standard Motor Shield R3 (MUST be R3 // for 3v3 compatibility!!) senseFactor for 3.3v systems is 1.95 as calculated when using // 10-bit A/D samples, and for 12-bit samples it's more like 0.488, but we probably need @@ -68,6 +68,7 @@ new MotorDriver(3, 12, UNUSED_PIN, 9, A0, 0.488, 1500, UNUSED_PIN), \ new MotorDriver(11, 13, UNUSED_PIN, 8, A1, 0.488, 1500, UNUSED_PIN) #define SAMD_STANDARD_MOTOR_SHIELD STANDARD_MOTOR_SHIELD +#define STM32_STANDARD_MOTOR_SHIELD STANDARD_MOTOR_SHIELD #elif defined(ARDUINO_ARCH_ESP32) // STANDARD shield on an ESPDUINO-32 (ESP32 in Uno form factor). The shield must be eiter the