Quentin Roche / ST_I2S

Il y avait des problèmes dans la libraire...

Dependents:   X_NUCLEO_CCA02M1

Fork of ST_I2S by ST

targets/TARGET_STM/stm_i2s_api.c@3:25de898f5354, 2016-12-14 (annotated)

Committer:
Davide Aliprandi
Date:
Wed Dec 14 14:23:12 2016 +0100
Revision:
3:25de898f5354
Parent:
2:0c9ce59aee25
Child:
4:21603d68bcf7
Default PLL set at initialization at 32KHz, removed setting of PLL at runtime.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Wolfgang Betz 1:f90318e0923b 1 #include "mbed_assert.h"
Wolfgang Betz 1:f90318e0923b 2 #include "mbed_error.h"
Wolfgang Betz 1:f90318e0923b 3 #include "stm_i2s_api.h"
Wolfgang Betz 1:f90318e0923b 4
Wolfgang Betz 1:f90318e0923b 5 #include "stm_dma_caps.h"
Wolfgang Betz 1:f90318e0923b 6
Wolfgang Betz 1:f90318e0923b 7 #if DEVICE_I2S
Wolfgang Betz 1:f90318e0923b 8
Wolfgang Betz 1:f90318e0923b 9 #include <math.h>
Wolfgang Betz 1:f90318e0923b 10 #include <string.h>
Wolfgang Betz 1:f90318e0923b 11 #include "cmsis.h"
Wolfgang Betz 1:f90318e0923b 12 #include "pinmap.h"
Wolfgang Betz 1:f90318e0923b 13 #include "PeripheralPins.h"
Davide Aliprandi 2:0c9ce59aee25 14 #include "StmI2sPeripheralPins.h"
Wolfgang Betz 1:f90318e0923b 15
Davide Aliprandi 2:0c9ce59aee25 16 //#define DEBUG_STDIO 1 // betzw - TODO: temporarily enable debug printfs
Wolfgang Betz 1:f90318e0923b 17
Wolfgang Betz 1:f90318e0923b 18 #ifndef DEBUG_STDIO
Wolfgang Betz 1:f90318e0923b 19 # define DEBUG_STDIO 0
Wolfgang Betz 1:f90318e0923b 20 #endif
Wolfgang Betz 1:f90318e0923b 21
Wolfgang Betz 1:f90318e0923b 22 #if DEBUG_STDIO
Wolfgang Betz 1:f90318e0923b 23 # include <stdio.h>
Wolfgang Betz 1:f90318e0923b 24 # define DEBUG_PRINTF(...) do { printf(__VA_ARGS__); } while(0)
Wolfgang Betz 1:f90318e0923b 25 #else
Wolfgang Betz 1:f90318e0923b 26 # define DEBUG_PRINTF(...) {}
Wolfgang Betz 1:f90318e0923b 27 #endif
Wolfgang Betz 1:f90318e0923b 28
Wolfgang Betz 1:f90318e0923b 29 typedef enum {
Wolfgang Betz 1:f90318e0923b 30 I2S_TRANSFER_TYPE_TX = 1,
Wolfgang Betz 1:f90318e0923b 31 I2S_TRANSFER_TYPE_RX = 2,
Wolfgang Betz 1:f90318e0923b 32 I2S_TRANSFER_TYPE_TXRX = 3,
Wolfgang Betz 1:f90318e0923b 33 } transfer_type_t;
Wolfgang Betz 1:f90318e0923b 34
Wolfgang Betz 1:f90318e0923b 35 typedef struct {
Wolfgang Betz 1:f90318e0923b 36 DMA_HandleTypeDef tx_dma_handle;
Wolfgang Betz 1:f90318e0923b 37 DMA_HandleTypeDef rx_dma_handle;
Wolfgang Betz 1:f90318e0923b 38 } dma_handles_t;
Wolfgang Betz 1:f90318e0923b 39
Wolfgang Betz 1:f90318e0923b 40 #define I2S_NUM (5) // betzw: this approach wastes quite a bit of memory - TO BE IMPROVED!?!?
Wolfgang Betz 1:f90318e0923b 41
Wolfgang Betz 1:f90318e0923b 42 static I2S_HandleTypeDef I2sHandle[I2S_NUM];
Wolfgang Betz 1:f90318e0923b 43 static DMA_HandleTypeDef DMaHandles[I2S_NUM][NUM_OF_DIRECTIONS];
Wolfgang Betz 1:f90318e0923b 44
Davide Aliprandi 2:0c9ce59aee25 45 static void init_i2s(i2s_t *obj) {
Wolfgang Betz 1:f90318e0923b 46 I2S_HandleTypeDef *handle = &I2sHandle[obj->i2s.module];
Wolfgang Betz 1:f90318e0923b 47
Wolfgang Betz 1:f90318e0923b 48 __HAL_I2S_DISABLE(handle);
Wolfgang Betz 1:f90318e0923b 49 HAL_I2S_Init(handle);
Wolfgang Betz 1:f90318e0923b 50 __HAL_I2S_ENABLE(handle);
Wolfgang Betz 1:f90318e0923b 51 }
Wolfgang Betz 1:f90318e0923b 52
Davide Aliprandi 2:0c9ce59aee25 53 static void init_dmas(i2s_t *obj) {
Wolfgang Betz 1:f90318e0923b 54 DMA_HandleTypeDef *primary_handle = NULL;
Wolfgang Betz 1:f90318e0923b 55 DMA_HandleTypeDef *secondary_handle = NULL;
Wolfgang Betz 1:f90318e0923b 56 DMA_HandleTypeDef *hdmatx = NULL;
Wolfgang Betz 1:f90318e0923b 57
Wolfgang Betz 1:f90318e0923b 58 switch(obj->dma.dma_direction) {
Davide Aliprandi 2:0c9ce59aee25 59 case DMA_TX:
Davide Aliprandi 2:0c9ce59aee25 60 if(obj->dma.dma[DMA_TX] != NULL) {
Davide Aliprandi 2:0c9ce59aee25 61 hdmatx = primary_handle = &DMaHandles[obj->i2s.module][DMA_TX];
Davide Aliprandi 2:0c9ce59aee25 62 }
Davide Aliprandi 2:0c9ce59aee25 63 if(obj->dma.dma[DMA_RX] != NULL) {
Davide Aliprandi 2:0c9ce59aee25 64 secondary_handle = &DMaHandles[obj->i2s.module][DMA_RX];
Davide Aliprandi 2:0c9ce59aee25 65 }
Davide Aliprandi 2:0c9ce59aee25 66 break;
Davide Aliprandi 2:0c9ce59aee25 67 case DMA_RX:
Davide Aliprandi 2:0c9ce59aee25 68 default:
Davide Aliprandi 2:0c9ce59aee25 69 if(obj->dma.dma[DMA_RX] != NULL) {
Davide Aliprandi 2:0c9ce59aee25 70 primary_handle = &DMaHandles[obj->i2s.module][DMA_RX];
Davide Aliprandi 2:0c9ce59aee25 71 }
Davide Aliprandi 2:0c9ce59aee25 72 if(obj->dma.dma[DMA_TX] != NULL) {
Davide Aliprandi 2:0c9ce59aee25 73 hdmatx = secondary_handle = &DMaHandles[obj->i2s.module][DMA_TX];
Davide Aliprandi 2:0c9ce59aee25 74 }
Davide Aliprandi 2:0c9ce59aee25 75 break;
Wolfgang Betz 1:f90318e0923b 76 }
Wolfgang Betz 1:f90318e0923b 77
Wolfgang Betz 1:f90318e0923b 78 if(primary_handle != NULL) {
Davide Aliprandi 2:0c9ce59aee25 79 __HAL_DMA_DISABLE(primary_handle);
Davide Aliprandi 2:0c9ce59aee25 80 HAL_DMA_Init(primary_handle);
Wolfgang Betz 1:f90318e0923b 81
Davide Aliprandi 2:0c9ce59aee25 82 if(hdmatx == primary_handle) {
Davide Aliprandi 2:0c9ce59aee25 83 __HAL_LINKDMA(&I2sHandle[obj->i2s.module], hdmatx, *primary_handle);
Davide Aliprandi 2:0c9ce59aee25 84 } else {
Davide Aliprandi 2:0c9ce59aee25 85 __HAL_LINKDMA(&I2sHandle[obj->i2s.module], hdmarx, *primary_handle);
Davide Aliprandi 2:0c9ce59aee25 86 }
Wolfgang Betz 1:f90318e0923b 87 }
Wolfgang Betz 1:f90318e0923b 88
Wolfgang Betz 1:f90318e0923b 89 if(secondary_handle != NULL) {
Davide Aliprandi 2:0c9ce59aee25 90 __HAL_DMA_DISABLE(secondary_handle);
Davide Aliprandi 2:0c9ce59aee25 91 HAL_DMA_Init(secondary_handle);
Wolfgang Betz 1:f90318e0923b 92
Davide Aliprandi 2:0c9ce59aee25 93 if(hdmatx == secondary_handle) {
Davide Aliprandi 2:0c9ce59aee25 94 __HAL_LINKDMA(&I2sHandle[obj->i2s.module], hdmatx, *secondary_handle);
Davide Aliprandi 2:0c9ce59aee25 95 } else {
Davide Aliprandi 2:0c9ce59aee25 96 __HAL_LINKDMA(&I2sHandle[obj->i2s.module], hdmarx, *secondary_handle);
Davide Aliprandi 2:0c9ce59aee25 97 }
Wolfgang Betz 1:f90318e0923b 98 }
Wolfgang Betz 1:f90318e0923b 99 }
Wolfgang Betz 1:f90318e0923b 100
Wolfgang Betz 1:f90318e0923b 101 static inline uint32_t i2s_get_mode(i2s_mode_t mode, uint8_t *direction) {
Wolfgang Betz 1:f90318e0923b 102 switch(mode) {
Davide Aliprandi 2:0c9ce59aee25 103 case SLAVE_TX:
Davide Aliprandi 2:0c9ce59aee25 104 *direction = DMA_TX;
Davide Aliprandi 2:0c9ce59aee25 105 return I2S_MODE_SLAVE_TX;
Davide Aliprandi 2:0c9ce59aee25 106 case SLAVE_RX:
Davide Aliprandi 2:0c9ce59aee25 107 *direction = DMA_RX;
Davide Aliprandi 2:0c9ce59aee25 108 return I2S_MODE_SLAVE_RX;
Davide Aliprandi 2:0c9ce59aee25 109 case MASTER_TX:
Davide Aliprandi 2:0c9ce59aee25 110 *direction = DMA_TX;
Davide Aliprandi 2:0c9ce59aee25 111 return I2S_MODE_MASTER_TX;
Davide Aliprandi 2:0c9ce59aee25 112 case MASTER_RX:
Davide Aliprandi 2:0c9ce59aee25 113 default:
Davide Aliprandi 2:0c9ce59aee25 114 *direction = DMA_RX;
Davide Aliprandi 2:0c9ce59aee25 115 return I2S_MODE_MASTER_RX;
Wolfgang Betz 1:f90318e0923b 116 }
Wolfgang Betz 1:f90318e0923b 117 }
Wolfgang Betz 1:f90318e0923b 118
Wolfgang Betz 1:f90318e0923b 119 static inline uint32_t i2s_get_priority(i2s_dma_prio_t priority) {
Wolfgang Betz 1:f90318e0923b 120 switch(priority) {
Davide Aliprandi 2:0c9ce59aee25 121 case LOW:
Davide Aliprandi 2:0c9ce59aee25 122 return DMA_PRIORITY_LOW;
Davide Aliprandi 2:0c9ce59aee25 123 case URGENT:
Davide Aliprandi 2:0c9ce59aee25 124 return DMA_PRIORITY_VERY_HIGH;
Davide Aliprandi 2:0c9ce59aee25 125 case HIGH:
Davide Aliprandi 2:0c9ce59aee25 126 return DMA_PRIORITY_HIGH;
Davide Aliprandi 2:0c9ce59aee25 127 default:
Davide Aliprandi 2:0c9ce59aee25 128 return DMA_PRIORITY_MEDIUM;
Wolfgang Betz 1:f90318e0923b 129 }
Wolfgang Betz 1:f90318e0923b 130 }
Wolfgang Betz 1:f90318e0923b 131
Wolfgang Betz 1:f90318e0923b 132 static void dma_i2s_init(i2s_t *obj, bool *use_tx, bool *use_rx, bool circular, i2s_dma_prio_t prio) {
Wolfgang Betz 1:f90318e0923b 133 // DMA declarations
Wolfgang Betz 1:f90318e0923b 134 DMA_HandleTypeDef *primary_handle = &DMaHandles[obj->i2s.module][obj->dma.dma_direction];
Wolfgang Betz 1:f90318e0923b 135 DMA_HandleTypeDef *secondary_handle = NULL;
Wolfgang Betz 1:f90318e0923b 136
Wolfgang Betz 1:f90318e0923b 137 // DMA initialization & configuration
Davide Aliprandi 2:0c9ce59aee25 138 stm_dma_init();
Wolfgang Betz 1:f90318e0923b 139 obj->dma.dma[DMA_TX] = obj->dma.dma[DMA_RX] = NULL;
Wolfgang Betz 1:f90318e0923b 140
Wolfgang Betz 1:f90318e0923b 141 switch(obj->dma.dma_direction) {
Davide Aliprandi 2:0c9ce59aee25 142 case DMA_TX:
Davide Aliprandi 2:0c9ce59aee25 143 if(*use_tx) {
Davide Aliprandi 2:0c9ce59aee25 144 obj->dma.dma[DMA_TX] = stm_dma_channel_allocate(MAKE_CAP(obj->dma.dma_device, DMA_TX));
Davide Aliprandi 2:0c9ce59aee25 145 MBED_ASSERT(obj->dma.dma[DMA_TX] != DMA_ERROR_OUT_OF_CHANNELS);
Davide Aliprandi 2:0c9ce59aee25 146 }
Davide Aliprandi 2:0c9ce59aee25 147 break;
Davide Aliprandi 2:0c9ce59aee25 148 case DMA_RX:
Davide Aliprandi 2:0c9ce59aee25 149 default:
Davide Aliprandi 2:0c9ce59aee25 150 if(*use_rx) {
Davide Aliprandi 2:0c9ce59aee25 151 obj->dma.dma[DMA_RX] = stm_dma_channel_allocate(MAKE_CAP(obj->dma.dma_device, DMA_RX));
Davide Aliprandi 2:0c9ce59aee25 152 MBED_ASSERT(obj->dma.dma[DMA_RX] != DMA_ERROR_OUT_OF_CHANNELS);
Davide Aliprandi 2:0c9ce59aee25 153 }
Davide Aliprandi 2:0c9ce59aee25 154 break;
Wolfgang Betz 1:f90318e0923b 155 }
Wolfgang Betz 1:f90318e0923b 156
Wolfgang Betz 1:f90318e0923b 157 // Primary DMA configuration
Wolfgang Betz 1:f90318e0923b 158 if(obj->dma.dma[obj->dma.dma_direction] != NULL) {
Davide Aliprandi 2:0c9ce59aee25 159 primary_handle->Instance = obj->dma.dma[obj->dma.dma_direction]->dma_stream;
Davide Aliprandi 2:0c9ce59aee25 160 primary_handle->Init.Channel = obj->dma.dma[obj->dma.dma_direction]->channel_nr;
Davide Aliprandi 2:0c9ce59aee25 161 primary_handle->Init.Direction = (obj->dma.dma_direction == DMA_TX) ?
Davide Aliprandi 2:0c9ce59aee25 162 DMA_MEMORY_TO_PERIPH : DMA_PERIPH_TO_MEMORY;
Davide Aliprandi 2:0c9ce59aee25 163 primary_handle->Init.FIFOMode = DMA_FIFOMODE_DISABLE;
Davide Aliprandi 2:0c9ce59aee25 164 primary_handle->Init.FIFOThreshold = DMA_FIFO_THRESHOLD_FULL;
Davide Aliprandi 2:0c9ce59aee25 165 primary_handle->Init.MemBurst = DMA_MBURST_SINGLE;
Davide Aliprandi 2:0c9ce59aee25 166 primary_handle->Init.MemDataAlignment = DMA_MDATAALIGN_HALFWORD;
Davide Aliprandi 2:0c9ce59aee25 167 primary_handle->Init.MemInc = DMA_MINC_ENABLE;
Davide Aliprandi 2:0c9ce59aee25 168 primary_handle->Init.Mode = (circular ? DMA_CIRCULAR : DMA_NORMAL);
Davide Aliprandi 2:0c9ce59aee25 169 primary_handle->Init.PeriphBurst = DMA_PBURST_SINGLE;
Davide Aliprandi 2:0c9ce59aee25 170 primary_handle->Init.PeriphDataAlignment = DMA_PDATAALIGN_HALFWORD;
Davide Aliprandi 2:0c9ce59aee25 171 primary_handle->Init.PeriphInc = DMA_PINC_DISABLE;
Davide Aliprandi 2:0c9ce59aee25 172 primary_handle->Init.Priority = i2s_get_priority(prio);
Wolfgang Betz 1:f90318e0923b 173 }
Wolfgang Betz 1:f90318e0923b 174
Wolfgang Betz 1:f90318e0923b 175 // Allocate secondary DMA channel (if full-duplex)
Wolfgang Betz 1:f90318e0923b 176 if(obj->i2s.pin_fdpx != NC) {
Davide Aliprandi 2:0c9ce59aee25 177 switch(obj->dma.dma_direction) {
Davide Aliprandi 2:0c9ce59aee25 178 case DMA_TX:
Davide Aliprandi 2:0c9ce59aee25 179 if(*use_rx) {
Davide Aliprandi 2:0c9ce59aee25 180 obj->dma.dma[DMA_RX] = stm_dma_channel_allocate(MAKE_CAP(obj->dma.dma_device, DMA_RX));
Davide Aliprandi 2:0c9ce59aee25 181 secondary_handle = &DMaHandles[obj->i2s.module][DMA_RX];
Davide Aliprandi 2:0c9ce59aee25 182 MBED_ASSERT(obj->dma.dma[DMA_RX] != DMA_ERROR_OUT_OF_CHANNELS);
Davide Aliprandi 2:0c9ce59aee25 183 }
Davide Aliprandi 2:0c9ce59aee25 184 break;
Davide Aliprandi 2:0c9ce59aee25 185 case DMA_RX:
Davide Aliprandi 2:0c9ce59aee25 186 default:
Davide Aliprandi 2:0c9ce59aee25 187 if(*use_tx) {
Davide Aliprandi 2:0c9ce59aee25 188 obj->dma.dma[DMA_TX] = stm_dma_channel_allocate(MAKE_CAP(obj->dma.dma_device, DMA_TX));
Davide Aliprandi 2:0c9ce59aee25 189 secondary_handle = &DMaHandles[obj->i2s.module][DMA_TX];
Davide Aliprandi 2:0c9ce59aee25 190 MBED_ASSERT(obj->dma.dma[DMA_TX] != DMA_ERROR_OUT_OF_CHANNELS);
Davide Aliprandi 2:0c9ce59aee25 191 }
Davide Aliprandi 2:0c9ce59aee25 192 break;
Davide Aliprandi 2:0c9ce59aee25 193 }
Wolfgang Betz 1:f90318e0923b 194 }
Wolfgang Betz 1:f90318e0923b 195
Wolfgang Betz 1:f90318e0923b 196 // Secondary DMA configuration
Wolfgang Betz 1:f90318e0923b 197 if(secondary_handle != NULL) {
Davide Aliprandi 2:0c9ce59aee25 198 uint8_t secondary_dma_direction = (obj->dma.dma_direction == DMA_TX) ? DMA_RX : DMA_TX;
Wolfgang Betz 1:f90318e0923b 199
Davide Aliprandi 2:0c9ce59aee25 200 secondary_handle->Instance = obj->dma.dma[secondary_dma_direction]->dma_stream;
Davide Aliprandi 2:0c9ce59aee25 201 secondary_handle->Init.Channel = obj->dma.dma[secondary_dma_direction]->channel_nr_fd;
Davide Aliprandi 2:0c9ce59aee25 202 secondary_handle->Init.Direction = (secondary_dma_direction == DMA_TX) ?
Davide Aliprandi 2:0c9ce59aee25 203 DMA_MEMORY_TO_PERIPH : DMA_PERIPH_TO_MEMORY;
Davide Aliprandi 2:0c9ce59aee25 204 secondary_handle->Init.FIFOMode = DMA_FIFOMODE_DISABLE;
Davide Aliprandi 2:0c9ce59aee25 205 secondary_handle->Init.FIFOThreshold = DMA_FIFO_THRESHOLD_FULL;
Davide Aliprandi 2:0c9ce59aee25 206 secondary_handle->Init.MemBurst = DMA_MBURST_SINGLE;
Davide Aliprandi 2:0c9ce59aee25 207 secondary_handle->Init.MemDataAlignment = DMA_MDATAALIGN_HALFWORD;
Davide Aliprandi 2:0c9ce59aee25 208 secondary_handle->Init.MemInc = DMA_MINC_ENABLE;
Davide Aliprandi 2:0c9ce59aee25 209 secondary_handle->Init.Mode = (circular ? DMA_CIRCULAR : DMA_NORMAL);
Davide Aliprandi 2:0c9ce59aee25 210 secondary_handle->Init.PeriphBurst = DMA_PBURST_SINGLE;
Davide Aliprandi 2:0c9ce59aee25 211 secondary_handle->Init.PeriphDataAlignment = DMA_PDATAALIGN_HALFWORD;
Davide Aliprandi 2:0c9ce59aee25 212 secondary_handle->Init.PeriphInc = DMA_PINC_DISABLE;
Davide Aliprandi 2:0c9ce59aee25 213 secondary_handle->Init.Priority = i2s_get_priority(prio);
Wolfgang Betz 1:f90318e0923b 214 }
Wolfgang Betz 1:f90318e0923b 215
Wolfgang Betz 1:f90318e0923b 216 if(obj->dma.dma[DMA_TX] == NULL) *use_tx = false;
Wolfgang Betz 1:f90318e0923b 217 if(obj->dma.dma[DMA_RX] == NULL) *use_rx = false;
Wolfgang Betz 1:f90318e0923b 218
Wolfgang Betz 1:f90318e0923b 219 // don't do anything, if the buffers aren't valid
Wolfgang Betz 1:f90318e0923b 220 if (!use_tx && !use_rx) {
Davide Aliprandi 2:0c9ce59aee25 221 DEBUG_PRINTF(" I2S%u: No DMAs to init\r\n", obj->i2s.module + 1);
Davide Aliprandi 2:0c9ce59aee25 222 return;
Wolfgang Betz 1:f90318e0923b 223 }
Wolfgang Betz 1:f90318e0923b 224
Davide Aliprandi 2:0c9ce59aee25 225 DEBUG_PRINTF(" I2S%u: DMA(s) Init\r\n", obj->i2s.module + 1);
Davide Aliprandi 2:0c9ce59aee25 226
Wolfgang Betz 1:f90318e0923b 227 init_dmas(obj);
Wolfgang Betz 1:f90318e0923b 228 }
Wolfgang Betz 1:f90318e0923b 229
Wolfgang Betz 1:f90318e0923b 230 static void dma_i2s_free(i2s_t *obj, uint8_t direction) {
Wolfgang Betz 1:f90318e0923b 231 const struct dma_stream_s *stream = obj->dma.dma[direction];
Wolfgang Betz 1:f90318e0923b 232
Wolfgang Betz 1:f90318e0923b 233 MBED_ASSERT(stream != NULL);
Wolfgang Betz 1:f90318e0923b 234
Wolfgang Betz 1:f90318e0923b 235 // disable irq
Wolfgang Betz 1:f90318e0923b 236 NVIC_DisableIRQ(stream->dma_stream_irq);
Wolfgang Betz 1:f90318e0923b 237
Wolfgang Betz 1:f90318e0923b 238 // free channel
Davide Aliprandi 2:0c9ce59aee25 239 stm_dma_channel_free((void*)stream);
Wolfgang Betz 1:f90318e0923b 240 obj->dma.dma[direction] = NULL;
Wolfgang Betz 1:f90318e0923b 241 }
Wolfgang Betz 1:f90318e0923b 242
Davide Aliprandi 2:0c9ce59aee25 243 void i2s_init(i2s_t *obj, PinName data, PinName sclk, PinName wsel, PinName fdpx, PinName mclk, i2s_mode_t mode) {
Wolfgang Betz 1:f90318e0923b 244 uint8_t dma_dev = 0, dma_direction = 0;
Wolfgang Betz 1:f90318e0923b 245
Wolfgang Betz 1:f90318e0923b 246 // Determine the I2S/SPI to use
Wolfgang Betz 1:f90318e0923b 247 SPIName i2s_data = (SPIName)pinmap_peripheral(data, PinMap_I2S_DATA);
Wolfgang Betz 1:f90318e0923b 248 SPIName i2s_sclk = (SPIName)pinmap_peripheral(sclk, PinMap_I2S_SCLK);
Wolfgang Betz 1:f90318e0923b 249
Wolfgang Betz 1:f90318e0923b 250 SPIName i2s_wsel = (SPIName)pinmap_peripheral(wsel, PinMap_I2S_WSEL);
Wolfgang Betz 1:f90318e0923b 251 SPIName i2s_fdpx = (SPIName)pinmap_peripheral(fdpx, PinMap_I2S_FDPX);
Wolfgang Betz 1:f90318e0923b 252
Wolfgang Betz 1:f90318e0923b 253 SPIName i2s_mclk = (SPIName)pinmap_peripheral(mclk, PinMap_I2S_MCLK);
Wolfgang Betz 1:f90318e0923b 254
Wolfgang Betz 1:f90318e0923b 255 SPIName i2s_merge1 = (SPIName)pinmap_merge(i2s_data, i2s_sclk);
Wolfgang Betz 1:f90318e0923b 256 SPIName i2s_merge2 = (SPIName)pinmap_merge(i2s_wsel, i2s_fdpx);
Wolfgang Betz 1:f90318e0923b 257
Wolfgang Betz 1:f90318e0923b 258 SPIName i2s_merge3 = (SPIName)pinmap_merge(i2s_merge1, i2s_merge2);
Wolfgang Betz 1:f90318e0923b 259 SPIName instance = (SPIName)pinmap_merge(i2s_merge3, i2s_mclk);
Wolfgang Betz 1:f90318e0923b 260 MBED_ASSERT(instance != (SPIName)NC);
Wolfgang Betz 1:f90318e0923b 261
Wolfgang Betz 1:f90318e0923b 262 // Enable I2S/SPI clock and set the right module number
Wolfgang Betz 1:f90318e0923b 263 switch(instance) {
Wolfgang Betz 1:f90318e0923b 264 #if defined(I2S1ext_BASE)
Wolfgang Betz 1:f90318e0923b 265 case SPI_1:
Wolfgang Betz 1:f90318e0923b 266 __SPI1_CLK_ENABLE();
Wolfgang Betz 1:f90318e0923b 267 obj->i2s.module = 0;
Wolfgang Betz 1:f90318e0923b 268 dma_dev = DMA_SPI1;
Wolfgang Betz 1:f90318e0923b 269 break;
Wolfgang Betz 1:f90318e0923b 270 #endif
Wolfgang Betz 1:f90318e0923b 271 #if defined(I2S2ext_BASE)
Wolfgang Betz 1:f90318e0923b 272 case SPI_2:
Wolfgang Betz 1:f90318e0923b 273 __SPI2_CLK_ENABLE();
Wolfgang Betz 1:f90318e0923b 274 obj->i2s.module = 1;
Wolfgang Betz 1:f90318e0923b 275 dma_dev = DMA_SPI2;
Wolfgang Betz 1:f90318e0923b 276 break;
Wolfgang Betz 1:f90318e0923b 277 #endif
Wolfgang Betz 1:f90318e0923b 278 #if defined(I2S3ext_BASE)
Wolfgang Betz 1:f90318e0923b 279 case SPI_3:
Wolfgang Betz 1:f90318e0923b 280 __SPI3_CLK_ENABLE();
Wolfgang Betz 1:f90318e0923b 281 obj->i2s.module = 2;
Wolfgang Betz 1:f90318e0923b 282 dma_dev = DMA_SPI3;
Wolfgang Betz 1:f90318e0923b 283 break;
Wolfgang Betz 1:f90318e0923b 284 #endif
Wolfgang Betz 1:f90318e0923b 285 #if defined(I2S4ext_BASE)
Wolfgang Betz 1:f90318e0923b 286 case SPI_4:
Wolfgang Betz 1:f90318e0923b 287 __SPI4_CLK_ENABLE();
Wolfgang Betz 1:f90318e0923b 288 obj->i2s.module = 3;
Wolfgang Betz 1:f90318e0923b 289 dma_dev = DMA_SPI4;
Wolfgang Betz 1:f90318e0923b 290 break;
Wolfgang Betz 1:f90318e0923b 291 #endif
Wolfgang Betz 1:f90318e0923b 292 #if defined(I2S5ext_BASE)
Wolfgang Betz 1:f90318e0923b 293 case SPI_5:
Wolfgang Betz 1:f90318e0923b 294 __SPI5_CLK_ENABLE();
Wolfgang Betz 1:f90318e0923b 295 obj->i2s.module = 4;
Wolfgang Betz 1:f90318e0923b 296 dma_dev = DMA_SPI5;
Wolfgang Betz 1:f90318e0923b 297 break;
Wolfgang Betz 1:f90318e0923b 298 #endif
Wolfgang Betz 1:f90318e0923b 299 default:
Wolfgang Betz 1:f90318e0923b 300 MBED_ASSERT(0);
Wolfgang Betz 1:f90318e0923b 301 break;
Wolfgang Betz 1:f90318e0923b 302 }
Wolfgang Betz 1:f90318e0923b 303
Wolfgang Betz 1:f90318e0923b 304 // Save DMA device
Wolfgang Betz 1:f90318e0923b 305 obj->dma.dma_device = dma_dev;
Wolfgang Betz 1:f90318e0923b 306
Wolfgang Betz 1:f90318e0923b 307 // Configure the I2S pins
Wolfgang Betz 1:f90318e0923b 308 pinmap_pinout(data, PinMap_I2S_DATA);
Wolfgang Betz 1:f90318e0923b 309 pinmap_pinout(wsel, PinMap_I2S_WSEL);
Wolfgang Betz 1:f90318e0923b 310 pinmap_pinout(sclk, PinMap_I2S_SCLK);
Wolfgang Betz 1:f90318e0923b 311 pinmap_pinout(fdpx, PinMap_I2S_FDPX);
Wolfgang Betz 1:f90318e0923b 312 pinmap_pinout(mclk, PinMap_I2S_MCLK);
Wolfgang Betz 1:f90318e0923b 313
Wolfgang Betz 1:f90318e0923b 314 obj->i2s.pin_wsel = wsel;
Wolfgang Betz 1:f90318e0923b 315 obj->i2s.pin_data = data;
Wolfgang Betz 1:f90318e0923b 316 obj->i2s.pin_sclk = sclk;
Wolfgang Betz 1:f90318e0923b 317 obj->i2s.pin_fdpx = fdpx;
Wolfgang Betz 1:f90318e0923b 318 obj->i2s.pin_mclk = mclk;
Wolfgang Betz 1:f90318e0923b 319
Davide Aliprandi 2:0c9ce59aee25 320 /* Configure PLLI2S */
Wolfgang Betz 1:f90318e0923b 321 static bool first_time = true;
Davide Aliprandi 2:0c9ce59aee25 322 if (first_time)
Davide Aliprandi 2:0c9ce59aee25 323 {
Davide Aliprandi 2:0c9ce59aee25 324 RCC_PeriphCLKInitTypeDef PeriphClkInitStruct;
Wolfgang Betz 1:f90318e0923b 325
Davide Aliprandi 2:0c9ce59aee25 326 /* Get RTCClockSelection */
Davide Aliprandi 2:0c9ce59aee25 327 HAL_RCCEx_GetPeriphCLKConfig(&PeriphClkInitStruct);
Wolfgang Betz 1:f90318e0923b 328
Davide Aliprandi 2:0c9ce59aee25 329 /* Set default configuration. Default frequency is 44100Hz. */
Davide Aliprandi 2:0c9ce59aee25 330 PeriphClkInitStruct.PeriphClockSelection = RCC_PERIPHCLK_I2S;
Davide Aliprandi 3:25de898f5354 331 PeriphClkInitStruct.PLLI2S.PLLI2SN = 213; //Davide: use values which are suggested in Table 91 of the
Davide Aliprandi 3:25de898f5354 332 PeriphClkInitStruct.PLLI2S.PLLI2SR = 2; // reference manual for master clock enabled & 32000Hz.
Davide Aliprandi 2:0c9ce59aee25 333
Wolfgang Betz 1:f90318e0923b 334 #ifdef NDEBUG
Davide Aliprandi 2:0c9ce59aee25 335 HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct);
Wolfgang Betz 1:f90318e0923b 336 #else
Davide Aliprandi 2:0c9ce59aee25 337 HAL_StatusTypeDef ret = HAL_RCCEx_PeriphCLKConfig(&PeriphClkInitStruct);
Wolfgang Betz 1:f90318e0923b 338 #endif
Davide Aliprandi 2:0c9ce59aee25 339 MBED_ASSERT(ret == HAL_OK);
Davide Aliprandi 2:0c9ce59aee25 340
Davide Aliprandi 2:0c9ce59aee25 341 first_time = false;
Wolfgang Betz 1:f90318e0923b 342 }
Wolfgang Betz 1:f90318e0923b 343
Davide Aliprandi 2:0c9ce59aee25 344 /* Initializing the handle for this master. */
Wolfgang Betz 1:f90318e0923b 345 I2S_HandleTypeDef *handle = &I2sHandle[obj->i2s.module];
Wolfgang Betz 1:f90318e0923b 346
Wolfgang Betz 1:f90318e0923b 347 handle->Instance = (SPI_TypeDef *)(instance);
Wolfgang Betz 1:f90318e0923b 348 handle->Init.Mode = i2s_get_mode(mode, &dma_direction);
Wolfgang Betz 1:f90318e0923b 349 handle->Init.Standard = I2S_STANDARD_PCM_SHORT;
Wolfgang Betz 1:f90318e0923b 350 handle->Init.DataFormat = I2S_DATAFORMAT_16B;
Wolfgang Betz 1:f90318e0923b 351 handle->Init.CPOL = I2S_CPOL_LOW;
Davide Aliprandi 3:25de898f5354 352 handle->Init.AudioFreq = I2S_AUDIOFREQ_32K; //Davide: Default frequency is 32000Hz.
Wolfgang Betz 1:f90318e0923b 353 handle->Init.ClockSource = I2S_CLOCK_PLL;
Davide Aliprandi 2:0c9ce59aee25 354 handle->Init.FullDuplexMode = (fdpx == NC ? I2S_FULLDUPLEXMODE_DISABLE : I2S_FULLDUPLEXMODE_ENABLE);
Davide Aliprandi 2:0c9ce59aee25 355 handle->Init.MCLKOutput = (mclk == NC ? I2S_MCLKOUTPUT_DISABLE : I2S_MCLKOUTPUT_ENABLE); //Davide: Microphones need master clock disabled, while sound terminal needs it enabled.
Davide Aliprandi 2:0c9ce59aee25 356
Davide Aliprandi 2:0c9ce59aee25 357 DEBUG_PRINTF("--> %s\r\n", __FUNCTION__);
Davide Aliprandi 2:0c9ce59aee25 358 DEBUG_PRINTF(" I2S%u: Mode: %u (%u)\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 359 (unsigned int)handle->Init.Mode, (unsigned int)mode);
Davide Aliprandi 2:0c9ce59aee25 360 DEBUG_PRINTF(" I2S%u: Standard: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 361 (unsigned int)handle->Init.Standard);
Davide Aliprandi 2:0c9ce59aee25 362 DEBUG_PRINTF(" I2S%u: DataFormat: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 363 (unsigned int)handle->Init.DataFormat);
Davide Aliprandi 2:0c9ce59aee25 364 DEBUG_PRINTF(" I2S%u: CPOL: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 365 (unsigned int)handle->Init.CPOL);
Davide Aliprandi 2:0c9ce59aee25 366 DEBUG_PRINTF(" I2S%u: AudioFreq: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 367 (unsigned int)handle->Init.AudioFreq);
Davide Aliprandi 2:0c9ce59aee25 368 DEBUG_PRINTF(" I2S%u: ClockSource: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 369 (unsigned int)handle->Init.ClockSource);
Davide Aliprandi 2:0c9ce59aee25 370 DEBUG_PRINTF(" I2S%u: FullDuplexMode: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 371 (unsigned int)handle->Init.FullDuplexMode);
Davide Aliprandi 2:0c9ce59aee25 372 DEBUG_PRINTF(" I2S%u: MCLKOutput: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 373 (unsigned int)handle->Init.MCLKOutput);
Wolfgang Betz 1:f90318e0923b 374
Wolfgang Betz 1:f90318e0923b 375 // Save primary DMA direction
Wolfgang Betz 1:f90318e0923b 376 obj->dma.dma_direction = dma_direction;
Wolfgang Betz 1:f90318e0923b 377
Wolfgang Betz 1:f90318e0923b 378 init_i2s(obj);
Wolfgang Betz 1:f90318e0923b 379 }
Wolfgang Betz 1:f90318e0923b 380
Davide Aliprandi 2:0c9ce59aee25 381 void i2s_free(i2s_t *obj) {
Wolfgang Betz 1:f90318e0923b 382 // Reset I2S and disable clock
Wolfgang Betz 1:f90318e0923b 383 switch(obj->i2s.module) {
Wolfgang Betz 1:f90318e0923b 384 #if defined(I2S1ext_BASE)
Davide Aliprandi 2:0c9ce59aee25 385 case 0:
Davide Aliprandi 2:0c9ce59aee25 386 __SPI1_FORCE_RESET();
Davide Aliprandi 2:0c9ce59aee25 387 __SPI1_RELEASE_RESET();
Davide Aliprandi 2:0c9ce59aee25 388 __SPI1_CLK_DISABLE();
Davide Aliprandi 2:0c9ce59aee25 389 break;
Wolfgang Betz 1:f90318e0923b 390 #endif
Wolfgang Betz 1:f90318e0923b 391 #if defined(I2S2ext_BASE)
Davide Aliprandi 2:0c9ce59aee25 392 case 1:
Davide Aliprandi 2:0c9ce59aee25 393 __SPI2_FORCE_RESET();
Davide Aliprandi 2:0c9ce59aee25 394 __SPI2_RELEASE_RESET();
Davide Aliprandi 2:0c9ce59aee25 395 __SPI2_CLK_DISABLE();
Davide Aliprandi 2:0c9ce59aee25 396 break;
Wolfgang Betz 1:f90318e0923b 397 #endif
Wolfgang Betz 1:f90318e0923b 398 #if defined(I2S3ext_BASE)
Davide Aliprandi 2:0c9ce59aee25 399 case 2:
Davide Aliprandi 2:0c9ce59aee25 400 __SPI3_FORCE_RESET();
Davide Aliprandi 2:0c9ce59aee25 401 __SPI3_RELEASE_RESET();
Davide Aliprandi 2:0c9ce59aee25 402 __SPI3_CLK_DISABLE();
Davide Aliprandi 2:0c9ce59aee25 403 break;
Wolfgang Betz 1:f90318e0923b 404 #endif
Wolfgang Betz 1:f90318e0923b 405 #if defined(I2S4ext_BASE)
Davide Aliprandi 2:0c9ce59aee25 406 case 3:
Davide Aliprandi 2:0c9ce59aee25 407 __SPI4_FORCE_RESET();
Davide Aliprandi 2:0c9ce59aee25 408 __SPI4_RELEASE_RESET();
Davide Aliprandi 2:0c9ce59aee25 409 __SPI4_CLK_DISABLE();
Davide Aliprandi 2:0c9ce59aee25 410 break;
Wolfgang Betz 1:f90318e0923b 411 #endif
Wolfgang Betz 1:f90318e0923b 412 #if defined(I2S5ext_BASE)
Davide Aliprandi 2:0c9ce59aee25 413 case 4:
Davide Aliprandi 2:0c9ce59aee25 414 __SPI5_FORCE_RESET();
Davide Aliprandi 2:0c9ce59aee25 415 __SPI5_RELEASE_RESET();
Davide Aliprandi 2:0c9ce59aee25 416 __SPI5_CLK_DISABLE();
Davide Aliprandi 2:0c9ce59aee25 417 break;
Wolfgang Betz 1:f90318e0923b 418 #endif
Davide Aliprandi 2:0c9ce59aee25 419 default:
Davide Aliprandi 2:0c9ce59aee25 420 MBED_ASSERT(0);
Davide Aliprandi 2:0c9ce59aee25 421 break;
Wolfgang Betz 1:f90318e0923b 422 }
Wolfgang Betz 1:f90318e0923b 423
Wolfgang Betz 1:f90318e0923b 424 // betzw - TODO: what about 'PLLI2S'?!?
Wolfgang Betz 1:f90318e0923b 425 // for the moment we leave it enabled!
Wolfgang Betz 1:f90318e0923b 426
Wolfgang Betz 1:f90318e0923b 427 // Configure GPIOs
Wolfgang Betz 1:f90318e0923b 428 pin_function(obj->i2s.pin_wsel, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0));
Wolfgang Betz 1:f90318e0923b 429 pin_function(obj->i2s.pin_data, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0));
Wolfgang Betz 1:f90318e0923b 430 pin_function(obj->i2s.pin_sclk, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0));
Wolfgang Betz 1:f90318e0923b 431 pin_function(obj->i2s.pin_fdpx, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0));
Wolfgang Betz 1:f90318e0923b 432 pin_function(obj->i2s.pin_mclk, STM_PIN_DATA(STM_MODE_INPUT, GPIO_NOPULL, 0));
Wolfgang Betz 1:f90318e0923b 433
Davide Aliprandi 2:0c9ce59aee25 434 DEBUG_PRINTF("--> %s\r\n", __FUNCTION__);
Wolfgang Betz 1:f90318e0923b 435 }
Wolfgang Betz 1:f90318e0923b 436
Davide Aliprandi 2:0c9ce59aee25 437 void i2s_format(i2s_t *obj, int dbits, int fbits, int polarity) {
Wolfgang Betz 1:f90318e0923b 438 I2S_HandleTypeDef *handle = &I2sHandle[obj->i2s.module];
Wolfgang Betz 1:f90318e0923b 439
Wolfgang Betz 1:f90318e0923b 440 // Save new values
Davide Aliprandi 2:0c9ce59aee25 441 if (fbits == 16)
Davide Aliprandi 2:0c9ce59aee25 442 { // format MUST be 16B
Davide Aliprandi 2:0c9ce59aee25 443 handle->Init.DataFormat = I2S_DATAFORMAT_16B;
Wolfgang Betz 1:f90318e0923b 444 } else { // format may NOT be 16B
Davide Aliprandi 2:0c9ce59aee25 445 switch (dbits)
Davide Aliprandi 2:0c9ce59aee25 446 {
Davide Aliprandi 2:0c9ce59aee25 447 case 16:
Davide Aliprandi 2:0c9ce59aee25 448 handle->Init.DataFormat = I2S_DATAFORMAT_16B_EXTENDED;
Davide Aliprandi 2:0c9ce59aee25 449 break;
Davide Aliprandi 2:0c9ce59aee25 450 case 24:
Davide Aliprandi 2:0c9ce59aee25 451 handle->Init.DataFormat = I2S_DATAFORMAT_24B;
Davide Aliprandi 2:0c9ce59aee25 452 break;
Davide Aliprandi 2:0c9ce59aee25 453 case 32:
Davide Aliprandi 2:0c9ce59aee25 454 default:
Davide Aliprandi 2:0c9ce59aee25 455 handle->Init.DataFormat = I2S_DATAFORMAT_32B;
Davide Aliprandi 2:0c9ce59aee25 456 break;
Davide Aliprandi 2:0c9ce59aee25 457 }
Wolfgang Betz 1:f90318e0923b 458 }
Wolfgang Betz 1:f90318e0923b 459
Wolfgang Betz 1:f90318e0923b 460 handle->Init.CPOL = (polarity == 0) ? I2S_CPOL_LOW : I2S_CPOL_HIGH;
Wolfgang Betz 1:f90318e0923b 461
Davide Aliprandi 2:0c9ce59aee25 462 DEBUG_PRINTF("--> %s\r\n", __FUNCTION__);
Davide Aliprandi 2:0c9ce59aee25 463 DEBUG_PRINTF(" I2S%u: DataFormat: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 464 (unsigned int)handle->Init.DataFormat);
Davide Aliprandi 2:0c9ce59aee25 465 DEBUG_PRINTF(" I2S%u: CPOL: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 466 (unsigned int)handle->Init.CPOL);
Davide Aliprandi 2:0c9ce59aee25 467 DEBUG_PRINTF(" I2S%u: (dbits, fbits): (%u, %u)\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 468 (unsigned int)dbits, (unsigned int)fbits);
Davide Aliprandi 2:0c9ce59aee25 469 DEBUG_PRINTF(" I2S%u: Polarity: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 470 (unsigned int)polarity);
Wolfgang Betz 1:f90318e0923b 471
Wolfgang Betz 1:f90318e0923b 472 init_i2s(obj);
Wolfgang Betz 1:f90318e0923b 473 }
Wolfgang Betz 1:f90318e0923b 474
Davide Aliprandi 2:0c9ce59aee25 475 void i2s_set_mode(i2s_t *obj, i2s_mode_t mode) {
Wolfgang Betz 1:f90318e0923b 476 uint8_t dma_direction;
Wolfgang Betz 1:f90318e0923b 477 I2S_HandleTypeDef *handle = &I2sHandle[obj->i2s.module];
Wolfgang Betz 1:f90318e0923b 478
Wolfgang Betz 1:f90318e0923b 479 handle->Init.Mode = i2s_get_mode(mode, &dma_direction);
Wolfgang Betz 1:f90318e0923b 480
Wolfgang Betz 1:f90318e0923b 481 // Save primary DMA direction
Wolfgang Betz 1:f90318e0923b 482 obj->dma.dma_direction = dma_direction;
Wolfgang Betz 1:f90318e0923b 483
Davide Aliprandi 2:0c9ce59aee25 484 DEBUG_PRINTF("--> %s\r\n", __FUNCTION__);
Davide Aliprandi 2:0c9ce59aee25 485 DEBUG_PRINTF(" I2S%u: Mode: %u (%u)\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 486 (unsigned int)handle->Init.Mode, (unsigned int)mode);
Davide Aliprandi 2:0c9ce59aee25 487
Davide Aliprandi 2:0c9ce59aee25 488 init_i2s(obj);
Davide Aliprandi 2:0c9ce59aee25 489 }
Davide Aliprandi 2:0c9ce59aee25 490
Davide Aliprandi 2:0c9ce59aee25 491 void i2s_set_protocol(i2s_t *obj, i2s_bitorder_t protocol) {
Davide Aliprandi 2:0c9ce59aee25 492 I2S_HandleTypeDef *handle = &I2sHandle[obj->i2s.module];
Davide Aliprandi 2:0c9ce59aee25 493
Davide Aliprandi 2:0c9ce59aee25 494 switch (protocol)
Davide Aliprandi 2:0c9ce59aee25 495 {
Davide Aliprandi 2:0c9ce59aee25 496 case PHILIPS:
Davide Aliprandi 2:0c9ce59aee25 497 handle->Init.Standard = I2S_STANDARD_PHILIPS;
Davide Aliprandi 2:0c9ce59aee25 498 break;
Davide Aliprandi 2:0c9ce59aee25 499 case MSB:
Davide Aliprandi 2:0c9ce59aee25 500 handle->Init.Standard = I2S_STANDARD_MSB;
Davide Aliprandi 2:0c9ce59aee25 501 break;
Davide Aliprandi 2:0c9ce59aee25 502 case LSB:
Davide Aliprandi 2:0c9ce59aee25 503 handle->Init.Standard = I2S_STANDARD_LSB;
Davide Aliprandi 2:0c9ce59aee25 504 break;
Davide Aliprandi 2:0c9ce59aee25 505 case PCM_SHORT:
Davide Aliprandi 2:0c9ce59aee25 506 handle->Init.Standard = I2S_STANDARD_PCM_SHORT;
Davide Aliprandi 2:0c9ce59aee25 507 break;
Davide Aliprandi 2:0c9ce59aee25 508 case PCM_LONG:
Davide Aliprandi 2:0c9ce59aee25 509 default:
Davide Aliprandi 2:0c9ce59aee25 510 handle->Init.Standard = I2S_STANDARD_PCM_LONG;
Davide Aliprandi 2:0c9ce59aee25 511 break;
Davide Aliprandi 2:0c9ce59aee25 512 }
Davide Aliprandi 2:0c9ce59aee25 513
Davide Aliprandi 2:0c9ce59aee25 514 DEBUG_PRINTF("--> %s\r\n", __FUNCTION__);
Davide Aliprandi 2:0c9ce59aee25 515 DEBUG_PRINTF(" I2S%u: Standard: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 516 (unsigned int)handle->Init.Standard);
Wolfgang Betz 1:f90318e0923b 517
Wolfgang Betz 1:f90318e0923b 518 init_i2s(obj);
Wolfgang Betz 1:f90318e0923b 519 }
Wolfgang Betz 1:f90318e0923b 520
Davide Aliprandi 2:0c9ce59aee25 521 void i2s_audio_frequency(i2s_t *obj, uint32_t hz) {
Wolfgang Betz 1:f90318e0923b 522 I2S_HandleTypeDef *handle = &I2sHandle[obj->i2s.module];
Wolfgang Betz 1:f90318e0923b 523
Davide Aliprandi 2:0c9ce59aee25 524 if (IS_I2S_AUDIO_FREQ(hz) && (hz != I2S_AUDIOFREQ_DEFAULT)) {
Davide Aliprandi 2:0c9ce59aee25 525 handle->Init.AudioFreq = hz;
Davide Aliprandi 2:0c9ce59aee25 526 }
Davide Aliprandi 2:0c9ce59aee25 527 else if (hz < I2S_AUDIOFREQ_8K) {
Davide Aliprandi 2:0c9ce59aee25 528 handle->Init.AudioFreq = I2S_AUDIOFREQ_8K;
Davide Aliprandi 2:0c9ce59aee25 529 }
Davide Aliprandi 2:0c9ce59aee25 530 else {
Davide Aliprandi 2:0c9ce59aee25 531 handle->Init.AudioFreq = I2S_AUDIOFREQ_192K;
Wolfgang Betz 1:f90318e0923b 532 }
Wolfgang Betz 1:f90318e0923b 533
Davide Aliprandi 2:0c9ce59aee25 534 DEBUG_PRINTF("--> %s\r\n", __FUNCTION__);
Davide Aliprandi 2:0c9ce59aee25 535 DEBUG_PRINTF(" I2S%u: AudioFreq: %u\r\n", obj->i2s.module + 1,
Davide Aliprandi 2:0c9ce59aee25 536 (unsigned int)handle->Init.AudioFreq);
Wolfgang Betz 1:f90318e0923b 537
Wolfgang Betz 1:f90318e0923b 538 init_i2s(obj);
Wolfgang Betz 1:f90318e0923b 539 }
Wolfgang Betz 1:f90318e0923b 540
Davide Aliprandi 2:0c9ce59aee25 541 uint8_t i2s_get_module(i2s_t *obj) {
Wolfgang Betz 1:f90318e0923b 542 return obj->i2s.module;
Wolfgang Betz 1:f90318e0923b 543 }
Wolfgang Betz 1:f90318e0923b 544
Davide Aliprandi 2:0c9ce59aee25 545 static void i2s_start_asynch_transfer(i2s_t *obj, transfer_type_t transfer_type, void *tx, void *rx, int length) {
Wolfgang Betz 1:f90318e0923b 546 I2S_HandleTypeDef *handle = &I2sHandle[obj->i2s.module];
Wolfgang Betz 1:f90318e0923b 547 obj->i2s.transfer_type = transfer_type;
Wolfgang Betz 1:f90318e0923b 548
Wolfgang Betz 1:f90318e0923b 549 // the HAL expects number of transfers instead of number of bytes
Wolfgang Betz 1:f90318e0923b 550 int words;
Wolfgang Betz 1:f90318e0923b 551 switch(handle->Init.DataFormat) {
Davide Aliprandi 2:0c9ce59aee25 552 case I2S_DATAFORMAT_16B:
Davide Aliprandi 2:0c9ce59aee25 553 case I2S_DATAFORMAT_16B_EXTENDED:
Davide Aliprandi 2:0c9ce59aee25 554 words = length / 2;
Davide Aliprandi 2:0c9ce59aee25 555 if(words > 0xFFFC) words = 0xFFFC; // truncate in order to respect max DMA length
Davide Aliprandi 2:0c9ce59aee25 556 break;
Davide Aliprandi 2:0c9ce59aee25 557 case I2S_DATAFORMAT_24B:
Davide Aliprandi 2:0c9ce59aee25 558 case I2S_DATAFORMAT_32B:
Davide Aliprandi 2:0c9ce59aee25 559 default:
Davide Aliprandi 2:0c9ce59aee25 560 words = length / 4;
Davide Aliprandi 2:0c9ce59aee25 561 if(words > 0x7FFC) words = 0x7FFC; // truncate in order to respect max DMA length
Davide Aliprandi 2:0c9ce59aee25 562 break;
Wolfgang Betz 1:f90318e0923b 563 }
Wolfgang Betz 1:f90318e0923b 564
Wolfgang Betz 1:f90318e0923b 565 // enable the right hal transfer
Wolfgang Betz 1:f90318e0923b 566 int rc = 0;
Wolfgang Betz 1:f90318e0923b 567 switch(transfer_type) {
Davide Aliprandi 2:0c9ce59aee25 568 case I2S_TRANSFER_TYPE_TXRX:
Davide Aliprandi 2:0c9ce59aee25 569 // enable the interrupts
Davide Aliprandi 2:0c9ce59aee25 570 NVIC_EnableIRQ(obj->dma.dma[DMA_TX]->dma_stream_irq);
Davide Aliprandi 2:0c9ce59aee25 571 NVIC_EnableIRQ(obj->dma.dma[DMA_RX]->dma_stream_irq);
Davide Aliprandi 2:0c9ce59aee25 572 // trigger DMA transfers
Davide Aliprandi 2:0c9ce59aee25 573 rc = HAL_I2SEx_TransmitReceive_DMA(handle, (uint16_t*)tx, (uint16_t*)rx, (uint16_t)words);
Davide Aliprandi 2:0c9ce59aee25 574 break;
Davide Aliprandi 2:0c9ce59aee25 575 case I2S_TRANSFER_TYPE_TX:
Davide Aliprandi 2:0c9ce59aee25 576 // enable the interrupt
Davide Aliprandi 2:0c9ce59aee25 577 NVIC_EnableIRQ(obj->dma.dma[DMA_TX]->dma_stream_irq);
Davide Aliprandi 2:0c9ce59aee25 578 // trigger DMA transfer
Davide Aliprandi 2:0c9ce59aee25 579 rc = HAL_I2S_Transmit_DMA(handle, (uint16_t*)tx, (uint16_t)words);
Davide Aliprandi 2:0c9ce59aee25 580 break;
Davide Aliprandi 2:0c9ce59aee25 581 case I2S_TRANSFER_TYPE_RX:
Davide Aliprandi 2:0c9ce59aee25 582 // enable the interrupt
Davide Aliprandi 2:0c9ce59aee25 583 NVIC_EnableIRQ(obj->dma.dma[DMA_RX]->dma_stream_irq);
Davide Aliprandi 2:0c9ce59aee25 584 // trigger DMA transfer
Davide Aliprandi 2:0c9ce59aee25 585 rc = HAL_I2S_Receive_DMA(handle, (uint16_t*)rx, (uint16_t)words);
Davide Aliprandi 2:0c9ce59aee25 586 break;
Wolfgang Betz 1:f90318e0923b 587 }
Wolfgang Betz 1:f90318e0923b 588
Wolfgang Betz 1:f90318e0923b 589 if (rc) {
Davide Aliprandi 2:0c9ce59aee25 590 DEBUG_PRINTF(" I2S%u: RC: %d\r\n", obj->i2s.module + 1, rc);
Wolfgang Betz 1:f90318e0923b 591 }
Wolfgang Betz 1:f90318e0923b 592
Wolfgang Betz 1:f90318e0923b 593 return;
Wolfgang Betz 1:f90318e0923b 594 }
Wolfgang Betz 1:f90318e0923b 595
Wolfgang Betz 1:f90318e0923b 596 // asynchronous API
Wolfgang Betz 1:f90318e0923b 597 void i2s_transfer(i2s_t *obj,
Wolfgang Betz 1:f90318e0923b 598 void *tx, int tx_length,
Wolfgang Betz 1:f90318e0923b 599 void *rx, int rx_length,
Wolfgang Betz 1:f90318e0923b 600 bool circular, i2s_dma_prio_t prio,
Davide Aliprandi 2:0c9ce59aee25 601 uint32_t handler_tx, uint32_t handler_rx, uint32_t event) {
Wolfgang Betz 1:f90318e0923b 602 // check which use-case we have
Wolfgang Betz 1:f90318e0923b 603 bool use_tx = (tx != NULL && tx_length > 0);
Wolfgang Betz 1:f90318e0923b 604 bool use_rx = (rx != NULL && rx_length > 0);
Wolfgang Betz 1:f90318e0923b 605
Wolfgang Betz 1:f90318e0923b 606 // Init DMAs
Wolfgang Betz 1:f90318e0923b 607 dma_i2s_init(obj, &use_tx, &use_rx, circular, prio);
Wolfgang Betz 1:f90318e0923b 608
Wolfgang Betz 1:f90318e0923b 609 // don't do anything, if the buffers aren't valid
Wolfgang Betz 1:f90318e0923b 610 if (!use_tx && !use_rx)
Wolfgang Betz 1:f90318e0923b 611 return;
Wolfgang Betz 1:f90318e0923b 612
Wolfgang Betz 1:f90318e0923b 613 // copy the buffers to the I2S object
Wolfgang Betz 1:f90318e0923b 614 obj->tx_buff.buffer = tx;
Wolfgang Betz 1:f90318e0923b 615 obj->tx_buff.length = tx_length;
Wolfgang Betz 1:f90318e0923b 616 obj->tx_buff.pos = 0;
Wolfgang Betz 1:f90318e0923b 617 obj->tx_buff.width = 16;
Wolfgang Betz 1:f90318e0923b 618
Wolfgang Betz 1:f90318e0923b 619 obj->rx_buff.buffer = rx;
Wolfgang Betz 1:f90318e0923b 620 obj->rx_buff.length = rx_length;
Wolfgang Betz 1:f90318e0923b 621 obj->rx_buff.pos = 0;
Wolfgang Betz 1:f90318e0923b 622 obj->rx_buff.width = obj->tx_buff.width;
Wolfgang Betz 1:f90318e0923b 623
Wolfgang Betz 1:f90318e0923b 624 obj->i2s.event = event;
Wolfgang Betz 1:f90318e0923b 625
Davide Aliprandi 2:0c9ce59aee25 626 DEBUG_PRINTF(" I2S%u: Transfer: %u, %u\r\n", obj->i2s.module + 1, tx_length, rx_length);
Wolfgang Betz 1:f90318e0923b 627
Wolfgang Betz 1:f90318e0923b 628 // register the thunking handler
Davide Aliprandi 2:0c9ce59aee25 629 if (use_tx) {
Davide Aliprandi 2:0c9ce59aee25 630 NVIC_SetVector(obj->dma.dma[DMA_TX]->dma_stream_irq, handler_tx);
Wolfgang Betz 1:f90318e0923b 631 }
Davide Aliprandi 2:0c9ce59aee25 632 if (use_rx) {
Davide Aliprandi 2:0c9ce59aee25 633 NVIC_SetVector(obj->dma.dma[DMA_RX]->dma_stream_irq, handler_rx);
Wolfgang Betz 1:f90318e0923b 634 }
Wolfgang Betz 1:f90318e0923b 635
Wolfgang Betz 1:f90318e0923b 636 // enable the right hal transfer
Wolfgang Betz 1:f90318e0923b 637 if (use_tx && use_rx) {
Davide Aliprandi 2:0c9ce59aee25 638 int size = (tx_length < rx_length)? tx_length : rx_length;
Davide Aliprandi 2:0c9ce59aee25 639 i2s_start_asynch_transfer(obj, I2S_TRANSFER_TYPE_TXRX, tx, rx, size);
Wolfgang Betz 1:f90318e0923b 640 } else if (use_tx) {
Davide Aliprandi 2:0c9ce59aee25 641 i2s_start_asynch_transfer(obj, I2S_TRANSFER_TYPE_TX, tx, NULL, tx_length);
Wolfgang Betz 1:f90318e0923b 642 } else if (use_rx) {
Davide Aliprandi 2:0c9ce59aee25 643 i2s_start_asynch_transfer(obj, I2S_TRANSFER_TYPE_RX, NULL, rx, rx_length);
Wolfgang Betz 1:f90318e0923b 644 }
Wolfgang Betz 1:f90318e0923b 645 }
Wolfgang Betz 1:f90318e0923b 646
Davide Aliprandi 2:0c9ce59aee25 647 uint32_t i2s_irq_handler_asynch(i2s_t *obj, uint8_t direction) {
Wolfgang Betz 1:f90318e0923b 648 direction = (direction == I2S_TX_EVENT) ? DMA_TX : DMA_RX;
Wolfgang Betz 1:f90318e0923b 649
Wolfgang Betz 1:f90318e0923b 650 // use the right instance
Wolfgang Betz 1:f90318e0923b 651 I2S_HandleTypeDef *i2s_handle = &I2sHandle[obj->i2s.module];
Wolfgang Betz 1:f90318e0923b 652 DMA_HandleTypeDef *dma_handle = (direction == DMA_TX) ? i2s_handle->hdmatx : i2s_handle->hdmarx;
Wolfgang Betz 1:f90318e0923b 653
Wolfgang Betz 1:f90318e0923b 654 MBED_ASSERT(dma_handle != NULL);
Wolfgang Betz 1:f90318e0923b 655
Wolfgang Betz 1:f90318e0923b 656 int event = 0;
Wolfgang Betz 1:f90318e0923b 657
Wolfgang Betz 1:f90318e0923b 658 // call the Cube handler, this will update the handle
Wolfgang Betz 1:f90318e0923b 659 HAL_DMA_IRQHandler(dma_handle);
Wolfgang Betz 1:f90318e0923b 660
Davide Aliprandi 2:0c9ce59aee25 661 switch(HAL_I2S_GetState(i2s_handle))
Davide Aliprandi 2:0c9ce59aee25 662 {
Davide Aliprandi 2:0c9ce59aee25 663 case HAL_I2S_STATE_READY: {
Davide Aliprandi 2:0c9ce59aee25 664 // adjust buffer positions (betzw - TODO: to be checked for DMA transfers!!!)
Davide Aliprandi 2:0c9ce59aee25 665 int tx_size = (i2s_handle->TxXferSize - i2s_handle->TxXferCount);
Davide Aliprandi 2:0c9ce59aee25 666 int rx_size = (i2s_handle->RxXferSize - i2s_handle->RxXferCount);
Wolfgang Betz 1:f90318e0923b 667
Davide Aliprandi 2:0c9ce59aee25 668 // take data format into consideration
Davide Aliprandi 2:0c9ce59aee25 669 switch(i2s_handle->Init.DataFormat)
Davide Aliprandi 2:0c9ce59aee25 670 {
Davide Aliprandi 2:0c9ce59aee25 671 case I2S_DATAFORMAT_16B:
Davide Aliprandi 2:0c9ce59aee25 672 case I2S_DATAFORMAT_16B_EXTENDED:
Davide Aliprandi 2:0c9ce59aee25 673 tx_size *= 2;
Davide Aliprandi 2:0c9ce59aee25 674 rx_size *= 2;
Davide Aliprandi 2:0c9ce59aee25 675 break;
Davide Aliprandi 2:0c9ce59aee25 676 case I2S_DATAFORMAT_24B:
Davide Aliprandi 2:0c9ce59aee25 677 case I2S_DATAFORMAT_32B:
Davide Aliprandi 2:0c9ce59aee25 678 default:
Davide Aliprandi 2:0c9ce59aee25 679 tx_size *= 4;
Davide Aliprandi 2:0c9ce59aee25 680 rx_size *= 4;
Davide Aliprandi 2:0c9ce59aee25 681 break;
Davide Aliprandi 2:0c9ce59aee25 682 }
Wolfgang Betz 1:f90318e0923b 683
Davide Aliprandi 2:0c9ce59aee25 684 // adjust buffer positions
Davide Aliprandi 2:0c9ce59aee25 685 if (obj->i2s.transfer_type != I2S_TRANSFER_TYPE_RX) {
Davide Aliprandi 2:0c9ce59aee25 686 obj->tx_buff.pos += tx_size;
Davide Aliprandi 2:0c9ce59aee25 687 }
Davide Aliprandi 2:0c9ce59aee25 688 if (obj->i2s.transfer_type != I2S_TRANSFER_TYPE_TX) {
Davide Aliprandi 2:0c9ce59aee25 689 obj->rx_buff.pos += rx_size;
Davide Aliprandi 2:0c9ce59aee25 690 }
Wolfgang Betz 1:f90318e0923b 691
Davide Aliprandi 2:0c9ce59aee25 692 if (i2s_handle->TxXferCount > 0) {
Davide Aliprandi 2:0c9ce59aee25 693 DEBUG_PRINTF(" I2S%u: TxXferCount: %u\r\n", obj->i2s.module + 1, i2s_handle->TxXferCount);
Davide Aliprandi 2:0c9ce59aee25 694 }
Davide Aliprandi 2:0c9ce59aee25 695 if (i2s_handle->RxXferCount > 0) {
Davide Aliprandi 2:0c9ce59aee25 696 DEBUG_PRINTF(" I2S%u: RxXferCount: %u\r\n", obj->i2s.module + 1, i2s_handle->RxXferCount);
Davide Aliprandi 2:0c9ce59aee25 697 }
Davide Aliprandi 2:0c9ce59aee25 698 }
Davide Aliprandi 2:0c9ce59aee25 699 /* no break */
Wolfgang Betz 1:f90318e0923b 700
Davide Aliprandi 2:0c9ce59aee25 701 case HAL_I2S_STATE_BUSY_TX:
Davide Aliprandi 2:0c9ce59aee25 702 case HAL_I2S_STATE_BUSY_RX:
Davide Aliprandi 2:0c9ce59aee25 703 case HAL_I2S_STATE_BUSY_TX_RX:
Davide Aliprandi 2:0c9ce59aee25 704 {
Davide Aliprandi 2:0c9ce59aee25 705 int error = HAL_I2S_GetError(i2s_handle);
Wolfgang Betz 1:f90318e0923b 706
Davide Aliprandi 2:0c9ce59aee25 707 if (error != HAL_I2S_ERROR_NONE) {
Davide Aliprandi 2:0c9ce59aee25 708 // something went wrong and the transfer has definitely completed
Davide Aliprandi 2:0c9ce59aee25 709 event = ((direction == DMA_TX) ? I2S_EVENT_TX_ERROR : I2S_EVENT_RX_ERROR) | I2S_EVENT_INTERNAL_TRANSFER_COMPLETE;
Wolfgang Betz 1:f90318e0923b 710
Davide Aliprandi 2:0c9ce59aee25 711 if (error & HAL_I2S_ERROR_OVR) {
Davide Aliprandi 2:0c9ce59aee25 712 // buffer overrun
Davide Aliprandi 2:0c9ce59aee25 713 event |= I2S_EVENT_RX_OVERFLOW;
Davide Aliprandi 2:0c9ce59aee25 714 }
Wolfgang Betz 1:f90318e0923b 715
Davide Aliprandi 2:0c9ce59aee25 716 if (error & HAL_I2S_ERROR_UDR) {
Davide Aliprandi 2:0c9ce59aee25 717 // buffer underrun
Davide Aliprandi 2:0c9ce59aee25 718 event |= I2S_EVENT_TX_UNDERRUN;
Davide Aliprandi 2:0c9ce59aee25 719 }
Wolfgang Betz 1:f90318e0923b 720
Davide Aliprandi 2:0c9ce59aee25 721 // cleanup DMA (after error)
Davide Aliprandi 2:0c9ce59aee25 722 dma_i2s_free(obj, direction);
Davide Aliprandi 2:0c9ce59aee25 723 } else
Davide Aliprandi 2:0c9ce59aee25 724 { // no error detected
Davide Aliprandi 2:0c9ce59aee25 725 HAL_DMA_StateTypeDef dma_state = HAL_DMA_GetState(dma_handle);
Wolfgang Betz 1:f90318e0923b 726
Davide Aliprandi 2:0c9ce59aee25 727 switch(dma_state)
Davide Aliprandi 2:0c9ce59aee25 728 {
Davide Aliprandi 2:0c9ce59aee25 729 case HAL_DMA_STATE_READY_HALF_MEM0:
Davide Aliprandi 2:0c9ce59aee25 730 case HAL_DMA_STATE_READY_HALF_MEM1:
Davide Aliprandi 2:0c9ce59aee25 731 event = ((direction == DMA_TX) ? I2S_EVENT_TX_HALF_COMPLETE : I2S_EVENT_RX_HALF_COMPLETE);
Davide Aliprandi 2:0c9ce59aee25 732 break;
Davide Aliprandi 2:0c9ce59aee25 733 case HAL_DMA_STATE_READY_MEM0:
Davide Aliprandi 2:0c9ce59aee25 734 case HAL_DMA_STATE_READY_MEM1:
Davide Aliprandi 2:0c9ce59aee25 735 event = ((direction == DMA_TX) ? I2S_EVENT_TX_COMPLETE : I2S_EVENT_RX_COMPLETE);
Davide Aliprandi 2:0c9ce59aee25 736 if(dma_handle->Init.Mode != DMA_CIRCULAR)
Davide Aliprandi 2:0c9ce59aee25 737 {
Davide Aliprandi 2:0c9ce59aee25 738 if (!i2s_active(obj))
Davide Aliprandi 2:0c9ce59aee25 739 { // Check for full-duplex transfer complete!
Davide Aliprandi 2:0c9ce59aee25 740 event |= I2S_EVENT_INTERNAL_TRANSFER_COMPLETE;
Davide Aliprandi 2:0c9ce59aee25 741 }
Wolfgang Betz 1:f90318e0923b 742
Davide Aliprandi 2:0c9ce59aee25 743 // cleanup DMA (because we are done)
Davide Aliprandi 2:0c9ce59aee25 744 dma_i2s_free(obj, direction);
Davide Aliprandi 2:0c9ce59aee25 745 }
Davide Aliprandi 2:0c9ce59aee25 746 break;
Davide Aliprandi 2:0c9ce59aee25 747 default:
Davide Aliprandi 2:0c9ce59aee25 748 printf("betzw(%s, %d): dma_state=0x%x\r\n", __func__, __LINE__, (int)dma_state);
Davide Aliprandi 2:0c9ce59aee25 749 MBED_ASSERT(0);
Davide Aliprandi 2:0c9ce59aee25 750 break;
Davide Aliprandi 2:0c9ce59aee25 751 }
Davide Aliprandi 2:0c9ce59aee25 752 }
Davide Aliprandi 2:0c9ce59aee25 753 }
Davide Aliprandi 2:0c9ce59aee25 754 break;
Wolfgang Betz 1:f90318e0923b 755 default:
Davide Aliprandi 2:0c9ce59aee25 756 // nothing to do?!?
Davide Aliprandi 2:0c9ce59aee25 757 break;
Wolfgang Betz 1:f90318e0923b 758 }
Wolfgang Betz 1:f90318e0923b 759
Davide Aliprandi 2:0c9ce59aee25 760 if (event) DEBUG_PRINTF(" I2S%u: Event: 0x%x\r\n", obj->i2s.module + 1, event);
Wolfgang Betz 1:f90318e0923b 761
Wolfgang Betz 1:f90318e0923b 762 return (event & (obj->i2s.event | I2S_EVENT_INTERNAL_TRANSFER_COMPLETE));
Wolfgang Betz 1:f90318e0923b 763 }
Wolfgang Betz 1:f90318e0923b 764
Davide Aliprandi 2:0c9ce59aee25 765 uint8_t i2s_active(i2s_t *obj) {
Wolfgang Betz 1:f90318e0923b 766 I2S_HandleTypeDef *handle = &I2sHandle[obj->i2s.module];
Wolfgang Betz 1:f90318e0923b 767 HAL_I2S_StateTypeDef state = HAL_I2S_GetState(handle);
Wolfgang Betz 1:f90318e0923b 768
Davide Aliprandi 2:0c9ce59aee25 769 switch(state){
Davide Aliprandi 2:0c9ce59aee25 770 case HAL_I2S_STATE_RESET:
Davide Aliprandi 2:0c9ce59aee25 771 case HAL_I2S_STATE_READY:
Davide Aliprandi 2:0c9ce59aee25 772 case HAL_I2S_STATE_ERROR:
Davide Aliprandi 2:0c9ce59aee25 773 return 0;
Davide Aliprandi 2:0c9ce59aee25 774 default:
Davide Aliprandi 2:0c9ce59aee25 775 return -1;
Wolfgang Betz 1:f90318e0923b 776 }
Wolfgang Betz 1:f90318e0923b 777 }
Wolfgang Betz 1:f90318e0923b 778
Davide Aliprandi 2:0c9ce59aee25 779 void i2s_abort_asynch(i2s_t *obj) {
Wolfgang Betz 1:f90318e0923b 780 I2S_HandleTypeDef *i2s_handle = &I2sHandle[obj->i2s.module];
Wolfgang Betz 1:f90318e0923b 781
Wolfgang Betz 1:f90318e0923b 782 // Stop transfer
Wolfgang Betz 1:f90318e0923b 783 HAL_I2S_DMAStop(i2s_handle);
Wolfgang Betz 1:f90318e0923b 784
Wolfgang Betz 1:f90318e0923b 785 if(obj->dma.dma[DMA_TX] != NULL) {
Davide Aliprandi 2:0c9ce59aee25 786 DMA_HandleTypeDef *dma_handle_tx = &DMaHandles[obj->i2s.module][DMA_TX];
Wolfgang Betz 1:f90318e0923b 787
Davide Aliprandi 2:0c9ce59aee25 788 // disable interrupt & free resource
Davide Aliprandi 2:0c9ce59aee25 789 dma_i2s_free(obj, DMA_TX);
Davide Aliprandi 2:0c9ce59aee25 790
Davide Aliprandi 2:0c9ce59aee25 791 //clean up
Davide Aliprandi 2:0c9ce59aee25 792 __HAL_DMA_DISABLE(dma_handle_tx);
Davide Aliprandi 2:0c9ce59aee25 793 HAL_DMA_DeInit(dma_handle_tx);
Davide Aliprandi 2:0c9ce59aee25 794 HAL_DMA_Init(dma_handle_tx);
Davide Aliprandi 2:0c9ce59aee25 795 __HAL_DMA_ENABLE(dma_handle_tx);
Wolfgang Betz 1:f90318e0923b 796 }
Wolfgang Betz 1:f90318e0923b 797 if(obj->dma.dma[DMA_RX] != NULL) {
Davide Aliprandi 2:0c9ce59aee25 798 DMA_HandleTypeDef *dma_handle_rx = &DMaHandles[obj->i2s.module][DMA_RX];
Wolfgang Betz 1:f90318e0923b 799
Davide Aliprandi 2:0c9ce59aee25 800 // disable interrupt & free resource
Davide Aliprandi 2:0c9ce59aee25 801 dma_i2s_free(obj, DMA_RX);
Wolfgang Betz 1:f90318e0923b 802
Davide Aliprandi 2:0c9ce59aee25 803 //clean up
Davide Aliprandi 2:0c9ce59aee25 804 __HAL_DMA_DISABLE(dma_handle_rx);
Davide Aliprandi 2:0c9ce59aee25 805 HAL_DMA_DeInit(dma_handle_rx);
Davide Aliprandi 2:0c9ce59aee25 806 HAL_DMA_Init(dma_handle_rx);
Davide Aliprandi 2:0c9ce59aee25 807 __HAL_DMA_ENABLE(dma_handle_rx);
Wolfgang Betz 1:f90318e0923b 808 }
Wolfgang Betz 1:f90318e0923b 809
Wolfgang Betz 1:f90318e0923b 810 // clean-up I2S
Wolfgang Betz 1:f90318e0923b 811 __HAL_I2S_DISABLE(i2s_handle);
Wolfgang Betz 1:f90318e0923b 812 HAL_I2S_DeInit(i2s_handle);
Wolfgang Betz 1:f90318e0923b 813 HAL_I2S_Init(i2s_handle);
Wolfgang Betz 1:f90318e0923b 814 __HAL_I2S_ENABLE(i2s_handle);
Wolfgang Betz 1:f90318e0923b 815 }
Wolfgang Betz 1:f90318e0923b 816
Wolfgang Betz 1:f90318e0923b 817 #endif