Allows Asynchronous reading from the analog pins to memory. Supports: K64F
asyncADC.cpp@2:754768be9b9a, 2017-05-24 (annotated)
- Committer:
- Condo2k4
- Date:
- Wed May 24 11:57:48 2017 +0000
- Revision:
- 2:754768be9b9a
- Parent:
- 1:57441202d8d0
Fixes
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Condo2k4 | 0:f0c00f67fba1 | 1 | #include "asyncADC.h" |
Condo2k4 | 0:f0c00f67fba1 | 2 | #include "pinmap.h" |
Condo2k4 | 0:f0c00f67fba1 | 3 | #include "PeripheralPins.h" |
Condo2k4 | 0:f0c00f67fba1 | 4 | #include "PeripheralNames.h" |
Condo2k4 | 0:f0c00f67fba1 | 5 | |
Condo2k4 | 0:f0c00f67fba1 | 6 | #define MAX_MOD (0xFFFF) |
Condo2k4 | 0:f0c00f67fba1 | 7 | |
Condo2k4 | 0:f0c00f67fba1 | 8 | static bool _asyncReadActive = false; |
Condo2k4 | 0:f0c00f67fba1 | 9 | static edma_handle_t _handle; |
Condo2k4 | 0:f0c00f67fba1 | 10 | static edma_tcd_t _tcd; |
Condo2k4 | 0:f0c00f67fba1 | 11 | static asyncISR _callback = NULL; |
Condo2k4 | 0:f0c00f67fba1 | 12 | static uint32_t _bufSize; |
Condo2k4 | 0:f0c00f67fba1 | 13 | |
Condo2k4 | 0:f0c00f67fba1 | 14 | // MATH SUPPORT FUNCTIONS |
Condo2k4 | 0:f0c00f67fba1 | 15 | |
Condo2k4 | 0:f0c00f67fba1 | 16 | float f_abs(float f) { |
Condo2k4 | 0:f0c00f67fba1 | 17 | return f>=0.0f ? f : -f; |
Condo2k4 | 0:f0c00f67fba1 | 18 | } |
Condo2k4 | 0:f0c00f67fba1 | 19 | |
Condo2k4 | 0:f0c00f67fba1 | 20 | int i_abs(int i) { |
Condo2k4 | 0:f0c00f67fba1 | 21 | return i>=0 ? i : -i; |
Condo2k4 | 0:f0c00f67fba1 | 22 | } |
Condo2k4 | 0:f0c00f67fba1 | 23 | |
Condo2k4 | 2:754768be9b9a | 24 | bool isPowerOfTwo(unsigned int x) { |
Condo2k4 | 0:f0c00f67fba1 | 25 | return (x != 0) && ((x & (x - 1)) == 0); |
Condo2k4 | 0:f0c00f67fba1 | 26 | } |
Condo2k4 | 0:f0c00f67fba1 | 27 | |
Condo2k4 | 0:f0c00f67fba1 | 28 | int log2(unsigned int i) { |
Condo2k4 | 0:f0c00f67fba1 | 29 | int l = 0; |
Condo2k4 | 0:f0c00f67fba1 | 30 | while(i>>=1) l++; |
Condo2k4 | 0:f0c00f67fba1 | 31 | return l; |
Condo2k4 | 0:f0c00f67fba1 | 32 | } |
Condo2k4 | 0:f0c00f67fba1 | 33 | |
Condo2k4 | 0:f0c00f67fba1 | 34 | // CLOCK SUPPORT FUNTIONS |
Condo2k4 | 0:f0c00f67fba1 | 35 | |
Condo2k4 | 0:f0c00f67fba1 | 36 | void calcClockDiv(const uint32_t targetFrequency, int ÷r, bool &useMult, int &modulus) { |
Condo2k4 | 0:f0c00f67fba1 | 37 | |
Condo2k4 | 0:f0c00f67fba1 | 38 | uint32_t busClock = CLOCK_GetFreq(kCLOCK_BusClk); |
Condo2k4 | 0:f0c00f67fba1 | 39 | |
Condo2k4 | 0:f0c00f67fba1 | 40 | if(targetFrequency > busClock) { |
Condo2k4 | 0:f0c00f67fba1 | 41 | useMult = false; |
Condo2k4 | 0:f0c00f67fba1 | 42 | divider = 0; |
Condo2k4 | 0:f0c00f67fba1 | 43 | modulus = 0; |
Condo2k4 | 0:f0c00f67fba1 | 44 | } |
Condo2k4 | 0:f0c00f67fba1 | 45 | |
Condo2k4 | 0:f0c00f67fba1 | 46 | useMult = false; |
Condo2k4 | 0:f0c00f67fba1 | 47 | divider = 0; |
Condo2k4 | 0:f0c00f67fba1 | 48 | modulus = (((busClock<<1)/targetFrequency+1)>>1)-1; // round(clock/freq)-1 |
Condo2k4 | 0:f0c00f67fba1 | 49 | int bestErr = i_abs(targetFrequency - busClock/(modulus+1)); |
Condo2k4 | 0:f0c00f67fba1 | 50 | |
Condo2k4 | 0:f0c00f67fba1 | 51 | for(int i=1; i<=7; i++) { |
Condo2k4 | 0:f0c00f67fba1 | 52 | int mod = (((busClock>>(i-1))/targetFrequency+1)>>1)-1; |
Condo2k4 | 0:f0c00f67fba1 | 53 | if(mod<0) mod=0; |
Condo2k4 | 0:f0c00f67fba1 | 54 | else if(mod > MAX_MOD) mod = MAX_MOD; |
Condo2k4 | 0:f0c00f67fba1 | 55 | int err = i_abs(targetFrequency - busClock/((1<<i) * (mod+1))); |
Condo2k4 | 0:f0c00f67fba1 | 56 | |
Condo2k4 | 0:f0c00f67fba1 | 57 | if(err<bestErr || (err==bestErr && mod<modulus)) { |
Condo2k4 | 0:f0c00f67fba1 | 58 | useMult = false; |
Condo2k4 | 0:f0c00f67fba1 | 59 | divider = i; |
Condo2k4 | 0:f0c00f67fba1 | 60 | modulus = mod; |
Condo2k4 | 0:f0c00f67fba1 | 61 | } |
Condo2k4 | 0:f0c00f67fba1 | 62 | |
Condo2k4 | 0:f0c00f67fba1 | 63 | mod = (((busClock>>(i-1))/(targetFrequency*5)+1)>>1)-1; |
Condo2k4 | 0:f0c00f67fba1 | 64 | if(mod<0) mod=0; |
Condo2k4 | 0:f0c00f67fba1 | 65 | else if(mod > MAX_MOD) mod = MAX_MOD; |
Condo2k4 | 0:f0c00f67fba1 | 66 | err = i_abs(targetFrequency - busClock/((1<<i) * (mod+1) * 5)); |
Condo2k4 | 0:f0c00f67fba1 | 67 | |
Condo2k4 | 0:f0c00f67fba1 | 68 | if(err<bestErr || (err==bestErr && mod<modulus)) { |
Condo2k4 | 0:f0c00f67fba1 | 69 | useMult = true; |
Condo2k4 | 0:f0c00f67fba1 | 70 | divider = i; |
Condo2k4 | 0:f0c00f67fba1 | 71 | modulus = mod; |
Condo2k4 | 0:f0c00f67fba1 | 72 | } |
Condo2k4 | 0:f0c00f67fba1 | 73 | |
Condo2k4 | 0:f0c00f67fba1 | 74 | } |
Condo2k4 | 0:f0c00f67fba1 | 75 | for(int i=8; i<=11; i++) { |
Condo2k4 | 0:f0c00f67fba1 | 76 | int mod = (((busClock>>(i-1))/(targetFrequency*5)+1)>>1)-1; |
Condo2k4 | 0:f0c00f67fba1 | 77 | if(mod<0) mod=0; |
Condo2k4 | 0:f0c00f67fba1 | 78 | else if(mod > MAX_MOD) mod = MAX_MOD; |
Condo2k4 | 0:f0c00f67fba1 | 79 | int err = i_abs(targetFrequency - busClock/((1<<i) * (mod+1) * 5)); |
Condo2k4 | 0:f0c00f67fba1 | 80 | |
Condo2k4 | 0:f0c00f67fba1 | 81 | if(err<bestErr || (err==bestErr && mod<modulus)) { |
Condo2k4 | 0:f0c00f67fba1 | 82 | useMult = true; |
Condo2k4 | 0:f0c00f67fba1 | 83 | divider = i; |
Condo2k4 | 0:f0c00f67fba1 | 84 | modulus = mod; |
Condo2k4 | 0:f0c00f67fba1 | 85 | } |
Condo2k4 | 0:f0c00f67fba1 | 86 | } |
Condo2k4 | 0:f0c00f67fba1 | 87 | |
Condo2k4 | 0:f0c00f67fba1 | 88 | if(modulus > MAX_MOD) |
Condo2k4 | 0:f0c00f67fba1 | 89 | modulus = MAX_MOD; |
Condo2k4 | 0:f0c00f67fba1 | 90 | } |
Condo2k4 | 0:f0c00f67fba1 | 91 | |
Condo2k4 | 0:f0c00f67fba1 | 92 | void calcClockDiv(const float targetFrequency, int ÷r, bool &useMult, int &modulus) { |
Condo2k4 | 0:f0c00f67fba1 | 93 | |
Condo2k4 | 0:f0c00f67fba1 | 94 | uint32_t busClock = CLOCK_GetFreq(kCLOCK_BusClk); |
Condo2k4 | 0:f0c00f67fba1 | 95 | |
Condo2k4 | 0:f0c00f67fba1 | 96 | if(targetFrequency > busClock) { |
Condo2k4 | 0:f0c00f67fba1 | 97 | useMult = false; |
Condo2k4 | 0:f0c00f67fba1 | 98 | divider = 0; |
Condo2k4 | 0:f0c00f67fba1 | 99 | modulus = 0; |
Condo2k4 | 0:f0c00f67fba1 | 100 | return; |
Condo2k4 | 0:f0c00f67fba1 | 101 | } |
Condo2k4 | 0:f0c00f67fba1 | 102 | |
Condo2k4 | 0:f0c00f67fba1 | 103 | useMult = false; |
Condo2k4 | 0:f0c00f67fba1 | 104 | divider = 0; |
Condo2k4 | 0:f0c00f67fba1 | 105 | modulus = (int)((busClock/targetFrequency)+0.5f); // round(clock/freq) |
Condo2k4 | 0:f0c00f67fba1 | 106 | float bestErr = f_abs(targetFrequency - busClock/(modulus+1)); |
Condo2k4 | 0:f0c00f67fba1 | 107 | |
Condo2k4 | 0:f0c00f67fba1 | 108 | for(int i=1; i<=7; i++) { |
Condo2k4 | 0:f0c00f67fba1 | 109 | int mod = (int)(((busClock>>i)/targetFrequency)+0.5f); |
Condo2k4 | 0:f0c00f67fba1 | 110 | if(mod<0) mod=0; |
Condo2k4 | 0:f0c00f67fba1 | 111 | else if(mod > MAX_MOD) mod = MAX_MOD; |
Condo2k4 | 0:f0c00f67fba1 | 112 | float err = f_abs(targetFrequency - busClock/(float)((1<<i) * (mod+1))); |
Condo2k4 | 0:f0c00f67fba1 | 113 | |
Condo2k4 | 0:f0c00f67fba1 | 114 | if(err<bestErr || (err==bestErr && mod<modulus)) { |
Condo2k4 | 0:f0c00f67fba1 | 115 | useMult = false; |
Condo2k4 | 0:f0c00f67fba1 | 116 | divider = i; |
Condo2k4 | 0:f0c00f67fba1 | 117 | modulus = mod; |
Condo2k4 | 0:f0c00f67fba1 | 118 | } |
Condo2k4 | 0:f0c00f67fba1 | 119 | |
Condo2k4 | 0:f0c00f67fba1 | 120 | mod = (int)(((busClock>>i)/(targetFrequency*5.0f))+0.5f); |
Condo2k4 | 0:f0c00f67fba1 | 121 | if(mod<0) mod=0; |
Condo2k4 | 0:f0c00f67fba1 | 122 | else if(mod > MAX_MOD) mod = MAX_MOD; |
Condo2k4 | 0:f0c00f67fba1 | 123 | err = f_abs(targetFrequency - busClock/(float)((1<<i) * (mod+1) * 5)); |
Condo2k4 | 0:f0c00f67fba1 | 124 | |
Condo2k4 | 0:f0c00f67fba1 | 125 | if(err<bestErr || (err==bestErr && mod<modulus)) { |
Condo2k4 | 0:f0c00f67fba1 | 126 | useMult = true; |
Condo2k4 | 0:f0c00f67fba1 | 127 | divider = i; |
Condo2k4 | 0:f0c00f67fba1 | 128 | modulus = mod; |
Condo2k4 | 0:f0c00f67fba1 | 129 | } |
Condo2k4 | 0:f0c00f67fba1 | 130 | |
Condo2k4 | 0:f0c00f67fba1 | 131 | } |
Condo2k4 | 0:f0c00f67fba1 | 132 | for(int i=8; i<=11; i++) { |
Condo2k4 | 0:f0c00f67fba1 | 133 | int mod = (int)(((busClock>>i)/(targetFrequency*5.0f))+0.5f); |
Condo2k4 | 0:f0c00f67fba1 | 134 | if(mod<0) mod=0; |
Condo2k4 | 0:f0c00f67fba1 | 135 | else if(mod > MAX_MOD) mod = MAX_MOD; |
Condo2k4 | 0:f0c00f67fba1 | 136 | float err = f_abs(targetFrequency - busClock/(float)((1<<i) * (mod+1) * 5)); |
Condo2k4 | 0:f0c00f67fba1 | 137 | |
Condo2k4 | 0:f0c00f67fba1 | 138 | if(err<bestErr || (err==bestErr && mod<modulus)) { |
Condo2k4 | 0:f0c00f67fba1 | 139 | useMult = true; |
Condo2k4 | 0:f0c00f67fba1 | 140 | divider = i; |
Condo2k4 | 0:f0c00f67fba1 | 141 | modulus = mod; |
Condo2k4 | 0:f0c00f67fba1 | 142 | } |
Condo2k4 | 0:f0c00f67fba1 | 143 | } |
Condo2k4 | 0:f0c00f67fba1 | 144 | } |
Condo2k4 | 0:f0c00f67fba1 | 145 | |
Condo2k4 | 0:f0c00f67fba1 | 146 | // INTERRUPT SERVICE ROUTINES |
Condo2k4 | 0:f0c00f67fba1 | 147 | |
Condo2k4 | 0:f0c00f67fba1 | 148 | void singleISR(edma_handle_t *_handle, void *userData, bool transferDone, uint32_t tcds) { |
Condo2k4 | 0:f0c00f67fba1 | 149 | PDB_Enable(PDB0, false); |
Condo2k4 | 0:f0c00f67fba1 | 150 | _asyncReadActive = false; |
Condo2k4 | 0:f0c00f67fba1 | 151 | if(_callback!=NULL) _callback(0, _bufSize); |
Condo2k4 | 0:f0c00f67fba1 | 152 | } |
Condo2k4 | 0:f0c00f67fba1 | 153 | |
Condo2k4 | 0:f0c00f67fba1 | 154 | void rollingISR(edma_handle_t *_handle, void *userData, bool transferDone, uint32_t tcds) { |
Condo2k4 | 0:f0c00f67fba1 | 155 | if(_callback!=NULL) { |
Condo2k4 | 0:f0c00f67fba1 | 156 | if(_handle->base->TCD[_handle->channel].CSR & DMA_CSR_DONE_MASK) |
Condo2k4 | 0:f0c00f67fba1 | 157 | _callback(_bufSize>>1, _bufSize-1); |
Condo2k4 | 0:f0c00f67fba1 | 158 | else |
Condo2k4 | 0:f0c00f67fba1 | 159 | _callback(0, (_bufSize>>1)-1); |
Condo2k4 | 0:f0c00f67fba1 | 160 | } |
Condo2k4 | 0:f0c00f67fba1 | 161 | } |
Condo2k4 | 0:f0c00f67fba1 | 162 | |
Condo2k4 | 0:f0c00f67fba1 | 163 | // INIT METHODS |
Condo2k4 | 0:f0c00f67fba1 | 164 | |
Condo2k4 | 0:f0c00f67fba1 | 165 | void prepareADC(uint8_t adcIndex, uint8_t channelGroup, uint8_t channel) { |
Condo2k4 | 0:f0c00f67fba1 | 166 | |
Condo2k4 | 0:f0c00f67fba1 | 167 | ADC_Type* adc; |
Condo2k4 | 0:f0c00f67fba1 | 168 | |
Condo2k4 | 0:f0c00f67fba1 | 169 | if(adcIndex) { |
Condo2k4 | 0:f0c00f67fba1 | 170 | SIM->SCGC3 |= SIM_SCGC3_ADC1_MASK; |
Condo2k4 | 0:f0c00f67fba1 | 171 | adc = ADC1; |
Condo2k4 | 0:f0c00f67fba1 | 172 | } else { |
Condo2k4 | 0:f0c00f67fba1 | 173 | SIM->SCGC6 |= SIM_SCGC6_ADC0_MASK; |
Condo2k4 | 0:f0c00f67fba1 | 174 | adc = ADC0; |
Condo2k4 | 0:f0c00f67fba1 | 175 | } |
Condo2k4 | 0:f0c00f67fba1 | 176 | |
Condo2k4 | 0:f0c00f67fba1 | 177 | adc16_config_t adc16ConfigStruct; |
Condo2k4 | 0:f0c00f67fba1 | 178 | |
Condo2k4 | 0:f0c00f67fba1 | 179 | ADC16_GetDefaultConfig(&adc16ConfigStruct); |
Condo2k4 | 0:f0c00f67fba1 | 180 | ADC16_Init(adc, &adc16ConfigStruct); |
Condo2k4 | 0:f0c00f67fba1 | 181 | ADC16_EnableHardwareTrigger(adc, true); |
Condo2k4 | 0:f0c00f67fba1 | 182 | ADC16_DoAutoCalibration(adc); |
Condo2k4 | 0:f0c00f67fba1 | 183 | ADC16_EnableHardwareTrigger(adc, true); |
Condo2k4 | 0:f0c00f67fba1 | 184 | ADC16_EnableDMA(adc, true); |
Condo2k4 | 0:f0c00f67fba1 | 185 | |
Condo2k4 | 0:f0c00f67fba1 | 186 | adc16_channel_config_t channelConfig; |
Condo2k4 | 0:f0c00f67fba1 | 187 | channelConfig.channelNumber = channel; |
Condo2k4 | 0:f0c00f67fba1 | 188 | channelConfig.enableInterruptOnConversionCompleted = false; |
Condo2k4 | 0:f0c00f67fba1 | 189 | channelConfig.enableDifferentialConversion = false; |
Condo2k4 | 0:f0c00f67fba1 | 190 | |
Condo2k4 | 0:f0c00f67fba1 | 191 | ADC16_SetChannelConfig(adc, channelGroup, &channelConfig); |
Condo2k4 | 0:f0c00f67fba1 | 192 | } |
Condo2k4 | 0:f0c00f67fba1 | 193 | |
Condo2k4 | 0:f0c00f67fba1 | 194 | status_t prepareDMA(uint16_t* destination, uint32_t destSize, int16_t dmaChannel, uint8_t adcIndex, uint8_t adcGroup, bool rollingMode) { |
Condo2k4 | 0:f0c00f67fba1 | 195 | if(dmaChannel<0) { |
Condo2k4 | 0:f0c00f67fba1 | 196 | //Find free DMA channel |
Condo2k4 | 0:f0c00f67fba1 | 197 | for(int i=0; i<16; i++) { |
Condo2k4 | 0:f0c00f67fba1 | 198 | if((DMA0->ERQ & (1U<<i)) == 0) { |
Condo2k4 | 0:f0c00f67fba1 | 199 | dmaChannel=i; |
Condo2k4 | 0:f0c00f67fba1 | 200 | break; |
Condo2k4 | 0:f0c00f67fba1 | 201 | } |
Condo2k4 | 0:f0c00f67fba1 | 202 | } |
Condo2k4 | 0:f0c00f67fba1 | 203 | if(dmaChannel<0) |
Condo2k4 | 0:f0c00f67fba1 | 204 | return kStatus_EDMA_Busy; |
Condo2k4 | 0:f0c00f67fba1 | 205 | } else { |
Condo2k4 | 0:f0c00f67fba1 | 206 | //check if requested DMA channel is free |
Condo2k4 | 0:f0c00f67fba1 | 207 | if((dmaChannel>15) || DMA0->ERQ & (1U<<dmaChannel)) |
Condo2k4 | 0:f0c00f67fba1 | 208 | return kStatus_EDMA_Busy; |
Condo2k4 | 0:f0c00f67fba1 | 209 | } |
Condo2k4 | 0:f0c00f67fba1 | 210 | |
Condo2k4 | 0:f0c00f67fba1 | 211 | /* Configure DMAMUX */ |
Condo2k4 | 0:f0c00f67fba1 | 212 | DMAMUX_Init(DMAMUX0); |
Condo2k4 | 0:f0c00f67fba1 | 213 | DMAMUX_SetSource(DMAMUX0, dmaChannel, 40+adcIndex); //Trigger 40 = ADC0, 41 = ADC1 |
Condo2k4 | 0:f0c00f67fba1 | 214 | DMAMUX_EnableChannel(DMAMUX0, dmaChannel); |
Condo2k4 | 0:f0c00f67fba1 | 215 | |
Condo2k4 | 0:f0c00f67fba1 | 216 | edma_config_t edma_config; |
Condo2k4 | 0:f0c00f67fba1 | 217 | |
Condo2k4 | 0:f0c00f67fba1 | 218 | /* Init the eDMA driver */ |
Condo2k4 | 0:f0c00f67fba1 | 219 | EDMA_GetDefaultConfig(&edma_config); |
Condo2k4 | 0:f0c00f67fba1 | 220 | |
Condo2k4 | 0:f0c00f67fba1 | 221 | EDMA_Init(DMA0, &edma_config); |
Condo2k4 | 0:f0c00f67fba1 | 222 | |
Condo2k4 | 0:f0c00f67fba1 | 223 | EDMA_CreateHandle(&_handle, DMA0, dmaChannel); |
Condo2k4 | 0:f0c00f67fba1 | 224 | EDMA_InstallTCDMemory(&_handle, NULL, 0); //make sure tcd memory pool is clear |
Condo2k4 | 0:f0c00f67fba1 | 225 | EDMA_SetCallback(&_handle, rollingMode ? rollingISR : singleISR, NULL); |
Condo2k4 | 0:f0c00f67fba1 | 226 | |
Condo2k4 | 0:f0c00f67fba1 | 227 | |
Condo2k4 | 0:f0c00f67fba1 | 228 | if(rollingMode) { |
Condo2k4 | 0:f0c00f67fba1 | 229 | EDMA_SetModulo(DMA0, dmaChannel, (edma_modulo_t)(log2(destSize)+1), kEDMA_ModuloDisable); |
Condo2k4 | 0:f0c00f67fba1 | 230 | _handle.base->TCD[dmaChannel].DLAST_SGA = -2*(int32_t)destSize; |
Condo2k4 | 0:f0c00f67fba1 | 231 | } |
Condo2k4 | 0:f0c00f67fba1 | 232 | |
Condo2k4 | 0:f0c00f67fba1 | 233 | edma_transfer_config_t transfer_config; |
Condo2k4 | 0:f0c00f67fba1 | 234 | EDMA_PrepareTransfer(&transfer_config, (void*)&((adcIndex?ADC1:ADC0)->R[adcGroup]), 2, destination, 2, 2, 2*destSize, kEDMA_PeripheralToMemory); |
Condo2k4 | 0:f0c00f67fba1 | 235 | status_t ret = EDMA_SubmitTransfer(&_handle, &transfer_config); |
Condo2k4 | 0:f0c00f67fba1 | 236 | |
Condo2k4 | 0:f0c00f67fba1 | 237 | if(rollingMode) |
Condo2k4 | 0:f0c00f67fba1 | 238 | EDMA_EnableAutoStopRequest(DMA0, dmaChannel, false); //must go after submit |
Condo2k4 | 0:f0c00f67fba1 | 239 | |
Condo2k4 | 0:f0c00f67fba1 | 240 | if(ret == kStatus_Success) { |
Condo2k4 | 0:f0c00f67fba1 | 241 | EDMA_EnableChannelInterrupts(DMA0, dmaChannel, rollingMode ? (kEDMA_MajorInterruptEnable|kEDMA_HalfInterruptEnable) : kEDMA_MajorInterruptEnable); |
Condo2k4 | 0:f0c00f67fba1 | 242 | EDMA_StartTransfer(&_handle); |
Condo2k4 | 0:f0c00f67fba1 | 243 | } |
Condo2k4 | 0:f0c00f67fba1 | 244 | |
Condo2k4 | 0:f0c00f67fba1 | 245 | return ret; |
Condo2k4 | 0:f0c00f67fba1 | 246 | } |
Condo2k4 | 0:f0c00f67fba1 | 247 | |
Condo2k4 | 0:f0c00f67fba1 | 248 | void preparePDB(int divider, bool useMult, int modulus, uint8_t adcIndex, uint8_t adcGroup) { |
Condo2k4 | 0:f0c00f67fba1 | 249 | SIM->SCGC6 |= SIM_SCGC6_PDB_MASK; |
Condo2k4 | 0:f0c00f67fba1 | 250 | |
Condo2k4 | 0:f0c00f67fba1 | 251 | pdb_config_t config; |
Condo2k4 | 0:f0c00f67fba1 | 252 | PDB_GetDefaultConfig(&config); |
Condo2k4 | 0:f0c00f67fba1 | 253 | if(useMult) { |
Condo2k4 | 0:f0c00f67fba1 | 254 | switch(divider) { |
Condo2k4 | 0:f0c00f67fba1 | 255 | case 1: |
Condo2k4 | 0:f0c00f67fba1 | 256 | config.dividerMultiplicationFactor = kPDB_DividerMultiplicationFactor10; |
Condo2k4 | 0:f0c00f67fba1 | 257 | divider = 0; |
Condo2k4 | 0:f0c00f67fba1 | 258 | break; |
Condo2k4 | 0:f0c00f67fba1 | 259 | case 2: |
Condo2k4 | 0:f0c00f67fba1 | 260 | config.dividerMultiplicationFactor = kPDB_DividerMultiplicationFactor20; |
Condo2k4 | 0:f0c00f67fba1 | 261 | divider = 0; |
Condo2k4 | 0:f0c00f67fba1 | 262 | break; |
Condo2k4 | 0:f0c00f67fba1 | 263 | default: |
Condo2k4 | 0:f0c00f67fba1 | 264 | config.dividerMultiplicationFactor = kPDB_DividerMultiplicationFactor40; |
Condo2k4 | 0:f0c00f67fba1 | 265 | divider-=3; |
Condo2k4 | 0:f0c00f67fba1 | 266 | break; |
Condo2k4 | 0:f0c00f67fba1 | 267 | } |
Condo2k4 | 0:f0c00f67fba1 | 268 | } else { |
Condo2k4 | 0:f0c00f67fba1 | 269 | config.dividerMultiplicationFactor = kPDB_DividerMultiplicationFactor1; |
Condo2k4 | 0:f0c00f67fba1 | 270 | } |
Condo2k4 | 0:f0c00f67fba1 | 271 | |
Condo2k4 | 0:f0c00f67fba1 | 272 | switch(divider) { |
Condo2k4 | 0:f0c00f67fba1 | 273 | case 0: |
Condo2k4 | 0:f0c00f67fba1 | 274 | config.prescalerDivider = kPDB_PrescalerDivider1; |
Condo2k4 | 0:f0c00f67fba1 | 275 | break; |
Condo2k4 | 0:f0c00f67fba1 | 276 | case 1: |
Condo2k4 | 0:f0c00f67fba1 | 277 | config.prescalerDivider = kPDB_PrescalerDivider2; |
Condo2k4 | 0:f0c00f67fba1 | 278 | break; |
Condo2k4 | 0:f0c00f67fba1 | 279 | case 2: |
Condo2k4 | 0:f0c00f67fba1 | 280 | config.prescalerDivider = kPDB_PrescalerDivider4; |
Condo2k4 | 0:f0c00f67fba1 | 281 | break; |
Condo2k4 | 0:f0c00f67fba1 | 282 | case 3: |
Condo2k4 | 0:f0c00f67fba1 | 283 | config.prescalerDivider = kPDB_PrescalerDivider8; |
Condo2k4 | 0:f0c00f67fba1 | 284 | break; |
Condo2k4 | 0:f0c00f67fba1 | 285 | case 4: |
Condo2k4 | 0:f0c00f67fba1 | 286 | config.prescalerDivider = kPDB_PrescalerDivider16; |
Condo2k4 | 0:f0c00f67fba1 | 287 | break; |
Condo2k4 | 0:f0c00f67fba1 | 288 | case 5: |
Condo2k4 | 0:f0c00f67fba1 | 289 | config.prescalerDivider = kPDB_PrescalerDivider32; |
Condo2k4 | 0:f0c00f67fba1 | 290 | break; |
Condo2k4 | 0:f0c00f67fba1 | 291 | case 6: |
Condo2k4 | 0:f0c00f67fba1 | 292 | config.prescalerDivider = kPDB_PrescalerDivider64; |
Condo2k4 | 0:f0c00f67fba1 | 293 | break; |
Condo2k4 | 0:f0c00f67fba1 | 294 | default: |
Condo2k4 | 0:f0c00f67fba1 | 295 | config.prescalerDivider = kPDB_PrescalerDivider128; |
Condo2k4 | 0:f0c00f67fba1 | 296 | break; |
Condo2k4 | 0:f0c00f67fba1 | 297 | } |
Condo2k4 | 0:f0c00f67fba1 | 298 | |
Condo2k4 | 0:f0c00f67fba1 | 299 | config.loadValueMode = kPDB_LoadValueImmediately; |
Condo2k4 | 0:f0c00f67fba1 | 300 | config.triggerInputSource = kPDB_TriggerSoftware; |
Condo2k4 | 0:f0c00f67fba1 | 301 | config.enableContinuousMode = true; |
Condo2k4 | 0:f0c00f67fba1 | 302 | PDB_Init(PDB0, &config); |
Condo2k4 | 0:f0c00f67fba1 | 303 | |
Condo2k4 | 0:f0c00f67fba1 | 304 | PDB_EnableDMA(PDB0, false); //set if PDB signals DMA directly instead of generating hardware interrupt |
Condo2k4 | 0:f0c00f67fba1 | 305 | PDB_DisableInterrupts(PDB0, kPDB_SequenceErrorInterruptEnable); //signal errors with interrupt? |
Condo2k4 | 0:f0c00f67fba1 | 306 | PDB_EnableInterrupts(PDB0, kPDB_DelayInterruptEnable); //send interrupt after delay? |
Condo2k4 | 0:f0c00f67fba1 | 307 | |
Condo2k4 | 0:f0c00f67fba1 | 308 | pdb_adc_pretrigger_config_t adcConfig; |
Condo2k4 | 0:f0c00f67fba1 | 309 | adcConfig.enablePreTriggerMask = 1; //enable pre-trigger 0 |
Condo2k4 | 0:f0c00f67fba1 | 310 | adcConfig.enableOutputMask = 1; //enable output for pre-trigger 0 |
Condo2k4 | 0:f0c00f67fba1 | 311 | adcConfig.enableBackToBackOperationMask = 0; //disable back-to-back for all pre-triggers |
Condo2k4 | 0:f0c00f67fba1 | 312 | PDB_SetADCPreTriggerConfig(PDB0, adcIndex, &adcConfig); |
Condo2k4 | 0:f0c00f67fba1 | 313 | |
Condo2k4 | 0:f0c00f67fba1 | 314 | PDB_SetADCPreTriggerDelayValue(PDB0, 0, 0, 0); //set delay on ADC0->R[0] |
Condo2k4 | 0:f0c00f67fba1 | 315 | PDB_SetADCPreTriggerDelayValue(PDB0, 0, 1, 0); //set delay on ADC0->R[1] |
Condo2k4 | 0:f0c00f67fba1 | 316 | PDB_SetADCPreTriggerDelayValue(PDB0, 1, 0, 0); //set delay on ADC1->R[0] |
Condo2k4 | 0:f0c00f67fba1 | 317 | PDB_SetADCPreTriggerDelayValue(PDB0, 1, 1, 0); //set delay on ADC1->R[1] |
Condo2k4 | 0:f0c00f67fba1 | 318 | |
Condo2k4 | 0:f0c00f67fba1 | 319 | PDB_SetModulusValue(PDB0, modulus); //actual frequency = clock frequency / ((modulus+1) * prescale divider * divider multiplier) |
Condo2k4 | 0:f0c00f67fba1 | 320 | |
Condo2k4 | 0:f0c00f67fba1 | 321 | PDB_Enable(PDB0, true); //do at end before load |
Condo2k4 | 0:f0c00f67fba1 | 322 | PDB_DoLoadValues(PDB0); |
Condo2k4 | 0:f0c00f67fba1 | 323 | } |
Condo2k4 | 0:f0c00f67fba1 | 324 | |
Condo2k4 | 0:f0c00f67fba1 | 325 | // API |
Condo2k4 | 0:f0c00f67fba1 | 326 | |
Condo2k4 | 0:f0c00f67fba1 | 327 | uint32_t approximateFrequency(uint32_t targetFrequency) { |
Condo2k4 | 0:f0c00f67fba1 | 328 | int divider, modulus; bool useMult; |
Condo2k4 | 0:f0c00f67fba1 | 329 | calcClockDiv(targetFrequency, divider, useMult, modulus); |
Condo2k4 | 0:f0c00f67fba1 | 330 | return (CLOCK_GetFreq(kCLOCK_BusClk)/((1<<divider) * (modulus+1) * (useMult ? 10 : 2))+1)>>1; |
Condo2k4 | 0:f0c00f67fba1 | 331 | } |
Condo2k4 | 0:f0c00f67fba1 | 332 | |
Condo2k4 | 0:f0c00f67fba1 | 333 | float approximateFrequency(float targetFrequency) { |
Condo2k4 | 0:f0c00f67fba1 | 334 | int divider, modulus; bool useMult; |
Condo2k4 | 0:f0c00f67fba1 | 335 | calcClockDiv(targetFrequency, divider, useMult, modulus); |
Condo2k4 | 0:f0c00f67fba1 | 336 | return CLOCK_GetFreq(kCLOCK_BusClk)/(float)((1<<divider) * (modulus+1) * (useMult ? 5 : 1)); |
Condo2k4 | 0:f0c00f67fba1 | 337 | } |
Condo2k4 | 0:f0c00f67fba1 | 338 | |
Condo2k4 | 0:f0c00f67fba1 | 339 | async_error_t asyncAnalogToBuffer(PinName source, uint16_t* destination, uint32_t destSize, uint32_t sampleFrequency, asyncISR callback, int16_t dmaChannel) { |
Condo2k4 | 0:f0c00f67fba1 | 340 | if(_asyncReadActive) |
Condo2k4 | 0:f0c00f67fba1 | 341 | return E_ASYNC_ADC_ACTIVE; |
Condo2k4 | 0:f0c00f67fba1 | 342 | _asyncReadActive = true; |
Condo2k4 | 0:f0c00f67fba1 | 343 | |
Condo2k4 | 0:f0c00f67fba1 | 344 | if(destSize<=0) { |
Condo2k4 | 0:f0c00f67fba1 | 345 | return E_INVALID_BUFFER_SIZE; //Destination buffer size must be greater that 0 |
Condo2k4 | 0:f0c00f67fba1 | 346 | } |
Condo2k4 | 0:f0c00f67fba1 | 347 | |
Condo2k4 | 0:f0c00f67fba1 | 348 | uint32_t adc = pinmap_peripheral(source, PinMap_ADC); |
Condo2k4 | 0:f0c00f67fba1 | 349 | |
Condo2k4 | 0:f0c00f67fba1 | 350 | if(adc == (ADCName)NC) { |
Condo2k4 | 0:f0c00f67fba1 | 351 | error("Pin doese not support Analog to Digital Conversion"); |
Condo2k4 | 0:f0c00f67fba1 | 352 | } |
Condo2k4 | 0:f0c00f67fba1 | 353 | |
Condo2k4 | 0:f0c00f67fba1 | 354 | int adcIndex = adc >> ADC_INSTANCE_SHIFT, adcGroup = 0, adcChannel = adc & 0xF; |
Condo2k4 | 0:f0c00f67fba1 | 355 | prepareADC(adcIndex, adcGroup, adcChannel); |
Condo2k4 | 0:f0c00f67fba1 | 356 | |
Condo2k4 | 0:f0c00f67fba1 | 357 | switch(prepareDMA(destination, destSize, dmaChannel, adcIndex, adcGroup, false)) { |
Condo2k4 | 0:f0c00f67fba1 | 358 | case kStatus_EDMA_QueueFull: |
Condo2k4 | 0:f0c00f67fba1 | 359 | case kStatus_EDMA_Busy: |
Condo2k4 | 0:f0c00f67fba1 | 360 | return E_DMA_IN_USE; |
Condo2k4 | 0:f0c00f67fba1 | 361 | default: |
Condo2k4 | 0:f0c00f67fba1 | 362 | break; |
Condo2k4 | 0:f0c00f67fba1 | 363 | } |
Condo2k4 | 0:f0c00f67fba1 | 364 | |
Condo2k4 | 0:f0c00f67fba1 | 365 | int divider, modulus; bool useMult; |
Condo2k4 | 0:f0c00f67fba1 | 366 | calcClockDiv(sampleFrequency, divider, useMult, modulus); |
Condo2k4 | 0:f0c00f67fba1 | 367 | preparePDB(divider, useMult, modulus, adcIndex, adcGroup); |
Condo2k4 | 0:f0c00f67fba1 | 368 | |
Condo2k4 | 0:f0c00f67fba1 | 369 | _bufSize = destSize; |
Condo2k4 | 0:f0c00f67fba1 | 370 | _callback = callback; |
Condo2k4 | 0:f0c00f67fba1 | 371 | |
Condo2k4 | 0:f0c00f67fba1 | 372 | PDB_DoSoftwareTrigger(PDB0); |
Condo2k4 | 0:f0c00f67fba1 | 373 | |
Condo2k4 | 0:f0c00f67fba1 | 374 | return SUCCESS; |
Condo2k4 | 0:f0c00f67fba1 | 375 | } |
Condo2k4 | 0:f0c00f67fba1 | 376 | |
Condo2k4 | 0:f0c00f67fba1 | 377 | async_error_t asyncAnalogToCircularBuffer(PinName source, uint16_t* destination, uint32_t destSize, uint32_t sampleFrequency, asyncISR callback, int16_t dmaChannel) { |
Condo2k4 | 0:f0c00f67fba1 | 378 | if(_asyncReadActive) |
Condo2k4 | 0:f0c00f67fba1 | 379 | return E_ASYNC_ADC_ACTIVE; |
Condo2k4 | 0:f0c00f67fba1 | 380 | _asyncReadActive = true; |
Condo2k4 | 0:f0c00f67fba1 | 381 | |
Condo2k4 | 0:f0c00f67fba1 | 382 | if(destSize<=0 && !isPowerOfTwo(destSize)) { |
Condo2k4 | 0:f0c00f67fba1 | 383 | return E_INVALID_BUFFER_SIZE; //Destination buffer size must be greater that 0 and a power of 2 |
Condo2k4 | 0:f0c00f67fba1 | 384 | } |
Condo2k4 | 0:f0c00f67fba1 | 385 | |
Condo2k4 | 0:f0c00f67fba1 | 386 | uint32_t adc = pinmap_peripheral(source, PinMap_ADC); |
Condo2k4 | 0:f0c00f67fba1 | 387 | |
Condo2k4 | 0:f0c00f67fba1 | 388 | if(adc == (ADCName)NC) { |
Condo2k4 | 0:f0c00f67fba1 | 389 | error("Pin doese not support Analog to Digital Conversion"); |
Condo2k4 | 0:f0c00f67fba1 | 390 | } |
Condo2k4 | 0:f0c00f67fba1 | 391 | |
Condo2k4 | 0:f0c00f67fba1 | 392 | int adcIndex = adc >> ADC_INSTANCE_SHIFT, adcGroup = 0, adcChannel = adc & 0xF; |
Condo2k4 | 0:f0c00f67fba1 | 393 | prepareADC(adcIndex, adcGroup, adcChannel); |
Condo2k4 | 0:f0c00f67fba1 | 394 | |
Condo2k4 | 0:f0c00f67fba1 | 395 | switch(prepareDMA(destination, destSize, dmaChannel, adcIndex, adcGroup, true)) { |
Condo2k4 | 0:f0c00f67fba1 | 396 | case kStatus_EDMA_QueueFull: |
Condo2k4 | 0:f0c00f67fba1 | 397 | case kStatus_EDMA_Busy: |
Condo2k4 | 0:f0c00f67fba1 | 398 | return E_DMA_IN_USE; |
Condo2k4 | 0:f0c00f67fba1 | 399 | default: |
Condo2k4 | 0:f0c00f67fba1 | 400 | break; |
Condo2k4 | 0:f0c00f67fba1 | 401 | } |
Condo2k4 | 0:f0c00f67fba1 | 402 | |
Condo2k4 | 0:f0c00f67fba1 | 403 | int divider, modulus; bool useMult; |
Condo2k4 | 0:f0c00f67fba1 | 404 | calcClockDiv(sampleFrequency, divider, useMult, modulus); |
Condo2k4 | 0:f0c00f67fba1 | 405 | preparePDB(divider, useMult, modulus, adcIndex, adcGroup); |
Condo2k4 | 0:f0c00f67fba1 | 406 | |
Condo2k4 | 0:f0c00f67fba1 | 407 | _bufSize = destSize; |
Condo2k4 | 0:f0c00f67fba1 | 408 | _callback = callback; |
Condo2k4 | 0:f0c00f67fba1 | 409 | |
Condo2k4 | 0:f0c00f67fba1 | 410 | PDB_DoSoftwareTrigger(PDB0); |
Condo2k4 | 0:f0c00f67fba1 | 411 | |
Condo2k4 | 0:f0c00f67fba1 | 412 | return SUCCESS; |
Condo2k4 | 0:f0c00f67fba1 | 413 | } |
Condo2k4 | 0:f0c00f67fba1 | 414 | |
Condo2k4 | 0:f0c00f67fba1 | 415 | async_error_t asyncAnalogToBuffer_f(PinName source, uint16_t* destination, uint32_t destSize, float sampleFrequency, asyncISR callback, int16_t dmaChannel) { |
Condo2k4 | 0:f0c00f67fba1 | 416 | if(_asyncReadActive) |
Condo2k4 | 0:f0c00f67fba1 | 417 | return E_ASYNC_ADC_ACTIVE; |
Condo2k4 | 0:f0c00f67fba1 | 418 | _asyncReadActive = true; |
Condo2k4 | 0:f0c00f67fba1 | 419 | |
Condo2k4 | 0:f0c00f67fba1 | 420 | if(destSize<=0) { |
Condo2k4 | 0:f0c00f67fba1 | 421 | return E_INVALID_BUFFER_SIZE; //Destination buffer size must be greater that 0 |
Condo2k4 | 0:f0c00f67fba1 | 422 | } |
Condo2k4 | 0:f0c00f67fba1 | 423 | |
Condo2k4 | 0:f0c00f67fba1 | 424 | uint32_t adc = pinmap_peripheral(source, PinMap_ADC); |
Condo2k4 | 0:f0c00f67fba1 | 425 | |
Condo2k4 | 0:f0c00f67fba1 | 426 | if(adc == (ADCName)NC) { |
Condo2k4 | 0:f0c00f67fba1 | 427 | error("Pin doese not support Analog to Digital Conversion"); |
Condo2k4 | 0:f0c00f67fba1 | 428 | } |
Condo2k4 | 0:f0c00f67fba1 | 429 | |
Condo2k4 | 0:f0c00f67fba1 | 430 | int adcIndex = adc >> ADC_INSTANCE_SHIFT, adcGroup = 0, adcChannel = adc & 0xF; |
Condo2k4 | 0:f0c00f67fba1 | 431 | prepareADC(adcIndex, adcGroup, adcChannel); |
Condo2k4 | 0:f0c00f67fba1 | 432 | |
Condo2k4 | 0:f0c00f67fba1 | 433 | switch(prepareDMA(destination, destSize, dmaChannel, adcIndex, adcGroup, false)) { |
Condo2k4 | 0:f0c00f67fba1 | 434 | case kStatus_EDMA_QueueFull: |
Condo2k4 | 0:f0c00f67fba1 | 435 | case kStatus_EDMA_Busy: |
Condo2k4 | 0:f0c00f67fba1 | 436 | return E_DMA_IN_USE; |
Condo2k4 | 0:f0c00f67fba1 | 437 | default: |
Condo2k4 | 0:f0c00f67fba1 | 438 | break; |
Condo2k4 | 0:f0c00f67fba1 | 439 | } |
Condo2k4 | 0:f0c00f67fba1 | 440 | |
Condo2k4 | 0:f0c00f67fba1 | 441 | int divider, modulus; bool useMult; |
Condo2k4 | 0:f0c00f67fba1 | 442 | calcClockDiv(sampleFrequency, divider, useMult, modulus); |
Condo2k4 | 0:f0c00f67fba1 | 443 | preparePDB(divider, useMult, modulus, adcIndex, adcGroup); |
Condo2k4 | 0:f0c00f67fba1 | 444 | |
Condo2k4 | 0:f0c00f67fba1 | 445 | _bufSize = destSize; |
Condo2k4 | 0:f0c00f67fba1 | 446 | _callback = callback; |
Condo2k4 | 0:f0c00f67fba1 | 447 | |
Condo2k4 | 0:f0c00f67fba1 | 448 | PDB_DoSoftwareTrigger(PDB0); |
Condo2k4 | 0:f0c00f67fba1 | 449 | |
Condo2k4 | 0:f0c00f67fba1 | 450 | return SUCCESS; |
Condo2k4 | 0:f0c00f67fba1 | 451 | } |
Condo2k4 | 0:f0c00f67fba1 | 452 | |
Condo2k4 | 0:f0c00f67fba1 | 453 | async_error_t asyncAnalogToCircularBuffer_f(PinName source, uint16_t* destination, uint32_t destSize, float sampleFrequency, asyncISR callback, int16_t dmaChannel) { |
Condo2k4 | 0:f0c00f67fba1 | 454 | if(_asyncReadActive) |
Condo2k4 | 0:f0c00f67fba1 | 455 | return E_ASYNC_ADC_ACTIVE; |
Condo2k4 | 0:f0c00f67fba1 | 456 | _asyncReadActive = true; |
Condo2k4 | 0:f0c00f67fba1 | 457 | |
Condo2k4 | 0:f0c00f67fba1 | 458 | if(destSize<=0 && !isPowerOfTwo(destSize)) { |
Condo2k4 | 0:f0c00f67fba1 | 459 | return E_INVALID_BUFFER_SIZE; //Destination buffer size must be greater that 0 and a power of 2 |
Condo2k4 | 0:f0c00f67fba1 | 460 | } |
Condo2k4 | 0:f0c00f67fba1 | 461 | |
Condo2k4 | 0:f0c00f67fba1 | 462 | uint32_t adc = pinmap_peripheral(source, PinMap_ADC); |
Condo2k4 | 0:f0c00f67fba1 | 463 | |
Condo2k4 | 0:f0c00f67fba1 | 464 | if(adc == (ADCName)NC) { |
Condo2k4 | 0:f0c00f67fba1 | 465 | error("Pin doese not support Analog to Digital Conversion"); |
Condo2k4 | 0:f0c00f67fba1 | 466 | } |
Condo2k4 | 0:f0c00f67fba1 | 467 | |
Condo2k4 | 0:f0c00f67fba1 | 468 | int adcIndex = adc >> ADC_INSTANCE_SHIFT, adcGroup = 0, adcChannel = adc & 0xF; |
Condo2k4 | 0:f0c00f67fba1 | 469 | prepareADC(adcIndex, adcGroup, adcChannel); |
Condo2k4 | 0:f0c00f67fba1 | 470 | |
Condo2k4 | 0:f0c00f67fba1 | 471 | switch(prepareDMA(destination, destSize, dmaChannel, adcIndex, adcGroup, true)) { |
Condo2k4 | 0:f0c00f67fba1 | 472 | case kStatus_EDMA_QueueFull: |
Condo2k4 | 0:f0c00f67fba1 | 473 | case kStatus_EDMA_Busy: |
Condo2k4 | 0:f0c00f67fba1 | 474 | return E_DMA_IN_USE; |
Condo2k4 | 0:f0c00f67fba1 | 475 | default: |
Condo2k4 | 0:f0c00f67fba1 | 476 | break; |
Condo2k4 | 0:f0c00f67fba1 | 477 | } |
Condo2k4 | 0:f0c00f67fba1 | 478 | |
Condo2k4 | 0:f0c00f67fba1 | 479 | int divider, modulus; bool useMult; |
Condo2k4 | 0:f0c00f67fba1 | 480 | calcClockDiv(sampleFrequency, divider, useMult, modulus); |
Condo2k4 | 0:f0c00f67fba1 | 481 | preparePDB(divider, useMult, modulus, adcIndex, adcGroup); |
Condo2k4 | 0:f0c00f67fba1 | 482 | |
Condo2k4 | 0:f0c00f67fba1 | 483 | _bufSize = destSize; |
Condo2k4 | 0:f0c00f67fba1 | 484 | _callback = callback; |
Condo2k4 | 0:f0c00f67fba1 | 485 | |
Condo2k4 | 0:f0c00f67fba1 | 486 | PDB_DoSoftwareTrigger(PDB0); |
Condo2k4 | 0:f0c00f67fba1 | 487 | |
Condo2k4 | 0:f0c00f67fba1 | 488 | return SUCCESS; |
Condo2k4 | 0:f0c00f67fba1 | 489 | } |
Condo2k4 | 0:f0c00f67fba1 | 490 | |
Condo2k4 | 0:f0c00f67fba1 | 491 | void terminateAsyncRead() { |
Condo2k4 | 0:f0c00f67fba1 | 492 | PDB_Enable(PDB0, false); |
Condo2k4 | 0:f0c00f67fba1 | 493 | EDMA_AbortTransfer(&_handle); |
Condo2k4 | 0:f0c00f67fba1 | 494 | _asyncReadActive = false; |
Condo2k4 | 0:f0c00f67fba1 | 495 | } |
Condo2k4 | 0:f0c00f67fba1 | 496 |