Signal Generator
Dependencies: IniManager RA8875 Watchdog mbed-rtos mbed
Fork of speaker_demo_Analog by
SignalGenDAC.cpp@5:49dd0c647a40, 2017-01-16 (annotated)
- Committer:
- WiredHome
- Date:
- Mon Jan 16 22:57:59 2017 +0000
- Revision:
- 5:49dd0c647a40
- Parent:
- 4:10281ddb673d
- Child:
- 6:1f48212fbaf9
Stable commit before any major refactoring
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
WiredHome | 2:8f71b71fce1b | 1 | |
WiredHome | 2:8f71b71fce1b | 2 | #include "SignalGenDAC.h" |
WiredHome | 2:8f71b71fce1b | 3 | |
WiredHome | 4:10281ddb673d | 4 | DigitalOut led(LED1); |
WiredHome | 4:10281ddb673d | 5 | |
WiredHome | 5:49dd0c647a40 | 6 | #define PI 3.14159 // for the sine-wave |
WiredHome | 2:8f71b71fce1b | 7 | |
WiredHome | 2:8f71b71fce1b | 8 | /// The linked list structure used to control the DMA transfer |
WiredHome | 2:8f71b71fce1b | 9 | /// |
WiredHome | 2:8f71b71fce1b | 10 | typedef struct { |
WiredHome | 2:8f71b71fce1b | 11 | uint32_t source; /// start of source area |
WiredHome | 2:8f71b71fce1b | 12 | uint32_t destination;/// start of destination area |
WiredHome | 2:8f71b71fce1b | 13 | uint32_t next; /// address of next strLLI in chain |
WiredHome | 2:8f71b71fce1b | 14 | uint32_t control; /// DMACCxControl register |
WiredHome | 2:8f71b71fce1b | 15 | } LinkListItem_t; |
WiredHome | 2:8f71b71fce1b | 16 | |
WiredHome | 3:d22f3e52d06a | 17 | /// The DACsignal memory, which is DMA sent to the DAC to play the waveform, |
WiredHome | 3:d22f3e52d06a | 18 | /// produced by scaling the VoltSignal array |
WiredHome | 2:8f71b71fce1b | 19 | /// |
WiredHome | 3:d22f3e52d06a | 20 | float VoltSignal[SIGNAL_MEM_ENTRIES] __attribute__ ((section("AHBSRAM0"))); |
WiredHome | 3:d22f3e52d06a | 21 | signed long DACsignal[SIGNAL_MEM_ENTRIES] __attribute__ ((section("AHBSRAM0"))); |
WiredHome | 2:8f71b71fce1b | 22 | |
WiredHome | 2:8f71b71fce1b | 23 | /// The linked list item record, used by the DMA engine to decide how to play |
WiredHome | 2:8f71b71fce1b | 24 | /// |
WiredHome | 2:8f71b71fce1b | 25 | LinkListItem_t llio __attribute__ ((section("AHBSRAM0"))); |
WiredHome | 2:8f71b71fce1b | 26 | |
WiredHome | 2:8f71b71fce1b | 27 | |
WiredHome | 2:8f71b71fce1b | 28 | SignalGenDAC::SignalGenDAC(PinName _aout, float _minV, float _maxV) : |
WiredHome | 2:8f71b71fce1b | 29 | minV(_minV), maxV(_maxV) { |
WiredHome | 2:8f71b71fce1b | 30 | aout = new AnalogOut(_aout); |
WiredHome | 2:8f71b71fce1b | 31 | } |
WiredHome | 2:8f71b71fce1b | 32 | |
WiredHome | 2:8f71b71fce1b | 33 | SignalGenDAC::~SignalGenDAC() { |
WiredHome | 2:8f71b71fce1b | 34 | } |
WiredHome | 2:8f71b71fce1b | 35 | |
WiredHome | 2:8f71b71fce1b | 36 | void SignalGenDAC::Start(bool oneShot) { |
WiredHome | 4:10281ddb673d | 37 | printf("Start(%d) w/%d samples\r\n", oneShot ? 1 : 0, numSamples); |
WiredHome | 3:d22f3e52d06a | 38 | isOn = (oneShot) ? false : true; |
WiredHome | 4:10281ddb673d | 39 | led = 1; |
WiredHome | 4:10281ddb673d | 40 | |
WiredHome | 4:10281ddb673d | 41 | for (int x=0; x<numSamples; x++) { |
WiredHome | 4:10281ddb673d | 42 | DACsignal[x] = ((uint16_t)(VoltSignal[x]/maxV * 1023) << 6); |
WiredHome | 4:10281ddb673d | 43 | printf("%3d, %5.3f, %d\r\n", x, VoltSignal[x], DACsignal[x]); |
WiredHome | 4:10281ddb673d | 44 | } |
WiredHome | 4:10281ddb673d | 45 | |
WiredHome | 4:10281ddb673d | 46 | llio.source = (uint32_t)DACsignal; |
WiredHome | 4:10281ddb673d | 47 | llio.destination = (uint32_t)&LPC_DAC->DACR; |
WiredHome | 4:10281ddb673d | 48 | llio.next = (uint32_t)&llio; |
WiredHome | 4:10281ddb673d | 49 | llio.control = (1<<26) | (2<<21) | (2<<18) | numSamples; |
WiredHome | 4:10281ddb673d | 50 | |
WiredHome | 4:10281ddb673d | 51 | LPC_SC->PCONP |= (1<<29); |
WiredHome | 4:10281ddb673d | 52 | |
WiredHome | 4:10281ddb673d | 53 | /* Enable GPDMA and sync logic */ |
WiredHome | 4:10281ddb673d | 54 | LPC_GPDMA->DMACConfig = 1; |
WiredHome | 4:10281ddb673d | 55 | LPC_GPDMA->DMACSync = (1<<6); |
WiredHome | 4:10281ddb673d | 56 | |
WiredHome | 4:10281ddb673d | 57 | /* Load DMA Channel0 */ |
WiredHome | 4:10281ddb673d | 58 | LPC_GPDMACH0->DMACCSrcAddr = (uint32_t)DACsignal; |
WiredHome | 4:10281ddb673d | 59 | LPC_GPDMACH0->DMACCDestAddr = (uint32_t)&LPC_DAC->DACR; |
WiredHome | 5:49dd0c647a40 | 60 | LPC_GPDMACH0->DMACCLLI = (uint32_t)&llio; |
WiredHome | 5:49dd0c647a40 | 61 | |
WiredHome | 4:10281ddb673d | 62 | LPC_GPDMACH0->DMACCControl = numSamples // transfer size (0 - 11) = 64 |
WiredHome | 4:10281ddb673d | 63 | | (0 << 12) // source burst size (12 - 14) = 1 |
WiredHome | 4:10281ddb673d | 64 | | (0 << 15) // destination burst size (15 - 17) = 1 |
WiredHome | 4:10281ddb673d | 65 | | (2 << 18) // source width (18 - 20) = 32 bit |
WiredHome | 4:10281ddb673d | 66 | | (2 << 21) // destination width (21 - 23) = 32 bit |
WiredHome | 4:10281ddb673d | 67 | | (0 << 24) // source AHB select (24) = AHB 0 |
WiredHome | 4:10281ddb673d | 68 | | (0 << 25) // destination AHB select (25) = AHB 0 |
WiredHome | 4:10281ddb673d | 69 | | (1 << 26) // source increment (26) = increment |
WiredHome | 4:10281ddb673d | 70 | | (0 << 27) // destination increment (27) = no increment |
WiredHome | 4:10281ddb673d | 71 | | (0 << 28) // mode select (28) = access in user mode |
WiredHome | 4:10281ddb673d | 72 | | (0 << 29) // (29) = access not bufferable |
WiredHome | 4:10281ddb673d | 73 | | (0 << 30) // (30) = access not cacheable |
WiredHome | 4:10281ddb673d | 74 | | (0 << 31); // terminal count interrupt disabled |
WiredHome | 4:10281ddb673d | 75 | |
WiredHome | 4:10281ddb673d | 76 | LPC_GPDMACH0->DMACCConfig = 1 |
WiredHome | 4:10281ddb673d | 77 | | (0 << 1) // source peripheral (1 - 5) = none |
WiredHome | 4:10281ddb673d | 78 | | (7 << 6) // destination peripheral (6 - 10) = DAC |
WiredHome | 4:10281ddb673d | 79 | | (1 << 11) // flow control (11 - 13) = mem to per |
WiredHome | 4:10281ddb673d | 80 | | (0 << 14) // (14) = mask out error interrupt |
WiredHome | 4:10281ddb673d | 81 | | (0 << 15) // (15) = mask out terminal count interrupt |
WiredHome | 4:10281ddb673d | 82 | | (0 << 16) // (16) = no locked transfers |
WiredHome | 4:10281ddb673d | 83 | | (0 << 18); // (27) = no HALT |
WiredHome | 4:10281ddb673d | 84 | |
WiredHome | 4:10281ddb673d | 85 | /* DACclk = 25 MHz, so 10 usec interval */ |
WiredHome | 4:10281ddb673d | 86 | LPC_DAC->DACCNTVAL = 20; // 16-bit reload value |
WiredHome | 4:10281ddb673d | 87 | /* DMA, timer running, dbuff */ |
WiredHome | 4:10281ddb673d | 88 | LPC_DAC->DACCTRL = |
WiredHome | 4:10281ddb673d | 89 | 1<<3 // DMA_ENA dma burst is enabled |
WiredHome | 4:10281ddb673d | 90 | | 1<<2 // CNT_ENA Timeout couner is enabled |
WiredHome | 4:10281ddb673d | 91 | | 1<<1; // DBLBUF_ENA double-buffering enabled |
WiredHome | 2:8f71b71fce1b | 92 | } |
WiredHome | 2:8f71b71fce1b | 93 | |
WiredHome | 2:8f71b71fce1b | 94 | void SignalGenDAC::Stop(void) { |
WiredHome | 3:d22f3e52d06a | 95 | printf("Stop()\r\n"); |
WiredHome | 3:d22f3e52d06a | 96 | LPC_GPDMACH0->DMACCLLI = 0; |
WiredHome | 5:49dd0c647a40 | 97 | while (LPC_GPDMACH0->DMACCConfig & 1) |
WiredHome | 5:49dd0c647a40 | 98 | wait_ms(1); |
WiredHome | 5:49dd0c647a40 | 99 | aout->write(offset / maxV); |
WiredHome | 3:d22f3e52d06a | 100 | isOn = false; |
WiredHome | 4:10281ddb673d | 101 | led = 0; |
WiredHome | 2:8f71b71fce1b | 102 | } |
WiredHome | 2:8f71b71fce1b | 103 | |
WiredHome | 2:8f71b71fce1b | 104 | |
WiredHome | 5:49dd0c647a40 | 105 | void SignalGenDAC::PrepareWaveform(SG_Mode mode, float _frequency, float _dutycycle, float _voltage, float _offset) { |
WiredHome | 2:8f71b71fce1b | 106 | int x, dcCount, firstQtr, lastQtr; |
WiredHome | 5:49dd0c647a40 | 107 | frequency = _frequency; |
WiredHome | 5:49dd0c647a40 | 108 | dutycycle = _dutycycle; |
WiredHome | 5:49dd0c647a40 | 109 | voltage = _voltage; |
WiredHome | 5:49dd0c647a40 | 110 | offset = _offset; |
WiredHome | 2:8f71b71fce1b | 111 | float upp = rangelimit(offset + voltage/2, minV, maxV); |
WiredHome | 2:8f71b71fce1b | 112 | float mid = rangelimit(offset, minV, maxV); |
WiredHome | 2:8f71b71fce1b | 113 | float low = rangelimit(offset - voltage/2, minV, maxV); |
WiredHome | 2:8f71b71fce1b | 114 | float v; |
WiredHome | 4:10281ddb673d | 115 | numSamples = 32; // Ideally, compute this based on the frequency for good resolution |
WiredHome | 2:8f71b71fce1b | 116 | dcCount = dutycycle/100.0 * numSamples; |
WiredHome | 2:8f71b71fce1b | 117 | firstQtr = dcCount / 2; |
WiredHome | 2:8f71b71fce1b | 118 | lastQtr = dcCount + (numSamples - dcCount)/2; |
WiredHome | 2:8f71b71fce1b | 119 | |
WiredHome | 2:8f71b71fce1b | 120 | // Set the timebased based on the frequency |
WiredHome | 2:8f71b71fce1b | 121 | if (isOn) { |
WiredHome | 4:10281ddb673d | 122 | Stop(); |
WiredHome | 2:8f71b71fce1b | 123 | } |
WiredHome | 4:10281ddb673d | 124 | printf("Generate wave for mode: %d\r\n", mode); |
WiredHome | 2:8f71b71fce1b | 125 | switch (mode) { |
WiredHome | 2:8f71b71fce1b | 126 | case SG_SINE: |
WiredHome | 2:8f71b71fce1b | 127 | for (x=0; x<numSamples; x++) { |
WiredHome | 2:8f71b71fce1b | 128 | if (x < dcCount) { |
WiredHome | 2:8f71b71fce1b | 129 | v = offset + voltage/2 * sin(x * 1 * PI / dcCount); |
WiredHome | 2:8f71b71fce1b | 130 | } else { |
WiredHome | 2:8f71b71fce1b | 131 | v = offset - voltage/2 * sin((x - dcCount) * 1 * PI / (numSamples-dcCount)); |
WiredHome | 2:8f71b71fce1b | 132 | } |
WiredHome | 3:d22f3e52d06a | 133 | v = rangelimit(v, minV, maxV); |
WiredHome | 3:d22f3e52d06a | 134 | VoltSignal[x] = v; |
WiredHome | 2:8f71b71fce1b | 135 | } |
WiredHome | 2:8f71b71fce1b | 136 | break; |
WiredHome | 2:8f71b71fce1b | 137 | case SG_SQUARE: |
WiredHome | 2:8f71b71fce1b | 138 | for (x=0; x<numSamples; x++) { |
WiredHome | 2:8f71b71fce1b | 139 | if (x < dcCount) { |
WiredHome | 2:8f71b71fce1b | 140 | v = rangelimit(offset + voltage/2, minV, maxV); |
WiredHome | 2:8f71b71fce1b | 141 | } else { |
WiredHome | 2:8f71b71fce1b | 142 | v = rangelimit(offset - voltage/2, minV, maxV); |
WiredHome | 2:8f71b71fce1b | 143 | } |
WiredHome | 3:d22f3e52d06a | 144 | VoltSignal[x] = v; |
WiredHome | 2:8f71b71fce1b | 145 | } |
WiredHome | 2:8f71b71fce1b | 146 | break; |
WiredHome | 2:8f71b71fce1b | 147 | case SG_TRIANGLE: |
WiredHome | 2:8f71b71fce1b | 148 | for (x=0; x<numSamples; x++) { |
WiredHome | 2:8f71b71fce1b | 149 | if (x < firstQtr) { |
WiredHome | 3:d22f3e52d06a | 150 | v = voltage/2 * (float)x/(firstQtr); |
WiredHome | 3:d22f3e52d06a | 151 | v += offset; |
WiredHome | 2:8f71b71fce1b | 152 | } else if (x < dcCount) { |
WiredHome | 3:d22f3e52d06a | 153 | v = voltage/2 * (float)x/(firstQtr); |
WiredHome | 3:d22f3e52d06a | 154 | v = voltage - (v - offset); |
WiredHome | 2:8f71b71fce1b | 155 | } else if (x < lastQtr) { |
WiredHome | 3:d22f3e52d06a | 156 | v = voltage * (float)(x - dcCount)/(numSamples - dcCount); |
WiredHome | 3:d22f3e52d06a | 157 | v = offset - v; |
WiredHome | 2:8f71b71fce1b | 158 | } else { |
WiredHome | 3:d22f3e52d06a | 159 | v = voltage * (float)(x - dcCount)/(numSamples - dcCount); |
WiredHome | 3:d22f3e52d06a | 160 | v = v + offset - voltage; |
WiredHome | 2:8f71b71fce1b | 161 | } |
WiredHome | 3:d22f3e52d06a | 162 | VoltSignal[x] = v; |
WiredHome | 2:8f71b71fce1b | 163 | } |
WiredHome | 2:8f71b71fce1b | 164 | break; |
WiredHome | 2:8f71b71fce1b | 165 | case SG_SAWTOOTH: |
WiredHome | 2:8f71b71fce1b | 166 | for (x=0; x<numSamples; x++) { |
WiredHome | 2:8f71b71fce1b | 167 | if (x < dcCount) { |
WiredHome | 3:d22f3e52d06a | 168 | v = offset - voltage/2 + (float)x/dcCount * voltage/2; |
WiredHome | 2:8f71b71fce1b | 169 | } else { |
WiredHome | 3:d22f3e52d06a | 170 | v = offset + (float)(x - dcCount)/(numSamples - dcCount) * voltage/2; |
WiredHome | 2:8f71b71fce1b | 171 | } |
WiredHome | 3:d22f3e52d06a | 172 | v = rangelimit(v, minV, maxV); |
WiredHome | 3:d22f3e52d06a | 173 | VoltSignal[x] = v; |
WiredHome | 2:8f71b71fce1b | 174 | } |
WiredHome | 2:8f71b71fce1b | 175 | break; |
WiredHome | 2:8f71b71fce1b | 176 | case SG_USER: |
WiredHome | 2:8f71b71fce1b | 177 | break; |
WiredHome | 2:8f71b71fce1b | 178 | } |
WiredHome | 3:d22f3e52d06a | 179 | //printf("DAC Data %3.2f %3.2f\r\n", voltage, offset); |
WiredHome | 2:8f71b71fce1b | 180 | for (x=0; x<numSamples; x++) { |
WiredHome | 4:10281ddb673d | 181 | DACsignal[x] = ((uint16_t)(VoltSignal[x]/maxV * 1023) << 6); |
WiredHome | 4:10281ddb673d | 182 | printf("%3d, %5.3f, %d\r\n", x, VoltSignal[x], DACsignal[x]); |
WiredHome | 2:8f71b71fce1b | 183 | } |
WiredHome | 5:49dd0c647a40 | 184 | if (!isOn) { |
WiredHome | 5:49dd0c647a40 | 185 | aout->write(offset / maxV); |
WiredHome | 5:49dd0c647a40 | 186 | } |
WiredHome | 2:8f71b71fce1b | 187 | } |
WiredHome | 2:8f71b71fce1b | 188 | |
WiredHome | 2:8f71b71fce1b | 189 | float SignalGenDAC::rangelimit(float value, float min, float max) { |
WiredHome | 2:8f71b71fce1b | 190 | if (value < min) |
WiredHome | 2:8f71b71fce1b | 191 | return min; |
WiredHome | 2:8f71b71fce1b | 192 | else if (value > max) |
WiredHome | 2:8f71b71fce1b | 193 | return max; |
WiredHome | 2:8f71b71fce1b | 194 | else |
WiredHome | 2:8f71b71fce1b | 195 | return value; |
WiredHome | 2:8f71b71fce1b | 196 | } |
WiredHome | 2:8f71b71fce1b | 197 |