visus
/
framework-arduinoteensy-cxx20
Следить 1
В избранное 0
Форкнуть 0
Код Задачи 0 Pull Request'ы 0 Релизы 0 Вики Активность
PlatformIO package of the Teensy core framework compatible with GCC 10 & C++20
Вы не можете выбрать более 25 тем Темы должны начинаться с буквы или цифры, могут содержать дефисы(-) и должны содержать не более 35 символов.
2 коммитов
1 ветка
Дерево: daa7cc5a30
Ветки Теги
${ item.name }
Создать ветку ${ searchTerm }
из 'daa7cc5a30'
${ noResults }
framework-arduinoteensy-cxx20/libraries/Audio/output_adat.cpp

743 lines
34KB
Исходник Blame История 

  1. /* ADAT for Teensy 3.X

  2.  * Copyright (c) 2017, Ernstjan Freriks,

  3.  * Thanks to Frank Bösing & KPC & Paul Stoffregen!

  4.  *

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

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

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

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

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

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

  11.  *

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

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

  14.  *

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

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

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

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

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

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

  21.  * THE SOFTWARE.

  22.  */

  23. 

  24. #include <Arduino.h>

  25. #include "output_adat.h"

  26. 

  27. #if defined(KINETISK)

  28. 

  29. audio_block_t * AudioOutputADAT::block_ch1_1st = NULL;

  30. audio_block_t * AudioOutputADAT::block_ch2_1st = NULL;

  31. audio_block_t * AudioOutputADAT::block_ch3_1st = NULL;

  32. audio_block_t * AudioOutputADAT::block_ch4_1st = NULL;

  33. audio_block_t * AudioOutputADAT::block_ch5_1st = NULL;

  34. audio_block_t * AudioOutputADAT::block_ch6_1st = NULL;

  35. audio_block_t * AudioOutputADAT::block_ch7_1st = NULL;

  36. audio_block_t * AudioOutputADAT::block_ch8_1st = NULL;

  37. 

  38. audio_block_t * AudioOutputADAT::block_ch1_2nd = NULL;

  39. audio_block_t * AudioOutputADAT::block_ch2_2nd = NULL;

  40. audio_block_t * AudioOutputADAT::block_ch3_2nd = NULL;

  41. audio_block_t * AudioOutputADAT::block_ch4_2nd = NULL;

  42. audio_block_t * AudioOutputADAT::block_ch5_2nd = NULL;

  43. audio_block_t * AudioOutputADAT::block_ch6_2nd = NULL;

  44. audio_block_t * AudioOutputADAT::block_ch7_2nd = NULL;

  45. audio_block_t * AudioOutputADAT::block_ch8_2nd = NULL;

  46. 

  47. uint16_t  AudioOutputADAT::ch1_offset = 0;

  48. uint16_t  AudioOutputADAT::ch2_offset = 0;

  49. uint16_t  AudioOutputADAT::ch3_offset = 0;

  50. uint16_t  AudioOutputADAT::ch4_offset = 0;

  51. uint16_t  AudioOutputADAT::ch5_offset = 0;

  52. uint16_t  AudioOutputADAT::ch6_offset = 0;

  53. uint16_t  AudioOutputADAT::ch7_offset = 0;

  54. uint16_t  AudioOutputADAT::ch8_offset = 0;

  55. 

  56. bool AudioOutputADAT::update_responsibility = false;

  57. //uint32_t  AudioOutputADAT::vucp = VUCP_VALID;

  58. 

  59. DMAMEM __attribute__((aligned(32))) static uint32_t ADAT_tx_buffer[AUDIO_BLOCK_SAMPLES * 8]; //4 KB, AUDIO_BLOCK_SAMPLES is usually 128

  60. 

  61. DMAChannel AudioOutputADAT::dma(false);

  62. 

  63. static const uint32_t zerodata[AUDIO_BLOCK_SAMPLES/4] = {0};

  64. 

  65. // These are the lookup tables. There are four of them so that the remainder of the 32 bit result can easily be XORred with the next 8 bits.

  66. static const uint32_t LookupTable_firstword[256]  = { 0x0, 0x1ffffff, 0x3ffffff, 0x2000000, 0x7ffffff, 0x6000000, 0x4000000, 0x5ffffff, 0xfffffff, 0xe000000, 0xc000000, 0xdffffff, 0x8000000, 0x9ffffff, 0xbffffff, 0xa000000, 0x1fffffff, 0x1e000000, 0x1c000000, 0x1dffffff, 0x18000000, 0x19ffffff, 0x1bffffff, 0x1a000000, 0x10000000, 0x11ffffff, 0x13ffffff, 0x12000000, 0x17ffffff, 0x16000000, 0x14000000, 0x15ffffff, 0x3fffffff, 0x3e000000, 0x3c000000, 0x3dffffff, 0x38000000, 0x39ffffff, 0x3bffffff, 0x3a000000, 0x30000000, 0x31ffffff, 0x33ffffff, 0x32000000, 0x37ffffff, 0x36000000, 0x34000000, 0x35ffffff, 0x20000000, 0x21ffffff, 0x23ffffff, 0x22000000, 0x27ffffff, 0x26000000, 0x24000000, 0x25ffffff, 0x2fffffff, 0x2e000000, 0x2c000000, 0x2dffffff, 0x28000000, 0x29ffffff, 0x2bffffff, 0x2a000000, 0x7fffffff, 0x7e000000, 0x7c000000, 0x7dffffff, 0x78000000, 0x79ffffff, 0x7bffffff, 0x7a000000, 0x70000000, 0x71ffffff, 0x73ffffff, 0x72000000, 0x77ffffff, 0x76000000, 0x74000000, 0x75ffffff, 0x60000000, 0x61ffffff, 0x63ffffff, 0x62000000, 0x67ffffff, 0x66000000, 0x64000000, 0x65ffffff, 0x6fffffff, 0x6e000000, 0x6c000000, 0x6dffffff, 0x68000000, 0x69ffffff, 0x6bffffff, 0x6a000000, 0x40000000, 0x41ffffff, 0x43ffffff, 0x42000000, 0x47ffffff, 0x46000000, 0x44000000, 0x45ffffff, 0x4fffffff, 0x4e000000, 0x4c000000, 0x4dffffff, 0x48000000, 0x49ffffff, 0x4bffffff, 0x4a000000, 0x5fffffff, 0x5e000000, 0x5c000000, 0x5dffffff, 0x58000000, 0x59ffffff, 0x5bffffff, 0x5a000000, 0x50000000, 0x51ffffff, 0x53ffffff, 0x52000000, 0x57ffffff, 0x56000000, 0x54000000, 0x55ffffff, 0xffffffff, 0xfe000000, 0xfc000000, 0xfdffffff, 0xf8000000, 0xf9ffffff, 0xfbffffff, 0xfa000000, 0xf0000000, 0xf1ffffff, 0xf3ffffff, 0xf2000000, 0xf7ffffff, 0xf6000000, 0xf4000000, 0xf5ffffff, 0xe0000000, 0xe1ffffff, 0xe3ffffff, 0xe2000000, 0xe7ffffff, 0xe6000000, 0xe4000000, 0xe5ffffff, 0xefffffff, 0xee000000, 0xec000000, 0xedffffff, 0xe8000000, 0xe9ffffff, 0xebffffff, 0xea000000, 0xc0000000, 0xc1ffffff, 0xc3ffffff, 0xc2000000, 0xc7ffffff, 0xc6000000, 0xc4000000, 0xc5ffffff, 0xcfffffff, 0xce000000, 0xcc000000, 0xcdffffff, 0xc8000000, 0xc9ffffff, 0xcbffffff, 0xca000000, 0xdfffffff, 0xde000000, 0xdc000000, 0xddffffff, 0xd8000000, 0xd9ffffff, 0xdbffffff, 0xda000000, 0xd0000000, 0xd1ffffff, 0xd3ffffff, 0xd2000000, 0xd7ffffff, 0xd6000000, 0xd4000000, 0xd5ffffff, 0x80000000, 0x81ffffff, 0x83ffffff, 0x82000000, 0x87ffffff, 0x86000000, 0x84000000, 0x85ffffff, 0x8fffffff, 0x8e000000, 0x8c000000, 0x8dffffff, 0x88000000, 0x89ffffff, 0x8bffffff, 0x8a000000, 0x9fffffff, 0x9e000000, 0x9c000000, 0x9dffffff, 0x98000000, 0x99ffffff, 0x9bffffff, 0x9a000000, 0x90000000, 0x91ffffff, 0x93ffffff, 0x92000000, 0x97ffffff, 0x96000000, 0x94000000, 0x95ffffff, 0xbfffffff, 0xbe000000, 0xbc000000, 0xbdffffff, 0xb8000000, 0xb9ffffff, 0xbbffffff, 0xba000000, 0xb0000000, 0xb1ffffff, 0xb3ffffff, 0xb2000000, 0xb7ffffff, 0xb6000000, 0xb4000000, 0xb5ffffff, 0xa0000000, 0xa1ffffff, 0xa3ffffff, 0xa2000000, 0xa7ffffff, 0xa6000000, 0xa4000000, 0xa5ffffff, 0xafffffff, 0xae000000, 0xac000000, 0xadffffff, 0xa8000000, 0xa9ffffff, 0xabffffff, 0xaa000000};

  67. static const uint32_t LookupTable_secondword[256] = { 0x0, 0x1ffff, 0x3ffff, 0x20000, 0x7ffff, 0x60000, 0x40000, 0x5ffff, 0xfffff, 0xe0000, 0xc0000, 0xdffff, 0x80000, 0x9ffff, 0xbffff, 0xa0000, 0x1fffff, 0x1e0000, 0x1c0000, 0x1dffff, 0x180000, 0x19ffff, 0x1bffff, 0x1a0000, 0x100000, 0x11ffff, 0x13ffff, 0x120000, 0x17ffff, 0x160000, 0x140000, 0x15ffff, 0x3fffff, 0x3e0000, 0x3c0000, 0x3dffff, 0x380000, 0x39ffff, 0x3bffff, 0x3a0000, 0x300000, 0x31ffff, 0x33ffff, 0x320000, 0x37ffff, 0x360000, 0x340000, 0x35ffff, 0x200000, 0x21ffff, 0x23ffff, 0x220000, 0x27ffff, 0x260000, 0x240000, 0x25ffff, 0x2fffff, 0x2e0000, 0x2c0000, 0x2dffff, 0x280000, 0x29ffff, 0x2bffff, 0x2a0000, 0x7fffff, 0x7e0000, 0x7c0000, 0x7dffff, 0x780000, 0x79ffff, 0x7bffff, 0x7a0000, 0x700000, 0x71ffff, 0x73ffff, 0x720000, 0x77ffff, 0x760000, 0x740000, 0x75ffff, 0x600000, 0x61ffff, 0x63ffff, 0x620000, 0x67ffff, 0x660000, 0x640000, 0x65ffff, 0x6fffff, 0x6e0000, 0x6c0000, 0x6dffff, 0x680000, 0x69ffff, 0x6bffff, 0x6a0000, 0x400000, 0x41ffff, 0x43ffff, 0x420000, 0x47ffff, 0x460000, 0x440000, 0x45ffff, 0x4fffff, 0x4e0000, 0x4c0000, 0x4dffff, 0x480000, 0x49ffff, 0x4bffff, 0x4a0000, 0x5fffff, 0x5e0000, 0x5c0000, 0x5dffff, 0x580000, 0x59ffff, 0x5bffff, 0x5a0000, 0x500000, 0x51ffff, 0x53ffff, 0x520000, 0x57ffff, 0x560000, 0x540000, 0x55ffff, 0xffffff, 0xfe0000, 0xfc0000, 0xfdffff, 0xf80000, 0xf9ffff, 0xfbffff, 0xfa0000, 0xf00000, 0xf1ffff, 0xf3ffff, 0xf20000, 0xf7ffff, 0xf60000, 0xf40000, 0xf5ffff, 0xe00000, 0xe1ffff, 0xe3ffff, 0xe20000, 0xe7ffff, 0xe60000, 0xe40000, 0xe5ffff, 0xefffff, 0xee0000, 0xec0000, 0xedffff, 0xe80000, 0xe9ffff, 0xebffff, 0xea0000, 0xc00000, 0xc1ffff, 0xc3ffff, 0xc20000, 0xc7ffff, 0xc60000, 0xc40000, 0xc5ffff, 0xcfffff, 0xce0000, 0xcc0000, 0xcdffff, 0xc80000, 0xc9ffff, 0xcbffff, 0xca0000, 0xdfffff, 0xde0000, 0xdc0000, 0xddffff, 0xd80000, 0xd9ffff, 0xdbffff, 0xda0000, 0xd00000, 0xd1ffff, 0xd3ffff, 0xd20000, 0xd7ffff, 0xd60000, 0xd40000, 0xd5ffff, 0x800000, 0x81ffff, 0x83ffff, 0x820000, 0x87ffff, 0x860000, 0x840000, 0x85ffff, 0x8fffff, 0x8e0000, 0x8c0000, 0x8dffff, 0x880000, 0x89ffff, 0x8bffff, 0x8a0000, 0x9fffff, 0x9e0000, 0x9c0000, 0x9dffff, 0x980000, 0x99ffff, 0x9bffff, 0x9a0000, 0x900000, 0x91ffff, 0x93ffff, 0x920000, 0x97ffff, 0x960000, 0x940000, 0x95ffff, 0xbfffff, 0xbe0000, 0xbc0000, 0xbdffff, 0xb80000, 0xb9ffff, 0xbbffff, 0xba0000, 0xb00000, 0xb1ffff, 0xb3ffff, 0xb20000, 0xb7ffff, 0xb60000, 0xb40000, 0xb5ffff, 0xa00000, 0xa1ffff, 0xa3ffff, 0xa20000, 0xa7ffff, 0xa60000, 0xa40000, 0xa5ffff, 0xafffff, 0xae0000, 0xac0000, 0xadffff, 0xa80000, 0xa9ffff, 0xabffff, 0xaa0000};

  68. static const uint32_t LookupTable_thirdword[256]  = { 0x0, 0x1ff, 0x3ff, 0x200, 0x7ff, 0x600, 0x400, 0x5ff, 0xfff, 0xe00, 0xc00, 0xdff, 0x800, 0x9ff, 0xbff, 0xa00, 0x1fff, 0x1e00, 0x1c00, 0x1dff, 0x1800, 0x19ff, 0x1bff, 0x1a00, 0x1000, 0x11ff, 0x13ff, 0x1200, 0x17ff, 0x1600, 0x1400, 0x15ff, 0x3fff, 0x3e00, 0x3c00, 0x3dff, 0x3800, 0x39ff, 0x3bff, 0x3a00, 0x3000, 0x31ff, 0x33ff, 0x3200, 0x37ff, 0x3600, 0x3400, 0x35ff, 0x2000, 0x21ff, 0x23ff, 0x2200, 0x27ff, 0x2600, 0x2400, 0x25ff, 0x2fff, 0x2e00, 0x2c00, 0x2dff, 0x2800, 0x29ff, 0x2bff, 0x2a00, 0x7fff, 0x7e00, 0x7c00, 0x7dff, 0x7800, 0x79ff, 0x7bff, 0x7a00, 0x7000, 0x71ff, 0x73ff, 0x7200, 0x77ff, 0x7600, 0x7400, 0x75ff, 0x6000, 0x61ff, 0x63ff, 0x6200, 0x67ff, 0x6600, 0x6400, 0x65ff, 0x6fff, 0x6e00, 0x6c00, 0x6dff, 0x6800, 0x69ff, 0x6bff, 0x6a00, 0x4000, 0x41ff, 0x43ff, 0x4200, 0x47ff, 0x4600, 0x4400, 0x45ff, 0x4fff, 0x4e00, 0x4c00, 0x4dff, 0x4800, 0x49ff, 0x4bff, 0x4a00, 0x5fff, 0x5e00, 0x5c00, 0x5dff, 0x5800, 0x59ff, 0x5bff, 0x5a00, 0x5000, 0x51ff, 0x53ff, 0x5200, 0x57ff, 0x5600, 0x5400, 0x55ff, 0xffff, 0xfe00, 0xfc00, 0xfdff, 0xf800, 0xf9ff, 0xfbff, 0xfa00, 0xf000, 0xf1ff, 0xf3ff, 0xf200, 0xf7ff, 0xf600, 0xf400, 0xf5ff, 0xe000, 0xe1ff, 0xe3ff, 0xe200, 0xe7ff, 0xe600, 0xe400, 0xe5ff, 0xefff, 0xee00, 0xec00, 0xedff, 0xe800, 0xe9ff, 0xebff, 0xea00, 0xc000, 0xc1ff, 0xc3ff, 0xc200, 0xc7ff, 0xc600, 0xc400, 0xc5ff, 0xcfff, 0xce00, 0xcc00, 0xcdff, 0xc800, 0xc9ff, 0xcbff, 0xca00, 0xdfff, 0xde00, 0xdc00, 0xddff, 0xd800, 0xd9ff, 0xdbff, 0xda00, 0xd000, 0xd1ff, 0xd3ff, 0xd200, 0xd7ff, 0xd600, 0xd400, 0xd5ff, 0x8000, 0x81ff, 0x83ff, 0x8200, 0x87ff, 0x8600, 0x8400, 0x85ff, 0x8fff, 0x8e00, 0x8c00, 0x8dff, 0x8800, 0x89ff, 0x8bff, 0x8a00, 0x9fff, 0x9e00, 0x9c00, 0x9dff, 0x9800, 0x99ff, 0x9bff, 0x9a00, 0x9000, 0x91ff, 0x93ff, 0x9200, 0x97ff, 0x9600, 0x9400, 0x95ff, 0xbfff, 0xbe00, 0xbc00, 0xbdff, 0xb800, 0xb9ff, 0xbbff, 0xba00, 0xb000, 0xb1ff, 0xb3ff, 0xb200, 0xb7ff, 0xb600, 0xb400, 0xb5ff, 0xa000, 0xa1ff, 0xa3ff, 0xa200, 0xa7ff, 0xa600, 0xa400, 0xa5ff, 0xafff, 0xae00, 0xac00, 0xadff, 0xa800, 0xa9ff, 0xabff, 0xaa00};

  69. static const uint32_t LookupTable_fourthword[256] = { 0x0, 0x1, 0x3, 0x2, 0x7, 0x6, 0x4, 0x5, 0xf, 0xe, 0xc, 0xd, 0x8, 0x9, 0xb, 0xa, 0x1f, 0x1e, 0x1c, 0x1d, 0x18, 0x19, 0x1b, 0x1a, 0x10, 0x11, 0x13, 0x12, 0x17, 0x16, 0x14, 0x15, 0x3f, 0x3e, 0x3c, 0x3d, 0x38, 0x39, 0x3b, 0x3a, 0x30, 0x31, 0x33, 0x32, 0x37, 0x36, 0x34, 0x35, 0x20, 0x21, 0x23, 0x22, 0x27, 0x26, 0x24, 0x25, 0x2f, 0x2e, 0x2c, 0x2d, 0x28, 0x29, 0x2b, 0x2a, 0x7f, 0x7e, 0x7c, 0x7d, 0x78, 0x79, 0x7b, 0x7a, 0x70, 0x71, 0x73, 0x72, 0x77, 0x76, 0x74, 0x75, 0x60, 0x61, 0x63, 0x62, 0x67, 0x66, 0x64, 0x65, 0x6f, 0x6e, 0x6c, 0x6d, 0x68, 0x69, 0x6b, 0x6a, 0x40, 0x41, 0x43, 0x42, 0x47, 0x46, 0x44, 0x45, 0x4f, 0x4e, 0x4c, 0x4d, 0x48, 0x49, 0x4b, 0x4a, 0x5f, 0x5e, 0x5c, 0x5d, 0x58, 0x59, 0x5b, 0x5a, 0x50, 0x51, 0x53, 0x52, 0x57, 0x56, 0x54, 0x55, 0xff, 0xfe, 0xfc, 0xfd, 0xf8, 0xf9, 0xfb, 0xfa, 0xf0, 0xf1, 0xf3, 0xf2, 0xf7, 0xf6, 0xf4, 0xf5, 0xe0, 0xe1, 0xe3, 0xe2, 0xe7, 0xe6, 0xe4, 0xe5, 0xef, 0xee, 0xec, 0xed, 0xe8, 0xe9, 0xeb, 0xea, 0xc0, 0xc1, 0xc3, 0xc2, 0xc7, 0xc6, 0xc4, 0xc5, 0xcf, 0xce, 0xcc, 0xcd, 0xc8, 0xc9, 0xcb, 0xca, 0xdf, 0xde, 0xdc, 0xdd, 0xd8, 0xd9, 0xdb, 0xda, 0xd0, 0xd1, 0xd3, 0xd2, 0xd7, 0xd6, 0xd4, 0xd5, 0x80, 0x81, 0x83, 0x82, 0x87, 0x86, 0x84, 0x85, 0x8f, 0x8e, 0x8c, 0x8d, 0x88, 0x89, 0x8b, 0x8a, 0x9f, 0x9e, 0x9c, 0x9d, 0x98, 0x99, 0x9b, 0x9a, 0x90, 0x91, 0x93, 0x92, 0x97, 0x96, 0x94, 0x95, 0xbf, 0xbe, 0xbc, 0xbd, 0xb8, 0xb9, 0xbb, 0xba, 0xb0, 0xb1, 0xb3, 0xb2, 0xb7, 0xb6, 0xb4, 0xb5, 0xa0, 0xa1, 0xa3, 0xa2, 0xa7, 0xa6, 0xa4, 0xa5, 0xaf, 0xae, 0xac, 0xad, 0xa8, 0xa9, 0xab, 0xaa};

  70. 

  71. void AudioOutputADAT::begin(void)

  72. {

  73. 

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

  75. 

  76. 	block_ch1_1st = NULL;

  77. 	block_ch2_1st = NULL;

  78. 	block_ch3_1st = NULL;

  79. 	block_ch4_1st = NULL;

  80. 	block_ch5_1st = NULL;

  81. 	block_ch6_1st = NULL;

  82. 	block_ch7_1st = NULL;

  83. 	block_ch8_1st = NULL;

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

  85. 	config_ADAT();

  86. 	CORE_PIN22_CONFIG = PORT_PCR_MUX(6); // pin 22, PTC1, I2S0_TXD0

  87. 

  88. 	const int nbytes_mlno = 2 * 8; // 16 Bytes per minor loop

  89. 

  90. 	dma.TCD->SADDR = ADAT_tx_buffer;

  91. 	dma.TCD->SOFF = 4;

  92. 	dma.TCD->ATTR = DMA_TCD_ATTR_SSIZE(2) | DMA_TCD_ATTR_DSIZE(2); //transfersize 2 = 32 bit, 5 = 32 byte

  93. 	dma.TCD->NBYTES_MLNO = nbytes_mlno;

  94. 	dma.TCD->SLAST = -sizeof(ADAT_tx_buffer);

  95. 	dma.TCD->DADDR = &I2S0_TDR0;

  96. 	dma.TCD->DOFF = 0;

  97. 	dma.TCD->CITER_ELINKNO = sizeof(ADAT_tx_buffer) / nbytes_mlno;

  98. 	dma.TCD->DLASTSGA = 0;

  99. 	dma.TCD->BITER_ELINKNO = sizeof(ADAT_tx_buffer) / nbytes_mlno;

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

  101. 	dma.triggerAtHardwareEvent(DMAMUX_SOURCE_I2S0_TX);

  102. 	update_responsibility = update_setup();

  103. 	dma.enable();

  104. 

  105. 	I2S0_TCSR |= I2S_TCSR_TE | I2S_TCSR_BCE | I2S_TCSR_FRDE | I2S_TCSR_FR;

  106. 	dma.attachInterrupt(isr);

  107. 

  108. }

  109. 

  110. /*

  111. 

  112. 	https://ackspace.nl/wiki/ADAT_project

  113. 	https://github.com/xcore/sc_adat/blob/master/module_adat_tx/src/adat_tx_port.xc

  114. 

  115. 	for information about the clock:

  116. 

  117. 	http://cache.freescale.com/files/32bit/doc/app_note/AN4800.pdf

  118. 

  119. 	We need a bitrate twice as high as the SPDIF example.

  120. 	Because BITCLK can not be the same as MCLK, but only half of MCLK, we need a 2*MCLK (so for 44100 samplerate we need 88200 MCLK)

  121. */

  122. 

  123. void AudioOutputADAT::isr(void)

  124. {

  125. 	const int16_t *src1, *src2, *src3, *src4,*src5, *src6, *src7, *src8;

  126. 	const int16_t *zeros = (const int16_t *)zerodata;

  127. 

  128. 	uint32_t *end, *dest;

  129. 	uint32_t saddr;

  130. 	uint32_t sample1, sample2, sample3, sample4, sample5, sample6, sample7, sample8;

  131. 

  132. 	static uint32_t previousnrzi_highlow = 0; //this is used for the NZRI encoding to remember the last state.

  133. 	// if the result of the lookup table LSB is other than this lastbit, the result of the lookup table must be inverted.

  134. 

  135. 	//static bool previousframeinverted=false;

  136. 

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

  138. 	dma.clearInterrupt();

  139. 	if (saddr < (uint32_t)ADAT_tx_buffer + sizeof(ADAT_tx_buffer) / 2) {

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

  141. 		// so we must fill the second half

  142. 		dest = (uint32_t *)&ADAT_tx_buffer[AUDIO_BLOCK_SAMPLES * 8/2];

  143. 		end = (uint32_t *)&ADAT_tx_buffer[AUDIO_BLOCK_SAMPLES * 8];

  144. 		if (AudioOutputADAT::update_responsibility) AudioStream::update_all();

  145. 	} else {

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

  147. 		// so we must fill the first half

  148. 		dest = (uint32_t *)ADAT_tx_buffer;

  149. 		end = (uint32_t *)&ADAT_tx_buffer[AUDIO_BLOCK_SAMPLES * 8/2];

  150. 	}

  151. 

  152. 	src1 = (block_ch1_1st) ? block_ch1_1st->data + ch1_offset : zeros;

  153. 	src2 = (block_ch2_1st) ? block_ch2_1st->data + ch2_offset : zeros;

  154. 	src3 = (block_ch3_1st) ? block_ch3_1st->data + ch3_offset : zeros;

  155. 	src4 = (block_ch4_1st) ? block_ch4_1st->data + ch4_offset : zeros;

  156. 	src5 = (block_ch5_1st) ? block_ch5_1st->data + ch5_offset : zeros;

  157. 	src6 = (block_ch6_1st) ? block_ch6_1st->data + ch6_offset : zeros;

  158. 	src7 = (block_ch7_1st) ? block_ch7_1st->data + ch7_offset : zeros;

  159. 	src8 = (block_ch8_1st) ? block_ch8_1st->data + ch8_offset : zeros;

  160. 

  161. 

  162. 	//Non-NZRI encoded 'empty' ADAT Frame

  163. 	/*     

  164. 	*(dest+0) = 0b10000100001000010000100001000010; // bit 0-31

  165. 	*(dest+1) = 0b00010000100001000010000100001000; // bit 32-63

  166. 	*(dest+2) = 0b01000010000100001000010000100001; // bit 64-95

  167. 	*(dest+3) = 0b00001000010000100001000010000100; // bit 96-127

  168. 

  169. 	*(dest+4) = 0b00100001000010000100001000010000; // bit 128-159

  170. 	*(dest+5) = 0b10000100001000010000100001000010; // bit 160-191

  171. 	*(dest+6) = 0b00010000100001000010000100001000; // bit 192-223

  172. 	*(dest+7) = 0b01000010000100001000000000010000; // bit 224-255

  173. 

  174. 	dest+=8;

  175. 

  176. 	*/

  177. 

  178. 	/*

  179. 	//NZRI encoded 'empty' ADAT Frame

  180. 

  181. 	*(dest+0) = 0b11111000001111100000111110000011; // bit 0-31

  182. 	*(dest+1) = 0b11100000111110000011111000001111; // bit 32-63

  183. 	*(dest+2) = 0b10000011111000001111100000111110; // bit 64-95

  184. 	*(dest+3) = 0b00001111100000111110000011111000; // bit 96-127

  185. 

  186. 	*(dest+4) = 0b00111110000011111000001111100000; // bit 128-159

  187. 	*(dest+5) = 0b11111000001111100000111110000011; // bit 160-191

  188. 	*(dest+6) = 0b11100000111110000011111000001111; // bit 192-223

  189. 	*(dest+7) = 0b10000011111000001111111111100000; // bit 224-255

  190. 

  191. 	dest+=8;

  192. 

  193. 	*/

  194. 

  195. 	do

  196. 	{

  197. 		sample1 = (*src1++);

  198. 		sample2 = (*src2++);

  199. 		sample3 = (*src3++);

  200. 		sample4 = (*src4++);

  201. 		sample5 = (*src5++);

  202. 		sample6 = (*src6++);

  203. 		sample7 = (*src7++);

  204. 		sample8 = (*src8++);

  205. 

  206. 		uint32_t value;

  207. 		uint32_t nzrivalue;

  208. 

  209. 		value=				 0b10000100001000010000100001000010 /* bit  0-31 */ 

  210. //							  b00000000000000001000000000000000 // start of 16 bit sample

  211. 			| ((sample1<<15)&0b01111000000000000000000000000000) 

  212. 			| ((sample1<<14)&0b00000011110000000000000000000000) 

  213. 			| ((sample1<<13)&0b00000000000111100000000000000000)   

  214. 			| ((sample1<<12)&0b00000000000000001111000000000000) 

  215. 			| ((sample2>>15)&0b00000000000000000000000000000001)

  216. 			; 

  217. 		nzrivalue = previousnrzi_highlow ^ (LookupTable_firstword[(byte)(value >> 24)] ^ LookupTable_secondword[(byte)(value >> 16)] ^ LookupTable_thirdword[(byte)(value >> 8)] ^ LookupTable_fourthword[(byte)value]);

  218. 		*(dest+0) = nzrivalue;

  219.         previousnrzi_highlow = ((nzrivalue & 0b1) == 0b1) ? ~0U : 0U;

  220. 		

  221. 		value =				 0b00010000100001000010000100001000 /* bit 32-63 */ 

  222. //							  b00000000000000001000100010001000 // start of 16 bit sample

  223. 			| ((sample2<<17)&0b11100000000000000000000000000000) 

  224. 			| ((sample2<<16)&0b00001111000000000000000000000000) 

  225. 			| ((sample2<<15)&0b00000000011110000000000000000000)   

  226. 			| ((sample2<<14)&0b00000000000000111100000000000000) 

  227. 			| ((sample3>>13)&0b00000000000000000000000000000111)

  228. 			; 

  229. 		nzrivalue = previousnrzi_highlow ^ (LookupTable_firstword[(byte)(value >> 24)] ^ LookupTable_secondword[(byte)(value >> 16)] ^ LookupTable_thirdword[(byte)(value >> 8)] ^ LookupTable_fourthword[(byte)value]);

  230. 		*(dest+1) = nzrivalue;

  231.         previousnrzi_highlow = ((nzrivalue & 0b1) == 0b1) ? ~0U : 0U;

  232. 

  233. 

  234. 		value =				 0b01000010000100001000010000100001 /* bit 64-95 */ 

  235. //							  b00000000000000001000000000000000 // start of 16 bit sample

  236. 			| ((sample3<<19)&0b10000000000000000000000000000000) 

  237. 			| ((sample3<<18)&0b00111100000000000000000000000000)  

  238. 			| ((sample3<<17)&0b00000001111000000000000000000000)  

  239. 			| ((sample3<<16)&0b00000000000011110000000000000000) 

  240. 			| ((sample4>>11)&0b00000000000000000000000000011110)

  241. 			;

  242. 		nzrivalue = previousnrzi_highlow ^ (LookupTable_firstword[(byte)(value >> 24)] ^ LookupTable_secondword[(byte)(value >> 16)] ^ LookupTable_thirdword[(byte)(value >> 8)] ^ LookupTable_fourthword[(byte)value]);

  243. 		*(dest+2) = nzrivalue;

  244.         previousnrzi_highlow = ((nzrivalue & 0b1) == 0b1) ? ~0U : 0U;

  245. 

  246. 		value =				 0b00001000010000100001000010000100 /* bit 96-127 */ 

  247. //							  b00000000000000001000100010001000 // start of 16 bit sample

  248. 			| ((sample4<<20)&0b11110000000000000000000000000000) 

  249. 			| ((sample4<<19)&0b00000111100000000000000000000000) 

  250. 			| ((sample4<<18)&0b00000000001111000000000000000000) 

  251. 			| ((sample5>>9 )&0b00000000000000000000000001111000) 

  252. 			| ((sample5>>10)&0b00000000000000000000000000000011) 

  253. 			;

  254. 		nzrivalue = previousnrzi_highlow ^ (LookupTable_firstword[(byte)(value >> 24)] ^ LookupTable_secondword[(byte)(value >> 16)] ^ LookupTable_thirdword[(byte)(value >> 8)] ^ LookupTable_fourthword[(byte)value]);

  255. 		*(dest+3) = nzrivalue;

  256.         previousnrzi_highlow = ((nzrivalue & 0b1) == 0b1) ? ~0U : 0U;

  257. 

  258. 		value =				 0b00100001000010000100001000010000 /* bit 128-159 */ 

  259. //							  b00000000000000001000100010001000 // start of 16 bit sample

  260. 			| ((sample5<<22)&0b11000000000000000000000000000000) 

  261. 			| ((sample5<<21)&0b00011110000000000000000000000000) 

  262. 			| ((sample5<<20)&0b00000000111100000000000000000000) 

  263. 			| ((sample6>>7 )&0b00000000000000000000000111100000) 

  264. 			| ((sample6>>8 )&0b00000000000000000000000000001111) 

  265. 			;

  266. 		nzrivalue = previousnrzi_highlow ^ (LookupTable_firstword[(byte)(value >> 24)] ^ LookupTable_secondword[(byte)(value >> 16)] ^ LookupTable_thirdword[(byte)(value >> 8)] ^ LookupTable_fourthword[(byte)value]);

  267. 		*(dest+4) = nzrivalue;

  268.         previousnrzi_highlow = ((nzrivalue & 0b1) == 0b1) ? ~0U : 0U;

  269. 

  270. 		value =				 0b10000100001000010000100001000010 /* bit 160-191 */

  271. //							  b00000000000000001000100010001000 // start of 16 bit sample

  272. 			| ((sample6<<23)&0b01111000000000000000000000000000) 

  273. 			| ((sample6<<22)&0b00000011110000000000000000000000) 

  274. 			| ((sample7>>5 )&0b00000000000000000000011110000000) 

  275. 			| ((sample7>>6 )&0b00000000000000000000000000111100) 

  276. 			| ((sample7>>7 )&0b00000000000000000000000000000001) 

  277. 			;

  278. 

  279. 		nzrivalue = previousnrzi_highlow ^ (LookupTable_firstword[(byte)(value >> 24)] ^ LookupTable_secondword[(byte)(value >> 16)] ^ LookupTable_thirdword[(byte)(value >> 8)] ^ LookupTable_fourthword[(byte)value]);

  280. 		*(dest+5) = nzrivalue;

  281.         previousnrzi_highlow = ((nzrivalue & 0b1) == 0b1) ? ~0U : 0U;

  282. 

  283. 		value =				 0b00010000100001000010000100001000 /* bit 192-223 */

  284. //							  b00000000000000001000100010001000 // start of 16 bit sample

  285. 			| ((sample7<<25)&0b11100000000000000000000000000000) 

  286. 			| ((sample7<<24)&0b00001111000000000000000000000000) 

  287. 			| ((sample8>>3 )&0b00000000000000000001111000000000) 

  288. 			| ((sample8>>4 )&0b00000000000000000000000011110000) 

  289. 			| ((sample8>>5 )&0b00000000000000000000000000000111)

  290. 			;

  291. 

  292. 		nzrivalue = previousnrzi_highlow ^ (LookupTable_firstword[(byte)(value >> 24)] ^ LookupTable_secondword[(byte)(value >> 16)] ^ LookupTable_thirdword[(byte)(value >> 8)] ^ LookupTable_fourthword[(byte)value]);

  293. 		*(dest+6) = nzrivalue;

  294.         previousnrzi_highlow = ((nzrivalue & 0b1) == 0b1) ? ~0U : 0U;

  295. 

  296. 		value =				 0b01000010000100001000000000010000 /* bit 224-255 */

  297. //							  b00000000000000001000100010001000 // start of 16 bit sample

  298. 			| ((sample8<<27)&0b10000000000000000000000000000000) 

  299. 			| ((sample8<<26)&0b00111100000000000000000000000000) 

  300. 			;

  301. 

  302. 		nzrivalue = previousnrzi_highlow ^ (LookupTable_firstword[(byte)(value >> 24)] ^ LookupTable_secondword[(byte)(value >> 16)] ^ LookupTable_thirdword[(byte)(value >> 8)] ^ LookupTable_fourthword[(byte)value]);

  303. 		*(dest+7) = nzrivalue;

  304.         previousnrzi_highlow = ((nzrivalue & 0b1) == 0b1) ? ~0U : 0U;

  305. 

  306. 		dest+=8;

  307. 	} while (dest < end);

  308. 	/*

  309. 	block = AudioOutputADAT::block_ch1_1st;

  310. 	if (block) {

  311. 		offset = AudioOutputADAT::ch1_offset;

  312. 		src = &block->data[offset];

  313. 		do {

  314. 

  315. 			sample = (uint32_t)*src++;

  316. 

  317. 		} while (dest < end);

  318. 		offset += AUDIO_BLOCK_SAMPLES/2;

  319. 		if (offset < AUDIO_BLOCK_SAMPLES) {

  320. 			AudioOutputADAT::ch1_offset = offset;

  321. 		} else {

  322. 			AudioOutputADAT::ch1_offset = 0;

  323. 			AudioStream::release(block);

  324. 			AudioOutputADAT::block_ch1_1st = AudioOutputADAT::block_ch1_2nd;

  325. 			AudioOutputADAT::block_ch1_2nd = NULL;

  326. 		}

  327. 	} else {

  328. 		sample = 0;

  329. 	

  330. 		do {

  331. 			// *(dest+0) = 0b11111000001111100000111110000011; // bit 0-31

  332. 			// *(dest+1) = 0b11100000111110000011111000001111; // bit 32-63

  333. 			// *(dest+2) = 0b10000011111000001111100000111110; // bit 64-95

  334. 			// *(dest+3) = 0b00001111100000111110000011111000; // bit 96-127

  335. 

  336. 			// *(dest+4) = 0b00111110000011111000001111100000; // bit 128-159

  337. 			// *(dest+5) = 0b11111000001111100000111110000011; // bit 160-191

  338. 			// *(dest+6) = 0b11100000111110000011111000001111; // bit 192-223

  339. 			// *(dest+7) = 0b10000011111000001111111111100000; // bit 224-255

  340. 			dest+=8;

  341. 		} while (dest < end);

  342. 	}

  343. 

  344. 	

  345. 	dest -= AUDIO_BLOCK_SAMPLES * 8/2 - 8/2;

  346. 	block = AudioOutputADAT::block_ch2_1st;

  347. 	if (block) {

  348. 		offset = AudioOutputADAT::ch2_offset;

  349. 		src = &block->data[offset];

  350. 

  351. 		do {

  352. 			sample = *src++;

  353. 			

  354. 			// *(dest+0) = 0b00111110000011111000001111100000; // bit 128-159

  355. 			// *(dest+1) = 0b11111000001111100000111110000011; // bit 160-191

  356. 			// *(dest+2) = 0b11100000111110000011111000001111; // bit 192-223

  357. 			// *(dest+3) = 0b10000011111000001111111111100000; // bit 224-255

  358. 			dest+=8;

  359. 		} while (dest < end);

  360. 

  361. 		offset += AUDIO_BLOCK_SAMPLES/2;

  362. 		if (offset < AUDIO_BLOCK_SAMPLES) {

  363. 			AudioOutputADAT::ch2_offset = offset;

  364. 		} else {

  365. 			AudioOutputADAT::ch2_offset = 0;

  366. 			AudioStream::release(block);

  367. 			AudioOutputADAT::block_ch2_1st = AudioOutputADAT::block_ch2_2nd;

  368. 			AudioOutputADAT::block_ch2_2nd = NULL;

  369. 		}

  370. 	} else {

  371. 			// *(dest+0) = 0b00111110000011111000001111100000; // bit 128-159

  372. 			// *(dest+1) = 0b11111000001111100000111110000011; // bit 160-191

  373. 			// *(dest+2) = 0b11100000111110000011111000001111; // bit 192-223

  374. 			// *(dest+3) = 0b10000011111000001111111111100000; // bit 224-255

  375. 			dest+=8;

  376. 	}*/

  377. 

  378. 	if (block_ch1_1st) {

  379. 		if (ch1_offset == 0) {

  380. 			ch1_offset = AUDIO_BLOCK_SAMPLES/2;

  381. 		} else {

  382. 			ch1_offset = 0;

  383. 			release(block_ch1_1st);

  384. 			block_ch1_1st = block_ch1_2nd;

  385. 			block_ch1_2nd = NULL;

  386. 		}

  387. 	}

  388. 	if (block_ch2_1st) {

  389. 		if (ch2_offset == 0) {

  390. 			ch2_offset = AUDIO_BLOCK_SAMPLES/2;

  391. 		} else {

  392. 			ch2_offset = 0;

  393. 			release(block_ch2_1st);

  394. 			block_ch2_1st = block_ch2_2nd;

  395. 			block_ch2_2nd = NULL;

  396. 		}

  397. 	}

  398. 	if (block_ch3_1st) {

  399. 		if (ch3_offset == 0) {

  400. 			ch3_offset = AUDIO_BLOCK_SAMPLES/2;

  401. 		} else {

  402. 			ch3_offset = 0;

  403. 			release(block_ch3_1st);

  404. 			block_ch3_1st = block_ch3_2nd;

  405. 			block_ch3_2nd = NULL;

  406. 		}

  407. 	}

  408. 	if (block_ch4_1st) {

  409. 		if (ch4_offset == 0) {

  410. 			ch4_offset = AUDIO_BLOCK_SAMPLES/2;

  411. 		} else {

  412. 			ch4_offset = 0;

  413. 			release(block_ch4_1st);

  414. 			block_ch4_1st = block_ch4_2nd;

  415. 			block_ch4_2nd = NULL;

  416. 		}

  417. 	}

  418. 	if (block_ch5_1st) {

  419. 		if (ch5_offset == 0) {

  420. 			ch5_offset = AUDIO_BLOCK_SAMPLES/2;

  421. 		} else {

  422. 			ch5_offset = 0;

  423. 			release(block_ch5_1st);

  424. 			block_ch5_1st = block_ch5_2nd;

  425. 			block_ch5_2nd = NULL;

  426. 		}

  427. 	}

  428. 	if (block_ch6_1st) {

  429. 		if (ch6_offset == 0) {

  430. 			ch6_offset = AUDIO_BLOCK_SAMPLES/2;

  431. 		} else {

  432. 			ch6_offset = 0;

  433. 			release(block_ch6_1st);

  434. 			block_ch6_1st = block_ch6_2nd;

  435. 			block_ch6_2nd = NULL;

  436. 		}

  437. 	}

  438. 	if (block_ch7_1st) {

  439. 		if (ch7_offset == 0) {

  440. 			ch7_offset = AUDIO_BLOCK_SAMPLES/2;

  441. 		} else {

  442. 			ch7_offset = 0;

  443. 			release(block_ch7_1st);

  444. 			block_ch7_1st = block_ch7_2nd;

  445. 			block_ch7_2nd = NULL;

  446. 		}

  447. 	}

  448. 	if (block_ch8_1st) {

  449. 		if (ch8_offset == 0) {

  450. 			ch8_offset = AUDIO_BLOCK_SAMPLES/2;

  451. 		} else {

  452. 			ch8_offset = 0;

  453. 			release(block_ch8_1st);

  454. 			block_ch8_1st = block_ch8_2nd;

  455. 			block_ch8_2nd = NULL;

  456. 		}

  457. 	}

  458. }

  459. 

  460. void AudioOutputADAT::mute_PCM(const bool mute)

  461. {

  462. 	//vucp = mute?VUCP_INVALID:VUCP_VALID;

  463. 	//#TODO

  464. }

  465. 

  466. void AudioOutputADAT::update(void)

  467. {

  468. 

  469. 	audio_block_t *block, *tmp;

  470. 

  471. 	block = receiveReadOnly(0); // input 0 = channel 1

  472. 	if (block) {

  473. 		__disable_irq();

  474. 		if (block_ch1_1st == NULL) {

  475. 			block_ch1_1st = block;

  476. 			ch1_offset = 0;

  477. 			__enable_irq();

  478. 		} else if (block_ch1_2nd == NULL) {

  479. 			block_ch1_2nd = block;

  480. 			__enable_irq();

  481. 		} else {

  482. 			tmp = block_ch1_1st;

  483. 			block_ch1_1st = block_ch1_2nd;

  484. 			block_ch1_2nd = block;

  485. 			ch1_offset = 0;

  486. 			__enable_irq();

  487. 			release(tmp);

  488. 		}

  489. 	}

  490. 	block = receiveReadOnly(1); // input 1 = channel 2

  491. 	if (block) {

  492. 		__disable_irq();

  493. 		if (block_ch2_1st == NULL) {

  494. 			block_ch2_1st = block;

  495. 			ch2_offset = 0;

  496. 			__enable_irq();

  497. 		} else if (block_ch2_2nd == NULL) {

  498. 			block_ch2_2nd = block;

  499. 			__enable_irq();

  500. 		} else {

  501. 			tmp = block_ch2_1st;

  502. 			block_ch2_1st = block_ch2_2nd;

  503. 			block_ch2_2nd = block;

  504. 			ch2_offset = 0;

  505. 			__enable_irq();

  506. 			release(tmp);

  507. 		}

  508. 	}

  509. 	block = receiveReadOnly(2); // channel 3

  510. 	if (block) {

  511. 		__disable_irq();

  512. 		if (block_ch3_1st == NULL) {

  513. 			block_ch3_1st = block;

  514. 			ch3_offset = 0;

  515. 			__enable_irq();

  516. 		} else if (block_ch3_2nd == NULL) {

  517. 			block_ch3_2nd = block;

  518. 			__enable_irq();

  519. 		} else {

  520. 			tmp = block_ch3_1st;

  521. 			block_ch3_1st = block_ch3_2nd;

  522. 			block_ch3_2nd = block;

  523. 			ch3_offset = 0;

  524. 			__enable_irq();

  525. 			release(tmp);

  526. 		}

  527. 	}

  528. 	block = receiveReadOnly(3); // channel 4

  529. 	if (block) {

  530. 		__disable_irq();

  531. 		if (block_ch4_1st == NULL) {

  532. 			block_ch4_1st = block;

  533. 			ch4_offset = 0;

  534. 			__enable_irq();

  535. 		} else if (block_ch4_2nd == NULL) {

  536. 			block_ch4_2nd = block;

  537. 			__enable_irq();

  538. 		} else {

  539. 			tmp = block_ch4_1st;

  540. 			block_ch4_1st = block_ch4_2nd;

  541. 			block_ch4_2nd = block;

  542. 			ch4_offset = 0;

  543. 			__enable_irq();

  544. 			release(tmp);

  545. 		}

  546. 	}

  547. 	block = receiveReadOnly(4); // channel 5

  548. 	if (block) {

  549. 		__disable_irq();

  550. 		if (block_ch5_1st == NULL) {

  551. 			block_ch5_1st = block;

  552. 			ch5_offset = 0;

  553. 			__enable_irq();

  554. 		} else if (block_ch5_2nd == NULL) {

  555. 			block_ch5_2nd = block;

  556. 			__enable_irq();

  557. 		} else {

  558. 			tmp = block_ch5_1st;

  559. 			block_ch5_1st = block_ch5_2nd;

  560. 			block_ch5_2nd = block;

  561. 			ch5_offset = 0;

  562. 			__enable_irq();

  563. 			release(tmp);

  564. 		}

  565. 	}

  566. 	block = receiveReadOnly(5); // channel 6

  567. 	if (block) {

  568. 		__disable_irq();

  569. 		if (block_ch6_1st == NULL) {

  570. 			block_ch6_1st = block;

  571. 			ch6_offset = 0;

  572. 			__enable_irq();

  573. 		} else if (block_ch6_2nd == NULL) {

  574. 			block_ch6_2nd = block;

  575. 			__enable_irq();

  576. 		} else {

  577. 			tmp = block_ch6_1st;

  578. 			block_ch6_1st = block_ch6_2nd;

  579. 			block_ch6_2nd = block;

  580. 			ch6_offset = 0;

  581. 			__enable_irq();

  582. 			release(tmp);

  583. 		}

  584. 	}

  585. 	block = receiveReadOnly(6); // channel 7

  586. 	if (block) {

  587. 		__disable_irq();

  588. 		if (block_ch7_1st == NULL) {

  589. 			block_ch7_1st = block;

  590. 			ch7_offset = 0;

  591. 			__enable_irq();

  592. 		} else if (block_ch7_2nd == NULL) {

  593. 			block_ch7_2nd = block;

  594. 			__enable_irq();

  595. 		} else {

  596. 			tmp = block_ch7_1st;

  597. 			block_ch7_1st = block_ch7_2nd;

  598. 			block_ch7_2nd = block;

  599. 			ch7_offset = 0;

  600. 			__enable_irq();

  601. 			release(tmp);

  602. 		}

  603. 	}

  604. 	block = receiveReadOnly(7); // channel 8

  605. 	if (block) {

  606. 		__disable_irq();

  607. 		if (block_ch8_1st == NULL) {

  608. 			block_ch8_1st = block;

  609. 			ch8_offset = 0;

  610. 			__enable_irq();

  611. 		} else if (block_ch8_2nd == NULL) {

  612. 			block_ch8_2nd = block;

  613. 			__enable_irq();

  614. 		} else {

  615. 			tmp = block_ch8_1st;

  616. 			block_ch8_1st = block_ch8_2nd;

  617. 			block_ch8_2nd = block;

  618. 			ch8_offset = 0;

  619. 			__enable_irq();

  620. 			release(tmp);

  621. 		}

  622. 	}

  623. }

  624. 

  625. 

  626. #ifndef MCLK_SRC

  627. #if F_CPU >= 20000000

  628.   #define MCLK_SRC  3  // the PLL

  629. #else

  630.   #define MCLK_SRC  0  // system clock

  631. #endif

  632. #endif

  633. 

  634. 

  635. void AudioOutputADAT::config_ADAT(void)

  636. {

  637. 	SIM_SCGC6 |= SIM_SCGC6_I2S;

  638. 	SIM_SCGC7 |= SIM_SCGC7_DMA;

  639. 	SIM_SCGC6 |= SIM_SCGC6_DMAMUX;

  640. 

  641. 	// enable MCLK output

  642. 	I2S0_MCR = I2S_MCR_MICS(MCLK_SRC) | I2S_MCR_MOE;

  643. 	//while (I2S0_MCR & I2S_MCR_DUF) ;

  644. 	//I2S0_MDR = I2S_MDR_FRACT((MCLK_MULT-1)) | I2S_MDR_DIVIDE((MCLK_DIV-1));

  645. 

  646. 	AudioOutputADAT::setI2SFreq(88200);

  647. 

  648. 	// configure transmitter

  649. 	I2S0_TMR = 0;

  650. 	I2S0_TCR1 = I2S_TCR1_TFW(1);  // watermark

  651. 	I2S0_TCR2 = I2S_TCR2_SYNC(0) | I2S_TCR2_MSEL(1) | I2S_TCR2_BCD | I2S_TCR2_DIV(0);

  652. 	I2S0_TCR3 = I2S_TCR3_TCE;

  653. 

  654. 	//8 Words per Frame 32 Bit Word-Length -> 256 Bit Frame-Length, MSB First:

  655. 	I2S0_TCR4 = I2S_TCR4_FRSZ(7) | I2S_TCR4_SYWD(0) | I2S_TCR4_MF | I2S_TCR4_FSP | I2S_TCR4_FSD;

  656. 	I2S0_TCR5 = I2S_TCR5_WNW(31) | I2S_TCR5_W0W(31) | I2S_TCR5_FBT(31);

  657. 

  658. 	I2S0_RCSR = 0;

  659. 

  660. #if 0

  661. 	// configure pin mux for 3 clock signals (debug only)

  662. 	CORE_PIN23_CONFIG = PORT_PCR_MUX(6); // pin 23, PTC2, I2S0_TX_FS (LRCLK)

  663. 	CORE_PIN9_CONFIG  = PORT_PCR_MUX(6); // pin  9, PTC3, I2S0_TX_BCLK

  664. //	CORE_PIN11_CONFIG = PORT_PCR_MUX(6); // pin 11, PTC6, I2S0_MCLK

  665. #endif

  666. }

  667. 

  668. /*

  669. 

  670. https://forum.pjrc.com/threads/38753-Discussion-about-a-simple-way-to-change-the-sample-rate

  671. 

  672. */

  673. 

  674. void AudioOutputADAT::setI2SFreq(int freq) {

  675.   typedef struct {

  676.     uint8_t mult;

  677.     uint16_t div;

  678.   } tmclk;

  679. 

  680.   const int numfreqs = 14;

  681.   const int samplefreqs[numfreqs] = { 8000, 11025, 16000, 22050, 32000, 44100, (int) 44117.64706 , 48000, 88200, (int) (44117.64706 * 2.0), 96000, 176400,(int) (44117.64706 * 4.0), 192000};

  682. 

  683. #if (F_PLL==16000000)

  684.   const tmclk clkArr[numfreqs] = {{16, 125}, {148, 839}, {32, 125}, {145, 411}, {64, 125}, {151, 214}, {12, 17}, {96, 125}, {151, 107}, {24, 17}, {192, 125}, {127, 45}, {48, 17}, {255, 83} };

  685. #elif (F_PLL==72000000)

  686.   const tmclk clkArr[numfreqs] = {{32, 1125}, {49, 1250}, {64, 1125}, {49, 625}, {128, 1125}, {98, 625}, {8, 51}, {64, 375}, {196, 625}, {16, 51}, {128, 375}, {249, 397}, {32, 51}, {185, 271} };

  687. #elif (F_PLL==96000000)

  688.   const tmclk clkArr[numfreqs] = {{8, 375}, {73, 2483}, {16, 375}, {147, 2500}, {32, 375}, {147, 1250}, {2, 17}, {16, 125}, {147, 625}, {4, 17}, {32, 125}, {151, 321}, {8, 17}, {64, 125} };

  689. #elif (F_PLL==120000000)

  690.   const tmclk clkArr[numfreqs] = {{32, 1875}, {89, 3784}, {64, 1875}, {147, 3125}, {128, 1875}, {205, 2179}, {8, 85}, {64, 625}, {89, 473}, {16, 85}, {128, 625}, {178, 473}, {32, 85}, {145, 354} };

  691. #elif (F_PLL==144000000)

  692.   const tmclk clkArr[numfreqs] = {{16, 1125}, {49, 2500}, {32, 1125}, {49, 1250}, {64, 1125}, {49, 625}, {4, 51}, {32, 375}, {98, 625}, {8, 51}, {64, 375}, {196, 625}, {16, 51}, {128, 375} };

  693. #elif (F_PLL==168000000)

  694.   const tmclk clkArr[numfreqs] = {{32, 2625}, {21, 1250}, {64, 2625}, {21, 625}, {128, 2625}, {42, 625}, {8, 119}, {64, 875}, {84, 625}, {16, 119}, {128, 875}, {168, 625}, {32, 119}, {189, 646} };	

  695. #elif (F_PLL==180000000)

  696.   const tmclk clkArr[numfreqs] = {{46, 4043}, {49, 3125}, {73, 3208}, {98, 3125}, {183, 4021}, {196, 3125}, {16, 255}, {128, 1875}, {107, 853}, {32, 255}, {219, 1604}, {214, 853}, {64, 255}, {219, 802} };

  697. #elif (F_PLL==192000000)

  698.   const tmclk clkArr[numfreqs] = {{4, 375}, {37, 2517}, {8, 375}, {73, 2483}, {16, 375}, {147, 2500}, {1, 17}, {8, 125}, {147, 1250}, {2, 17}, {16, 125}, {147, 625}, {4, 17}, {32, 125} };

  699. #elif (F_PLL==216000000)

  700.   const tmclk clkArr[numfreqs] = {{32, 3375}, {49, 3750}, {64, 3375}, {49, 1875}, {128, 3375}, {98, 1875}, {8, 153}, {64, 1125}, {196, 1875}, {16, 153}, {128, 1125}, {226, 1081}, {32, 153}, {147, 646} };

  701. #elif (F_PLL==240000000)

  702.   const tmclk clkArr[numfreqs] = {{16, 1875}, {29, 2466}, {32, 1875}, {89, 3784}, {64, 1875}, {147, 3125}, {4, 85}, {32, 625}, {205, 2179}, {8, 85}, {64, 625}, {89, 473}, {16, 85}, {128, 625} };

  703. #elif (F_PLL==256000000)

  704.   // TODO: fix these...

  705.   const tmclk clkArr[numfreqs] = {{16, 1875}, {29, 2466}, {32, 1875}, {89, 3784}, {64, 1875}, {147, 3125}, {4, 85}, {32, 625}, {205, 2179}, {8, 85}, {64, 625}, {89, 473}, {16, 85}, {128, 625} };

  706. #endif

  707. 

  708.   for (int f = 0; f < numfreqs; f++) {

  709.     if ( freq == samplefreqs[f] ) {

  710.       while (I2S0_MCR & I2S_MCR_DUF) ;

  711.       I2S0_MDR = I2S_MDR_FRACT((clkArr[f].mult - 1)) | I2S_MDR_DIVIDE((clkArr[f].div - 1));

  712.       return;

  713.     }

  714.   }

  715. }

  716. 

  717. #elif defined(KINETISL)

  718. 

  719. void AudioOutputADAT::update(void)

  720. {

  721. 

  722. 	audio_block_t *block;

  723. 	block = receiveReadOnly(0); // input 0 = ch1 channel

  724. 	if (block) release(block);

  725. 	block = receiveReadOnly(1); // input 1 = ch2 channel

  726. 	if (block) release(block);

  727. 	block = receiveReadOnly(2); // input 2 = ch3 channel

  728. 	if (block) release(block);

  729. 	block = receiveReadOnly(3); // input 3 = ch4 channel

  730. 	if (block) release(block);

  731. 	block = receiveReadOnly(4); // input 4 = ch5 channel

  732. 	if (block) release(block);

  733. 	block = receiveReadOnly(5); // input 5 = ch6 channel

  734. 	if (block) release(block);

  735. 	block = receiveReadOnly(6); // input 6 = ch7 channel

  736. 	if (block) release(block);

  737. 	block = receiveReadOnly(7); // input 7 = ch8 channel

  738. 	if (block) release(block);

  739. }

  740. 

  741. #endif