visus
/
framework-arduinoteensy-cxx20
關注 1
收藏 0
複製 0
程式碼 問題 0 合併請求 0 版本發佈 0 Wiki 活動
PlatformIO package of the Teensy core framework compatible with GCC 10 & C++20
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
3 提交
1 分支
目錄樹: 8b2d08b377
分支列表 標籤
${ item.name }
建立分支 ${ searchTerm }
從 '8b2d08b377'
${ noResults }
framework-arduinoteensy-cxx20/libraries/Audio/output_pt8211_2.cpp

431 line
14KB
原始文件 Blame 歷史記錄 

  1. /* Audio Library for Teensy 3.X

  2.  * Copyright (c) 2016, 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. //Adapted to PT8211, Frank Bösing, Ben-Rheinland

  28. 

  29. #if defined(__IMXRT1052__) || defined(__IMXRT1062__)

  30. #include <Arduino.h>

  31. #include "output_pt8211_2.h"

  32. #include "memcpy_audio.h"

  33. #include "utility/imxrt_hw.h"

  34. 

  35. audio_block_t * AudioOutputPT8211_2::block_left_1st = NULL;

  36. audio_block_t * AudioOutputPT8211_2::block_right_1st = NULL;

  37. audio_block_t * AudioOutputPT8211_2::block_left_2nd = NULL;

  38. audio_block_t * AudioOutputPT8211_2::block_right_2nd = NULL;

  39. uint16_t  AudioOutputPT8211_2::block_left_offset = 0;

  40. uint16_t  AudioOutputPT8211_2::block_right_offset = 0;

  41. bool AudioOutputPT8211_2::update_responsibility = false;

  42. #if defined(AUDIO_PT8211_OVERSAMPLING)

  43. DMAMEM __attribute__((aligned(32))) static uint32_t i2s_tx_buffer[AUDIO_BLOCK_SAMPLES*4];

  44. #else

  45. DMAMEM __attribute__((aligned(32))) static uint32_t i2s_tx_buffer[AUDIO_BLOCK_SAMPLES];

  46. #endif

  47. DMAChannel AudioOutputPT8211_2::dma(false);

  48. 

  49. FLASHMEM

  50. void AudioOutputPT8211_2::begin(void)

  51. {

  52. 	dma.begin(true); // Allocate the DMA channel first

  53. 

  54. 	block_left_1st = NULL;

  55. 	block_right_1st = NULL;

  56. 

  57. 	// TODO: should we set & clear the I2S_TCSR_SR bit here?

  58. 	config_i2s();

  59. 	CORE_PIN2_CONFIG  = 2;  //2:TX_DATA0

  60. 	

  61. 	dma.TCD->SADDR = i2s_tx_buffer;

  62. 	dma.TCD->SOFF = 2;

  63. 	dma.TCD->ATTR = DMA_TCD_ATTR_SSIZE(1) | DMA_TCD_ATTR_DSIZE(1);

  64. 	dma.TCD->NBYTES_MLNO = 2;

  65. 	dma.TCD->SLAST = -sizeof(i2s_tx_buffer);

  66. 	dma.TCD->DOFF = 0;

  67. 	dma.TCD->CITER_ELINKNO = sizeof(i2s_tx_buffer) / 2;

  68. 	dma.TCD->DLASTSGA = 0;

  69. 	dma.TCD->BITER_ELINKNO = sizeof(i2s_tx_buffer) / 2;

  70. 	dma.TCD->CSR = DMA_TCD_CSR_INTHALF | DMA_TCD_CSR_INTMAJOR;

  71. 	dma.TCD->DADDR = (void *)((uint32_t)&I2S2_TDR0);

  72. 	dma.triggerAtHardwareEvent(DMAMUX_SOURCE_SAI2_TX);

  73. 

  74. 	I2S2_TCSR |= I2S_TCSR_TE | I2S_TCSR_BCE | I2S_TCSR_FRDE;

  75. 

  76. 	update_responsibility = update_setup();

  77. 	dma.attachInterrupt(isr);

  78. 	dma.enable();

  79. }

  80. 

  81. void AudioOutputPT8211_2::isr(void)

  82. {

  83. 	int16_t *dest, *dest_copy;

  84. 	audio_block_t *blockL, *blockR;

  85. 	uint32_t saddr, offsetL, offsetR;

  86. 

  87. 	saddr = (uint32_t)(dma.TCD->SADDR);

  88. 	dma.clearInterrupt();

  89. 	if (saddr < (uint32_t)i2s_tx_buffer + sizeof(i2s_tx_buffer) / 2) {

  90. 		// DMA is transmitting the first half of the buffer

  91. 		// so we must fill the second half

  92. 		#if defined(AUDIO_PT8211_OVERSAMPLING)

  93. 			dest = (int16_t *)&i2s_tx_buffer[(AUDIO_BLOCK_SAMPLES/2)*4];

  94. 		#else

  95. 			dest = (int16_t *)&i2s_tx_buffer[AUDIO_BLOCK_SAMPLES/2];

  96. 		#endif

  97. 		if (AudioOutputPT8211_2::update_responsibility) AudioStream::update_all();

  98. 	} else {

  99. 		// DMA is transmitting the second half of the buffer

  100. 		// so we must fill the first half

  101. 		dest = (int16_t *)i2s_tx_buffer;

  102. 	}

  103. 	dest_copy = dest;

  104. 

  105. 	blockL = AudioOutputPT8211_2::block_left_1st;

  106. 	blockR = AudioOutputPT8211_2::block_right_1st;

  107. 	offsetL = AudioOutputPT8211_2::block_left_offset;

  108. 	offsetR = AudioOutputPT8211_2::block_right_offset;

  109. 

  110. 	#if defined(AUDIO_PT8211_OVERSAMPLING)

  111. 		static int32_t oldL = 0;

  112. 		static int32_t oldR = 0;

  113. 	#endif

  114. 	if (blockL && blockR) {

  115. 		#if defined(AUDIO_PT8211_OVERSAMPLING)

  116. 			#if defined(AUDIO_PT8211_INTERPOLATION_LINEAR)

  117. 				for (int i=0; i< AUDIO_BLOCK_SAMPLES / 2; i++, offsetL++, offsetR++) {

  118. 					int32_t valL = blockL->data[offsetL];

  119. 					int32_t valR = blockR->data[offsetR];

  120. 					int32_t nL = (oldL+valL) >> 1;

  121. 					int32_t nR = (oldR+valR) >> 1;

  122. 					*(dest+0) = (oldL+nL) >> 1;

  123. 					*(dest+1) = (oldR+nR) >> 1;

  124. 					*(dest+2) = nL;

  125. 					*(dest+3) = nR;

  126. 					*(dest+4) = (nL+valL) >> 1;

  127. 					*(dest+5) = (nR+valR) >> 1;

  128. 					*(dest+6) = valL;

  129. 					*(dest+7) = valR;

  130. 					dest+=8;

  131. 					oldL = valL;

  132. 					oldR = valR;

  133. 				}

  134. 			#elif defined(AUDIO_PT8211_INTERPOLATION_CIC)

  135. 				for (int i=0; i< AUDIO_BLOCK_SAMPLES / 2; i++, offsetL++, offsetR++) {

  136. 					int32_t valL = blockL->data[offsetL];

  137. 					int32_t valR = blockR->data[offsetR];

  138. 

  139. 					int32_t combL[3] = {0};

  140. 					static int32_t combLOld[2] = {0};

  141. 					int32_t combR[3] = {0};

  142. 					static int32_t combROld[2] = {0};

  143. 

  144. 					combL[0] = valL - oldL;

  145. 					combR[0] = valR - oldR;

  146. 					combL[1] = combL[0] - combLOld[0];

  147. 					combR[1] = combR[0] - combROld[0];

  148. 					combL[2] = combL[1] - combLOld[1];

  149. 					combR[2] = combR[1] - combROld[1];

  150. 					// combL[2] now holds input val

  151. 					// combR[2] now holds input val

  152. 					oldL = valL;

  153. 					oldR = valR;

  154. 					combLOld[0] = combL[0];

  155. 					combROld[0] = combR[0];

  156. 					combLOld[1] = combL[1];

  157. 					combROld[1] = combR[1];

  158. 					for (int j = 0; j < 4; j++) {

  159. 						int32_t integrateL[3];

  160. 						int32_t integrateR[3];

  161. 						static int32_t integrateLOld[3] = {0};

  162. 						static int32_t integrateROld[3] = {0};

  163. 						integrateL[0] = ( (j==0) ? (combL[2]) : (0) ) + integrateLOld[0];

  164. 						integrateR[0] = ( (j==0) ? (combR[2]) : (0) ) + integrateROld[0];

  165. 						integrateL[1] = integrateL[0] + integrateLOld[1];

  166. 						integrateR[1] = integrateR[0] + integrateROld[1];

  167. 						integrateL[2] = integrateL[1] + integrateLOld[2];

  168. 						integrateR[2] = integrateR[1] + integrateROld[2];

  169. 						// integrateL[2] now holds j'th upsampled value

  170. 						// integrateR[2] now holds j'th upsampled value

  171. 						*(dest+j*2) = integrateL[2] >> 4;

  172. 						*(dest+j*2+1) = integrateR[2] >> 4;

  173. 						integrateLOld[0] = integrateL[0];

  174. 						integrateROld[0] = integrateR[0];

  175. 						integrateLOld[1] = integrateL[1];

  176. 						integrateROld[1] = integrateR[1];

  177. 						integrateLOld[2] = integrateL[2];

  178. 						integrateROld[2] = integrateR[2];

  179. 					}

  180. 					dest+=8;

  181. 				}

  182. 			#else

  183. 				#error no interpolation method defined for oversampling.

  184. 			#endif //defined(AUDIO_PT8211_INTERPOLATION_LINEAR)

  185. 		#else

  186. 			memcpy_tointerleaveLR(dest, blockL->data + offsetL, blockR->data + offsetR);

  187. 			offsetL += AUDIO_BLOCK_SAMPLES / 2;

  188. 			offsetR += AUDIO_BLOCK_SAMPLES / 2;

  189. 		#endif //defined(AUDIO_PT8211_OVERSAMPLING)

  190. 

  191. 	} else if (blockL) {

  192. 		#if defined(AUDIO_PT8211_OVERSAMPLING)

  193. 			#if defined(AUDIO_PT8211_INTERPOLATION_LINEAR)

  194. 				for (int i=0; i< AUDIO_BLOCK_SAMPLES / 2; i++, offsetL++) {

  195. 					int32_t val = blockL->data[offsetL];

  196. 					int32_t n = (oldL+val) >> 1;

  197. 					*(dest+0) = (oldL+n) >> 1;

  198. 					*(dest+1) = 0;

  199. 					*(dest+2) = n;

  200. 					*(dest+3) = 0;

  201. 					*(dest+4) = (n+val) >> 1;

  202. 					*(dest+5) = 0;

  203. 					*(dest+6) = val;

  204. 					*(dest+7) = 0;

  205. 					dest+=8;

  206. 					oldL = val;

  207. 				}

  208. 			#elif defined(AUDIO_PT8211_INTERPOLATION_CIC)

  209. 				for (int i=0; i< AUDIO_BLOCK_SAMPLES / 2; i++, offsetL++, offsetR++) {

  210. 					int32_t valL = blockL->data[offsetL];

  211. 

  212. 					int32_t combL[3] = {0};

  213. 					static int32_t combLOld[2] = {0};

  214. 

  215. 					combL[0] = valL - oldL;

  216. 					combL[1] = combL[0] - combLOld[0];

  217. 					combL[2] = combL[1] - combLOld[1];

  218. 					// combL[2] now holds input val

  219. 					combLOld[0] = combL[0];

  220. 					combLOld[1] = combL[1];

  221. 

  222. 					for (int j = 0; j < 4; j++) {

  223. 						int32_t integrateL[3];

  224. 						static int32_t integrateLOld[3] = {0};

  225. 						integrateL[0] = ( (j==0) ? (combL[2]) : (0) ) + integrateLOld[0];

  226. 						integrateL[1] = integrateL[0] + integrateLOld[1];

  227. 						integrateL[2] = integrateL[1] + integrateLOld[2];

  228. 						// integrateL[2] now holds j'th upsampled value

  229. 						*(dest+j*2) = integrateL[2] >> 4;

  230. 						integrateLOld[0] = integrateL[0];

  231. 						integrateLOld[1] = integrateL[1];

  232. 						integrateLOld[2] = integrateL[2];

  233. 					}

  234. 

  235. 					// fill right channel with zeros:

  236. 					*(dest+1) = 0;

  237. 					*(dest+3) = 0;

  238. 					*(dest+5) = 0;

  239. 					*(dest+7) = 0;

  240. 					dest+=8;

  241. 					oldL = valL;

  242. 				}

  243. 			#else

  244. 				#error no interpolation method defined for oversampling.

  245. 			#endif //defined(AUDIO_PT8211_INTERPOLATION_LINEAR)

  246. 		#else

  247. 			memcpy_tointerleaveL(dest, blockL->data + offsetL);

  248. 			offsetL += (AUDIO_BLOCK_SAMPLES / 2);

  249. 		#endif //defined(AUDIO_PT8211_OVERSAMPLING)

  250. 	} else if (blockR) {

  251. 		#if defined(AUDIO_PT8211_OVERSAMPLING)

  252. 			#if defined(AUDIO_PT8211_INTERPOLATION_LINEAR)

  253. 				for (int i=0; i< AUDIO_BLOCK_SAMPLES / 2; i++, offsetR++) {

  254. 					int32_t val = blockR->data[offsetR];

  255. 					int32_t n = (oldR+val) >> 1;

  256. 					*(dest+0) = 0;

  257. 					*(dest+1) = ((oldR+n) >> 1);

  258. 					*(dest+2) = 0;

  259. 					*(dest+3) = n;

  260. 					*(dest+4) = 0;

  261. 					*(dest+5) = ((n+val) >> 1);

  262. 					*(dest+6) = 0;

  263. 					*(dest+7) = val;

  264. 					dest+=8;

  265. 					oldR = val;

  266. 				}

  267. 			#elif defined(AUDIO_PT8211_INTERPOLATION_CIC)

  268. 				for (int i=0; i< AUDIO_BLOCK_SAMPLES / 2; i++, offsetL++, offsetR++) {

  269. 					int32_t valR = blockR->data[offsetR];

  270. 

  271. 					int32_t combR[3] = {0};

  272. 					static int32_t combROld[2] = {0};

  273. 

  274. 					combR[0] = valR - oldR;

  275. 					combR[1] = combR[0] - combROld[0];

  276. 					combR[2] = combR[1] - combROld[1];

  277. 					// combR[2] now holds input val

  278. 					combROld[0] = combR[0];

  279. 					combROld[1] = combR[1];

  280. 

  281. 					for (int j = 0; j < 4; j++) {

  282. 						int32_t integrateR[3];

  283. 						static int32_t integrateROld[3] = {0};

  284. 						integrateR[0] = ( (j==0) ? (combR[2]) : (0) ) + integrateROld[0];

  285. 						integrateR[1] = integrateR[0] + integrateROld[1];

  286. 						integrateR[2] = integrateR[1] + integrateROld[2];

  287. 						// integrateR[2] now holds j'th upsampled value

  288. 						*(dest+j*2+1) = integrateR[2] >> 4;

  289. 						integrateROld[0] = integrateR[0];

  290. 						integrateROld[1] = integrateR[1];

  291. 						integrateROld[2] = integrateR[2];

  292. 					}

  293. 

  294. 					// fill left channel with zeros:

  295. 					*(dest+0) = 0;

  296. 					*(dest+2) = 0;

  297. 					*(dest+4) = 0;

  298. 					*(dest+6) = 0;

  299. 					dest+=8;

  300. 					oldR = valR;

  301. 				}

  302. 			#else

  303. 				#error no interpolation method defined for oversampling.

  304. 			#endif //defined(AUDIO_PT8211_INTERPOLATION_LINEAR)

  305. 		#else

  306. 			memcpy_tointerleaveR(dest, blockR->data + offsetR);

  307. 			offsetR += AUDIO_BLOCK_SAMPLES / 2;

  308. 		#endif //defined(AUDIO_PT8211_OVERSAMPLING)

  309. 	} else {

  310. 		#if defined(AUDIO_PT8211_OVERSAMPLING)

  311. 			memset(dest,0,AUDIO_BLOCK_SAMPLES*8);

  312. 		#else

  313. 			memset(dest,0,AUDIO_BLOCK_SAMPLES*2);

  314. 		#endif

  315. 		return;

  316. 	}

  317. 

  318. 	arm_dcache_flush_delete(dest_copy, sizeof(i2s_tx_buffer) / 2);

  319. 

  320. 	if (offsetL < AUDIO_BLOCK_SAMPLES) {

  321. 		AudioOutputPT8211_2::block_left_offset = offsetL;

  322. 	} else {

  323. 		AudioOutputPT8211_2::block_left_offset = 0;

  324. 		AudioStream::release(blockL);

  325. 		AudioOutputPT8211_2::block_left_1st = AudioOutputPT8211_2::block_left_2nd;

  326. 		AudioOutputPT8211_2::block_left_2nd = NULL;

  327. 	}

  328. 	if (offsetR < AUDIO_BLOCK_SAMPLES) {

  329. 		AudioOutputPT8211_2::block_right_offset = offsetR;

  330. 	} else {

  331. 		AudioOutputPT8211_2::block_right_offset = 0;

  332. 		AudioStream::release(blockR);

  333. 		AudioOutputPT8211_2::block_right_1st = AudioOutputPT8211_2::block_right_2nd;

  334. 		AudioOutputPT8211_2::block_right_2nd = NULL;

  335. 	}

  336. }

  337. 

  338. 

  339. 

  340. void AudioOutputPT8211_2::update(void)

  341. {

  342. 

  343. 	audio_block_t *block;

  344. 	block = receiveReadOnly(0); // input 0 = left channel

  345. 	if (block) {

  346. 		__disable_irq();

  347. 		if (block_left_1st == NULL) {

  348. 			block_left_1st = block;

  349. 			block_left_offset = 0;

  350. 			__enable_irq();

  351. 		} else if (block_left_2nd == NULL) {

  352. 			block_left_2nd = block;

  353. 			__enable_irq();

  354. 		} else {

  355. 			audio_block_t *tmp = block_left_1st;

  356. 			block_left_1st = block_left_2nd;

  357. 			block_left_2nd = block;

  358. 			block_left_offset = 0;

  359. 			__enable_irq();

  360. 			release(tmp);

  361. 		}

  362. 	}

  363. 	block = receiveReadOnly(1); // input 1 = right channel

  364. 	if (block) {

  365. 		__disable_irq();

  366. 		if (block_right_1st == NULL) {

  367. 			block_right_1st = block;

  368. 			block_right_offset = 0;

  369. 			__enable_irq();

  370. 		} else if (block_right_2nd == NULL) {

  371. 			block_right_2nd = block;

  372. 			__enable_irq();

  373. 		} else {

  374. 			audio_block_t *tmp = block_right_1st;

  375. 			block_right_1st = block_right_2nd;

  376. 			block_right_2nd = block;

  377. 			block_right_offset = 0;

  378. 			__enable_irq();

  379. 			release(tmp);

  380. 		}

  381. 	}

  382. }

  383. 

  384. FLASHMEM

  385. void AudioOutputPT8211_2::config_i2s(void)

  386. {

  387. 

  388. 	CCM_CCGR5 |= CCM_CCGR5_SAI2(CCM_CCGR_ON);

  389. //PLL:

  390. 	int fs = AUDIO_SAMPLE_RATE_EXACT;

  391. 	// PLL between 27*24 = 648MHz und 54*24=1296MHz

  392. 	int n1 = 4; //SAI prescaler 4 => (n1*n2) = multiple of 4

  393. 	int n2 = 1 + (24000000 * 27) / (fs * 256 * n1);

  394. 

  395. 	double C = ((double)fs * 256 * n1 * n2) / 24000000;

  396. 	int c0 = C;

  397. 	int c2 = 10000;

  398. 	int c1 = C * c2 - (c0 * c2);

  399. 	set_audioClock(c0, c1, c2);

  400. 

  401. 	CCM_CSCMR1 = (CCM_CSCMR1 & ~(CCM_CSCMR1_SAI2_CLK_SEL_MASK))

  402. 		   | CCM_CSCMR1_SAI2_CLK_SEL(2); // &0x03 // (0,1,2): PLL3PFD0, PLL5, PLL4,

  403. 	CCM_CS2CDR = (CCM_CS2CDR & ~(CCM_CS2CDR_SAI2_CLK_PRED_MASK | CCM_CS2CDR_SAI2_CLK_PODF_MASK))

  404. 		   | CCM_CS2CDR_SAI2_CLK_PRED(n1-1) 

  405. 		   | CCM_CS2CDR_SAI2_CLK_PODF(n2-1);

  406. 	IOMUXC_GPR_GPR1 = (IOMUXC_GPR_GPR1 & ~(IOMUXC_GPR_GPR1_SAI2_MCLK3_SEL_MASK))

  407. 			| (IOMUXC_GPR_GPR1_SAI2_MCLK_DIR | IOMUXC_GPR_GPR1_SAI2_MCLK3_SEL(0));	//Select MCLK

  408. 

  409. 	if (I2S2_TCSR & I2S_TCSR_TE) return;

  410. 

  411. 	//CORE_PIN5_CONFIG  = 2;  //2:MCLK

  412. 	CORE_PIN4_CONFIG  = 2;  //2:TX_BCLK

  413. 	CORE_PIN3_CONFIG  = 2;  //2:TX_SYNC

  414. 

  415. 	#if defined(AUDIO_PT8211_OVERSAMPLING)

  416. 	int div = 0;

  417. 	#else

  418. 	int div = 3;

  419. 	#endif

  420. 	// configure transmitter

  421. 	I2S2_TMR = 0;

  422. 	I2S2_TCR1 = I2S_TCR1_RFW(0);

  423. 	I2S2_TCR2 = I2S_TCR2_SYNC(0) | I2S_TCR2_BCP | I2S_TCR2_MSEL(1) | I2S_TCR2_BCD | I2S_TCR2_DIV(div);

  424. 	I2S2_TCR3 = I2S_TCR3_TCE;

  425. //	I2S2_TCR4 = I2S_TCR4_FRSZ(1) | I2S_TCR4_SYWD(15) | I2S_TCR4_MF | I2S_TCR4_FSE | I2S_TCR4_FSP | I2S_TCR4_FSD; //TDA1543

  426. 	I2S2_TCR4 = I2S_TCR4_FRSZ(1) | I2S_TCR4_SYWD(15) | I2S_TCR4_MF /*| I2S_TCR4_FSE*/ | I2S_TCR4_FSP | I2S_TCR4_FSD; //PT8211

  427. 	I2S2_TCR5 = I2S_TCR5_WNW(15) | I2S_TCR5_W0W(15) | I2S_TCR5_FBT(15);

  428. 

  429. }

  430. #endif