Jared Baxter
/
Impedance_Fast_Circuitry
Fork of DSP_200kHz by
dma.cpp@45:d591d138cdeb, 2015-01-31 (annotated)
- Committer:
- timmey9
- Date:
- Sat Jan 31 07:25:52 2015 +0000
- Revision:
- 45:d591d138cdeb
- Parent:
- 44:41c262caf898
- Child:
- 46:a015ebf4663b
Quadrature decoder is working.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
timmey9 | 45:d591d138cdeb | 1 | /** |
timmey9 | 45:d591d138cdeb | 2 | * Setup triggering for DMA2 and PortC |
timmey9 | 34:44cc9b76a507 | 3 | */ |
timmey9 | 34:44cc9b76a507 | 4 | #include "dma.h" |
timmey9 | 34:44cc9b76a507 | 5 | |
timmey9 | 45:d591d138cdeb | 6 | #define TOTAL_SAMPLES 10 |
timmey9 | 45:d591d138cdeb | 7 | int len = TOTAL_SAMPLES; |
timmey9 | 45:d591d138cdeb | 8 | uint16_t sample_array0[TOTAL_SAMPLES]; |
timmey9 | 45:d591d138cdeb | 9 | uint16_t sample_array1[TOTAL_SAMPLES]; |
timmey9 | 45:d591d138cdeb | 10 | uint16_t angle_array[TOTAL_SAMPLES]; |
timmey9 | 45:d591d138cdeb | 11 | DigitalIn AMT20_A(PTC0); // FTM2_QD_PHA, apparently the k64f has a quadrature decoder. look into this (page 264) |
timmey9 | 45:d591d138cdeb | 12 | DigitalIn AMT20_B(PTC1); |
timmey9 | 45:d591d138cdeb | 13 | |
timmey9 | 45:d591d138cdeb | 14 | void dma_init() |
timmey9 | 34:44cc9b76a507 | 15 | { |
timmey9 | 34:44cc9b76a507 | 16 | // Enable clock for DMAMUX and DMA |
timmey9 | 34:44cc9b76a507 | 17 | SIM_SCGC6 |= SIM_SCGC6_DMAMUX_MASK; |
timmey9 | 45:d591d138cdeb | 18 | SIM_SCGC7 |= SIM_SCGC7_DMA_MASK; |
timmey9 | 45:d591d138cdeb | 19 | SIM_SCGC3 |= SIM_SCGC3_FTM2_MASK; // make sure clock is enabled for FTM2 |
timmey9 | 34:44cc9b76a507 | 20 | |
timmey9 | 45:d591d138cdeb | 21 | // Enable DMA channels and select MUX to the correct source (see page 95 of user manual |
timmey9 | 45:d591d138cdeb | 22 | DMAMUX_CHCFG0 |= DMAMUX_CHCFG_ENBL_MASK | DMAMUX_CHCFG_SOURCE(40); // ADC0 |
timmey9 | 45:d591d138cdeb | 23 | DMAMUX_CHCFG1 |= DMAMUX_CHCFG_ENBL_MASK | DMAMUX_CHCFG_SOURCE(41); // ADC1 |
timmey9 | 43:c593a8b9688f | 24 | DMAMUX_CHCFG2 |= DMAMUX_CHCFG_ENBL_MASK | DMAMUX_CHCFG_TRIG_MASK | DMAMUX_CHCFG_SOURCE(51); // PortC |
timmey9 | 36:07d8a3143967 | 25 | |
timmey9 | 36:07d8a3143967 | 26 | |
timmey9 | 34:44cc9b76a507 | 27 | // Enable request signal for channel 0 |
timmey9 | 36:07d8a3143967 | 28 | DMA_ERQ = DMA_ERQ_ERQ0_MASK | DMA_ERQ_ERQ1_MASK | DMA_ERQ_ERQ2_MASK; |
timmey9 | 45:d591d138cdeb | 29 | |
timmey9 | 45:d591d138cdeb | 30 | // select round-robin arbitration priority |
timmey9 | 45:d591d138cdeb | 31 | DMA_CR |= DMA_CR_ERCA_MASK; |
timmey9 | 45:d591d138cdeb | 32 | |
timmey9 | 36:07d8a3143967 | 33 | // Set memory address for source and destination for DMA0, DMA1, and DMA2 |
timmey9 | 45:d591d138cdeb | 34 | DMA_TCD0_SADDR = (uint32_t) &ADC0_RA; |
timmey9 | 45:d591d138cdeb | 35 | DMA_TCD0_DADDR = (uint32_t) sample_array0; |
timmey9 | 45:d591d138cdeb | 36 | DMA_TCD1_SADDR = (uint32_t) &ADC1_RA; |
timmey9 | 45:d591d138cdeb | 37 | DMA_TCD1_DADDR = (uint32_t) sample_array1; |
timmey9 | 45:d591d138cdeb | 38 | DMA_TCD2_SADDR = (uint32_t) &FTM2_CNT; |
timmey9 | 45:d591d138cdeb | 39 | DMA_TCD2_DADDR = (uint32_t) angle_array; |
timmey9 | 36:07d8a3143967 | 40 | |
timmey9 | 34:44cc9b76a507 | 41 | // Set an offset for source and destination address |
timmey9 | 34:44cc9b76a507 | 42 | DMA_TCD0_SOFF = 0x00; // Source address offset of 2 bits per transaction |
timmey9 | 34:44cc9b76a507 | 43 | DMA_TCD0_DOFF = 0x02; // Destination address offset of 1 bit per transaction |
timmey9 | 36:07d8a3143967 | 44 | DMA_TCD1_SOFF = 0x00; // Source address offset of 2 bits per transaction |
timmey9 | 36:07d8a3143967 | 45 | DMA_TCD1_DOFF = 0x02; // Destination address offset of 1 bit per transaction |
timmey9 | 36:07d8a3143967 | 46 | DMA_TCD2_SOFF = 0x00; // Source address offset of 2 bits per transaction |
timmey9 | 36:07d8a3143967 | 47 | DMA_TCD2_DOFF = 0x02; // Destination address offset of 1 bit per transaction |
timmey9 | 34:44cc9b76a507 | 48 | |
timmey9 | 34:44cc9b76a507 | 49 | // Set source and destination data transfer size |
timmey9 | 34:44cc9b76a507 | 50 | DMA_TCD0_ATTR = DMA_ATTR_SSIZE(1) | DMA_ATTR_DSIZE(1); |
timmey9 | 36:07d8a3143967 | 51 | DMA_TCD1_ATTR = DMA_ATTR_SSIZE(1) | DMA_ATTR_DSIZE(1); |
timmey9 | 36:07d8a3143967 | 52 | DMA_TCD2_ATTR = DMA_ATTR_SSIZE(1) | DMA_ATTR_DSIZE(1); |
timmey9 | 34:44cc9b76a507 | 53 | |
timmey9 | 34:44cc9b76a507 | 54 | // Number of bytes to be transfered in each service request of the channel |
timmey9 | 34:44cc9b76a507 | 55 | DMA_TCD0_NBYTES_MLNO = 0x02; |
timmey9 | 36:07d8a3143967 | 56 | DMA_TCD1_NBYTES_MLNO = 0x02; |
timmey9 | 36:07d8a3143967 | 57 | DMA_TCD2_NBYTES_MLNO = 0x02; |
timmey9 | 34:44cc9b76a507 | 58 | |
timmey9 | 34:44cc9b76a507 | 59 | // Current major iteration count (a single iteration of 5 bytes) |
timmey9 | 45:d591d138cdeb | 60 | DMA_TCD0_CITER_ELINKNO = DMA_CITER_ELINKNO_CITER(len); |
timmey9 | 45:d591d138cdeb | 61 | DMA_TCD0_BITER_ELINKNO = DMA_BITER_ELINKNO_BITER(len); |
timmey9 | 45:d591d138cdeb | 62 | DMA_TCD1_CITER_ELINKNO = DMA_CITER_ELINKNO_CITER(len); |
timmey9 | 45:d591d138cdeb | 63 | DMA_TCD1_BITER_ELINKNO = DMA_BITER_ELINKNO_BITER(len); |
timmey9 | 45:d591d138cdeb | 64 | DMA_TCD2_CITER_ELINKNO = DMA_CITER_ELINKNO_CITER(len); |
timmey9 | 45:d591d138cdeb | 65 | DMA_TCD2_BITER_ELINKNO = DMA_BITER_ELINKNO_BITER(len); |
timmey9 | 34:44cc9b76a507 | 66 | |
timmey9 | 34:44cc9b76a507 | 67 | // Adjustment value used to restore the source and destiny address to the initial value |
timmey9 | 45:d591d138cdeb | 68 | // After reading 'len' number of times, the DMA goes back to the beginning by subtracting len*2 from the address (going back to the original address) |
timmey9 | 45:d591d138cdeb | 69 | |
timmey9 | 44:41c262caf898 | 70 | DMA_TCD0_SLAST = 0; // Source address adjustment |
timmey9 | 45:d591d138cdeb | 71 | DMA_TCD0_DLASTSGA = -len*2; // Destination address adjustment |
timmey9 | 44:41c262caf898 | 72 | DMA_TCD1_SLAST = 0; // Source address adjustment |
timmey9 | 45:d591d138cdeb | 73 | DMA_TCD1_DLASTSGA = -len*2; // Destination address adjustment |
timmey9 | 44:41c262caf898 | 74 | DMA_TCD2_SLAST = 0; // Source address adjustment |
timmey9 | 45:d591d138cdeb | 75 | DMA_TCD2_DLASTSGA = -len*2; // Destination address adjustment |
timmey9 | 34:44cc9b76a507 | 76 | |
timmey9 | 34:44cc9b76a507 | 77 | // Setup control and status register |
timmey9 | 34:44cc9b76a507 | 78 | DMA_TCD0_CSR = 0; |
timmey9 | 36:07d8a3143967 | 79 | DMA_TCD1_CSR = 0; |
timmey9 | 36:07d8a3143967 | 80 | DMA_TCD2_CSR = 1; |
timmey9 | 39:82dc3daecf32 | 81 | |
timmey9 | 45:d591d138cdeb | 82 | |
timmey9 | 40:bd6d8c35e822 | 83 | /*pc.printf("DMA_CR: %08x\r\n", DMA_CR); |
timmey9 | 39:82dc3daecf32 | 84 | pc.printf("DMA_ES: %08x\r\n", DMA_ES); |
timmey9 | 39:82dc3daecf32 | 85 | pc.printf("DMA_ERQ: %08x\r\n", DMA_ERQ); |
timmey9 | 39:82dc3daecf32 | 86 | pc.printf("DMA_EEI: %08x\r\n", DMA_EEI); |
timmey9 | 39:82dc3daecf32 | 87 | pc.printf("DMA_CEEI: %02x\r\n", DMA_CEEI); |
timmey9 | 39:82dc3daecf32 | 88 | pc.printf("DMA_SEEI: %02x\r\n", DMA_SEEI); |
timmey9 | 39:82dc3daecf32 | 89 | pc.printf("DMA_CERQ: %02x\r\n", DMA_CERQ); |
timmey9 | 39:82dc3daecf32 | 90 | pc.printf("DMA_SERQ: %02x\r\n", DMA_SERQ); |
timmey9 | 39:82dc3daecf32 | 91 | pc.printf("DMA_CDNE: %02x\r\n", DMA_CDNE); |
timmey9 | 39:82dc3daecf32 | 92 | pc.printf("DMA_SSRT: %02x\r\n", DMA_SSRT); |
timmey9 | 39:82dc3daecf32 | 93 | pc.printf("DMA_CERR: %02x\r\n", DMA_CERR); |
timmey9 | 39:82dc3daecf32 | 94 | pc.printf("DMA_CINT: %02x\r\n", DMA_CINT); |
timmey9 | 39:82dc3daecf32 | 95 | pc.printf("DMA_INT: %08x\r\n", DMA_INT); |
timmey9 | 39:82dc3daecf32 | 96 | pc.printf("DMA_ERR: %08x\r\n", DMA_ERR); |
timmey9 | 40:bd6d8c35e822 | 97 | pc.printf("DMA_HRS: %08x\r\n", DMA_HRS);*/ |
timmey9 | 34:44cc9b76a507 | 98 | } |
timmey9 | 40:bd6d8c35e822 | 99 | |
timmey9 | 45:d591d138cdeb | 100 | void dma_reset() { |
timmey9 | 40:bd6d8c35e822 | 101 | // Set memory address for destinations back to the beginning |
timmey9 | 45:d591d138cdeb | 102 | dma_init(); |
timmey9 | 40:bd6d8c35e822 | 103 | } |