Add calculators for frequency steps. Accumulator has a typedef now. Optimize tick.

This commit is contained in:
Stephen Olesen 2015-07-03 15:23:39 -06:00
parent 5fd0fdf154
commit acc4aebe03
2 changed files with 43 additions and 25 deletions

23
DDS.cpp
View File

@ -59,22 +59,27 @@ void DDS::stop() {
} }
// Set our current sine wave frequency in Hz // Set our current sine wave frequency in Hz
void DDS::setFrequency(unsigned short freq) { ddsAccumulator_t DDS::calcFrequency(unsigned short freq) {
// Fo = (M*Fc)/2^N // Fo = (M*Fc)/2^N
// M = (Fo/Fc)*2^N // M = (Fo/Fc)*2^N
ddsAccumulator_t newStep;
if(refclk == DDS_REFCLK_DEFAULT) { if(refclk == DDS_REFCLK_DEFAULT) {
// Try to use precalculated values if possible // Try to use precalculated values if possible
if(freq == 2200) { if(freq == 2200) {
stepRate = (2200.0 / (DDS_REFCLK_DEFAULT+DDS_REFCLK_OFFSET)) * pow(2,ACCUMULATOR_BITS); newStep = (2200.0 / (DDS_REFCLK_DEFAULT+DDS_REFCLK_OFFSET)) * pow(2,ACCUMULATOR_BITS);
} else if (freq == 1200) { } else if (freq == 1200) {
stepRate = (1200.0 / (DDS_REFCLK_DEFAULT+DDS_REFCLK_OFFSET)) * pow(2,ACCUMULATOR_BITS); newStep = (1200.0 / (DDS_REFCLK_DEFAULT+DDS_REFCLK_OFFSET)) * pow(2,ACCUMULATOR_BITS);
} else if(freq == 2400) {
newStep = (2400.0 / (DDS_REFCLK_DEFAULT+DDS_REFCLK_OFFSET)) * pow(2,ACCUMULATOR_BITS);
} else if (freq == 1500) {
newStep = (1500.0 / (DDS_REFCLK_DEFAULT+DDS_REFCLK_OFFSET)) * pow(2,ACCUMULATOR_BITS);
} else if (freq == 600) { } else if (freq == 600) {
stepRate = (600.0 / (DDS_REFCLK_DEFAULT+DDS_REFCLK_OFFSET)) * pow(2,ACCUMULATOR_BITS); newStep = (600.0 / (DDS_REFCLK_DEFAULT+DDS_REFCLK_OFFSET)) * pow(2,ACCUMULATOR_BITS);
} }
} else { } else {
// BUG: Step rate isn't properly calculated here, it gets the wrong frequency newStep = pow(2,ACCUMULATOR_BITS)*freq / (refclk+DDS_REFCLK_OFFSET);
stepRate = pow(2,ACCUMULATOR_BITS)*freq / (refclk+DDS_REFCLK_OFFSET);
} }
return newStep;
} }
// Degrees should be between -360 and +360 (others don't make much sense) // Degrees should be between -360 and +360 (others don't make much sense)
@ -139,14 +144,20 @@ uint8_t DDS::getDutyCycle() {
#else #else
uint8_t phAng; uint8_t phAng;
#endif #endif
if(amplitude == 0) // Shortcut out on no amplitude
return 128>>(8-COMPARATOR_BITS);
phAng = (accumulator >> ACCUMULATOR_BIT_SHIFT); phAng = (accumulator >> ACCUMULATOR_BIT_SHIFT);
int8_t position = pgm_read_byte_near(ddsSineTable + phAng); //>>(8-COMPARATOR_BITS); int8_t position = pgm_read_byte_near(ddsSineTable + phAng); //>>(8-COMPARATOR_BITS);
// Apply scaling and return // Apply scaling and return
int16_t scaled = position; int16_t scaled = position;
// output = ((duty * amplitude) / 256) + 128 // output = ((duty * amplitude) / 256) + 128
// This keeps amplitudes centered around 50% duty // This keeps amplitudes centered around 50% duty
if(amplitude != 255) { // Amplitude is reduced, so do the full math
scaled *= amplitude; scaled *= amplitude;
scaled >>= 8+(8-COMPARATOR_BITS); scaled >>= 8+(8-COMPARATOR_BITS);
} else { // Otherwise, only shift for the comparator bits
scaled >>= (8-COMPARATOR_BITS);
}
scaled += 128>>(8-COMPARATOR_BITS); scaled += 128>>(8-COMPARATOR_BITS);
return scaled; return scaled;
} }

31
DDS.h
View File

