visus
/
teensy-audio
Bevaka 1
Stjärnmärk 0
Förgrening 0
Kod Ärenden 0 Pull-förfrågningar 0 Släpp 0 Wiki Aktiviteter
207 Incheckningar
2 Grenar
Träd: 2e34b4e9fd
teensy-audio/input_i2s.cpp

218 lines
7.5KB
Rå Blame Historik 

  1. /* Audio Library for Teensy 3.X

  2.  * Copyright (c) 2014, Paul Stoffregen, paul@pjrc.com

  3.  *

  4.  * Development of this audio library was funded by PJRC.COM, LLC by sales of

  5.  * Teensy and Audio Adaptor boards.  Please support PJRC's efforts to develop

  6.  * open source software by purchasing Teensy or other PJRC products.

  7.  *

  8.  * Permission is hereby granted, free of charge, to any person obtaining a copy

  9.  * of this software and associated documentation files (the "Software"), to deal

  10.  * in the Software without restriction, including without limitation the rights

  11.  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell

  12.  * copies of the Software, and to permit persons to whom the Software is

  13.  * furnished to do so, subject to the following conditions:

  14.  *

  15.  * The above copyright notice, development funding notice, and this permission

  16.  * notice shall be included in all copies or substantial portions of the Software.

  17.  *

  18.  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR

  19.  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,

  20.  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE

  21.  * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER

  22.  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,

  23.  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN

  24.  * THE SOFTWARE.

  25.  */

  26. 

  27. #include "input_i2s.h"

  28. #include "output_i2s.h"

  29. 

  30. DMAMEM static uint32_t i2s_rx_buffer[AUDIO_BLOCK_SAMPLES];

  31. audio_block_t * AudioInputI2S::block_left = NULL;

  32. audio_block_t * AudioInputI2S::block_right = NULL;

  33. uint16_t AudioInputI2S::block_offset = 0;

  34. bool AudioInputI2S::update_responsibility = false;

  35. 

  36. 

  37. void AudioInputI2S::begin(void)

  38. {

  39. 	//block_left_1st = NULL;

  40. 	//block_right_1st = NULL;

  41. 

  42. 	//pinMode(3, OUTPUT);

  43. 	//digitalWriteFast(3, HIGH);

  44. 	//delayMicroseconds(500);

  45. 	//digitalWriteFast(3, LOW);

  46. 

  47. 	// TODO: should we set & clear the I2S_RCSR_SR bit here?

  48. 	AudioOutputI2S::config_i2s();

  49. 

  50. 	CORE_PIN13_CONFIG = PORT_PCR_MUX(4); // pin 13, PTC5, I2S0_RXD0

  51. 

  52. 	DMA_CR = 0;

  53. 	DMA_TCD_SADDR(AUDIO_IN_I2S_DMA_CHANNEL) = &I2S0_RDR0;

  54. 	DMA_TCD_SOFF(AUDIO_IN_I2S_DMA_CHANNEL) = 0;

  55. 	DMA_TCD_ATTR(AUDIO_IN_I2S_DMA_CHANNEL) = DMA_TCD_ATTR_SSIZE(1) | DMA_TCD_ATTR_DSIZE(1);

  56. 	DMA_TCD_NBYTES_MLNO(AUDIO_IN_I2S_DMA_CHANNEL) = 2;

  57. 	DMA_TCD_SLAST(AUDIO_IN_I2S_DMA_CHANNEL) = 0;

  58. 	DMA_TCD_DADDR(AUDIO_IN_I2S_DMA_CHANNEL) = i2s_rx_buffer;

  59. 	DMA_TCD_DOFF(AUDIO_IN_I2S_DMA_CHANNEL) = 2;

  60. 	DMA_TCD_CITER_ELINKNO(AUDIO_IN_I2S_DMA_CHANNEL) = sizeof(i2s_rx_buffer) / 2;

  61. 	DMA_TCD_DLASTSGA(AUDIO_IN_I2S_DMA_CHANNEL) = -sizeof(i2s_rx_buffer);

  62. 	DMA_TCD_BITER_ELINKNO(AUDIO_IN_I2S_DMA_CHANNEL) = sizeof(i2s_rx_buffer) / 2;

  63. 	DMA_TCD_CSR(AUDIO_IN_I2S_DMA_CHANNEL) = DMA_TCD_CSR_INTHALF | DMA_TCD_CSR_INTMAJOR;

  64. 

  65. 	DMAMUX0_CHCFG(AUDIO_IN_I2S_DMA_CHANNEL) = DMAMUX_DISABLE;

  66. 	DMAMUX0_CHCFG(AUDIO_IN_I2S_DMA_CHANNEL) = DMAMUX_SOURCE_I2S0_RX | DMAMUX_ENABLE;

  67. 	update_responsibility = update_setup();

  68. 	DMA_SERQ = AUDIO_IN_I2S_DMA_CHANNEL;

  69. 

  70. 	// TODO: is I2S_RCSR_BCE appropriate if sync'd to transmitter clock?

  71. 	//I2S0_RCSR |= I2S_RCSR_RE | I2S_RCSR_BCE | I2S_RCSR_FRDE | I2S_RCSR_FR;

  72. 	I2S0_RCSR |= I2S_RCSR_RE | I2S_RCSR_FRDE | I2S_RCSR_FR;

  73. 	NVIC_ENABLE_IRQ(IRQ_DMA_CH(AUDIO_IN_I2S_DMA_CHANNEL));

  74. }

  75. 

  76. void DMA_ISR(AUDIO_IN_I2S_DMA_CHANNEL)(void)

  77. {

  78. 	uint32_t daddr, offset;

  79. 	const int16_t *src, *end;

  80. 	int16_t *dest_left, *dest_right;

  81. 	audio_block_t *left, *right;

  82. 

  83. 	//digitalWriteFast(3, HIGH);

  84. 	daddr = (uint32_t)(DMA_TCD_DADDR(AUDIO_IN_I2S_DMA_CHANNEL));

  85.         DMA_CINT = AUDIO_IN_I2S_DMA_CHANNEL;

  86. 

  87. 	if (daddr < (uint32_t)i2s_rx_buffer + sizeof(i2s_rx_buffer) / 2) {

  88. 		// DMA is receiving to the first half of the buffer

  89. 		// need to remove data from the second half

  90. 		src = (int16_t *)&i2s_rx_buffer[AUDIO_BLOCK_SAMPLES/2];

  91. 		end = (int16_t *)&i2s_rx_buffer[AUDIO_BLOCK_SAMPLES];

  92. 		if (AudioInputI2S::update_responsibility) AudioStream::update_all();

  93. 	} else {

  94. 		// DMA is receiving to the second half of the buffer

  95. 		// need to remove data from the first half

  96. 		src = (int16_t *)&i2s_rx_buffer[0];

  97. 		end = (int16_t *)&i2s_rx_buffer[AUDIO_BLOCK_SAMPLES/2];

  98. 	}

  99. 	left = AudioInputI2S::block_left;

  100. 	right = AudioInputI2S::block_right;

  101. 	if (left != NULL && right != NULL) {

  102. 		offset = AudioInputI2S::block_offset;

  103. 		if (offset <= AUDIO_BLOCK_SAMPLES/2) {

  104. 			dest_left = &(left->data[offset]);

  105. 			dest_right = &(right->data[offset]);

  106. 			AudioInputI2S::block_offset = offset + AUDIO_BLOCK_SAMPLES/2;

  107. 			do {

  108. 				//n = *src++;

  109. 				//*dest_left++ = (int16_t)n;

  110. 				//*dest_right++ = (int16_t)(n >> 16);

  111. 				*dest_left++ = *src++;

  112. 				*dest_right++ = *src++;

  113. 			} while (src < end);

  114. 		}

  115. 	}

  116. 	//digitalWriteFast(3, LOW);

  117. }

  118. 

  119. 

  120. 

  121. void AudioInputI2S::update(void)

  122. {

  123. 	audio_block_t *new_left=NULL, *new_right=NULL, *out_left=NULL, *out_right=NULL;

  124. 

  125. 	// allocate 2 new blocks, but if one fails, allocate neither

  126. 	new_left = allocate();

  127. 	if (new_left != NULL) {

  128. 		new_right = allocate();

  129. 		if (new_right == NULL) {

  130. 			release(new_left);

  131. 			new_left = NULL;

  132. 		}

  133. 	}

  134. 	__disable_irq();

  135. 	if (block_offset >= AUDIO_BLOCK_SAMPLES) {

  136. 		// the DMA filled 2 blocks, so grab them and get the

  137. 		// 2 new blocks to the DMA, as quickly as possible

  138. 		out_left = block_left;

  139. 		block_left = new_left;

  140. 		out_right = block_right;

  141. 		block_right = new_right;

  142. 		block_offset = 0;

  143. 		__enable_irq();

  144. 		// then transmit the DMA's former blocks

  145. 		transmit(out_left, 0);

  146. 		release(out_left);

  147. 		transmit(out_right, 1);

  148. 		release(out_right);

  149. 		//Serial.print(".");

  150. 	} else if (new_left != NULL) {

  151. 		// the DMA didn't fill blocks, but we allocated blocks

  152. 		if (block_left == NULL) {

  153. 			// the DMA doesn't have any blocks to fill, so

  154. 			// give it the ones we just allocated

  155. 			block_left = new_left;

  156. 			block_right = new_right;

  157. 			block_offset = 0;

  158. 			__enable_irq();

  159. 		} else {

  160. 			// the DMA already has blocks, doesn't need these

  161. 			__enable_irq();

  162. 			release(new_left);

  163. 			release(new_right);

  164. 		}

  165. 	} else {

  166. 		// The DMA didn't fill blocks, and we could not allocate

  167. 		// memory... the system is likely starving for memory!

  168. 		// Sadly, there's nothing we can do.

  169. 		__enable_irq();

  170. 	}

  171. }

  172. 

  173. 

  174. /******************************************************************/

  175. 

  176. 

  177. void AudioInputI2Sslave::begin(void)

  178. {

  179. 	//block_left_1st = NULL;

  180. 	//block_right_1st = NULL;

  181. 

  182. 	//pinMode(3, OUTPUT);

  183. 	//digitalWriteFast(3, HIGH);

  184. 	//delayMicroseconds(500);

  185. 	//digitalWriteFast(3, LOW);

  186. 

  187. 	AudioOutputI2Sslave::config_i2s();

  188. 

  189. 	CORE_PIN13_CONFIG = PORT_PCR_MUX(4); // pin 13, PTC5, I2S0_RXD0

  190. 

  191. 	DMA_CR = 0;

  192. 	DMA_TCD_SADDR(AUDIO_IN_I2S_DMA_CHANNEL) = &I2S0_RDR0;

  193. 	DMA_TCD_SOFF(AUDIO_IN_I2S_DMA_CHANNEL) = 0;

  194. 	DMA_TCD_ATTR(AUDIO_IN_I2S_DMA_CHANNEL) = DMA_TCD_ATTR_SSIZE(1) | DMA_TCD_ATTR_DSIZE(1);

  195. 	DMA_TCD_NBYTES_MLNO(AUDIO_IN_I2S_DMA_CHANNEL) = 2;

  196. 	DMA_TCD_SLAST(AUDIO_IN_I2S_DMA_CHANNEL) = 0;

  197. 	DMA_TCD_DADDR(AUDIO_IN_I2S_DMA_CHANNEL) = i2s_rx_buffer;

  198. 	DMA_TCD_DOFF(AUDIO_IN_I2S_DMA_CHANNEL) = 2;

  199. 	DMA_TCD_CITER_ELINKNO(AUDIO_IN_I2S_DMA_CHANNEL) = sizeof(i2s_rx_buffer) / 2;

  200. 	DMA_TCD_DLASTSGA(AUDIO_IN_I2S_DMA_CHANNEL) = -sizeof(i2s_rx_buffer);

  201. 	DMA_TCD_BITER_ELINKNO(AUDIO_IN_I2S_DMA_CHANNEL) = sizeof(i2s_rx_buffer) / 2;

  202. 	DMA_TCD_CSR(AUDIO_IN_I2S_DMA_CHANNEL) = DMA_TCD_CSR_INTHALF | DMA_TCD_CSR_INTMAJOR;

  203. 

  204. 	DMAMUX0_CHCFG(AUDIO_IN_I2S_DMA_CHANNEL) = DMAMUX_DISABLE;

  205. 	DMAMUX0_CHCFG(AUDIO_IN_I2S_DMA_CHANNEL) = DMAMUX_SOURCE_I2S0_RX | DMAMUX_ENABLE;

  206. 	update_responsibility = update_setup();

  207. 	DMA_SERQ = AUDIO_IN_I2S_DMA_CHANNEL;

  208. 

  209. 	// TODO: is I2S_RCSR_BCE appropriate if sync'd to transmitter clock?

  210. 	//I2S0_RCSR |= I2S_RCSR_RE | I2S_RCSR_BCE | I2S_RCSR_FRDE | I2S_RCSR_FR;

  211. 	I2S0_RCSR |= I2S_RCSR_RE | I2S_RCSR_FRDE | I2S_RCSR_FR;

  212. 	NVIC_ENABLE_IRQ(IRQ_DMA_CH(AUDIO_IN_I2S_DMA_CHANNEL));

  213. }

  214. 

  215. 

  216.