Dependencies:   mbed-dsp mbed

Fork of DSP_200kHz by Mazzeo Research Group

Committer:
bmazzeo
Date:
Wed Feb 17 20:26:26 2016 +0000
Revision:
55:2526b3317bc8
Parent:
54:1697dc574b96
Child:
56:7e08cbc3a4f1
This correctly implements the static creation of a buffer for processing.

Who changed what in which revision?

UserRevisionLine numberNew 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
bmazzeo 55:2526b3317bc8 6 #define TOTAL_SAMPLES 16
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 51:43143a3fc2d7 10
bmazzeo 54:1697dc574b96 11 uint16_t static_input_array0[TOTAL_SAMPLES];
bmazzeo 54:1697dc574b96 12 uint16_t static_input_array1[TOTAL_SAMPLES];
timmey9 51:43143a3fc2d7 13
bmazzeo 55:2526b3317bc8 14 uint16_t static_output_array0[TOTAL_SAMPLES];
timmey9 45:d591d138cdeb 15
timmey9 45:d591d138cdeb 16 void dma_init()
timmey9 34:44cc9b76a507 17 {
bmazzeo 54:1697dc574b96 18 // Enable clock for DMAMUX and DMA - all the peripherals need clocks to function
bmazzeo 54:1697dc574b96 19 SIM_SCGC6 |= SIM_SCGC6_DMAMUX_MASK;
bmazzeo 54:1697dc574b96 20 SIM_SCGC7 |= SIM_SCGC7_DMA_MASK;
bmazzeo 54:1697dc574b96 21
bmazzeo 54:1697dc574b96 22
timmey9 45:d591d138cdeb 23 // Enable DMA channels and select MUX to the correct source (see page 95 of user manual
bmazzeo 54:1697dc574b96 24 DMAMUX_CHCFG0 = 0;
bmazzeo 54:1697dc574b96 25 DMAMUX_CHCFG1 = 0;
bmazzeo 54:1697dc574b96 26
timmey9 36:07d8a3143967 27
bmazzeo 54:1697dc574b96 28 // Enable request signal for channel 0, 1
bmazzeo 54:1697dc574b96 29 DMA_ERQ = 0;
bmazzeo 54:1697dc574b96 30 DMA_ERQ = DMA_ERQ_ERQ0_MASK | DMA_ERQ_ERQ1_MASK;
timmey9 45:d591d138cdeb 31
timmey9 45:d591d138cdeb 32 // select round-robin arbitration priority
timmey9 45:d591d138cdeb 33 DMA_CR |= DMA_CR_ERCA_MASK;
timmey9 45:d591d138cdeb 34
bmazzeo 55:2526b3317bc8 35 // Disable minor loop
bmazzeo 55:2526b3317bc8 36 DMA_CR &= ~DMA_CR_EMLM_MASK;
bmazzeo 55:2526b3317bc8 37
bmazzeo 54:1697dc574b96 38 // Set memory address for source and destination for DMA0 and DMA1
bmazzeo 54:1697dc574b96 39 DMA_TCD0_SADDR = (uint32_t) &ADC0_RA;
timmey9 45:d591d138cdeb 40 DMA_TCD0_DADDR = (uint32_t) sample_array0;
timmey9 50:33524a27e08c 41 DMA_TCD1_SADDR = (uint32_t) &ADC1_RA;
timmey9 45:d591d138cdeb 42 DMA_TCD1_DADDR = (uint32_t) sample_array1;
timmey9 36:07d8a3143967 43
timmey9 34:44cc9b76a507 44 // Set an offset for source and destination address
bmazzeo 55:2526b3317bc8 45 DMA_TCD0_SOFF = 0x00; // Source address offset of 0 bytes per transaction
bmazzeo 55:2526b3317bc8 46 DMA_TCD0_DOFF = 0x02; // Destination address offset of 2 bytes per transaction
bmazzeo 55:2526b3317bc8 47 DMA_TCD1_SOFF = 0x00; // Source address offset of 0 bytes per transaction
bmazzeo 55:2526b3317bc8 48 DMA_TCD1_DOFF = 0x02; // Destination address offset of 2 bytes per transaction
timmey9 34:44cc9b76a507 49
timmey9 34:44cc9b76a507 50 // Set source and destination data transfer size
timmey9 34:44cc9b76a507 51 DMA_TCD0_ATTR = DMA_ATTR_SSIZE(1) | DMA_ATTR_DSIZE(1);
timmey9 36:07d8a3143967 52 DMA_TCD1_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 34:44cc9b76a507 57
bmazzeo 54:1697dc574b96 58 // Major iteration count
timmey9 45:d591d138cdeb 59 DMA_TCD0_CITER_ELINKNO = DMA_CITER_ELINKNO_CITER(len);
timmey9 45:d591d138cdeb 60 DMA_TCD0_BITER_ELINKNO = DMA_BITER_ELINKNO_BITER(len);
timmey9 45:d591d138cdeb 61 DMA_TCD1_CITER_ELINKNO = DMA_CITER_ELINKNO_CITER(len);
timmey9 45:d591d138cdeb 62 DMA_TCD1_BITER_ELINKNO = DMA_BITER_ELINKNO_BITER(len);
timmey9 34:44cc9b76a507 63
timmey9 34:44cc9b76a507 64 // Adjustment value used to restore the source and destiny address to the initial value
timmey9 45:d591d138cdeb 65 // 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 66
timmey9 44:41c262caf898 67 DMA_TCD0_SLAST = 0; // Source address adjustment
timmey9 45:d591d138cdeb 68 DMA_TCD0_DLASTSGA = -len*2; // Destination address adjustment
timmey9 44:41c262caf898 69 DMA_TCD1_SLAST = 0; // Source address adjustment
timmey9 45:d591d138cdeb 70 DMA_TCD1_DLASTSGA = -len*2; // Destination address adjustment
bmazzeo 54:1697dc574b96 71 // DMA_TCD2_SLAST = 0; // Source address adjustment
bmazzeo 54:1697dc574b96 72 // DMA_TCD2_DLASTSGA = -len*2; // Destination address adjustment
bmazzeo 54:1697dc574b96 73
bmazzeo 54:1697dc574b96 74 DMAMUX_CHCFG0 |= DMAMUX_CHCFG_ENBL_MASK | DMAMUX_CHCFG_SOURCE(40); // ADC0
bmazzeo 54:1697dc574b96 75 DMAMUX_CHCFG1 |= DMAMUX_CHCFG_ENBL_MASK | DMAMUX_CHCFG_SOURCE(41); // ADC1
bmazzeo 54:1697dc574b96 76 /* Source number Source module
bmazzeo 54:1697dc574b96 77 40 ADC0
bmazzeo 54:1697dc574b96 78 41 ADC1
bmazzeo 54:1697dc574b96 79 */
bmazzeo 54:1697dc574b96 80
bmazzeo 54:1697dc574b96 81
timmey9 34:44cc9b76a507 82 // Setup control and status register
timmey9 34:44cc9b76a507 83 DMA_TCD0_CSR = 0;
timmey9 36:07d8a3143967 84 DMA_TCD1_CSR = 0;
bmazzeo 54:1697dc574b96 85
bmazzeo 54:1697dc574b96 86
bmazzeo 54:1697dc574b96 87 // Now set up linking once the ADC samples are recorded
bmazzeo 54:1697dc574b96 88 // DMA Channels 2 and 3 now will be enabled
bmazzeo 54:1697dc574b96 89 DMA_ERQ |= DMA_ERQ_ERQ2_MASK | DMA_ERQ_ERQ3_MASK;
bmazzeo 54:1697dc574b96 90 DMA_TCD0_CSR |= DMA_CSR_MAJORLINKCH(2) | DMA_CSR_MAJORELINK_MASK;
bmazzeo 54:1697dc574b96 91 DMA_TCD1_CSR |= DMA_CSR_MAJORLINKCH(3) | DMA_CSR_MAJORELINK_MASK;
bmazzeo 54:1697dc574b96 92
bmazzeo 54:1697dc574b96 93 // Set memory address for source and destination for DMA0 and DMA1
bmazzeo 54:1697dc574b96 94 DMA_TCD2_SADDR = (uint32_t) sample_array0;
bmazzeo 54:1697dc574b96 95 DMA_TCD2_DADDR = (uint32_t) static_input_array0;
bmazzeo 54:1697dc574b96 96 DMA_TCD3_SADDR = (uint32_t) sample_array1;
bmazzeo 54:1697dc574b96 97 DMA_TCD3_DADDR = (uint32_t) static_input_array1;
bmazzeo 54:1697dc574b96 98
bmazzeo 54:1697dc574b96 99 // Set an offset for source and destination address
bmazzeo 54:1697dc574b96 100 DMA_TCD2_SOFF = 0x02; // Source address offset of 2 bits per transaction
bmazzeo 54:1697dc574b96 101 DMA_TCD2_DOFF = 0x02; // Destination address offset of 1 bit per transaction
bmazzeo 54:1697dc574b96 102 DMA_TCD3_SOFF = 0x02; // Source address offset of 2 bits per transaction
bmazzeo 54:1697dc574b96 103 DMA_TCD3_DOFF = 0x02; // Destination address offset of 1 bit per transaction
bmazzeo 54:1697dc574b96 104
bmazzeo 54:1697dc574b96 105 // Set source and destination data transfer size
bmazzeo 54:1697dc574b96 106 DMA_TCD2_ATTR = DMA_ATTR_SSIZE(1) | DMA_ATTR_DSIZE(1);
bmazzeo 54:1697dc574b96 107 DMA_TCD3_ATTR = DMA_ATTR_SSIZE(1) | DMA_ATTR_DSIZE(1);
bmazzeo 54:1697dc574b96 108
bmazzeo 54:1697dc574b96 109 // Number of bytes to be transfered in each service request of the channel
bmazzeo 55:2526b3317bc8 110 //DMA_TCD2_NBYTES_MLNO = 0x02 * TOTAL_SAMPLES;
bmazzeo 55:2526b3317bc8 111 //DMA_TCD3_NBYTES_MLNO = 0x02 * TOTAL_SAMPLES;
bmazzeo 55:2526b3317bc8 112 DMA_TCD2_NBYTES_MLNO = 0x02 * len;
bmazzeo 55:2526b3317bc8 113 DMA_TCD3_NBYTES_MLNO = 0x02 * len;
bmazzeo 54:1697dc574b96 114
bmazzeo 54:1697dc574b96 115 // Current major iteration count
bmazzeo 55:2526b3317bc8 116 DMA_TCD2_CITER_ELINKNO = 0x01;
bmazzeo 55:2526b3317bc8 117 DMA_TCD2_BITER_ELINKNO = 0x01;
bmazzeo 55:2526b3317bc8 118 DMA_TCD3_CITER_ELINKNO = 0x01;
bmazzeo 55:2526b3317bc8 119 DMA_TCD3_BITER_ELINKNO = 0x01;
bmazzeo 54:1697dc574b96 120
bmazzeo 54:1697dc574b96 121 // Adjustment value used to restore the source and destiny address to the initial value
bmazzeo 54:1697dc574b96 122 // 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)
bmazzeo 54:1697dc574b96 123
bmazzeo 54:1697dc574b96 124 DMA_TCD2_SLAST = -len*2; // Source address adjustment
bmazzeo 54:1697dc574b96 125 DMA_TCD2_DLASTSGA = -len*2; // Destination address adjustment
bmazzeo 54:1697dc574b96 126 DMA_TCD3_SLAST = -len*2; // Source address adjustment
bmazzeo 54:1697dc574b96 127 DMA_TCD3_DLASTSGA = -len*2; // Destination address adjustment
bmazzeo 54:1697dc574b96 128
timmey9 46:a015ebf4663b 129 DMA_TCD2_CSR = 0;
bmazzeo 54:1697dc574b96 130 DMA_TCD3_CSR = 0;
bmazzeo 54:1697dc574b96 131
bmazzeo 55:2526b3317bc8 132 // Now set up DAC
bmazzeo 55:2526b3317bc8 133 DMA_ERQ |= DMA_ERQ_ERQ4_MASK;
bmazzeo 55:2526b3317bc8 134 DMA_TCD0_CSR |= DMA_CSR_MAJORLINKCH(2) | DMA_CSR_MAJORELINK_MASK;
bmazzeo 55:2526b3317bc8 135
bmazzeo 54:1697dc574b96 136
timmey9 51:43143a3fc2d7 137 }
timmey9 51:43143a3fc2d7 138
timmey9 51:43143a3fc2d7 139 void dma_reset() {
timmey9 51:43143a3fc2d7 140 // Set memory address for destinations back to the beginning
timmey9 51:43143a3fc2d7 141 dma_init();
timmey9 51:43143a3fc2d7 142 }
timmey9 51:43143a3fc2d7 143
timmey9 51:43143a3fc2d7 144
timmey9 51:43143a3fc2d7 145
timmey9 51:43143a3fc2d7 146
timmey9 51:43143a3fc2d7 147 /*pc.printf("DMA_CR: %08x\r\n", DMA_CR);
timmey9 50:33524a27e08c 148 pc.printf("DMA_ES: %08x\r\n", DMA_ES);
timmey9 50:33524a27e08c 149 pc.printf("DMA_ERQ: %08x\r\n", DMA_ERQ);
timmey9 50:33524a27e08c 150 pc.printf("DMA_EEI: %08x\r\n", DMA_EEI);
timmey9 50:33524a27e08c 151 pc.printf("DMA_CEEI: %02x\r\n", DMA_CEEI);
timmey9 50:33524a27e08c 152 pc.printf("DMA_SEEI: %02x\r\n", DMA_SEEI);
timmey9 50:33524a27e08c 153 pc.printf("DMA_CERQ: %02x\r\n", DMA_CERQ);
timmey9 50:33524a27e08c 154 pc.printf("DMA_SERQ: %02x\r\n", DMA_SERQ);
timmey9 50:33524a27e08c 155 pc.printf("DMA_CDNE: %02x\r\n", DMA_CDNE);
timmey9 50:33524a27e08c 156 pc.printf("DMA_SSRT: %02x\r\n", DMA_SSRT);
timmey9 50:33524a27e08c 157 pc.printf("DMA_CERR: %02x\r\n", DMA_CERR);
timmey9 50:33524a27e08c 158 pc.printf("DMA_CINT: %02x\r\n", DMA_CINT);
timmey9 50:33524a27e08c 159 pc.printf("DMA_INT: %08x\r\n", DMA_INT);
timmey9 50:33524a27e08c 160 pc.printf("DMA_ERR: %08x\r\n", DMA_ERR);
timmey9 51:43143a3fc2d7 161 pc.printf("DMA_HRS: %08x\r\n", DMA_HRS);*/