Final version.
Fork of F746_SAI_IO by
SAI_InOut.cpp@12:4ceb45cb8161, 2017-08-16 (annotated)
- Committer:
- mladjo1993
- Date:
- Wed Aug 16 10:05:53 2017 +0000
- Revision:
- 12:4ceb45cb8161
- Parent:
- 10:eb439bbba0f2
- Child:
- 13:2757dd069581
Comments changed to english.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
mladjo1993 | 12:4ceb45cb8161 | 1 | /******************************************************** |
mladjo1993 | 12:4ceb45cb8161 | 2 | * SaiIO class |
mladjo1993 | 12:4ceb45cb8161 | 3 | * |
mladjo1993 | 12:4ceb45cb8161 | 4 | * Mladen Adamovic, 3326/2016 |
mladjo1993 | 12:4ceb45cb8161 | 5 | ********************************************************/ |
MikamiUitOpen | 0:eade5d3ae0eb | 6 | |
MikamiUitOpen | 0:eade5d3ae0eb | 7 | #include "SAI_InOut.hpp" |
MikamiUitOpen | 0:eade5d3ae0eb | 8 | |
MikamiUitOpen | 0:eade5d3ae0eb | 9 | namespace Mikami |
MikamiUitOpen | 0:eade5d3ae0eb | 10 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 11 | // Constructor |
MikamiUitOpen | 0:eade5d3ae0eb | 12 | SaiIO::SaiIO(InOutBoth ioBoth, int size, int fs, |
MikamiUitOpen | 0:eade5d3ae0eb | 13 | uint16_t inputDevice) |
MikamiUitOpen | 0:eade5d3ae0eb | 14 | : FS_(fs), IOBOTH_(ioBoth) |
MikamiUitOpen | 0:eade5d3ae0eb | 15 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 16 | nData_ = size; |
MikamiUitOpen | 0:eade5d3ae0eb | 17 | bufferSize_ = (size*2)*2; |
MikamiUitOpen | 0:eade5d3ae0eb | 18 | |
MikamiUitOpen | 0:eade5d3ae0eb | 19 | if (ioBoth != OUTPUT) |
MikamiUitOpen | 0:eade5d3ae0eb | 20 | { |
MikamiUitOpen | 5:20cc265d7aec | 21 | inBuffer_.SetSize((size*2)*2); |
MikamiUitOpen | 0:eade5d3ae0eb | 22 | inOffset_ = 0; |
MikamiUitOpen | 0:eade5d3ae0eb | 23 | captured_ = false; |
MikamiUitOpen | 0:eade5d3ae0eb | 24 | } |
MikamiUitOpen | 2:1aef7b703249 | 25 | if (ioBoth != INPUT) |
MikamiUitOpen | 2:1aef7b703249 | 26 | { |
MikamiUitOpen | 5:20cc265d7aec | 27 | outBuffer_.SetSize((size*2)*2); |
MikamiUitOpen | 5:20cc265d7aec | 28 | tmp_.SetSize(size*2); |
MikamiUitOpen | 2:1aef7b703249 | 29 | tmpIndex_ = 0; |
MikamiUitOpen | 2:1aef7b703249 | 30 | xferred_ = false; |
MikamiUitOpen | 2:1aef7b703249 | 31 | ClearBuffer(); |
MikamiUitOpen | 2:1aef7b703249 | 32 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 33 | InitCodec(inputDevice); |
MikamiUitOpen | 0:eade5d3ae0eb | 34 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 35 | |
MikamiUitOpen | 2:1aef7b703249 | 36 | // Input start |
MikamiUitOpen | 2:1aef7b703249 | 37 | void SaiIO::RecordIn() |
MikamiUitOpen | 0:eade5d3ae0eb | 38 | { |
MikamiUitOpen | 10:eb439bbba0f2 | 39 | if (BSP_AUDIO_IN_Record(inBuffer_, bufferSize_) == AUDIO_ERROR) |
MikamiUitOpen | 2:1aef7b703249 | 40 | ErrorTrap(); |
MikamiUitOpen | 0:eade5d3ae0eb | 41 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 42 | |
MikamiUitOpen | 0:eade5d3ae0eb | 43 | // Switching input device and run |
MikamiUitOpen | 0:eade5d3ae0eb | 44 | void SaiIO::SwitchInputDevice(int sw) |
MikamiUitOpen | 0:eade5d3ae0eb | 45 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 46 | uint16_t dev = (sw == 0) ? |
MikamiUitOpen | 0:eade5d3ae0eb | 47 | INPUT_DEVICE_DIGITAL_MICROPHONE_2 |
MikamiUitOpen | 0:eade5d3ae0eb | 48 | : INPUT_DEVICE_INPUT_LINE_1; |
MikamiUitOpen | 3:3bfdd8be834f | 49 | InitInput(dev); |
MikamiUitOpen | 3:3bfdd8be834f | 50 | ClearBuffer(); |
MikamiUitOpen | 3:3bfdd8be834f | 51 | RecordIn(); |
MikamiUitOpen | 3:3bfdd8be834f | 52 | if (IOBOTH_ == BOTH) PlayOut(); |
MikamiUitOpen | 0:eade5d3ae0eb | 53 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 54 | |
MikamiUitOpen | 0:eade5d3ae0eb | 55 | // If captured, return true |
MikamiUitOpen | 0:eade5d3ae0eb | 56 | bool SaiIO::IsCaptured() |
MikamiUitOpen | 0:eade5d3ae0eb | 57 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 58 | if (!captured_) return false; |
MikamiUitOpen | 0:eade5d3ae0eb | 59 | |
MikamiUitOpen | 0:eade5d3ae0eb | 60 | inIndex_ = inOffset_; |
MikamiUitOpen | 9:25a9655d6a0e | 61 | captured_ = false; |
MikamiUitOpen | 0:eade5d3ae0eb | 62 | return true; |
MikamiUitOpen | 0:eade5d3ae0eb | 63 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 64 | |
MikamiUitOpen | 1:48ed86c8430a | 65 | void SaiIO::PlayOut() |
MikamiUitOpen | 1:48ed86c8430a | 66 | { |
MikamiUitOpen | 2:1aef7b703249 | 67 | ClearBuffer(); |
MikamiUitOpen | 4:2170289dfe94 | 68 | BSP_AUDIO_OUT_SetAudioFrameSlot(CODEC_AUDIOFRAME_SLOT_02); |
MikamiUitOpen | 10:eb439bbba0f2 | 69 | if (BSP_AUDIO_OUT_Play(outBuffer_, bufferSize_*AUDIODATA_SIZE) |
MikamiUitOpen | 10:eb439bbba0f2 | 70 | == AUDIO_ERROR) |
MikamiUitOpen | 1:48ed86c8430a | 71 | ErrorTrap(); |
MikamiUitOpen | 1:48ed86c8430a | 72 | } |
MikamiUitOpen | 1:48ed86c8430a | 73 | |
MikamiUitOpen | 5:20cc265d7aec | 74 | // Return true if transfer completion to output |
MikamiUitOpen | 0:eade5d3ae0eb | 75 | bool SaiIO::IsXferred() |
MikamiUitOpen | 0:eade5d3ae0eb | 76 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 77 | if (!xferred_) return false; |
MikamiUitOpen | 0:eade5d3ae0eb | 78 | |
MikamiUitOpen | 0:eade5d3ae0eb | 79 | tmpIndex_ = 0; |
MikamiUitOpen | 9:25a9655d6a0e | 80 | xferred_ = false; |
MikamiUitOpen | 0:eade5d3ae0eb | 81 | return true; |
MikamiUitOpen | 0:eade5d3ae0eb | 82 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 83 | |
MikamiUitOpen | 0:eade5d3ae0eb | 84 | void SaiIO::Output(int16_t xL, int16_t xR) |
MikamiUitOpen | 0:eade5d3ae0eb | 85 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 86 | tmp_[tmpIndex_++] = xL; // Left |
MikamiUitOpen | 0:eade5d3ae0eb | 87 | tmp_[tmpIndex_++] = xR; // Right |
MikamiUitOpen | 0:eade5d3ae0eb | 88 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 89 | |
MikamiUitOpen | 0:eade5d3ae0eb | 90 | void SaiIO::ErrorTrap() |
MikamiUitOpen | 0:eade5d3ae0eb | 91 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 92 | DigitalOut led1(LED1); |
MikamiUitOpen | 0:eade5d3ae0eb | 93 | fprintf(stderr, "\r\n#### ERROR ####\r\n"); |
MikamiUitOpen | 0:eade5d3ae0eb | 94 | while(true) |
MikamiUitOpen | 0:eade5d3ae0eb | 95 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 96 | led1 = !led1; |
MikamiUitOpen | 0:eade5d3ae0eb | 97 | wait_ms(250); |
MikamiUitOpen | 0:eade5d3ae0eb | 98 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 99 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 100 | |
MikamiUitOpen | 0:eade5d3ae0eb | 101 | // Initialize audio input and output |
MikamiUitOpen | 0:eade5d3ae0eb | 102 | void SaiIO::InitCodec(uint16_t inputDevice) |
MikamiUitOpen | 0:eade5d3ae0eb | 103 | { |
MikamiUitOpen | 3:3bfdd8be834f | 104 | if (inputDevice != 0) InitInput(inputDevice); |
MikamiUitOpen | 3:3bfdd8be834f | 105 | |
MikamiUitOpen | 3:3bfdd8be834f | 106 | if (IOBOTH_ == OUTPUT) |
MikamiUitOpen | 3:3bfdd8be834f | 107 | if (BSP_AUDIO_OUT_Init(OUTPUT_DEVICE_HEADPHONE, |
MikamiUitOpen | 8:9893f8e53b07 | 108 | 100, FS_) == AUDIO_ERROR) |
MikamiUitOpen | 3:3bfdd8be834f | 109 | ErrorTrap(); |
MikamiUitOpen | 3:3bfdd8be834f | 110 | |
MikamiUitOpen | 3:3bfdd8be834f | 111 | if (IOBOTH_ != OUTPUT) SetInput(); |
MikamiUitOpen | 3:3bfdd8be834f | 112 | if (IOBOTH_ != INPUT) SetOutput(); |
MikamiUitOpen | 3:3bfdd8be834f | 113 | } |
MikamiUitOpen | 3:3bfdd8be834f | 114 | |
MikamiUitOpen | 3:3bfdd8be834f | 115 | void SaiIO::InitInput(uint16_t inputDevice) |
MikamiUitOpen | 3:3bfdd8be834f | 116 | { |
MikamiUitOpen | 3:3bfdd8be834f | 117 | int audioInVolume = (inputDevice == INPUT_DEVICE_INPUT_LINE_1) ? |
MikamiUitOpen | 7:60c57b2dc83e | 118 | 70 : 90; |
MikamiUitOpen | 5:20cc265d7aec | 119 | InputFp = (inputDevice == INPUT_DEVICE_INPUT_LINE_1) ? |
MikamiUitOpen | 5:20cc265d7aec | 120 | &SaiIO::InputNormal : &SaiIO::InputReversal; |
MikamiUitOpen | 0:eade5d3ae0eb | 121 | |
MikamiUitOpen | 0:eade5d3ae0eb | 122 | if (IOBOTH_ == BOTH) |
MikamiUitOpen | 5:20cc265d7aec | 123 | if (BSP_AUDIO_IN_OUT_Init(inputDevice, OUTPUT_DEVICE_HEADPHONE, |
MikamiUitOpen | 5:20cc265d7aec | 124 | audioInVolume, FS_) == AUDIO_ERROR) |
MikamiUitOpen | 0:eade5d3ae0eb | 125 | ErrorTrap(); |
MikamiUitOpen | 0:eade5d3ae0eb | 126 | |
MikamiUitOpen | 0:eade5d3ae0eb | 127 | if (IOBOTH_ == INPUT) |
MikamiUitOpen | 0:eade5d3ae0eb | 128 | if (BSP_AUDIO_IN_Init(inputDevice, |
MikamiUitOpen | 0:eade5d3ae0eb | 129 | audioInVolume, FS_) == AUDIO_ERROR) |
MikamiUitOpen | 0:eade5d3ae0eb | 130 | ErrorTrap(); |
MikamiUitOpen | 0:eade5d3ae0eb | 131 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 132 | |
MikamiUitOpen | 3:3bfdd8be834f | 133 | void SaiIO::SetInput() |
MikamiUitOpen | 0:eade5d3ae0eb | 134 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 135 | NVIC_SetVector(AUDIO_IN_SAIx_DMAx_IRQ, |
MikamiUitOpen | 0:eade5d3ae0eb | 136 | (uint32_t)AUDIO_IN_SAIx_DMAx_IRQHandler); |
MikamiUitOpen | 0:eade5d3ae0eb | 137 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 138 | |
MikamiUitOpen | 3:3bfdd8be834f | 139 | void SaiIO::SetOutput() |
MikamiUitOpen | 0:eade5d3ae0eb | 140 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 141 | NVIC_SetVector(AUDIO_OUT_SAIx_DMAx_IRQ, |
MikamiUitOpen | 0:eade5d3ae0eb | 142 | (uint32_t)AUDIO_OUT_SAIx_DMAx_IRQHandler); |
MikamiUitOpen | 0:eade5d3ae0eb | 143 | BSP_AUDIO_OUT_SetAudioFrameSlot(CODEC_AUDIOFRAME_SLOT_02); |
MikamiUitOpen | 0:eade5d3ae0eb | 144 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 145 | |
MikamiUitOpen | 0:eade5d3ae0eb | 146 | void SaiIO::ClearBuffer() |
MikamiUitOpen | 0:eade5d3ae0eb | 147 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 148 | if (IOBOTH_ != OUTPUT) |
MikamiUitOpen | 0:eade5d3ae0eb | 149 | for (int n=0; n<bufferSize_; n++) inBuffer_[n] = 0; |
MikamiUitOpen | 0:eade5d3ae0eb | 150 | for (int n=0; n<bufferSize_; n++) outBuffer_[n] = 0; |
MikamiUitOpen | 0:eade5d3ae0eb | 151 | for (int n=0; n<nData_*2; n++) tmp_[n] = 0; |
MikamiUitOpen | 0:eade5d3ae0eb | 152 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 153 | |
MikamiUitOpen | 5:20cc265d7aec | 154 | // For line input |
MikamiUitOpen | 5:20cc265d7aec | 155 | void SaiIO::InputNormal(int16_t &xL, int16_t &xR) |
MikamiUitOpen | 5:20cc265d7aec | 156 | { |
MikamiUitOpen | 5:20cc265d7aec | 157 | xL = inBuffer_[inIndex_++]; |
MikamiUitOpen | 5:20cc265d7aec | 158 | xR = inBuffer_[inIndex_++]; |
MikamiUitOpen | 5:20cc265d7aec | 159 | } |
MikamiUitOpen | 5:20cc265d7aec | 160 | |
MikamiUitOpen | 5:20cc265d7aec | 161 | // For MEMS microphone input |
MikamiUitOpen | 5:20cc265d7aec | 162 | void SaiIO::InputReversal(int16_t &xL, int16_t &xR) |
MikamiUitOpen | 5:20cc265d7aec | 163 | { |
MikamiUitOpen | 5:20cc265d7aec | 164 | xR = inBuffer_[inIndex_++]; |
MikamiUitOpen | 5:20cc265d7aec | 165 | xL = inBuffer_[inIndex_++]; |
MikamiUitOpen | 5:20cc265d7aec | 166 | } |
MikamiUitOpen | 5:20cc265d7aec | 167 | |
MikamiUitOpen | 0:eade5d3ae0eb | 168 | void SaiIO::Captured(int32_t offset) |
MikamiUitOpen | 0:eade5d3ae0eb | 169 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 170 | captured_ = true; |
MikamiUitOpen | 0:eade5d3ae0eb | 171 | inOffset_ = offset; |
MikamiUitOpen | 0:eade5d3ae0eb | 172 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 173 | |
MikamiUitOpen | 0:eade5d3ae0eb | 174 | void SaiIO::FillBuffer(uint32_t offset) |
MikamiUitOpen | 0:eade5d3ae0eb | 175 | { |
MikamiUitOpen | 0:eade5d3ae0eb | 176 | int k = offset; |
MikamiUitOpen | 0:eade5d3ae0eb | 177 | for (int n=0; n<nData_*2; n++) |
MikamiUitOpen | 0:eade5d3ae0eb | 178 | outBuffer_[k++] = tmp_[n]; |
MikamiUitOpen | 0:eade5d3ae0eb | 179 | xferred_ = true; |
MikamiUitOpen | 0:eade5d3ae0eb | 180 | } |
MikamiUitOpen | 0:eade5d3ae0eb | 181 | |
MikamiUitOpen | 0:eade5d3ae0eb | 182 | int32_t SaiIO::nData_; |
MikamiUitOpen | 0:eade5d3ae0eb | 183 | int32_t SaiIO::bufferSize_; |
MikamiUitOpen | 0:eade5d3ae0eb | 184 | |
MikamiUitOpen | 0:eade5d3ae0eb | 185 | __IO bool SaiIO::captured_; |
MikamiUitOpen | 0:eade5d3ae0eb | 186 | __IO int32_t SaiIO::inOffset_; |
MikamiUitOpen | 0:eade5d3ae0eb | 187 | |
MikamiUitOpen | 10:eb439bbba0f2 | 188 | Array<uint16_t> SaiIO::outBuffer_; |
MikamiUitOpen | 10:eb439bbba0f2 | 189 | Array<uint16_t> SaiIO::tmp_; |
MikamiUitOpen | 0:eade5d3ae0eb | 190 | __IO bool SaiIO::xferred_; |
MikamiUitOpen | 0:eade5d3ae0eb | 191 | } |