@ -6,7 +6,7 @@
// Use pin 3 for PWM? If not defined, use pin 11 // Use pin 3 for PWM? If not defined, use pin 11
// Quality on pin 3 is higher than on 11, as it can be clocked faster // Quality on pin 3 is higher than on 11, as it can be clocked faster
// when the COMPARATOR_BITS value is less than 8 // when the COMPARATOR_BITS value is less than 8
// #define DDS_PWM_PIN_3 #define DDS_PWM_PIN_3
// Normally, we turn on timer2 and timer1, and have ADC sampling as our clock // Normally, we turn on timer2 and timer1, and have ADC sampling as our clock
// Define this to only use Timer2, and not start the ADC clock // Define this to only use Timer2, and not start the ADC clock
@ -18,8 +18,10 @@
#ifdef SHORT_ACCUMULATOR #ifdef SHORT_ACCUMULATOR
#define ACCUMULATOR_BITS 16 #define ACCUMULATOR_BITS 16
typedef int16_t ddsAccumulator_t;
#else #else
#define ACCUMULATOR_BITS 32 #define ACCUMULATOR_BITS 32
typedef int32_t ddsAccumulator_t;
#endif #endif
// If defined, the timer will idle at 50% duty cycle // If defined, the timer will idle at 50% duty cycle
@ -42,11 +44,16 @@
// This is how often we'll perform a phase advance, as well as ADC sampling // This is how often we'll perform a phase advance, as well as ADC sampling
// rate. The higher this value, the smoother the output wave will be, at the // rate. The higher this value, the smoother the output wave will be, at the
// expense of CPU time. It maxes out around 62000 (TBD) // expense of CPU time. It maxes out around 62000 (TBD)
// May be overridden in the sketch to improve performance
#ifndef DDS_REFCLK_DEFAULT
#define DDS_REFCLK_DEFAULT 38400 #define DDS_REFCLK_DEFAULT 38400
#endif
// As each Arduino crystal is a little different, this can be fine tuned to // As each Arduino crystal is a little different, this can be fine tuned to
// provide more accurate frequencies. Adjustments in the range of hundreds // provide more accurate frequencies. Adjustments in the range of hundreds
// is a good start. // is a good start.
#ifndef DDS_REFCLK_OFFSET
#define DDS_REFCLK_OFFSET 0 #define DDS_REFCLK_OFFSET 0
#endif
#ifdef DDS_USE_ONLY_TIMER2 #ifdef DDS_USE_ONLY_TIMER2
// TODO: Figure out where this clock value is generated from // TODO: Figure out where this clock value is generated from
@ -172,7 +179,7 @@ static const int8_t ddsSineTable[256] PROGMEM = {
class DDS { class DDS {
public: public:
DDS(): refclk(DDS_REFCLK_DEFAULT), accumulator(0), running(false), DDS(): refclk(DDS_REFCLK_DEFAULT), accumulator(0), running(false),
timeLimited(false), tickDuration(0), amplitude(0) timeLimited(false), tickDuration(0), amplitude(255)
{}; {};
// Start all of the timers needed // Start all of the timers needed
@ -210,9 +217,15 @@ public:
delay(duration); delay(duration);
} }
// Use these to get some calculated values for specific frequencies
// or to get the current frequency stepping rate.
ddsAccumulator_t calcFrequency(unsigned short freq);
ddsAccumulator_t getPhaseAdvance() { return stepRate; };
// Our maximum clock isn't very high, so our highest // Our maximum clock isn't very high, so our highest
// frequency supported will fit in a short. // frequency supported will fit in a short.
void setFrequency(unsigned short freq); void setFrequency(unsigned short freq) { stepRate = calcFrequency(freq); };
void setPrecalcFrequency(ddsAccumulator_t freq) { stepRate = freq; };
// Handle phase shifts // Handle phase shifts
void setPhaseDeg(int16_t degrees); void setPhaseDeg(int16_t degrees);
@ -244,15 +257,9 @@ private:
volatile unsigned long tickDuration; volatile unsigned long tickDuration;
volatile bool timeLimited; volatile bool timeLimited;
volatile unsigned char amplitude; volatile unsigned char amplitude;
#ifdef SHORT_ACCUMULATOR volatile ddsAccumulator_t accumulator;
volatile unsigned short accumulator; volatile ddsAccumulator_t stepRate;
volatile unsigned short stepRate; ddsAccumulator_t refclk;
unsigned short refclk;
#else
volatile unsigned long accumulator;
volatile unsigned long stepRate;
unsigned long refclk;
#endif
static DDS *sDDS; static DDS *sDDS;
}; };