visus
/
teensy-audio
Watch 1
Star 0
Fork 0
Code Issues 0 Pull Requests 0 Releases 0 Wiki Activity
451 Commits
2 Branches
Tree: d38e6e1de7
teensy-audio/effect_delay_ext.cpp

256 lines
7.6KB
Raw Blame History 

  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 "effect_delay_ext.h"

  28. 

  29. //#define INTERNAL_TEST

  30. 

  31. // Use these with the audio adaptor board  (should be adjustable by the user...)

  32. #define SPIRAM_MOSI_PIN  7

  33. #define SPIRAM_MISO_PIN  12

  34. #define SPIRAM_SCK_PIN   14

  35. 

  36. #define SPIRAM_CS_PIN    6

  37. 

  38. #define MEMBOARD_CS0_PIN 2

  39. #define MEMBOARD_CS1_PIN 3

  40. #define MEMBOARD_CS2_PIN 4

  41. 

  42. void AudioEffectDelayExternal::update(void)

  43. {

  44. 	audio_block_t *block;

  45. 	uint32_t n, channel, read_offset;

  46. 

  47. 	// grab incoming data and put it into the memory

  48. 	block = receiveReadOnly();

  49. 	if (memory_type >= AUDIO_MEMORY_UNDEFINED) {

  50. 		// ignore input and do nothing if undefined memory type

  51. 		release(block);

  52. 		return;

  53. 	}

  54. 	if (block) {

  55. 		if (head_offset + AUDIO_BLOCK_SAMPLES <= memory_length) {

  56. 			// a single write is enough

  57. 			write(head_offset, AUDIO_BLOCK_SAMPLES, block->data);

  58. 			head_offset += AUDIO_BLOCK_SAMPLES;

  59. 		} else {

  60. 			// write wraps across end-of-memory

  61. 			n = memory_length - head_offset;

  62. 			write(head_offset, n, block->data);

  63. 			head_offset = AUDIO_BLOCK_SAMPLES - n;

  64. 			write(0, head_offset, block->data + n);

  65. 		}

  66. 		release(block);

  67. 	} else {

  68. 		// if no input, store zeros, so later playback will

  69. 		// not be random garbage previously stored in memory

  70. 		if (head_offset + AUDIO_BLOCK_SAMPLES <= memory_length) {

  71. 			zero(head_offset, AUDIO_BLOCK_SAMPLES);

  72. 			head_offset += AUDIO_BLOCK_SAMPLES;

  73. 		} else {

  74. 			n = memory_length - head_offset;

  75. 			zero(head_offset, n);

  76. 			head_offset = AUDIO_BLOCK_SAMPLES - n;

  77. 			zero(0, head_offset);

  78. 		}

  79. 	}

  80. 

  81. 	// transmit the delayed outputs

  82. 	for (channel = 0; channel < 8; channel++) {

  83. 		if (!(activemask & (1<<channel))) continue;

  84. 		block = allocate();

  85. 		if (!block) continue;

  86. 		// compute the delayed location where we read

  87. 		if (delay_length[channel] <= head_offset) {

  88. 			read_offset = head_offset - delay_length[channel];

  89. 		} else {

  90. 			read_offset = memory_length + head_offset - delay_length[channel];

  91. 		}

  92. 		if (read_offset + AUDIO_BLOCK_SAMPLES <= memory_length) {

  93. 			// a single read will do it

  94. 			read(read_offset, AUDIO_BLOCK_SAMPLES, block->data);

  95. 		} else {

  96. 			// read wraps across end-of-memory

  97. 			n = memory_length - read_offset;

  98. 			read(read_offset, n, block->data);

  99. 			read(0, AUDIO_BLOCK_SAMPLES - n, block->data + n);

  100. 		}

  101. 		transmit(block, channel);

  102. 		release(block);

  103. 	}

  104. }

  105. 

  106. uint32_t AudioEffectDelayExternal::allocated[2] = {0, 0};

  107. 

  108. void AudioEffectDelayExternal::initialize(AudioEffectDelayMemoryType_t type, uint32_t samples)

  109. {

  110. 	uint32_t memsize, avail;

  111. 

  112. 	activemask = 0;

  113. 	head_offset = 0;

  114. 	memory_type = type;

  115. 	if (type == AUDIO_MEMORY_23LC1024) {

  116. #ifdef INTERNAL_TEST

  117. 		memsize = 8000;

  118. #else

  119. 		memsize = 65536;

  120. #endif

  121. 		pinMode(SPIRAM_CS_PIN, OUTPUT);

  122. 		digitalWriteFast(SPIRAM_CS_PIN, HIGH);

  123. 	} else if (type == AUDIO_MEMORY_MEMORYBOARD) {

  124. 		memsize = 393216;

  125. 		pinMode(MEMBOARD_CS0_PIN, OUTPUT);

  126. 		pinMode(MEMBOARD_CS1_PIN, OUTPUT);

  127. 		pinMode(MEMBOARD_CS2_PIN, OUTPUT);

  128. 		digitalWriteFast(MEMBOARD_CS0_PIN, LOW);

  129. 		digitalWriteFast(MEMBOARD_CS1_PIN, LOW);

  130. 		digitalWriteFast(MEMBOARD_CS2_PIN, LOW);

  131. 	} else {

  132. 		return;

  133. 	}

  134. 	avail = memsize - allocated[type];

  135. 	if (avail < AUDIO_BLOCK_SAMPLES*2+1) {

  136. 		memory_type = AUDIO_MEMORY_UNDEFINED;

  137. 		return;

  138. 	}

  139. 	if (samples > avail) samples = avail;

  140. 	memory_begin = allocated[type];

  141. 	allocated[type] += samples;

  142. 	memory_length = samples;

  143. 

  144. 	SPI.setMOSI(SPIRAM_MOSI_PIN);

  145. 	SPI.setMISO(SPIRAM_MISO_PIN);

  146. 	SPI.setSCK(SPIRAM_SCK_PIN);

  147. 

  148. 	SPI.begin();

  149. 	zero(0, memory_length);

  150. }

  151. 

  152. 

  153. #ifdef INTERNAL_TEST

  154. static int16_t testmem[8000]; // testing only

  155. #endif

  156. 

  157. 

  158. #define SPISETTING SPISettings(20000000, MSBFIRST, SPI_MODE0)

  159. 

  160. void AudioEffectDelayExternal::read(uint32_t offset, uint32_t count, int16_t *data)

  161. {

  162. 	uint32_t addr = memory_begin + offset;

  163. 

  164. #ifdef INTERNAL_TEST

  165. 	while (count) { *data++ = testmem[addr++]; count--; } // testing only

  166. #else

  167. 	if (memory_type == AUDIO_MEMORY_23LC1024) {

  168. 		addr *= 2;

  169. 		SPI.beginTransaction(SPISETTING);

  170. 		digitalWriteFast(SPIRAM_CS_PIN, LOW);

  171. 		SPI.transfer16((0x03 << 8) | (addr >> 16));

  172. 		SPI.transfer16(addr & 0xFFFF);

  173. 		while (count) {

  174. 			*data++ = (int16_t)(SPI.transfer16(0));

  175. 			count--;

  176. 		}

  177. 		digitalWriteFast(SPIRAM_CS_PIN, HIGH);

  178. 		SPI.endTransaction();

  179. 	} else if (memory_type == AUDIO_MEMORY_MEMORYBOARD) {

  180. 		SPI.beginTransaction(SPISETTING);

  181. 		while (count) {

  182. 			uint32_t chip = (addr >> 16) + 1;

  183. 			digitalWriteFast(MEMBOARD_CS0_PIN, chip & 1);

  184. 			digitalWriteFast(MEMBOARD_CS1_PIN, chip & 2);

  185. 			digitalWriteFast(MEMBOARD_CS2_PIN, chip & 4);

  186. 			uint32_t chipaddr = (addr & 0xFFFF) << 1;

  187. 			SPI.transfer16((0x03 << 8) | (chipaddr >> 16));

  188. 			SPI.transfer16(chipaddr & 0xFFFF);

  189. 			uint32_t num = 0x10000 - (addr & 0xFFFF);

  190. 			if (num > count) num = count;

  191. 			count -= num;

  192. 			addr += num;

  193. 			do {

  194. 				*data++ = (int16_t)(SPI.transfer16(0));

  195. 			} while (--num > 0);

  196. 		}

  197. 		digitalWriteFast(MEMBOARD_CS0_PIN, LOW);

  198. 		digitalWriteFast(MEMBOARD_CS1_PIN, LOW);

  199. 		digitalWriteFast(MEMBOARD_CS2_PIN, LOW);

  200. 		SPI.endTransaction();

  201. 	}

  202. #endif

  203. }

  204. 

  205. void AudioEffectDelayExternal::write(uint32_t offset, uint32_t count, const int16_t *data)

  206. {

  207. 	uint32_t addr = memory_begin + offset;

  208. 

  209. #ifdef INTERNAL_TEST

  210. 	while (count) { testmem[addr++] = *data++; count--; } // testing only

  211. #else

  212. 	if (memory_type == AUDIO_MEMORY_23LC1024) {

  213. 		addr *= 2;

  214. 		SPI.beginTransaction(SPISETTING);

  215. 		digitalWriteFast(SPIRAM_CS_PIN, LOW);

  216. 		SPI.transfer16((0x02 << 8) | (addr >> 16));

  217. 		SPI.transfer16(addr & 0xFFFF);

  218. 		while (count) {

  219. 			int16_t w = 0;

  220. 			if (data) w = *data++;

  221. 			SPI.transfer16(w);

  222. 			count--;

  223. 		}

  224. 		digitalWriteFast(SPIRAM_CS_PIN, HIGH);

  225. 		SPI.endTransaction();

  226. 	} else if (memory_type == AUDIO_MEMORY_MEMORYBOARD) {

  227. 		SPI.beginTransaction(SPISETTING);

  228. 		while (count) {

  229. 			uint32_t chip = (addr >> 16) + 1;

  230. 			digitalWriteFast(MEMBOARD_CS0_PIN, chip & 1);

  231. 			digitalWriteFast(MEMBOARD_CS1_PIN, chip & 2);

  232. 			digitalWriteFast(MEMBOARD_CS2_PIN, chip & 4);

  233. 			uint32_t chipaddr = (addr & 0xFFFF) << 1;

  234. 			SPI.transfer16((0x02 << 8) | (chipaddr >> 16));

  235. 			SPI.transfer16(chipaddr & 0xFFFF);

  236. 			uint32_t num = 0x10000 - (addr & 0xFFFF);

  237. 			if (num > count) num = count;

  238. 			count -= num;

  239. 			addr += num;

  240. 			do {

  241. 				int16_t w = 0;

  242. 				if (data) w = *data++;

  243. 				SPI.transfer16(w);

  244. 			} while (--num > 0);

  245. 		}

  246. 		digitalWriteFast(MEMBOARD_CS0_PIN, LOW);

  247. 		digitalWriteFast(MEMBOARD_CS1_PIN, LOW);

  248. 		digitalWriteFast(MEMBOARD_CS2_PIN, LOW);

  249. 		SPI.endTransaction();

  250. 	}

  251. #endif

  252. }

  253. 

  254.