Add calculators for frequency steps. Accumulator has a typedef now. Optimize tick.
This commit is contained in:
		
							parent
							
								
									5fd0fdf154
								
							
						
					
					
						commit
						acc4aebe03
					
				
							
								
								
									
										23
									
								
								DDS.cpp
								
								
								
								
							
							
						
						
									
										23
									
								
								DDS.cpp
								
								
								
								
							| 
						 | 
					@ -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
								
								
								
								
							
							
						
						
									
										31
									
								
								DDS.h
								
								
								
								
							| 
						 | 
					@ -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;
 | 
				
			||||||
};
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
| 
						 | 
					
 | 
				
			||||||
		Loading…
	
		Reference in New Issue