@@ -85,6 +85,7 @@ | |||
#include "mixer.h" | |||
#include "output_dac.h" | |||
#include "output_i2s.h" | |||
#include "output_i2s_quad.h" | |||
#include "output_pwm.h" | |||
#include "output_spdif.h" | |||
#include "play_memory.h" |
@@ -42,6 +42,8 @@ void AudioAnalyzePeak::update(void) | |||
max = max_sample; | |||
do { | |||
int16_t d=*p++; | |||
// TODO: can we speed this up with SSUB16 and SEL | |||
// http://www.m4-unleashed.com/parallel-comparison/ | |||
if (d<min) min=d; | |||
if (d>max) max=d; | |||
} while (p < end); |
@@ -495,10 +495,18 @@ | |||
#define DAP_COEF_WR_A2_MSB 0x0138 | |||
#define DAP_COEF_WR_A2_LSB 0x013A | |||
#define SGTL5000_I2C_ADDR 0x0A // CTRL_ADR0_CS pin low (normal configuration) | |||
//#define SGTL5000_I2C_ADDR 0x2A // CTRL_ADR0_CS pin high | |||
#define SGTL5000_I2C_ADDR_CS_LOW 0x0A // CTRL_ADR0_CS pin low (normal configuration) | |||
#define SGTL5000_I2C_ADDR_CS_HIGH 0x2A // CTRL_ADR0_CS pin high | |||
void AudioControlSGTL5000::setAddress(uint8_t level) | |||
{ | |||
if (level == LOW) { | |||
i2c_addr = SGTL5000_I2C_ADDR_CS_LOW; | |||
} else { | |||
i2c_addr = SGTL5000_I2C_ADDR_CS_HIGH; | |||
} | |||
} | |||
bool AudioControlSGTL5000::enable(void) | |||
{ | |||
@@ -536,11 +544,11 @@ bool AudioControlSGTL5000::enable(void) | |||
unsigned int AudioControlSGTL5000::read(unsigned int reg) | |||
{ | |||
unsigned int val; | |||
Wire.beginTransmission(SGTL5000_I2C_ADDR); | |||
Wire.beginTransmission(i2c_addr); | |||
Wire.write(reg >> 8); | |||
Wire.write(reg); | |||
if (Wire.endTransmission(false) != 0) return 0; | |||
if (Wire.requestFrom(SGTL5000_I2C_ADDR, 2) < 2) return 0; | |||
if (Wire.requestFrom((int)i2c_addr, 2) < 2) return 0; | |||
val = Wire.read() << 8; | |||
val |= Wire.read(); | |||
return val; | |||
@@ -549,7 +557,7 @@ unsigned int AudioControlSGTL5000::read(unsigned int reg) | |||
bool AudioControlSGTL5000::write(unsigned int reg, unsigned int val) | |||
{ | |||
if (reg == CHIP_ANA_CTRL) ana_ctrl = val; | |||
Wire.beginTransmission(SGTL5000_I2C_ADDR); | |||
Wire.beginTransmission(i2c_addr); | |||
Wire.write(reg >> 8); | |||
Wire.write(reg); | |||
Wire.write(val >> 8); |
@@ -32,6 +32,8 @@ | |||
class AudioControlSGTL5000 : public AudioControl | |||
{ | |||
public: | |||
AudioControlSGTL5000(void) : i2c_addr(0x0A) { } | |||
void setAddress(uint8_t level); | |||
bool enable(void); | |||
bool disable(void) { return false; } | |||
bool volume(float n) { return volumeInteger(n * 129 + 0.499); } | |||
@@ -92,6 +94,7 @@ protected: | |||
bool muted; | |||
bool volumeInteger(unsigned int n); // range: 0x00 to 0x80 | |||
uint16_t ana_ctrl; | |||
uint8_t i2c_addr; | |||
unsigned char calcVol(float n, unsigned char range); | |||
unsigned int read(unsigned int reg); | |||
bool write(unsigned int reg, unsigned int val); |
@@ -0,0 +1,67 @@ | |||
// Quad channel output test | |||
// Play two WAV files on two audio shields. | |||
// | |||
// TODO: add info about required hardware connections here.... | |||
// | |||
// Data files to put on your SD card can be downloaded here: | |||
// http://www.pjrc.com/teensy/td_libs_AudioDataFiles.html | |||
// | |||
// This example code is in the public domain. | |||
#include <Audio.h> | |||
#include <Wire.h> | |||
#include <SPI.h> | |||
#include <SD.h> | |||
#include <SerialFlash.h> | |||
AudioPlaySdWav playSdWav1; | |||
AudioPlaySdWav playSdWav2; | |||
AudioOutputI2SQuad audioOutput; | |||
AudioConnection patchCord1(playSdWav1, 0, audioOutput, 0); | |||
AudioConnection patchCord2(playSdWav1, 1, audioOutput, 1); | |||
AudioConnection patchCord3(playSdWav2, 0, audioOutput, 2); | |||
AudioConnection patchCord4(playSdWav2, 1, audioOutput, 3); | |||
AudioControlSGTL5000 sgtl5000_1; | |||
AudioControlSGTL5000 sgtl5000_2; | |||
// Use these with the audio adaptor board | |||
#define SDCARD_CS_PIN 10 | |||
#define SDCARD_MOSI_PIN 7 | |||
#define SDCARD_SCK_PIN 14 | |||
void setup() { | |||
Serial.begin(9600); | |||
AudioMemory(10); | |||
sgtl5000_1.setAddress(LOW); | |||
sgtl5000_1.enable(); | |||
sgtl5000_1.volume(0.5); | |||
sgtl5000_2.setAddress(HIGH); | |||
sgtl5000_2.enable(); | |||
sgtl5000_2.volume(0.5); | |||
SPI.setMOSI(SDCARD_MOSI_PIN); | |||
SPI.setSCK(SDCARD_SCK_PIN); | |||
if (!(SD.begin(SDCARD_CS_PIN))) { | |||
// stop here, but print a message repetitively | |||
while (1) { | |||
Serial.println("Unable to access the SD card"); | |||
delay(500); | |||
} | |||
} | |||
} | |||
void loop() { | |||
if (playSdWav1.isPlaying() == false) { | |||
Serial.println("Start playing 1"); | |||
playSdWav1.play("SDTEST2.WAV"); | |||
delay(10); // wait for library to parse WAV info | |||
} | |||
if (playSdWav2.isPlaying() == false) { | |||
Serial.println("Start playing 2"); | |||
playSdWav2.play("SDTEST4.WAV"); | |||
delay(10); // wait for library to parse WAV info | |||
} | |||
} | |||
@@ -348,6 +348,7 @@ span.mainfunction {color: #993300; font-weight: bolder} | |||
{"type":"AudioInputAnalog","data":{"defaults":{"name":{"value":"new"}},"shortName":"adc","inputs":0,"outputs":1,"category":"input-function","color":"#E6E0F8","icon":"arrow-in.png"}}, | |||
{"type":"AudioInputI2Sslave","data":{"defaults":{"name":{"value":"new"}},"shortName":"i2ss","inputs":0,"outputs":2,"category":"input-function","color":"#E6E0F8","icon":"arrow-in.png"}}, | |||
{"type":"AudioOutputI2S","data":{"defaults":{"name":{"value":"new"}},"shortName":"i2s","inputs":2,"outputs":0,"category":"output-function","color":"#E6E0F8","icon":"arrow-in.png"}}, | |||
{"type":"AudioOutputI2SQuad","data":{"defaults":{"name":{"value":"new"}},"shortName":"i2s_quad","inputs":4,"outputs":0,"category":"output-function","color":"#E6E0F8","icon":"arrow-in.png"}}, | |||
{"type":"AudioOutputSPDIF","data":{"defaults":{"name":{"value":"new"}},"shortName":"spdif","inputs":2,"outputs":0,"category":"output-function","color":"#E6E0F8","icon":"arrow-in.png"}}, | |||
{"type":"AudioOutputAnalog","data":{"defaults":{"name":{"value":"new"}},"shortName":"dac","inputs":1,"outputs":0,"category":"output-function","color":"#E6E0F8","icon":"arrow-in.png"}}, | |||
{"type":"AudioOutputPWM","data":{"defaults":{"name":{"value":"new"}},"shortName":"pwm","inputs":1,"outputs":0,"category":"output-function","color":"#E6E0F8","icon":"arrow-in.png"}}, | |||
@@ -610,6 +611,56 @@ span.mainfunction {color: #993300; font-weight: bolder} | |||
</div> | |||
</script> | |||
<script type="text/x-red" data-help-name="AudioOutputI2SQuad"> | |||
<h3>Summary</h3> | |||
<div class=tooltipinfo> | |||
<p>Transmit quad (4) channel 16 bit audio, using I2S master mode.</p> | |||
</div> | |||
<h3>Audio Connections</h3> | |||
<table class=doc align=center cellpadding=3> | |||
<tr class=top><th>Port</th><th>Purpose</th></tr> | |||
<tr class=odd><td align=center>In 0</td><td>Channel #1</td></tr> | |||
<tr class=odd><td align=center>In 1</td><td>Channel #2</td></tr> | |||
<tr class=odd><td align=center>In 2</td><td>Channel #3</td></tr> | |||
<tr class=odd><td align=center>In 3</td><td>Channel #4</td></tr> | |||
</table> | |||
<h3>Functions</h3> | |||
<p>This object has no functions to call from the Arduino sketch. It | |||
simply streams data from its 4 input ports to the I2S hardware.</p> | |||
<h3>Hardware</h3> | |||
<p>TODO: <a href="https://forum.pjrc.com/threads/29373-Bit-bang-multiple-I2S-inputs-simultaneously?p=79606#post79606" target="_blank">details</a> for how to connect 2 Teensy audio shields</p> | |||
<p>The I2S signals are used in "master" mode, where Teensy creates | |||
all 3 clock signals and controls all data timing.</p> | |||
<table class=doc align=center cellpadding=3> | |||
<tr class=top><th>Pin</th><th>Signal</th><th>Direction</th></tr> | |||
<tr class=odd><td align=center>9</td><td>BCLK</td><td>Output</td></tr> | |||
<tr class=odd><td align=center>11</td><td>MCLK</td><td>Output</td></tr> | |||
<tr class=odd><td align=center>22</td><td>TX (ch 1+2)</td><td>Output</td></tr> | |||
<tr class=odd><td align=center>15</td><td>TX (ch 3+4)</td><td>Output</td></tr> | |||
<tr class=odd><td align=center>23</td><td>LRCLK</td><td>Output</td></tr> | |||
</table> | |||
<p>Audio from | |||
master mode I2S may be used in the same project as ADC, DAC and | |||
PWM signals, because all remain in sync to Teensy's timing</p> | |||
<h3>Examples</h3> | |||
<p class=exam>File > Examples > Audio > HardwareTesting > SGTL5000 > QuadChannelOutput | |||
</p> | |||
<h3>Notes</h3> | |||
<p>Normally, this object is used with two Audio Shields, which | |||
are controlled separately by a pair of "sgtl5000" objects.</p> | |||
</script> | |||
<script type="text/x-red" data-template-name="AudioOutputI2SQuad"> | |||
<div class="form-row"> | |||
<label for="node-input-name"><i class="fa fa-tag"></i> Name</label> | |||
<input type="text" id="node-input-name" placeholder="Name"> | |||
</div> | |||
</script> | |||
<script type="text/x-red" data-help-name="AudioOutputSPDIF"> | |||
<h3>Summary</h3> | |||
<div class=tooltipinfo> |
@@ -3,6 +3,7 @@ AudioConnection KEYWORD2 | |||
AudioInputI2S KEYWORD2 | |||
AudioInputI2Sslave KEYWORD2 | |||
AudioOutputI2S KEYWORD2 | |||
AudioOutputI2SQuad KEYWORD2 | |||
AudioOutputI2Sslave KEYWORD2 | |||
AudioOutputSPDIF KEYWORD2 | |||
AudioOutputPWM KEYWORD2 | |||
@@ -78,6 +79,7 @@ output KEYWORD2 | |||
trigger KEYWORD2 | |||
length KEYWORD2 | |||
threshold KEYWORD2 | |||
setAddress KEYWORD2 | |||
enable KEYWORD2 | |||
enableIn KEYWORD2 | |||
enableOut KEYWORD2 |
@@ -164,6 +164,47 @@ | |||
BX lr | |||
/* void memcpy_tointerleaveQuad(int16_t *dst, const int16_t *src1, const int16_t *src2, const int16_t *src3, const int16_t *src4) */ | |||
.global memcpy_tointerleaveQuad | |||
.thumb_func | |||
memcpy_tointerleaveQuad: | |||
@ r0: dst | |||
@ r1: src1 | |||
@ r2: src2 | |||
@ r3: src3 | |||
@ r4: src4 | |||
push {r4-r11} | |||
ldr r4, [sp, #(0+32)] //4th parameter is saved on the stack | |||
add r11,r0,#512 // TODO: 512 = AUDIO_BLOCK_SAMPLES*4 | |||
.align 2 | |||
.loopQuad: | |||
.irp offset, 1,2 | |||
ldr r5, [r1],4 | |||
ldr r6, [r3],4 | |||
pkhbt r7,r5,r6,LSL #16 | |||
pkhtb r9,r6,r5,ASR #16 | |||
ldr r5, [r2],4 | |||
ldr r6, [r4],4 | |||
pkhbt r8,r5,r6,LSL #16 | |||
pkhtb r10,r6,r5,ASR #16 | |||
stmia r0!, {r7-r10} | |||
.endr | |||
cmp r11, r0 | |||
bne .loopQuad | |||
pop {r4-r11} | |||
BX lr | |||
.END | |||
#endif |
@@ -36,6 +36,8 @@ extern "C" { | |||
void memcpy_tointerleaveLR(int16_t *dst, const int16_t *srcL, const int16_t *srcR); | |||
void memcpy_tointerleaveL(int16_t *dst, const int16_t *srcL); | |||
void memcpy_tointerleaveR(int16_t *dst, const int16_t *srcR); | |||
void memcpy_tointerleaveQuad(int16_t *dst, const int16_t *src1, const int16_t *src2, | |||
const int16_t *src3, const int16_t *src4); | |||
#ifdef __cplusplus | |||
} | |||
#endif |
@@ -0,0 +1,340 @@ | |||
/* Audio Library for Teensy 3.X | |||
* Copyright (c) 2014, Paul Stoffregen, paul@pjrc.com | |||
* | |||
* Development of this audio library was funded by PJRC.COM, LLC by sales of | |||
* Teensy and Audio Adaptor boards. Please support PJRC's efforts to develop | |||
* open source software by purchasing Teensy or other PJRC products. | |||
* | |||
* Permission is hereby granted, free of charge, to any person obtaining a copy | |||
* of this software and associated documentation files (the "Software"), to deal | |||
* in the Software without restriction, including without limitation the rights | |||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | |||
* copies of the Software, and to permit persons to whom the Software is | |||
* furnished to do so, subject to the following conditions: | |||
* | |||
* The above copyright notice, development funding notice, and this permission | |||
* notice shall be included in all copies or substantial portions of the Software. | |||
* | |||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE | |||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | |||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | |||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN | |||
* THE SOFTWARE. | |||
*/ | |||
#include "output_i2s_quad.h" | |||
#include "memcpy_audio.h" | |||
#if defined(__MK20DX256__) | |||
audio_block_t * AudioOutputI2SQuad::block_ch1_1st = NULL; | |||
audio_block_t * AudioOutputI2SQuad::block_ch2_1st = NULL; | |||
audio_block_t * AudioOutputI2SQuad::block_ch3_1st = NULL; | |||
audio_block_t * AudioOutputI2SQuad::block_ch4_1st = NULL; | |||
audio_block_t * AudioOutputI2SQuad::block_ch1_2nd = NULL; | |||
audio_block_t * AudioOutputI2SQuad::block_ch2_2nd = NULL; | |||
audio_block_t * AudioOutputI2SQuad::block_ch3_2nd = NULL; | |||
audio_block_t * AudioOutputI2SQuad::block_ch4_2nd = NULL; | |||
uint16_t AudioOutputI2SQuad::ch1_offset = 0; | |||
uint16_t AudioOutputI2SQuad::ch2_offset = 0; | |||
uint16_t AudioOutputI2SQuad::ch3_offset = 0; | |||
uint16_t AudioOutputI2SQuad::ch4_offset = 0; | |||
//audio_block_t * AudioOutputI2SQuad::inputQueueArray[4]; | |||
bool AudioOutputI2SQuad::update_responsibility = false; | |||
DMAMEM static uint32_t i2s_tx_buffer[AUDIO_BLOCK_SAMPLES*2]; | |||
DMAChannel AudioOutputI2SQuad::dma(false); | |||
static const uint32_t zerodata[AUDIO_BLOCK_SAMPLES/4] = {0}; | |||
void AudioOutputI2SQuad::begin(void) | |||
{ | |||
#if 1 | |||
dma.begin(true); // Allocate the DMA channel first | |||
block_ch1_1st = NULL; | |||
block_ch2_1st = NULL; | |||
block_ch3_1st = NULL; | |||
block_ch4_1st = NULL; | |||
// TODO: can we call normal config_i2s, and then just enable the extra output? | |||
config_i2s(); | |||
CORE_PIN22_CONFIG = PORT_PCR_MUX(6); // pin 22, PTC1, I2S0_TXD0 -> ch1 & ch2 | |||
CORE_PIN15_CONFIG = PORT_PCR_MUX(6); // pin 15, PTC0, I2S0_TXD1 -> ch3 & ch4 | |||
dma.TCD->SADDR = i2s_tx_buffer; | |||
dma.TCD->SOFF = 2; | |||
dma.TCD->ATTR = DMA_TCD_ATTR_SSIZE(1) | DMA_TCD_ATTR_DSIZE(1) | DMA_TCD_ATTR_DMOD(3); | |||
dma.TCD->NBYTES_MLNO = 4; | |||
dma.TCD->SLAST = -sizeof(i2s_tx_buffer); | |||
dma.TCD->DADDR = &I2S0_TDR0; | |||
dma.TCD->DOFF = 4; | |||
dma.TCD->CITER_ELINKNO = sizeof(i2s_tx_buffer) / 4; | |||
dma.TCD->DLASTSGA = 0; | |||
dma.TCD->BITER_ELINKNO = sizeof(i2s_tx_buffer) / 4; | |||
dma.TCD->CSR = DMA_TCD_CSR_INTHALF | DMA_TCD_CSR_INTMAJOR; | |||
dma.triggerAtHardwareEvent(DMAMUX_SOURCE_I2S0_TX); | |||
update_responsibility = update_setup(); | |||
dma.enable(); | |||
I2S0_TCSR |= I2S_TCSR_TE | I2S_TCSR_BCE | I2S_TCSR_FRDE | I2S_TCSR_FR; | |||
dma.attachInterrupt(isr); | |||
#endif | |||
} | |||
void AudioOutputI2SQuad::isr(void) | |||
{ | |||
uint32_t saddr; | |||
const int16_t *src1, *src2, *src3, *src4; | |||
const int16_t *zeros = (const int16_t *)zerodata; | |||
int16_t *dest; | |||
saddr = (uint32_t)(dma.TCD->SADDR); | |||
dma.clearInterrupt(); | |||
if (saddr < (uint32_t)i2s_tx_buffer + sizeof(i2s_tx_buffer) / 2) { | |||
// DMA is transmitting the first half of the buffer | |||
// so we must fill the second half | |||
dest = (int16_t *)&i2s_tx_buffer[AUDIO_BLOCK_SAMPLES]; | |||
if (update_responsibility) update_all(); | |||
} else { | |||
dest = (int16_t *)i2s_tx_buffer; | |||
} | |||
src1 = (block_ch1_1st) ? block_ch1_1st->data + ch1_offset : zeros; | |||
src2 = (block_ch2_1st) ? block_ch2_1st->data + ch2_offset : zeros; | |||
src3 = (block_ch3_1st) ? block_ch3_1st->data + ch3_offset : zeros; | |||
src4 = (block_ch4_1st) ? block_ch4_1st->data + ch4_offset : zeros; | |||
// TODO: fast 4-way interleaved memcpy... | |||
#if 1 | |||
memcpy_tointerleaveQuad(dest, src1, src2, src3, src4); | |||
#else | |||
for (int i=0; i < AUDIO_BLOCK_SAMPLES/2; i++) { | |||
*dest++ = *src1++; | |||
*dest++ = *src3++; | |||
*dest++ = *src2++; | |||
*dest++ = *src4++; | |||
} | |||
#endif | |||
if (block_ch1_1st) { | |||
if (ch1_offset == 0) { | |||
ch1_offset = AUDIO_BLOCK_SAMPLES/2; | |||
} else { | |||
ch1_offset = 0; | |||
release(block_ch1_1st); | |||
block_ch1_1st = block_ch1_2nd; | |||
block_ch1_2nd = NULL; | |||
} | |||
} | |||
if (block_ch2_1st) { | |||
if (ch2_offset == 0) { | |||
ch2_offset = AUDIO_BLOCK_SAMPLES/2; | |||
} else { | |||
ch2_offset = 0; | |||
release(block_ch2_1st); | |||
block_ch2_1st = block_ch2_2nd; | |||
block_ch2_2nd = NULL; | |||
} | |||
} | |||
if (block_ch3_1st) { | |||
if (ch3_offset == 0) { | |||
ch3_offset = AUDIO_BLOCK_SAMPLES/2; | |||
} else { | |||
ch3_offset = 0; | |||
release(block_ch3_1st); | |||
block_ch3_1st = block_ch3_2nd; | |||
block_ch3_2nd = NULL; | |||
} | |||
} | |||
if (block_ch4_1st) { | |||
if (ch4_offset == 0) { | |||
ch4_offset = AUDIO_BLOCK_SAMPLES/2; | |||
} else { | |||
ch4_offset = 0; | |||
release(block_ch4_1st); | |||
block_ch4_1st = block_ch4_2nd; | |||
block_ch4_2nd = NULL; | |||
} | |||
} | |||
} | |||
void AudioOutputI2SQuad::update(void) | |||
{ | |||
audio_block_t *block, *tmp; | |||
block = receiveReadOnly(0); // channel 1 | |||
if (block) { | |||
__disable_irq(); | |||
if (block_ch1_1st == NULL) { | |||
block_ch1_1st = block; | |||
ch1_offset = 0; | |||
__enable_irq(); | |||
} else if (block_ch1_2nd == NULL) { | |||
block_ch1_2nd = block; | |||
__enable_irq(); | |||
} else { | |||
tmp = block_ch1_1st; | |||
block_ch1_1st = block_ch1_2nd; | |||
block_ch1_2nd = block; | |||
ch1_offset = 0; | |||
__enable_irq(); | |||
release(tmp); | |||
} | |||
} | |||
block = receiveReadOnly(1); // channel 2 | |||
if (block) { | |||
__disable_irq(); | |||
if (block_ch2_1st == NULL) { | |||
block_ch2_1st = block; | |||
ch2_offset = 0; | |||
__enable_irq(); | |||
} else if (block_ch2_2nd == NULL) { | |||
block_ch2_2nd = block; | |||
__enable_irq(); | |||
} else { | |||
tmp = block_ch2_1st; | |||
block_ch2_1st = block_ch2_2nd; | |||
block_ch2_2nd = block; | |||
ch2_offset = 0; | |||
__enable_irq(); | |||
release(tmp); | |||
} | |||
} | |||
block = receiveReadOnly(2); // channel 3 | |||
if (block) { | |||
__disable_irq(); | |||
if (block_ch3_1st == NULL) { | |||
block_ch3_1st = block; | |||
ch3_offset = 0; | |||
__enable_irq(); | |||
} else if (block_ch3_2nd == NULL) { | |||
block_ch3_2nd = block; | |||
__enable_irq(); | |||
} else { | |||
tmp = block_ch3_1st; | |||
block_ch3_1st = block_ch3_2nd; | |||
block_ch3_2nd = block; | |||
ch3_offset = 0; | |||
__enable_irq(); | |||
release(tmp); | |||
} | |||
} | |||
block = receiveReadOnly(3); // channel 4 | |||
if (block) { | |||
__disable_irq(); | |||
if (block_ch4_1st == NULL) { | |||
block_ch4_1st = block; | |||
ch4_offset = 0; | |||
__enable_irq(); | |||
} else if (block_ch4_2nd == NULL) { | |||
block_ch4_2nd = block; | |||
__enable_irq(); | |||
} else { | |||
tmp = block_ch4_1st; | |||
block_ch4_1st = block_ch4_2nd; | |||
block_ch4_2nd = block; | |||
ch4_offset = 0; | |||
__enable_irq(); | |||
release(tmp); | |||
} | |||
} | |||
} | |||
// MCLK needs to be 48e6 / 1088 * 256 = 11.29411765 MHz -> 44.117647 kHz sample rate | |||
// | |||
#if F_CPU == 96000000 || F_CPU == 48000000 || F_CPU == 24000000 | |||
// PLL is at 96 MHz in these modes | |||
#define MCLK_MULT 2 | |||
#define MCLK_DIV 17 | |||
#elif F_CPU == 72000000 | |||
#define MCLK_MULT 8 | |||
#define MCLK_DIV 51 | |||
#elif F_CPU == 120000000 | |||
#define MCLK_MULT 8 | |||
#define MCLK_DIV 85 | |||
#elif F_CPU == 144000000 | |||
#define MCLK_MULT 4 | |||
#define MCLK_DIV 51 | |||
#elif F_CPU == 168000000 | |||
#define MCLK_MULT 8 | |||
#define MCLK_DIV 119 | |||
#elif F_CPU == 16000000 | |||
#define MCLK_MULT 12 | |||
#define MCLK_DIV 17 | |||
#else | |||
#error "This CPU Clock Speed is not supported by the Audio library"; | |||
#endif | |||
#if F_CPU >= 20000000 | |||
#define MCLK_SRC 3 // the PLL | |||
#else | |||
#define MCLK_SRC 0 // system clock | |||
#endif | |||
void AudioOutputI2SQuad::config_i2s(void) | |||
{ | |||
SIM_SCGC6 |= SIM_SCGC6_I2S; | |||
SIM_SCGC7 |= SIM_SCGC7_DMA; | |||
SIM_SCGC6 |= SIM_SCGC6_DMAMUX; | |||
// if either transmitter or receiver is enabled, do nothing | |||
if (I2S0_TCSR & I2S_TCSR_TE) return; | |||
if (I2S0_RCSR & I2S_RCSR_RE) return; | |||
// enable MCLK output | |||
I2S0_MCR = I2S_MCR_MICS(MCLK_SRC) | I2S_MCR_MOE; | |||
I2S0_MDR = I2S_MDR_FRACT((MCLK_MULT-1)) | I2S_MDR_DIVIDE((MCLK_DIV-1)); | |||
// configure transmitter | |||
I2S0_TMR = 0; | |||
I2S0_TCR1 = I2S_TCR1_TFW(1); // watermark at half fifo size | |||
I2S0_TCR2 = I2S_TCR2_SYNC(0) | I2S_TCR2_BCP | I2S_TCR2_MSEL(1) | |||
| I2S_TCR2_BCD | I2S_TCR2_DIV(3); | |||
I2S0_TCR3 = I2S_TCR3_TCE_2CH; | |||
I2S0_TCR4 = I2S_TCR4_FRSZ(1) | I2S_TCR4_SYWD(15) | I2S_TCR4_MF | |||
| I2S_TCR4_FSE | I2S_TCR4_FSP | I2S_TCR4_FSD; | |||
I2S0_TCR5 = I2S_TCR5_WNW(15) | I2S_TCR5_W0W(15) | I2S_TCR5_FBT(15); | |||
// configure receiver (sync'd to transmitter clocks) | |||
I2S0_RMR = 0; | |||
I2S0_RCR1 = I2S_RCR1_RFW(1); | |||
I2S0_RCR2 = I2S_RCR2_SYNC(1) | I2S_TCR2_BCP | I2S_RCR2_MSEL(1) | |||
| I2S_RCR2_BCD | I2S_RCR2_DIV(3); | |||
I2S0_RCR3 = I2S_RCR3_RCE_2CH; | |||
I2S0_RCR4 = I2S_RCR4_FRSZ(1) | I2S_RCR4_SYWD(15) | I2S_RCR4_MF | |||
| I2S_RCR4_FSE | I2S_RCR4_FSP | I2S_RCR4_FSD; | |||
I2S0_RCR5 = I2S_RCR5_WNW(15) | I2S_RCR5_W0W(15) | I2S_RCR5_FBT(15); | |||
// configure pin mux for 3 clock signals | |||
CORE_PIN23_CONFIG = PORT_PCR_MUX(6); // pin 23, PTC2, I2S0_TX_FS (LRCLK) | |||
CORE_PIN9_CONFIG = PORT_PCR_MUX(6); // pin 9, PTC3, I2S0_TX_BCLK | |||
CORE_PIN11_CONFIG = PORT_PCR_MUX(6); // pin 11, PTC6, I2S0_MCLK | |||
} | |||
#else // not __MK20DX256__ | |||
void AudioOutputI2SQuad::begin(void) | |||
{ | |||
} | |||
void AudioOutputI2SQuad::update(void) | |||
{ | |||
audio_block_t *block; | |||
block = receiveReadOnly(0); | |||
if (block) release(block); | |||
block = receiveReadOnly(1); | |||
if (block) release(block); | |||
block = receiveReadOnly(2); | |||
if (block) release(block); | |||
block = receiveReadOnly(3); | |||
if (block) release(block); | |||
} | |||
#endif |
@@ -0,0 +1,59 @@ | |||
/* Audio Library for Teensy 3.X | |||
* Copyright (c) 2014, Paul Stoffregen, paul@pjrc.com | |||
* | |||
* Development of this audio library was funded by PJRC.COM, LLC by sales of | |||
* Teensy and Audio Adaptor boards. Please support PJRC's efforts to develop | |||
* open source software by purchasing Teensy or other PJRC products. | |||
* | |||
* Permission is hereby granted, free of charge, to any person obtaining a copy | |||
* of this software and associated documentation files (the "Software"), to deal | |||
* in the Software without restriction, including without limitation the rights | |||
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | |||
* copies of the Software, and to permit persons to whom the Software is | |||
* furnished to do so, subject to the following conditions: | |||
* | |||
* The above copyright notice, development funding notice, and this permission | |||
* notice shall be included in all copies or substantial portions of the Software. | |||
* | |||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE | |||
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | |||
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | |||
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN | |||
* THE SOFTWARE. | |||
*/ | |||
#ifndef output_i2s_quad_h_ | |||
#define output_i2s_quad_h_ | |||
#include "AudioStream.h" | |||
#include "DMAChannel.h" | |||
class AudioOutputI2SQuad : public AudioStream | |||
{ | |||
public: | |||
AudioOutputI2SQuad(void) : AudioStream(4, inputQueueArray) { begin(); } | |||
virtual void update(void); | |||
void begin(void); | |||
private: | |||
static void config_i2s(void); | |||
static audio_block_t *block_ch1_1st; | |||
static audio_block_t *block_ch2_1st; | |||
static audio_block_t *block_ch3_1st; | |||
static audio_block_t *block_ch4_1st; | |||
static bool update_responsibility; | |||
static DMAChannel dma; | |||
static void isr(void); | |||
static audio_block_t *block_ch1_2nd; | |||
static audio_block_t *block_ch2_2nd; | |||
static audio_block_t *block_ch3_2nd; | |||
static audio_block_t *block_ch4_2nd; | |||
static uint16_t ch1_offset; | |||
static uint16_t ch2_offset; | |||
static uint16_t ch3_offset; | |||
static uint16_t ch4_offset; | |||
audio_block_t *inputQueueArray[4]; | |||
}; | |||
#endif |