Yue Kong / Mbed 2 deprecated WoYaoChengGOng

Change the Ledstrip with Different input signal frequency

Dependencies:   PololuLedStrip mbed

ADC_full/adc.cpp@0:dc6175686e56, 2014-07-28 (annotated)

Committer:
KongXiangyue
Date:
Mon Jul 28 13:48:16 2014 +0000
Revision:
0:dc6175686e56
FFT input analogue and drive the PololuLed strip

Who changed what in which revision?

UserRevisionLine numberNew contents of line
KongXiangyue 0:dc6175686e56 1 /* mbed Library - ADC
KongXiangyue 0:dc6175686e56 2 * Copyright (c) 2010, sblandford
KongXiangyue 0:dc6175686e56 3 * released under MIT license http://mbed.org/licence/mit
KongXiangyue 0:dc6175686e56 4 */
KongXiangyue 0:dc6175686e56 5 #include "mbed.h"
KongXiangyue 0:dc6175686e56 6 #include "adc.h"
KongXiangyue 0:dc6175686e56 7
KongXiangyue 0:dc6175686e56 8
KongXiangyue 0:dc6175686e56 9 ADC *ADC::instance;
KongXiangyue 0:dc6175686e56 10
KongXiangyue 0:dc6175686e56 11 ADC::ADC(int sample_rate, int cclk_div)
KongXiangyue 0:dc6175686e56 12 {
KongXiangyue 0:dc6175686e56 13
KongXiangyue 0:dc6175686e56 14 int i, adc_clk_freq, pclk, clock_div, max_div=1;
KongXiangyue 0:dc6175686e56 15
KongXiangyue 0:dc6175686e56 16 //Work out CCLK
KongXiangyue 0:dc6175686e56 17 adc_clk_freq=CLKS_PER_SAMPLE*sample_rate;
KongXiangyue 0:dc6175686e56 18 int m = (LPC_SC->PLL0CFG & 0xFFFF) + 1;
KongXiangyue 0:dc6175686e56 19 int n = (LPC_SC->PLL0CFG >> 16) + 1;
KongXiangyue 0:dc6175686e56 20 int cclkdiv = LPC_SC->CCLKCFG + 1;
KongXiangyue 0:dc6175686e56 21 int Fcco = (2 * m * XTAL_FREQ) / n;
KongXiangyue 0:dc6175686e56 22 int cclk = Fcco / cclkdiv;
KongXiangyue 0:dc6175686e56 23
KongXiangyue 0:dc6175686e56 24 //Power up the ADC
KongXiangyue 0:dc6175686e56 25 LPC_SC->PCONP |= (1 << 12);
KongXiangyue 0:dc6175686e56 26 //Set clock at cclk / 1.
KongXiangyue 0:dc6175686e56 27 LPC_SC->PCLKSEL0 &= ~(0x3 << 24);
KongXiangyue 0:dc6175686e56 28 switch (cclk_div) {
KongXiangyue 0:dc6175686e56 29 case 1:
KongXiangyue 0:dc6175686e56 30 LPC_SC->PCLKSEL0 |= 0x1 << 24;
KongXiangyue 0:dc6175686e56 31 break;
KongXiangyue 0:dc6175686e56 32 case 2:
KongXiangyue 0:dc6175686e56 33 LPC_SC->PCLKSEL0 |= 0x2 << 24;
KongXiangyue 0:dc6175686e56 34 break;
KongXiangyue 0:dc6175686e56 35 case 4:
KongXiangyue 0:dc6175686e56 36 LPC_SC->PCLKSEL0 |= 0x0 << 24;
KongXiangyue 0:dc6175686e56 37 break;
KongXiangyue 0:dc6175686e56 38 case 8:
KongXiangyue 0:dc6175686e56 39 LPC_SC->PCLKSEL0 |= 0x3 << 24;
KongXiangyue 0:dc6175686e56 40 break;
KongXiangyue 0:dc6175686e56 41 default:
KongXiangyue 0:dc6175686e56 42 fprintf(stderr, "Warning: ADC CCLK clock divider must be 1, 2, 4 or 8. %u supplied.\n",
KongXiangyue 0:dc6175686e56 43 cclk_div);
KongXiangyue 0:dc6175686e56 44 fprintf(stderr, "Defaulting to 1.\n");
KongXiangyue 0:dc6175686e56 45 LPC_SC->PCLKSEL0 |= 0x1 << 24;
KongXiangyue 0:dc6175686e56 46 break;
KongXiangyue 0:dc6175686e56 47 }
KongXiangyue 0:dc6175686e56 48 pclk = cclk / cclk_div;
KongXiangyue 0:dc6175686e56 49 clock_div=pclk / adc_clk_freq;
KongXiangyue 0:dc6175686e56 50
KongXiangyue 0:dc6175686e56 51 if (clock_div > 0xFF) {
KongXiangyue 0:dc6175686e56 52 fprintf(stderr, "Warning: Clock division is %u which is above 255 limit. Re-Setting at limit.\n",
KongXiangyue 0:dc6175686e56 53 clock_div);
KongXiangyue 0:dc6175686e56 54 clock_div=0xFF;
KongXiangyue 0:dc6175686e56 55 }
KongXiangyue 0:dc6175686e56 56 if (clock_div == 0) {
KongXiangyue 0:dc6175686e56 57 fprintf(stderr, "Warning: Clock division is 0. Re-Setting to 1.\n");
KongXiangyue 0:dc6175686e56 58 clock_div=1;
KongXiangyue 0:dc6175686e56 59 }
KongXiangyue 0:dc6175686e56 60
KongXiangyue 0:dc6175686e56 61 _adc_clk_freq=pclk / clock_div;
KongXiangyue 0:dc6175686e56 62 if (_adc_clk_freq > MAX_ADC_CLOCK) {
KongXiangyue 0:dc6175686e56 63 fprintf(stderr, "Warning: Actual ADC sample rate of %u which is above %u limit\n",
KongXiangyue 0:dc6175686e56 64 _adc_clk_freq / CLKS_PER_SAMPLE, MAX_ADC_CLOCK / CLKS_PER_SAMPLE);
KongXiangyue 0:dc6175686e56 65 while ((pclk / max_div) > MAX_ADC_CLOCK) max_div++;
KongXiangyue 0:dc6175686e56 66 fprintf(stderr, "Maximum recommended sample rate is %u\n", (pclk / max_div) / CLKS_PER_SAMPLE);
KongXiangyue 0:dc6175686e56 67 }
KongXiangyue 0:dc6175686e56 68
KongXiangyue 0:dc6175686e56 69 LPC_ADC->ADCR =
KongXiangyue 0:dc6175686e56 70 ((clock_div - 1 ) << 8 ) | //Clkdiv
KongXiangyue 0:dc6175686e56 71 ( 1 << 21 ); //A/D operational
KongXiangyue 0:dc6175686e56 72
KongXiangyue 0:dc6175686e56 73 //Default no channels enabled
KongXiangyue 0:dc6175686e56 74 LPC_ADC->ADCR &= ~0xFF;
KongXiangyue 0:dc6175686e56 75 //Default NULL global custom isr
KongXiangyue 0:dc6175686e56 76 _adc_g_isr = NULL;
KongXiangyue 0:dc6175686e56 77 //Initialize arrays
KongXiangyue 0:dc6175686e56 78 for (i=7; i>=0; i--) {
KongXiangyue 0:dc6175686e56 79 _adc_data[i] = 0;
KongXiangyue 0:dc6175686e56 80 _adc_isr[i] = NULL;
KongXiangyue 0:dc6175686e56 81 }
KongXiangyue 0:dc6175686e56 82
KongXiangyue 0:dc6175686e56 83
KongXiangyue 0:dc6175686e56 84 //* Attach IRQ
KongXiangyue 0:dc6175686e56 85 instance = this;
KongXiangyue 0:dc6175686e56 86 NVIC_SetVector(ADC_IRQn, (uint32_t)&_adcisr);
KongXiangyue 0:dc6175686e56 87
KongXiangyue 0:dc6175686e56 88 //Disable global interrupt
KongXiangyue 0:dc6175686e56 89 LPC_ADC->ADINTEN &= ~0x100;
KongXiangyue 0:dc6175686e56 90
KongXiangyue 0:dc6175686e56 91 };
KongXiangyue 0:dc6175686e56 92
KongXiangyue 0:dc6175686e56 93 void ADC::_adcisr(void)
KongXiangyue 0:dc6175686e56 94 {
KongXiangyue 0:dc6175686e56 95 instance->adcisr();
KongXiangyue 0:dc6175686e56 96 }
KongXiangyue 0:dc6175686e56 97
KongXiangyue 0:dc6175686e56 98
KongXiangyue 0:dc6175686e56 99 void ADC::adcisr(void)
KongXiangyue 0:dc6175686e56 100 {
KongXiangyue 0:dc6175686e56 101 uint32_t stat;
KongXiangyue 0:dc6175686e56 102 int chan;
KongXiangyue 0:dc6175686e56 103
KongXiangyue 0:dc6175686e56 104 // Read status
KongXiangyue 0:dc6175686e56 105 stat = LPC_ADC->ADSTAT;
KongXiangyue 0:dc6175686e56 106 //Scan channels for over-run or done and update array
KongXiangyue 0:dc6175686e56 107 if (stat & 0x0101) _adc_data[0] = LPC_ADC->ADDR0;
KongXiangyue 0:dc6175686e56 108 if (stat & 0x0202) _adc_data[1] = LPC_ADC->ADDR1;
KongXiangyue 0:dc6175686e56 109 if (stat & 0x0404) _adc_data[2] = LPC_ADC->ADDR2;
KongXiangyue 0:dc6175686e56 110 if (stat & 0x0808) _adc_data[3] = LPC_ADC->ADDR3;
KongXiangyue 0:dc6175686e56 111 if (stat & 0x1010) _adc_data[4] = LPC_ADC->ADDR4;
KongXiangyue 0:dc6175686e56 112 if (stat & 0x2020) _adc_data[5] = LPC_ADC->ADDR5;
KongXiangyue 0:dc6175686e56 113 if (stat & 0x4040) _adc_data[6] = LPC_ADC->ADDR6;
KongXiangyue 0:dc6175686e56 114 if (stat & 0x8080) _adc_data[7] = LPC_ADC->ADDR7;
KongXiangyue 0:dc6175686e56 115
KongXiangyue 0:dc6175686e56 116 // Channel that triggered interrupt
KongXiangyue 0:dc6175686e56 117 chan = (LPC_ADC->ADGDR >> 24) & 0x07;
KongXiangyue 0:dc6175686e56 118 //User defined interrupt handlers
KongXiangyue 0:dc6175686e56 119 if (_adc_isr[chan] != NULL)
KongXiangyue 0:dc6175686e56 120 _adc_isr[chan](_adc_data[chan]);
KongXiangyue 0:dc6175686e56 121 if (_adc_g_isr != NULL)
KongXiangyue 0:dc6175686e56 122 _adc_g_isr(chan, _adc_data[chan]);
KongXiangyue 0:dc6175686e56 123 return;
KongXiangyue 0:dc6175686e56 124 }
KongXiangyue 0:dc6175686e56 125
KongXiangyue 0:dc6175686e56 126 int ADC::_pin_to_channel(PinName pin) {
KongXiangyue 0:dc6175686e56 127 int chan;
KongXiangyue 0:dc6175686e56 128 switch (pin) {
KongXiangyue 0:dc6175686e56 129 case p15://=p0.23 of LPC1768
KongXiangyue 0:dc6175686e56 130 default:
KongXiangyue 0:dc6175686e56 131 chan=0;
KongXiangyue 0:dc6175686e56 132 break;
KongXiangyue 0:dc6175686e56 133 case p16://=p0.24 of LPC1768
KongXiangyue 0:dc6175686e56 134 chan=1;
KongXiangyue 0:dc6175686e56 135 break;
KongXiangyue 0:dc6175686e56 136 case p17://=p0.25 of LPC1768
KongXiangyue 0:dc6175686e56 137 chan=2;
KongXiangyue 0:dc6175686e56 138 break;
KongXiangyue 0:dc6175686e56 139 case p18://=p0.26 of LPC1768
KongXiangyue 0:dc6175686e56 140 chan=3;
KongXiangyue 0:dc6175686e56 141 break;
KongXiangyue 0:dc6175686e56 142 case p19://=p1.30 of LPC1768
KongXiangyue 0:dc6175686e56 143 chan=4;
KongXiangyue 0:dc6175686e56 144 break;
KongXiangyue 0:dc6175686e56 145 case p20://=p1.31 of LPC1768
KongXiangyue 0:dc6175686e56 146 chan=5;
KongXiangyue 0:dc6175686e56 147 break;
KongXiangyue 0:dc6175686e56 148 }
KongXiangyue 0:dc6175686e56 149 return(chan);
KongXiangyue 0:dc6175686e56 150 }
KongXiangyue 0:dc6175686e56 151
KongXiangyue 0:dc6175686e56 152 PinName ADC::channel_to_pin(int chan) {
KongXiangyue 0:dc6175686e56 153 const PinName pin[8]={p15, p16, p17, p18, p19, p20, p15, p15};
KongXiangyue 0:dc6175686e56 154
KongXiangyue 0:dc6175686e56 155 if ((chan < 0) || (chan > 5))
KongXiangyue 0:dc6175686e56 156 fprintf(stderr, "ADC channel %u is outside range available to MBED pins.\n", chan);
KongXiangyue 0:dc6175686e56 157 return(pin[chan & 0x07]);
KongXiangyue 0:dc6175686e56 158 }
KongXiangyue 0:dc6175686e56 159
KongXiangyue 0:dc6175686e56 160
KongXiangyue 0:dc6175686e56 161 int ADC::channel_to_pin_number(int chan) {
KongXiangyue 0:dc6175686e56 162 const int pin[8]={15, 16, 17, 18, 19, 20, 0, 0};
KongXiangyue 0:dc6175686e56 163
KongXiangyue 0:dc6175686e56 164 if ((chan < 0) || (chan > 5))
KongXiangyue 0:dc6175686e56 165 fprintf(stderr, "ADC channel %u is outside range available to MBED pins.\n", chan);
KongXiangyue 0:dc6175686e56 166 return(pin[chan & 0x07]);
KongXiangyue 0:dc6175686e56 167 }
KongXiangyue 0:dc6175686e56 168
KongXiangyue 0:dc6175686e56 169
KongXiangyue 0:dc6175686e56 170 uint32_t ADC::_data_of_pin(PinName pin) {
KongXiangyue 0:dc6175686e56 171 //If in burst mode and at least one interrupt enabled then
KongXiangyue 0:dc6175686e56 172 //take all values from _adc_data
KongXiangyue 0:dc6175686e56 173 if (burst() && (LPC_ADC->ADINTEN & 0x3F)) {
KongXiangyue 0:dc6175686e56 174 return(_adc_data[_pin_to_channel(pin)]);
KongXiangyue 0:dc6175686e56 175 } else {
KongXiangyue 0:dc6175686e56 176 //Return current register value or last value from interrupt
KongXiangyue 0:dc6175686e56 177 switch (pin) {
KongXiangyue 0:dc6175686e56 178 case p15://=p0.23 of LPC1768
KongXiangyue 0:dc6175686e56 179 default:
KongXiangyue 0:dc6175686e56 180 return(LPC_ADC->ADINTEN & 0x01?_adc_data[0]:LPC_ADC->ADDR0);
KongXiangyue 0:dc6175686e56 181 case p16://=p0.24 of LPC1768
KongXiangyue 0:dc6175686e56 182 return(LPC_ADC->ADINTEN & 0x02?_adc_data[1]:LPC_ADC->ADDR1);
KongXiangyue 0:dc6175686e56 183 case p17://=p0.25 of LPC1768
KongXiangyue 0:dc6175686e56 184 return(LPC_ADC->ADINTEN & 0x04?_adc_data[2]:LPC_ADC->ADDR2);
KongXiangyue 0:dc6175686e56 185 case p18://=p0.26 of LPC1768:
KongXiangyue 0:dc6175686e56 186 return(LPC_ADC->ADINTEN & 0x08?_adc_data[3]:LPC_ADC->ADDR3);
KongXiangyue 0:dc6175686e56 187 case p19://=p1.30 of LPC1768
KongXiangyue 0:dc6175686e56 188 return(LPC_ADC->ADINTEN & 0x10?_adc_data[4]:LPC_ADC->ADDR4);
KongXiangyue 0:dc6175686e56 189 case p20://=p1.31 of LPC1768
KongXiangyue 0:dc6175686e56 190 return(LPC_ADC->ADINTEN & 0x20?_adc_data[5]:LPC_ADC->ADDR5);
KongXiangyue 0:dc6175686e56 191 }
KongXiangyue 0:dc6175686e56 192 }
KongXiangyue 0:dc6175686e56 193 }
KongXiangyue 0:dc6175686e56 194
KongXiangyue 0:dc6175686e56 195 //Enable or disable an ADC pin
KongXiangyue 0:dc6175686e56 196 void ADC::setup(PinName pin, int state) {
KongXiangyue 0:dc6175686e56 197 int chan;
KongXiangyue 0:dc6175686e56 198 chan=_pin_to_channel(pin);
KongXiangyue 0:dc6175686e56 199 if ((state & 1) == 1) {
KongXiangyue 0:dc6175686e56 200 switch(pin) {
KongXiangyue 0:dc6175686e56 201 case p15://=p0.23 of LPC1768
KongXiangyue 0:dc6175686e56 202 default:
KongXiangyue 0:dc6175686e56 203 LPC_PINCON->PINSEL1 &= ~((unsigned int)0x3 << 14);
KongXiangyue 0:dc6175686e56 204 LPC_PINCON->PINSEL1 |= (unsigned int)0x1 << 14;
KongXiangyue 0:dc6175686e56 205 LPC_PINCON->PINMODE1 &= ~((unsigned int)0x3 << 14);
KongXiangyue 0:dc6175686e56 206 LPC_PINCON->PINMODE1 |= (unsigned int)0x2 << 14;
KongXiangyue 0:dc6175686e56 207 break;
KongXiangyue 0:dc6175686e56 208 case p16://=p0.24 of LPC1768
KongXiangyue 0:dc6175686e56 209 LPC_PINCON->PINSEL1 &= ~((unsigned int)0x3 << 16);
KongXiangyue 0:dc6175686e56 210 LPC_PINCON->PINSEL1 |= (unsigned int)0x1 << 16;
KongXiangyue 0:dc6175686e56 211 LPC_PINCON->PINMODE1 &= ~((unsigned int)0x3 << 16);
KongXiangyue 0:dc6175686e56 212 LPC_PINCON->PINMODE1 |= (unsigned int)0x2 << 16;
KongXiangyue 0:dc6175686e56 213 break;
KongXiangyue 0:dc6175686e56 214 case p17://=p0.25 of LPC1768
KongXiangyue 0:dc6175686e56 215 LPC_PINCON->PINSEL1 &= ~((unsigned int)0x3 << 18);
KongXiangyue 0:dc6175686e56 216 LPC_PINCON->PINSEL1 |= (unsigned int)0x1 << 18;
KongXiangyue 0:dc6175686e56 217 LPC_PINCON->PINMODE1 &= ~((unsigned int)0x3 << 18);
KongXiangyue 0:dc6175686e56 218 LPC_PINCON->PINMODE1 |= (unsigned int)0x2 << 18;
KongXiangyue 0:dc6175686e56 219 break;
KongXiangyue 0:dc6175686e56 220 case p18://=p0.26 of LPC1768:
KongXiangyue 0:dc6175686e56 221 LPC_PINCON->PINSEL1 &= ~((unsigned int)0x3 << 20);
KongXiangyue 0:dc6175686e56 222 LPC_PINCON->PINSEL1 |= (unsigned int)0x1 << 20;
KongXiangyue 0:dc6175686e56 223 LPC_PINCON->PINMODE1 &= ~((unsigned int)0x3 << 20);
KongXiangyue 0:dc6175686e56 224 LPC_PINCON->PINMODE1 |= (unsigned int)0x2 << 20;
KongXiangyue 0:dc6175686e56 225 break;
KongXiangyue 0:dc6175686e56 226 case p19://=p1.30 of LPC1768
KongXiangyue 0:dc6175686e56 227 LPC_PINCON->PINSEL3 &= ~((unsigned int)0x3 << 28);
KongXiangyue 0:dc6175686e56 228 LPC_PINCON->PINSEL3 |= (unsigned int)0x3 << 28;
KongXiangyue 0:dc6175686e56 229 LPC_PINCON->PINMODE3 &= ~((unsigned int)0x3 << 28);
KongXiangyue 0:dc6175686e56 230 LPC_PINCON->PINMODE3 |= (unsigned int)0x2 << 28;
KongXiangyue 0:dc6175686e56 231 break;
KongXiangyue 0:dc6175686e56 232 case p20://=p1.31 of LPC1768
KongXiangyue 0:dc6175686e56 233 LPC_PINCON->PINSEL3 &= ~((unsigned int)0x3 << 30);
KongXiangyue 0:dc6175686e56 234 LPC_PINCON->PINSEL3 |= (unsigned int)0x3 << 30;
KongXiangyue 0:dc6175686e56 235 LPC_PINCON->PINMODE3 &= ~((unsigned int)0x3 << 30);
KongXiangyue 0:dc6175686e56 236 LPC_PINCON->PINMODE3 |= (unsigned int)0x2 << 30;
KongXiangyue 0:dc6175686e56 237 break;
KongXiangyue 0:dc6175686e56 238 }
KongXiangyue 0:dc6175686e56 239 //Only one channel can be selected at a time if not in burst mode
KongXiangyue 0:dc6175686e56 240 if (!burst()) LPC_ADC->ADCR &= ~0xFF;
KongXiangyue 0:dc6175686e56 241 //Select channel
KongXiangyue 0:dc6175686e56 242 LPC_ADC->ADCR |= (1 << chan);
KongXiangyue 0:dc6175686e56 243 }
KongXiangyue 0:dc6175686e56 244 else {
KongXiangyue 0:dc6175686e56 245 switch(pin) {
KongXiangyue 0:dc6175686e56 246 case p15://=p0.23 of LPC1768
KongXiangyue 0:dc6175686e56 247 default:
KongXiangyue 0:dc6175686e56 248 LPC_PINCON->PINSEL1 &= ~((unsigned int)0x3 << 14);
KongXiangyue 0:dc6175686e56 249 LPC_PINCON->PINMODE1 &= ~((unsigned int)0x3 << 14);
KongXiangyue 0:dc6175686e56 250 break;
KongXiangyue 0:dc6175686e56 251 case p16://=p0.24 of LPC1768
KongXiangyue 0:dc6175686e56 252 LPC_PINCON->PINSEL1 &= ~((unsigned int)0x3 << 16);
KongXiangyue 0:dc6175686e56 253 LPC_PINCON->PINMODE1 &= ~((unsigned int)0x3 << 16);
KongXiangyue 0:dc6175686e56 254 break;
KongXiangyue 0:dc6175686e56 255 case p17://=p0.25 of LPC1768
KongXiangyue 0:dc6175686e56 256 LPC_PINCON->PINSEL1 &= ~((unsigned int)0x3 << 18);
KongXiangyue 0:dc6175686e56 257 LPC_PINCON->PINMODE1 &= ~((unsigned int)0x3 << 18);
KongXiangyue 0:dc6175686e56 258 break;
KongXiangyue 0:dc6175686e56 259 case p18://=p0.26 of LPC1768:
KongXiangyue 0:dc6175686e56 260 LPC_PINCON->PINSEL1 &= ~((unsigned int)0x3 << 20);
KongXiangyue 0:dc6175686e56 261 LPC_PINCON->PINMODE1 &= ~((unsigned int)0x3 << 20);
KongXiangyue 0:dc6175686e56 262 break;
KongXiangyue 0:dc6175686e56 263 case p19://=p1.30 of LPC1768
KongXiangyue 0:dc6175686e56 264 LPC_PINCON->PINSEL3 &= ~((unsigned int)0x3 << 28);
KongXiangyue 0:dc6175686e56 265 LPC_PINCON->PINMODE3 &= ~((unsigned int)0x3 << 28);
KongXiangyue 0:dc6175686e56 266 break;
KongXiangyue 0:dc6175686e56 267 case p20://=p1.31 of LPC1768
KongXiangyue 0:dc6175686e56 268 LPC_PINCON->PINSEL3 &= ~((unsigned int)0x3 << 30);
KongXiangyue 0:dc6175686e56 269 LPC_PINCON->PINMODE3 &= ~((unsigned int)0x3 << 30);
KongXiangyue 0:dc6175686e56 270 break;
KongXiangyue 0:dc6175686e56 271 }
KongXiangyue 0:dc6175686e56 272 LPC_ADC->ADCR &= ~(1 << chan);
KongXiangyue 0:dc6175686e56 273 }
KongXiangyue 0:dc6175686e56 274 }
KongXiangyue 0:dc6175686e56 275 //Return channel enabled/disabled state
KongXiangyue 0:dc6175686e56 276 int ADC::setup(PinName pin) {
KongXiangyue 0:dc6175686e56 277 int chan;
KongXiangyue 0:dc6175686e56 278
KongXiangyue 0:dc6175686e56 279 chan = _pin_to_channel(pin);
KongXiangyue 0:dc6175686e56 280 return((LPC_ADC->ADCR & (1 << chan)) >> chan);
KongXiangyue 0:dc6175686e56 281 }
KongXiangyue 0:dc6175686e56 282
KongXiangyue 0:dc6175686e56 283 //Select channel already setup
KongXiangyue 0:dc6175686e56 284 void ADC::select(PinName pin) {
KongXiangyue 0:dc6175686e56 285 int chan;
KongXiangyue 0:dc6175686e56 286
KongXiangyue 0:dc6175686e56 287 //Only one channel can be selected at a time if not in burst mode
KongXiangyue 0:dc6175686e56 288 if (!burst()) LPC_ADC->ADCR &= ~0xFF;
KongXiangyue 0:dc6175686e56 289 //Select channel
KongXiangyue 0:dc6175686e56 290 chan = _pin_to_channel(pin);
KongXiangyue 0:dc6175686e56 291 LPC_ADC->ADCR |= (1 << chan);
KongXiangyue 0:dc6175686e56 292 }
KongXiangyue 0:dc6175686e56 293
KongXiangyue 0:dc6175686e56 294 //Enable or disable burst mode
KongXiangyue 0:dc6175686e56 295 void ADC::burst(int state) {
KongXiangyue 0:dc6175686e56 296 if ((state & 1) == 1) {
KongXiangyue 0:dc6175686e56 297 if (startmode(0) != 0)
KongXiangyue 0:dc6175686e56 298 fprintf(stderr, "Warning. startmode is %u. Must be 0 for burst mode.\n", startmode(0));
KongXiangyue 0:dc6175686e56 299 LPC_ADC->ADCR |= (1 << 16);
KongXiangyue 0:dc6175686e56 300 }
KongXiangyue 0:dc6175686e56 301 else
KongXiangyue 0:dc6175686e56 302 LPC_ADC->ADCR &= ~(1 << 16);
KongXiangyue 0:dc6175686e56 303 }
KongXiangyue 0:dc6175686e56 304 //Return burst mode state
KongXiangyue 0:dc6175686e56 305 int ADC::burst(void) {
KongXiangyue 0:dc6175686e56 306 return((LPC_ADC->ADCR & (1 << 16)) >> 16);
KongXiangyue 0:dc6175686e56 307 }
KongXiangyue 0:dc6175686e56 308
KongXiangyue 0:dc6175686e56 309 //Set startmode and edge
KongXiangyue 0:dc6175686e56 310 void ADC::startmode(int mode, int edge) {
KongXiangyue 0:dc6175686e56 311 int lpc_adc_temp;
KongXiangyue 0:dc6175686e56 312
KongXiangyue 0:dc6175686e56 313 //Reset start mode and edge bit,
KongXiangyue 0:dc6175686e56 314 lpc_adc_temp = LPC_ADC->ADCR & ~(0x0F << 24);
KongXiangyue 0:dc6175686e56 315 //Write with new values
KongXiangyue 0:dc6175686e56 316 lpc_adc_temp |= ((mode & 7) << 24) | ((edge & 1) << 27);
KongXiangyue 0:dc6175686e56 317 LPC_ADC->ADCR = lpc_adc_temp;
KongXiangyue 0:dc6175686e56 318 }
KongXiangyue 0:dc6175686e56 319
KongXiangyue 0:dc6175686e56 320 //Return startmode state according to mode_edge=0: mode and mode_edge=1: edge
KongXiangyue 0:dc6175686e56 321 int ADC::startmode(int mode_edge){
KongXiangyue 0:dc6175686e56 322 switch (mode_edge) {
KongXiangyue 0:dc6175686e56 323 case 0:
KongXiangyue 0:dc6175686e56 324 default:
KongXiangyue 0:dc6175686e56 325 return((LPC_ADC->ADCR >> 24) & 0x07);
KongXiangyue 0:dc6175686e56 326 case 1:
KongXiangyue 0:dc6175686e56 327 return((LPC_ADC->ADCR >> 27) & 0x01);
KongXiangyue 0:dc6175686e56 328 }
KongXiangyue 0:dc6175686e56 329 }
KongXiangyue 0:dc6175686e56 330
KongXiangyue 0:dc6175686e56 331 //Start ADC conversion
KongXiangyue 0:dc6175686e56 332 void ADC::start(void) {
KongXiangyue 0:dc6175686e56 333 startmode(1,0);
KongXiangyue 0:dc6175686e56 334 }
KongXiangyue 0:dc6175686e56 335
KongXiangyue 0:dc6175686e56 336
KongXiangyue 0:dc6175686e56 337 //Set interrupt enable/disable for pin to state
KongXiangyue 0:dc6175686e56 338 void ADC::interrupt_state(PinName pin, int state) {
KongXiangyue 0:dc6175686e56 339 int chan;
KongXiangyue 0:dc6175686e56 340
KongXiangyue 0:dc6175686e56 341 chan = _pin_to_channel(pin);
KongXiangyue 0:dc6175686e56 342 if (state == 1) {
KongXiangyue 0:dc6175686e56 343 LPC_ADC->ADINTEN &= ~0x100;
KongXiangyue 0:dc6175686e56 344 LPC_ADC->ADINTEN |= 1 << chan;
KongXiangyue 0:dc6175686e56 345 /* Enable the ADC Interrupt */
KongXiangyue 0:dc6175686e56 346 NVIC_EnableIRQ(ADC_IRQn);
KongXiangyue 0:dc6175686e56 347 } else {
KongXiangyue 0:dc6175686e56 348 LPC_ADC->ADINTEN &= ~( 1 << chan );
KongXiangyue 0:dc6175686e56 349 //Disable interrrupt if no active pins left
KongXiangyue 0:dc6175686e56 350 if ((LPC_ADC->ADINTEN & 0xFF) == 0)
KongXiangyue 0:dc6175686e56 351 NVIC_DisableIRQ(ADC_IRQn);
KongXiangyue 0:dc6175686e56 352 }
KongXiangyue 0:dc6175686e56 353 }
KongXiangyue 0:dc6175686e56 354
KongXiangyue 0:dc6175686e56 355 //Return enable/disable state of interrupt for pin
KongXiangyue 0:dc6175686e56 356 int ADC::interrupt_state(PinName pin) {
KongXiangyue 0:dc6175686e56 357 int chan;
KongXiangyue 0:dc6175686e56 358
KongXiangyue 0:dc6175686e56 359 chan = _pin_to_channel(pin);
KongXiangyue 0:dc6175686e56 360 return((LPC_ADC->ADINTEN >> chan) & 0x01);
KongXiangyue 0:dc6175686e56 361 }
KongXiangyue 0:dc6175686e56 362
KongXiangyue 0:dc6175686e56 363
KongXiangyue 0:dc6175686e56 364 //Attach custom interrupt handler replacing default
KongXiangyue 0:dc6175686e56 365 void ADC::attach(void(*fptr)(void)) {
KongXiangyue 0:dc6175686e56 366 //* Attach IRQ
KongXiangyue 0:dc6175686e56 367 NVIC_SetVector(ADC_IRQn, (uint32_t)fptr);
KongXiangyue 0:dc6175686e56 368 }
KongXiangyue 0:dc6175686e56 369
KongXiangyue 0:dc6175686e56 370 //Restore default interrupt handler
KongXiangyue 0:dc6175686e56 371 void ADC::detach(void) {
KongXiangyue 0:dc6175686e56 372 //* Attach IRQ
KongXiangyue 0:dc6175686e56 373 instance = this;
KongXiangyue 0:dc6175686e56 374 NVIC_SetVector(ADC_IRQn, (uint32_t)&_adcisr);
KongXiangyue 0:dc6175686e56 375 }
KongXiangyue 0:dc6175686e56 376
KongXiangyue 0:dc6175686e56 377
KongXiangyue 0:dc6175686e56 378 //Append interrupt handler for pin to function isr
KongXiangyue 0:dc6175686e56 379 void ADC::append(PinName pin, void(*fptr)(uint32_t value)) {
KongXiangyue 0:dc6175686e56 380 int chan;
KongXiangyue 0:dc6175686e56 381
KongXiangyue 0:dc6175686e56 382 chan = _pin_to_channel(pin);
KongXiangyue 0:dc6175686e56 383 _adc_isr[chan] = fptr;
KongXiangyue 0:dc6175686e56 384 }
KongXiangyue 0:dc6175686e56 385
KongXiangyue 0:dc6175686e56 386 //Append interrupt handler for pin to function isr
KongXiangyue 0:dc6175686e56 387 void ADC::unappend(PinName pin) {
KongXiangyue 0:dc6175686e56 388 int chan;
KongXiangyue 0:dc6175686e56 389
KongXiangyue 0:dc6175686e56 390 chan = _pin_to_channel(pin);
KongXiangyue 0:dc6175686e56 391 _adc_isr[chan] = NULL;
KongXiangyue 0:dc6175686e56 392 }
KongXiangyue 0:dc6175686e56 393
KongXiangyue 0:dc6175686e56 394 //Unappend global interrupt handler to function isr
KongXiangyue 0:dc6175686e56 395 void ADC::append(void(*fptr)(int chan, uint32_t value)) {
KongXiangyue 0:dc6175686e56 396 _adc_g_isr = fptr;
KongXiangyue 0:dc6175686e56 397 }
KongXiangyue 0:dc6175686e56 398
KongXiangyue 0:dc6175686e56 399 //Detach global interrupt handler to function isr
KongXiangyue 0:dc6175686e56 400 void ADC::unappend() {
KongXiangyue 0:dc6175686e56 401 _adc_g_isr = NULL;
KongXiangyue 0:dc6175686e56 402 }
KongXiangyue 0:dc6175686e56 403
KongXiangyue 0:dc6175686e56 404 //Set ADC offset
KongXiangyue 0:dc6175686e56 405 void offset(int offset) {
KongXiangyue 0:dc6175686e56 406 LPC_ADC->ADTRM &= ~(0x07 << 4);
KongXiangyue 0:dc6175686e56 407 LPC_ADC->ADTRM |= (offset & 0x07) << 4;
KongXiangyue 0:dc6175686e56 408 }
KongXiangyue 0:dc6175686e56 409
KongXiangyue 0:dc6175686e56 410 //Return current ADC offset
KongXiangyue 0:dc6175686e56 411 int offset(void) {
KongXiangyue 0:dc6175686e56 412 return((LPC_ADC->ADTRM >> 4) & 0x07);
KongXiangyue 0:dc6175686e56 413 }
KongXiangyue 0:dc6175686e56 414
KongXiangyue 0:dc6175686e56 415 //Return value of ADC on pin
KongXiangyue 0:dc6175686e56 416 int ADC::read(PinName pin) {
KongXiangyue 0:dc6175686e56 417 //Reset DONE and OVERRUN flags of interrupt handled ADC data
KongXiangyue 0:dc6175686e56 418 _adc_data[_pin_to_channel(pin)] &= ~(((uint32_t)0x01 << 31) | ((uint32_t)0x01 << 30));
KongXiangyue 0:dc6175686e56 419 //Return value
KongXiangyue 0:dc6175686e56 420 return((_data_of_pin(pin) >> 4) & 0xFFF);
KongXiangyue 0:dc6175686e56 421 }
KongXiangyue 0:dc6175686e56 422
KongXiangyue 0:dc6175686e56 423 //Return DONE flag of ADC on pin
KongXiangyue 0:dc6175686e56 424 int ADC::done(PinName pin) {
KongXiangyue 0:dc6175686e56 425 return((_data_of_pin(pin) >> 31) & 0x01);
KongXiangyue 0:dc6175686e56 426 }
KongXiangyue 0:dc6175686e56 427
KongXiangyue 0:dc6175686e56 428 //Return OVERRUN flag of ADC on pin
KongXiangyue 0:dc6175686e56 429 int ADC::overrun(PinName pin) {
KongXiangyue 0:dc6175686e56 430 return((_data_of_pin(pin) >> 30) & 0x01);
KongXiangyue 0:dc6175686e56 431 }
KongXiangyue 0:dc6175686e56 432
KongXiangyue 0:dc6175686e56 433 int ADC::actual_adc_clock(void) {
KongXiangyue 0:dc6175686e56 434 return(_adc_clk_freq);
KongXiangyue 0:dc6175686e56 435 }
KongXiangyue 0:dc6175686e56 436
KongXiangyue 0:dc6175686e56 437 int ADC::actual_sample_rate(void) {
KongXiangyue 0:dc6175686e56 438 return(_adc_clk_freq / CLKS_PER_SAMPLE);
KongXiangyue 0:dc6175686e56 439 }