visus
/
teensy-audio
Tarkkaile 1
Äänestä 0
Fork 0
Koodi Ongelmat 0 Pull-pyynnöt 0 Julkaisut 0 Wiki Activity
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.
657 Commitit
2 Branchit
Puu: 98a6be4511
Branchit Tagit
${ item.name }
Create branch ${ searchTerm }
from '98a6be4511'
${ noResults }
teensy-audio/output_adat.cpp

737 lines
34KB
Raaka Blame Historia 

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

  25. 

  26. #if defined(KINETISK)

  27. 

  28. audio_block_t * AudioOutputADAT::block_ch1_1st = NULL;

  29. audio_block_t * AudioOutputADAT::block_ch2_1st = NULL;

  30. audio_block_t * AudioOutputADAT::block_ch3_1st = NULL;

  31. audio_block_t * AudioOutputADAT::block_ch4_1st = NULL;

  32. audio_block_t * AudioOutputADAT::block_ch5_1st = NULL;

  33. audio_block_t * AudioOutputADAT::block_ch6_1st = NULL;

  34. audio_block_t * AudioOutputADAT::block_ch7_1st = NULL;

  35. audio_block_t * AudioOutputADAT::block_ch8_1st = NULL;

  36. 

  37. audio_block_t * AudioOutputADAT::block_ch1_2nd = NULL;

  38. audio_block_t * AudioOutputADAT::block_ch2_2nd = NULL;

  39. audio_block_t * AudioOutputADAT::block_ch3_2nd = NULL;

  40. audio_block_t * AudioOutputADAT::block_ch4_2nd = NULL;

  41. audio_block_t * AudioOutputADAT::block_ch5_2nd = NULL;

  42. audio_block_t * AudioOutputADAT::block_ch6_2nd = NULL;

  43. audio_block_t * AudioOutputADAT::block_ch7_2nd = NULL;

  44. audio_block_t * AudioOutputADAT::block_ch8_2nd = NULL;

  45. 

  46. uint16_t  AudioOutputADAT::ch1_offset = 0;

  47. uint16_t  AudioOutputADAT::ch2_offset = 0;

  48. uint16_t  AudioOutputADAT::ch3_offset = 0;

  49. uint16_t  AudioOutputADAT::ch4_offset = 0;

  50. uint16_t  AudioOutputADAT::ch5_offset = 0;

  51. uint16_t  AudioOutputADAT::ch6_offset = 0;

  52. uint16_t  AudioOutputADAT::ch7_offset = 0;

  53. uint16_t  AudioOutputADAT::ch8_offset = 0;

  54. 

  55. bool AudioOutputADAT::update_responsibility = false;

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

  57. 

  58. DMAMEM static uint32_t ADAT_tx_buffer[AUDIO_BLOCK_SAMPLES * 8]; //4 KB, AUDIO_BLOCK_SAMPLES is usually 128

  59. 

  60. DMAChannel AudioOutputADAT::dma(false);

  61. 

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

  63. 

  64. // 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.

  65. 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};

  66. 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};

  67. 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};

  68. 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};

  69. 

  70. void AudioOutputADAT::begin(void)

  71. {

  72. 

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

  74. 

  75. 	block_ch1_1st = NULL;

  76. 	block_ch2_1st = NULL;

  77. 	block_ch3_1st = NULL;

  78. 	block_ch4_1st = NULL;

  79. 	block_ch5_1st = NULL;

  80. 	block_ch6_1st = NULL;

  81. 	block_ch7_1st = NULL;

  82. 	block_ch8_1st = NULL;

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

  84. 	config_ADAT();

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

  86. 

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

  88. 

  89. 	dma.TCD->SADDR = ADAT_tx_buffer;

  90. 	dma.TCD->SOFF = 4;

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

  92. 	dma.TCD->NBYTES_MLNO = nbytes_mlno;

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

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

  95. 	dma.TCD->DOFF = 0;

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

  97. 	dma.TCD->DLASTSGA = 0;

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

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

  100. 	dma.triggerAtHardwareEvent(DMAMUX_SOURCE_I2S0_TX);

  101. 	update_responsibility = update_setup();

  102. 	dma.enable();

  103. 

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

  105. 	dma.attachInterrupt(isr);

  106. 

  107. }

  108. 

  109. /*

  110. 

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

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

  113. 

  114. 	for information about the clock:

  115. 

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

  117. 

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

  119. 	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)

  120. */

  121. 

  122. void AudioOutputADAT::isr(void)

  123. {

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

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

  126. 

  127. 	uint32_t *end, *dest;

  128. 	uint32_t saddr;

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

  130. 

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

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

  133. 

  134. 	//static bool previousframeinverted=false;

  135. 

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

  137. 	dma.clearInterrupt();

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

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

  140. 		// so we must fill the second half

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

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

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

  144. 	} else {

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

  146. 		// so we must fill the first half

  147. 		dest = (uint32_t *)ADAT_tx_buffer;

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

  149. 	}

  150. 

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

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

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

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

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

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

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

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

  159. 

  160. 

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

  162. 	/*     

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

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

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

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

  167. 

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

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

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

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

  172. 

  173. 	dest+=8;

  174. 

  175. 	*/

  176. 

  177. 	/*

  178. 	//NZRI encoded 'empty' ADAT Frame

  179. 

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

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

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

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

  184. 

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

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

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

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

  189. 

  190. 	dest+=8;

  191. 

  192. 	*/

  193. 

  194. 	do

  195. 	{

  196. 		sample1 = (*src1++);

  197. 		sample2 = (*src2++);

  198. 		sample3 = (*src3++);

  199. 		sample4 = (*src4++);

  200. 		sample5 = (*src5++);

  201. 		sample6 = (*src6++);

  202. 		sample7 = (*src7++);

  203. 		sample8 = (*src8++);

  204. 

  205. 		uint32_t value;

  206. 		uint32_t nzrivalue;

  207. 

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

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

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

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

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

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

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

  215. 			; 

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

  217. 		*(dest+0) = nzrivalue;

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

  219. 		

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

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

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

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

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

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

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

  227. 			; 

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

  229. 		*(dest+1) = nzrivalue;

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

  231. 

  232. 

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

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

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

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

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

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

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

  240. 			;

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

  242. 		*(dest+2) = nzrivalue;

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

  244. 

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

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

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

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

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

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

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

  252. 			;

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

  254. 		*(dest+3) = nzrivalue;

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

  256. 

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

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

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

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

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

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

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

  264. 			;

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

  266. 		*(dest+4) = nzrivalue;

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

  268. 

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

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

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

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

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

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

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

  276. 			;

  277. 

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

  279. 		*(dest+5) = nzrivalue;

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

  281. 

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

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

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

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

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

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

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

  289. 			;

  290. 

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

  292. 		*(dest+6) = nzrivalue;

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

  294. 

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

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

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

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

  299. 			;

  300. 

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

  302. 		*(dest+7) = nzrivalue;

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

  304. 

  305. 		dest+=8;

  306. 	} while (dest < end);

  307. 	/*

  308. 	block = AudioOutputADAT::block_ch1_1st;

  309. 	if (block) {

  310. 		offset = AudioOutputADAT::ch1_offset;

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

  312. 		do {

  313. 

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

  315. 

  316. 		} while (dest < end);

  317. 		offset += AUDIO_BLOCK_SAMPLES/2;

  318. 		if (offset < AUDIO_BLOCK_SAMPLES) {

  319. 			AudioOutputADAT::ch1_offset = offset;

  320. 		} else {

  321. 			AudioOutputADAT::ch1_offset = 0;

  322. 			AudioStream::release(block);

  323. 			AudioOutputADAT::block_ch1_1st = AudioOutputADAT::block_ch1_2nd;

  324. 			AudioOutputADAT::block_ch1_2nd = NULL;

  325. 		}

  326. 	} else {

  327. 		sample = 0;

  328. 	

  329. 		do {

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

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

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

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

  334. 

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

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

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

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

  339. 			dest+=8;

  340. 		} while (dest < end);

  341. 	}

  342. 

  343. 	

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

  345. 	block = AudioOutputADAT::block_ch2_1st;

  346. 	if (block) {

  347. 		offset = AudioOutputADAT::ch2_offset;

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

  349. 

  350. 		do {

  351. 			sample = *src++;

  352. 			

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

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

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

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

  357. 			dest+=8;

  358. 		} while (dest < end);

  359. 

  360. 		offset += AUDIO_BLOCK_SAMPLES/2;

  361. 		if (offset < AUDIO_BLOCK_SAMPLES) {

  362. 			AudioOutputADAT::ch2_offset = offset;

  363. 		} else {

  364. 			AudioOutputADAT::ch2_offset = 0;

  365. 			AudioStream::release(block);

  366. 			AudioOutputADAT::block_ch2_1st = AudioOutputADAT::block_ch2_2nd;

  367. 			AudioOutputADAT::block_ch2_2nd = NULL;

  368. 		}

  369. 	} else {

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

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

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

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

  374. 			dest+=8;

  375. 	}*/

  376. 

  377. 	if (block_ch1_1st) {

  378. 		if (ch1_offset == 0) {

  379. 			ch1_offset = AUDIO_BLOCK_SAMPLES/2;

  380. 		} else {

  381. 			ch1_offset = 0;

  382. 			release(block_ch1_1st);

  383. 			block_ch1_1st = block_ch1_2nd;

  384. 			block_ch1_2nd = NULL;

  385. 		}

  386. 	}

  387. 	if (block_ch2_1st) {

  388. 		if (ch2_offset == 0) {

  389. 			ch2_offset = AUDIO_BLOCK_SAMPLES/2;

  390. 		} else {

  391. 			ch2_offset = 0;

  392. 			release(block_ch2_1st);

  393. 			block_ch2_1st = block_ch2_2nd;

  394. 			block_ch2_2nd = NULL;

  395. 		}

  396. 	}

  397. 	if (block_ch3_1st) {

  398. 		if (ch3_offset == 0) {

  399. 			ch3_offset = AUDIO_BLOCK_SAMPLES/2;

  400. 		} else {

  401. 			ch3_offset = 0;

  402. 			release(block_ch3_1st);

  403. 			block_ch3_1st = block_ch3_2nd;

  404. 			block_ch3_2nd = NULL;

  405. 		}

  406. 	}

  407. 	if (block_ch4_1st) {

  408. 		if (ch4_offset == 0) {

  409. 			ch4_offset = AUDIO_BLOCK_SAMPLES/2;

  410. 		} else {

  411. 			ch4_offset = 0;

  412. 			release(block_ch4_1st);

  413. 			block_ch4_1st = block_ch4_2nd;

  414. 			block_ch4_2nd = NULL;

  415. 		}

  416. 	}

  417. 	if (block_ch5_1st) {

  418. 		if (ch5_offset == 0) {

  419. 			ch5_offset = AUDIO_BLOCK_SAMPLES/2;

  420. 		} else {

  421. 			ch5_offset = 0;

  422. 			release(block_ch5_1st);

  423. 			block_ch5_1st = block_ch5_2nd;

  424. 			block_ch5_2nd = NULL;

  425. 		}

  426. 	}

  427. 	if (block_ch6_1st) {

  428. 		if (ch6_offset == 0) {

  429. 			ch6_offset = AUDIO_BLOCK_SAMPLES/2;

  430. 		} else {

  431. 			ch6_offset = 0;

  432. 			release(block_ch6_1st);

  433. 			block_ch6_1st = block_ch6_2nd;

  434. 			block_ch6_2nd = NULL;

  435. 		}

  436. 	}

  437. 	if (block_ch7_1st) {

  438. 		if (ch7_offset == 0) {

  439. 			ch7_offset = AUDIO_BLOCK_SAMPLES/2;

  440. 		} else {

  441. 			ch7_offset = 0;

  442. 			release(block_ch7_1st);

  443. 			block_ch7_1st = block_ch7_2nd;

  444. 			block_ch7_2nd = NULL;

  445. 		}

  446. 	}

  447. 	if (block_ch8_1st) {

  448. 		if (ch8_offset == 0) {

  449. 			ch8_offset = AUDIO_BLOCK_SAMPLES/2;

  450. 		} else {

  451. 			ch8_offset = 0;

  452. 			release(block_ch8_1st);

  453. 			block_ch8_1st = block_ch8_2nd;

  454. 			block_ch8_2nd = NULL;

  455. 		}

  456. 	}

  457. }

  458. 

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

  460. {

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

  462. 	//#TODO

  463. }

  464. 

  465. void AudioOutputADAT::update(void)

  466. {

  467. 

  468. 	audio_block_t *block, *tmp;

  469. 

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

  471. 	if (block) {

  472. 		__disable_irq();

  473. 		if (block_ch1_1st == NULL) {

  474. 			block_ch1_1st = block;

  475. 			ch1_offset = 0;

  476. 			__enable_irq();

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

  478. 			block_ch1_2nd = block;

  479. 			__enable_irq();

  480. 		} else {

  481. 			tmp = block_ch1_1st;

  482. 			block_ch1_1st = block_ch1_2nd;

  483. 			block_ch1_2nd = block;

  484. 			ch1_offset = 0;

  485. 			__enable_irq();

  486. 			release(tmp);

  487. 		}

  488. 	}

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

  490. 	if (block) {

  491. 		__disable_irq();

  492. 		if (block_ch2_1st == NULL) {

  493. 			block_ch2_1st = block;

  494. 			ch2_offset = 0;

  495. 			__enable_irq();

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

  497. 			block_ch2_2nd = block;

  498. 			__enable_irq();

  499. 		} else {

  500. 			tmp = block_ch2_1st;

  501. 			block_ch2_1st = block_ch2_2nd;

  502. 			block_ch2_2nd = block;

  503. 			ch2_offset = 0;

  504. 			__enable_irq();

  505. 			release(tmp);

  506. 		}

  507. 	}

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

  509. 	if (block) {

  510. 		__disable_irq();

  511. 		if (block_ch3_1st == NULL) {

  512. 			block_ch3_1st = block;

  513. 			ch3_offset = 0;

  514. 			__enable_irq();

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

  516. 			block_ch3_2nd = block;

  517. 			__enable_irq();

  518. 		} else {

  519. 			tmp = block_ch3_1st;

  520. 			block_ch3_1st = block_ch3_2nd;

  521. 			block_ch3_2nd = block;

  522. 			ch3_offset = 0;

  523. 			__enable_irq();

  524. 			release(tmp);

  525. 		}

  526. 	}

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

  528. 	if (block) {

  529. 		__disable_irq();

  530. 		if (block_ch4_1st == NULL) {

  531. 			block_ch4_1st = block;

  532. 			ch4_offset = 0;

  533. 			__enable_irq();

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

  535. 			block_ch4_2nd = block;

  536. 			__enable_irq();

  537. 		} else {

  538. 			tmp = block_ch4_1st;

  539. 			block_ch4_1st = block_ch4_2nd;

  540. 			block_ch4_2nd = block;

  541. 			ch4_offset = 0;

  542. 			__enable_irq();

  543. 			release(tmp);

  544. 		}

  545. 	}

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

  547. 	if (block) {

  548. 		__disable_irq();

  549. 		if (block_ch5_1st == NULL) {

  550. 			block_ch5_1st = block;

  551. 			ch5_offset = 0;

  552. 			__enable_irq();

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

  554. 			block_ch5_2nd = block;

  555. 			__enable_irq();

  556. 		} else {

  557. 			tmp = block_ch5_1st;

  558. 			block_ch5_1st = block_ch5_2nd;

  559. 			block_ch5_2nd = block;

  560. 			ch5_offset = 0;

  561. 			__enable_irq();

  562. 			release(tmp);

  563. 		}

  564. 	}

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

  566. 	if (block) {

  567. 		__disable_irq();

  568. 		if (block_ch6_1st == NULL) {

  569. 			block_ch6_1st = block;

  570. 			ch6_offset = 0;

  571. 			__enable_irq();

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

  573. 			block_ch6_2nd = block;

  574. 			__enable_irq();

  575. 		} else {

  576. 			tmp = block_ch6_1st;

  577. 			block_ch6_1st = block_ch6_2nd;

  578. 			block_ch6_2nd = block;

  579. 			ch6_offset = 0;

  580. 			__enable_irq();

  581. 			release(tmp);

  582. 		}

  583. 	}

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

  585. 	if (block) {

  586. 		__disable_irq();

  587. 		if (block_ch7_1st == NULL) {

  588. 			block_ch7_1st = block;

  589. 			ch7_offset = 0;

  590. 			__enable_irq();

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

  592. 			block_ch7_2nd = block;

  593. 			__enable_irq();

  594. 		} else {

  595. 			tmp = block_ch7_1st;

  596. 			block_ch7_1st = block_ch7_2nd;

  597. 			block_ch7_2nd = block;

  598. 			ch7_offset = 0;

  599. 			__enable_irq();

  600. 			release(tmp);

  601. 		}

  602. 	}

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

  604. 	if (block) {

  605. 		__disable_irq();

  606. 		if (block_ch8_1st == NULL) {

  607. 			block_ch8_1st = block;

  608. 			ch8_offset = 0;

  609. 			__enable_irq();

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

  611. 			block_ch8_2nd = block;

  612. 			__enable_irq();

  613. 		} else {

  614. 			tmp = block_ch8_1st;

  615. 			block_ch8_1st = block_ch8_2nd;

  616. 			block_ch8_2nd = block;

  617. 			ch8_offset = 0;

  618. 			__enable_irq();

  619. 			release(tmp);

  620. 		}

  621. 	}

  622. }

  623. 

  624. 

  625. #ifndef MCLK_SRC

  626. #if F_CPU >= 20000000

  627.   #define MCLK_SRC  3  // the PLL

  628. #else

  629.   #define MCLK_SRC  0  // system clock

  630. #endif

  631. #endif

  632. 

  633. 

  634. void AudioOutputADAT::config_ADAT(void)

  635. {

  636. 	SIM_SCGC6 |= SIM_SCGC6_I2S;

  637. 	SIM_SCGC7 |= SIM_SCGC7_DMA;

  638. 	SIM_SCGC6 |= SIM_SCGC6_DMAMUX;

  639. 

  640. 	// enable MCLK output

  641. 	I2S0_MCR = I2S_MCR_MICS(MCLK_SRC) | I2S_MCR_MOE;

  642. 	//while (I2S0_MCR & I2S_MCR_DUF) ;

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

  644. 

  645. 	AudioOutputADAT::setI2SFreq(88200);

  646. 

  647. 	// configure transmitter

  648. 	I2S0_TMR = 0;

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

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

  651. 	I2S0_TCR3 = I2S_TCR3_TCE;

  652. 

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

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

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

  656. 

  657. 	I2S0_RCSR = 0;

  658. 

  659. #if 0

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

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

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

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

  664. #endif

  665. }

  666. 

  667. 

  668. #elif defined(KINETISL)

  669. 

  670. void AudioOutputADAT::update(void)

  671. {

  672. 

  673. 	audio_block_t *block;

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

  675. 	if (block) release(block);

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

  677. 	if (block) release(block);

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

  679. 	if (block) release(block);

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

  681. 	if (block) release(block);

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

  683. 	if (block) release(block);

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

  685. 	if (block) release(block);

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

  687. 	if (block) release(block);

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

  689. 	if (block) release(block);

  690. }

  691. 

  692. #endif

  693. 

  694. /*

  695. 

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

  697. 

  698. */

  699. 

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

  701.   typedef struct {

  702.     uint8_t mult;

  703.     uint16_t div;

  704.   } tmclk;

  705. 

  706.   const int numfreqs = 14;

  707.   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};

  708. 

  709. #if (F_PLL==16000000)

  710.   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} };

  711. #elif (F_PLL==72000000)

  712.   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} };

  713. #elif (F_PLL==96000000)

  714.   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} };

  715. #elif (F_PLL==120000000)

  716.   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} };

  717. #elif (F_PLL==144000000)

  718.   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} };

  719. #elif (F_PLL==180000000)

  720.   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} };

  721. #elif (F_PLL==192000000)

  722.   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} };

  723. #elif (F_PLL==216000000)

  724.   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} };

  725. #elif (F_PLL==240000000)

  726.   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} };

  727. #endif

  728. 

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

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

  731.       while (I2S0_MCR & I2S_MCR_DUF) ;

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

  733.       return;

  734.     }

  735.   }

  736. }