| /* 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 <stdint.h> | |||||
| const __attribute__((aligned(32))) | |||||
| uint16_t spdif_bmclookup[256] = { //biphase mark encoded values (least significant bit first) | |||||
| 0xcccc, 0x4ccc, 0x2ccc, 0xaccc, 0x34cc, 0xb4cc, 0xd4cc, 0x54cc, | |||||
| 0x32cc, 0xb2cc, 0xd2cc, 0x52cc, 0xcacc, 0x4acc, 0x2acc, 0xaacc, | |||||
| 0x334c, 0xb34c, 0xd34c, 0x534c, 0xcb4c, 0x4b4c, 0x2b4c, 0xab4c, | |||||
| 0xcd4c, 0x4d4c, 0x2d4c, 0xad4c, 0x354c, 0xb54c, 0xd54c, 0x554c, | |||||
| 0x332c, 0xb32c, 0xd32c, 0x532c, 0xcb2c, 0x4b2c, 0x2b2c, 0xab2c, | |||||
| 0xcd2c, 0x4d2c, 0x2d2c, 0xad2c, 0x352c, 0xb52c, 0xd52c, 0x552c, | |||||
| 0xccac, 0x4cac, 0x2cac, 0xacac, 0x34ac, 0xb4ac, 0xd4ac, 0x54ac, | |||||
| 0x32ac, 0xb2ac, 0xd2ac, 0x52ac, 0xcaac, 0x4aac, 0x2aac, 0xaaac, | |||||
| 0x3334, 0xb334, 0xd334, 0x5334, 0xcb34, 0x4b34, 0x2b34, 0xab34, | |||||
| 0xcd34, 0x4d34, 0x2d34, 0xad34, 0x3534, 0xb534, 0xd534, 0x5534, | |||||
| 0xccb4, 0x4cb4, 0x2cb4, 0xacb4, 0x34b4, 0xb4b4, 0xd4b4, 0x54b4, | |||||
| 0x32b4, 0xb2b4, 0xd2b4, 0x52b4, 0xcab4, 0x4ab4, 0x2ab4, 0xaab4, | |||||
| 0xccd4, 0x4cd4, 0x2cd4, 0xacd4, 0x34d4, 0xb4d4, 0xd4d4, 0x54d4, | |||||
| 0x32d4, 0xb2d4, 0xd2d4, 0x52d4, 0xcad4, 0x4ad4, 0x2ad4, 0xaad4, | |||||
| 0x3354, 0xb354, 0xd354, 0x5354, 0xcb54, 0x4b54, 0x2b54, 0xab54, | |||||
| 0xcd54, 0x4d54, 0x2d54, 0xad54, 0x3554, 0xb554, 0xd554, 0x5554, | |||||
| 0x3332, 0xb332, 0xd332, 0x5332, 0xcb32, 0x4b32, 0x2b32, 0xab32, | |||||
| 0xcd32, 0x4d32, 0x2d32, 0xad32, 0x3532, 0xb532, 0xd532, 0x5532, | |||||
| 0xccb2, 0x4cb2, 0x2cb2, 0xacb2, 0x34b2, 0xb4b2, 0xd4b2, 0x54b2, | |||||
| 0x32b2, 0xb2b2, 0xd2b2, 0x52b2, 0xcab2, 0x4ab2, 0x2ab2, 0xaab2, | |||||
| 0xccd2, 0x4cd2, 0x2cd2, 0xacd2, 0x34d2, 0xb4d2, 0xd4d2, 0x54d2, | |||||
| 0x32d2, 0xb2d2, 0xd2d2, 0x52d2, 0xcad2, 0x4ad2, 0x2ad2, 0xaad2, | |||||
| 0x3352, 0xb352, 0xd352, 0x5352, 0xcb52, 0x4b52, 0x2b52, 0xab52, | |||||
| 0xcd52, 0x4d52, 0x2d52, 0xad52, 0x3552, 0xb552, 0xd552, 0x5552, | |||||
| 0xccca, 0x4cca, 0x2cca, 0xacca, 0x34ca, 0xb4ca, 0xd4ca, 0x54ca, | |||||
| 0x32ca, 0xb2ca, 0xd2ca, 0x52ca, 0xcaca, 0x4aca, 0x2aca, 0xaaca, | |||||
| 0x334a, 0xb34a, 0xd34a, 0x534a, 0xcb4a, 0x4b4a, 0x2b4a, 0xab4a, | |||||
| 0xcd4a, 0x4d4a, 0x2d4a, 0xad4a, 0x354a, 0xb54a, 0xd54a, 0x554a, | |||||
| 0x332a, 0xb32a, 0xd32a, 0x532a, 0xcb2a, 0x4b2a, 0x2b2a, 0xab2a, | |||||
| 0xcd2a, 0x4d2a, 0x2d2a, 0xad2a, 0x352a, 0xb52a, 0xd52a, 0x552a, | |||||
| 0xccaa, 0x4caa, 0x2caa, 0xacaa, 0x34aa, 0xb4aa, 0xd4aa, 0x54aa, | |||||
| 0x32aa, 0xb2aa, 0xd2aa, 0x52aa, 0xcaaa, 0x4aaa, 0x2aaa, 0xaaaa | |||||
| }; |
| uint16_t AudioOutputSPDIF::block_left_offset = 0; | uint16_t AudioOutputSPDIF::block_left_offset = 0; | ||||
| uint16_t AudioOutputSPDIF::block_right_offset = 0; | uint16_t AudioOutputSPDIF::block_right_offset = 0; | ||||
| bool AudioOutputSPDIF::update_responsibility = false; | bool AudioOutputSPDIF::update_responsibility = false; | ||||
| /* DMAMEM */ static uint32_t SPDIF_tx_buffer[AUDIO_BLOCK_SAMPLES * 4]; //2 KB | |||||
| DMAChannel AudioOutputSPDIF::dma(false); | DMAChannel AudioOutputSPDIF::dma(false); | ||||
| extern uint16_t spdif_bmclookup[256]; | |||||
| DMAMEM __attribute__((aligned(32))) | |||||
| static uint32_t SPDIF_tx_buffer[AUDIO_BLOCK_SAMPLES * 4]; //2 KB | |||||
| #if defined(KINETISK) || defined(__IMXRT1052__) || defined(__IMXRT1062__) | #if defined(KINETISK) || defined(__IMXRT1052__) || defined(__IMXRT1062__) | ||||
| uint32_t AudioOutputSPDIF::vucp = VUCP_VALID; | uint32_t AudioOutputSPDIF::vucp = VUCP_VALID; | ||||
| static const | |||||
| uint16_t bmclookup[256] = { //biphase mark encoded values (least significant bit first) | |||||
| 0xcccc, 0x4ccc, 0x2ccc, 0xaccc, 0x34cc, 0xb4cc, 0xd4cc, 0x54cc, | |||||
| 0x32cc, 0xb2cc, 0xd2cc, 0x52cc, 0xcacc, 0x4acc, 0x2acc, 0xaacc, | |||||
| 0x334c, 0xb34c, 0xd34c, 0x534c, 0xcb4c, 0x4b4c, 0x2b4c, 0xab4c, | |||||
| 0xcd4c, 0x4d4c, 0x2d4c, 0xad4c, 0x354c, 0xb54c, 0xd54c, 0x554c, | |||||
| 0x332c, 0xb32c, 0xd32c, 0x532c, 0xcb2c, 0x4b2c, 0x2b2c, 0xab2c, | |||||
| 0xcd2c, 0x4d2c, 0x2d2c, 0xad2c, 0x352c, 0xb52c, 0xd52c, 0x552c, | |||||
| 0xccac, 0x4cac, 0x2cac, 0xacac, 0x34ac, 0xb4ac, 0xd4ac, 0x54ac, | |||||
| 0x32ac, 0xb2ac, 0xd2ac, 0x52ac, 0xcaac, 0x4aac, 0x2aac, 0xaaac, | |||||
| 0x3334, 0xb334, 0xd334, 0x5334, 0xcb34, 0x4b34, 0x2b34, 0xab34, | |||||
| 0xcd34, 0x4d34, 0x2d34, 0xad34, 0x3534, 0xb534, 0xd534, 0x5534, | |||||
| 0xccb4, 0x4cb4, 0x2cb4, 0xacb4, 0x34b4, 0xb4b4, 0xd4b4, 0x54b4, | |||||
| 0x32b4, 0xb2b4, 0xd2b4, 0x52b4, 0xcab4, 0x4ab4, 0x2ab4, 0xaab4, | |||||
| 0xccd4, 0x4cd4, 0x2cd4, 0xacd4, 0x34d4, 0xb4d4, 0xd4d4, 0x54d4, | |||||
| 0x32d4, 0xb2d4, 0xd2d4, 0x52d4, 0xcad4, 0x4ad4, 0x2ad4, 0xaad4, | |||||
| 0x3354, 0xb354, 0xd354, 0x5354, 0xcb54, 0x4b54, 0x2b54, 0xab54, | |||||
| 0xcd54, 0x4d54, 0x2d54, 0xad54, 0x3554, 0xb554, 0xd554, 0x5554, | |||||
| 0x3332, 0xb332, 0xd332, 0x5332, 0xcb32, 0x4b32, 0x2b32, 0xab32, | |||||
| 0xcd32, 0x4d32, 0x2d32, 0xad32, 0x3532, 0xb532, 0xd532, 0x5532, | |||||
| 0xccb2, 0x4cb2, 0x2cb2, 0xacb2, 0x34b2, 0xb4b2, 0xd4b2, 0x54b2, | |||||
| 0x32b2, 0xb2b2, 0xd2b2, 0x52b2, 0xcab2, 0x4ab2, 0x2ab2, 0xaab2, | |||||
| 0xccd2, 0x4cd2, 0x2cd2, 0xacd2, 0x34d2, 0xb4d2, 0xd4d2, 0x54d2, | |||||
| 0x32d2, 0xb2d2, 0xd2d2, 0x52d2, 0xcad2, 0x4ad2, 0x2ad2, 0xaad2, | |||||
| 0x3352, 0xb352, 0xd352, 0x5352, 0xcb52, 0x4b52, 0x2b52, 0xab52, | |||||
| 0xcd52, 0x4d52, 0x2d52, 0xad52, 0x3552, 0xb552, 0xd552, 0x5552, | |||||
| 0xccca, 0x4cca, 0x2cca, 0xacca, 0x34ca, 0xb4ca, 0xd4ca, 0x54ca, | |||||
| 0x32ca, 0xb2ca, 0xd2ca, 0x52ca, 0xcaca, 0x4aca, 0x2aca, 0xaaca, | |||||
| 0x334a, 0xb34a, 0xd34a, 0x534a, 0xcb4a, 0x4b4a, 0x2b4a, 0xab4a, | |||||
| 0xcd4a, 0x4d4a, 0x2d4a, 0xad4a, 0x354a, 0xb54a, 0xd54a, 0x554a, | |||||
| 0x332a, 0xb32a, 0xd32a, 0x532a, 0xcb2a, 0x4b2a, 0x2b2a, 0xab2a, | |||||
| 0xcd2a, 0x4d2a, 0x2d2a, 0xad2a, 0x352a, 0xb52a, 0xd52a, 0x552a, | |||||
| 0xccaa, 0x4caa, 0x2caa, 0xacaa, 0x34aa, 0xb4aa, 0xd4aa, 0x54aa, | |||||
| 0x32aa, 0xb2aa, 0xd2aa, 0x52aa, 0xcaaa, 0x4aaa, 0x2aaa, 0xaaaa | |||||
| }; | |||||
| #endif | #endif | ||||
| PROGMEM | |||||
| void AudioOutputSPDIF::begin(void) | void AudioOutputSPDIF::begin(void) | ||||
| { | { | ||||
| sample = *src++; | sample = *src++; | ||||
| //Subframe Channel 1 | //Subframe Channel 1 | ||||
| hi = bmclookup[(uint8_t)(sample >> 8)]; | |||||
| lo = bmclookup[(uint8_t) sample]; | |||||
| hi = spdif_bmclookup[(uint8_t)(sample >> 8)]; | |||||
| lo = spdif_bmclookup[(uint8_t) sample]; | |||||
| lo ^= (~((int16_t)hi) >> 16); | lo ^= (~((int16_t)hi) >> 16); | ||||
| // 16 Bit sample: | // 16 Bit sample: | ||||
| *(dest+1) = ((uint32_t)lo << 16) | hi; | *(dest+1) = ((uint32_t)lo << 16) | hi; | ||||
| sample = *src++; | sample = *src++; | ||||
| //Subframe Channel 2 | //Subframe Channel 2 | ||||
| hi = bmclookup[(uint8_t)(sample >> 8)]; | |||||
| lo = bmclookup[(uint8_t)sample]; | |||||
| hi = spdif_bmclookup[(uint8_t)(sample >> 8)]; | |||||
| lo = spdif_bmclookup[(uint8_t)sample]; | |||||
| lo ^= (~((int16_t)hi) >> 16); | lo ^= (~((int16_t)hi) >> 16); | ||||
| *(dest+1) = ( ((uint32_t)lo << 16) | hi ); | *(dest+1) = ( ((uint32_t)lo << 16) | hi ); | ||||
| } while (dest < end); | } while (dest < end); | ||||
| } | } | ||||
| #if IMXRT_CACHE_ENABLED >= 2 | |||||
| dest -= AUDIO_BLOCK_SAMPLES * 4/2 + 4/2; | |||||
| arm_dcache_flush_delete(dest, sizeof(SPDIF_tx_buffer) / 2 ); | |||||
| #endif | |||||
| } | } | ||||
| void AudioOutputSPDIF::mute_PCM(const bool mute) | void AudioOutputSPDIF::mute_PCM(const bool mute) | ||||
| #endif | #endif | ||||
| #endif | #endif | ||||
| PROGMEM | |||||
| void AudioOutputSPDIF::config_SPDIF(void) | void AudioOutputSPDIF::config_SPDIF(void) | ||||
| { | { | ||||
| #if defined(KINETISK) | #if defined(KINETISK) |
| uint16_t AudioOutputSPDIF2::block_left_offset = 0; | uint16_t AudioOutputSPDIF2::block_left_offset = 0; | ||||
| uint16_t AudioOutputSPDIF2::block_right_offset = 0; | uint16_t AudioOutputSPDIF2::block_right_offset = 0; | ||||
| bool AudioOutputSPDIF2::update_responsibility = false; | bool AudioOutputSPDIF2::update_responsibility = false; | ||||
| DMAChannel AudioOutputSPDIF2::dma(false); | |||||
| extern uint16_t spdif_bmclookup[256]; | |||||
| DMAMEM __attribute__((aligned(32))) | DMAMEM __attribute__((aligned(32))) | ||||
| static uint32_t SPDIF_tx_buffer[AUDIO_BLOCK_SAMPLES * 4]; //2 KB | static uint32_t SPDIF_tx_buffer[AUDIO_BLOCK_SAMPLES * 4]; //2 KB | ||||
| DMAChannel AudioOutputSPDIF2::dma(false); | |||||
| #define PREAMBLE_B (0xE8) //11101000 | #define PREAMBLE_B (0xE8) //11101000 | ||||
| #define PREAMBLE_M (0xE2) //11100010 | #define PREAMBLE_M (0xE2) //11100010 | ||||
| uint32_t AudioOutputSPDIF2::vucp = VUCP_VALID; | uint32_t AudioOutputSPDIF2::vucp = VUCP_VALID; | ||||
| static const | |||||
| uint16_t bmclookup[256] = { //biphase mark encoded values (least significant bit first) | |||||
| 0xcccc, 0x4ccc, 0x2ccc, 0xaccc, 0x34cc, 0xb4cc, 0xd4cc, 0x54cc, | |||||
| 0x32cc, 0xb2cc, 0xd2cc, 0x52cc, 0xcacc, 0x4acc, 0x2acc, 0xaacc, | |||||
| 0x334c, 0xb34c, 0xd34c, 0x534c, 0xcb4c, 0x4b4c, 0x2b4c, 0xab4c, | |||||
| 0xcd4c, 0x4d4c, 0x2d4c, 0xad4c, 0x354c, 0xb54c, 0xd54c, 0x554c, | |||||
| 0x332c, 0xb32c, 0xd32c, 0x532c, 0xcb2c, 0x4b2c, 0x2b2c, 0xab2c, | |||||
| 0xcd2c, 0x4d2c, 0x2d2c, 0xad2c, 0x352c, 0xb52c, 0xd52c, 0x552c, | |||||
| 0xccac, 0x4cac, 0x2cac, 0xacac, 0x34ac, 0xb4ac, 0xd4ac, 0x54ac, | |||||
| 0x32ac, 0xb2ac, 0xd2ac, 0x52ac, 0xcaac, 0x4aac, 0x2aac, 0xaaac, | |||||
| 0x3334, 0xb334, 0xd334, 0x5334, 0xcb34, 0x4b34, 0x2b34, 0xab34, | |||||
| 0xcd34, 0x4d34, 0x2d34, 0xad34, 0x3534, 0xb534, 0xd534, 0x5534, | |||||
| 0xccb4, 0x4cb4, 0x2cb4, 0xacb4, 0x34b4, 0xb4b4, 0xd4b4, 0x54b4, | |||||
| 0x32b4, 0xb2b4, 0xd2b4, 0x52b4, 0xcab4, 0x4ab4, 0x2ab4, 0xaab4, | |||||
| 0xccd4, 0x4cd4, 0x2cd4, 0xacd4, 0x34d4, 0xb4d4, 0xd4d4, 0x54d4, | |||||
| 0x32d4, 0xb2d4, 0xd2d4, 0x52d4, 0xcad4, 0x4ad4, 0x2ad4, 0xaad4, | |||||
| 0x3354, 0xb354, 0xd354, 0x5354, 0xcb54, 0x4b54, 0x2b54, 0xab54, | |||||
| 0xcd54, 0x4d54, 0x2d54, 0xad54, 0x3554, 0xb554, 0xd554, 0x5554, | |||||
| 0x3332, 0xb332, 0xd332, 0x5332, 0xcb32, 0x4b32, 0x2b32, 0xab32, | |||||
| 0xcd32, 0x4d32, 0x2d32, 0xad32, 0x3532, 0xb532, 0xd532, 0x5532, | |||||
| 0xccb2, 0x4cb2, 0x2cb2, 0xacb2, 0x34b2, 0xb4b2, 0xd4b2, 0x54b2, | |||||
| 0x32b2, 0xb2b2, 0xd2b2, 0x52b2, 0xcab2, 0x4ab2, 0x2ab2, 0xaab2, | |||||
| 0xccd2, 0x4cd2, 0x2cd2, 0xacd2, 0x34d2, 0xb4d2, 0xd4d2, 0x54d2, | |||||
| 0x32d2, 0xb2d2, 0xd2d2, 0x52d2, 0xcad2, 0x4ad2, 0x2ad2, 0xaad2, | |||||
| 0x3352, 0xb352, 0xd352, 0x5352, 0xcb52, 0x4b52, 0x2b52, 0xab52, | |||||
| 0xcd52, 0x4d52, 0x2d52, 0xad52, 0x3552, 0xb552, 0xd552, 0x5552, | |||||
| 0xccca, 0x4cca, 0x2cca, 0xacca, 0x34ca, 0xb4ca, 0xd4ca, 0x54ca, | |||||
| 0x32ca, 0xb2ca, 0xd2ca, 0x52ca, 0xcaca, 0x4aca, 0x2aca, 0xaaca, | |||||
| 0x334a, 0xb34a, 0xd34a, 0x534a, 0xcb4a, 0x4b4a, 0x2b4a, 0xab4a, | |||||
| 0xcd4a, 0x4d4a, 0x2d4a, 0xad4a, 0x354a, 0xb54a, 0xd54a, 0x554a, | |||||
| 0x332a, 0xb32a, 0xd32a, 0x532a, 0xcb2a, 0x4b2a, 0x2b2a, 0xab2a, | |||||
| 0xcd2a, 0x4d2a, 0x2d2a, 0xad2a, 0x352a, 0xb52a, 0xd52a, 0x552a, | |||||
| 0xccaa, 0x4caa, 0x2caa, 0xacaa, 0x34aa, 0xb4aa, 0xd4aa, 0x54aa, | |||||
| 0x32aa, 0xb2aa, 0xd2aa, 0x52aa, 0xcaaa, 0x4aaa, 0x2aaa, 0xaaaa | |||||
| }; | |||||
| PROGMEM | PROGMEM | ||||
| void AudioOutputSPDIF2::begin(void) | void AudioOutputSPDIF2::begin(void) | ||||
| { | { | ||||
| sample = *src++; | sample = *src++; | ||||
| //Subframe Channel 1 | //Subframe Channel 1 | ||||
| hi = bmclookup[(uint8_t)(sample >> 8)]; | |||||
| lo = bmclookup[(uint8_t) sample]; | |||||
| hi = spdif_bmclookup[(uint8_t)(sample >> 8)]; | |||||
| lo = spdif_bmclookup[(uint8_t) sample]; | |||||
| lo ^= (~((int16_t)hi) >> 16); | lo ^= (~((int16_t)hi) >> 16); | ||||
| // 16 Bit sample: | // 16 Bit sample: | ||||
| *(dest+1) = ((uint32_t)lo << 16) | hi; | *(dest+1) = ((uint32_t)lo << 16) | hi; | ||||
| sample = *src++; | sample = *src++; | ||||
| //Subframe Channel 2 | //Subframe Channel 2 | ||||
| hi = bmclookup[(uint8_t)(sample >> 8)]; | |||||
| lo = bmclookup[(uint8_t)sample]; | |||||
| hi = spdif_bmclookup[(uint8_t)(sample >> 8)]; | |||||
| lo = spdif_bmclookup[(uint8_t)sample]; | |||||
| lo ^= (~((int16_t)hi) >> 16); | lo ^= (~((int16_t)hi) >> 16); | ||||
| *(dest+1) = ( ((uint32_t)lo << 16) | hi ); | *(dest+1) = ( ((uint32_t)lo << 16) | hi ); |