Teensy 4.1 core updated for C++20
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

180 lines
6.3KB

  1. /* Teensyduino Core Library
  2. * http://www.pjrc.com/teensy/
  3. * Copyright (c) 2013 PJRC.COM, LLC.
  4. *
  5. * Permission is hereby granted, free of charge, to any person obtaining
  6. * a copy of this software and associated documentation files (the
  7. * "Software"), to deal in the Software without restriction, including
  8. * without limitation the rights to use, copy, modify, merge, publish,
  9. * distribute, sublicense, and/or sell copies of the Software, and to
  10. * permit persons to whom the Software is furnished to do so, subject to
  11. * the following conditions:
  12. *
  13. * 1. The above copyright notice and this permission notice shall be
  14. * included in all copies or substantial portions of the Software.
  15. *
  16. * 2. If the Software is incorporated into a build system that allows
  17. * selection among a list of target devices, then similar target
  18. * devices manufactured by PJRC.COM must be included in the list of
  19. * target devices and selectable in the same manner.
  20. *
  21. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  22. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  23. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  24. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  25. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  26. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  27. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  28. * SOFTWARE.
  29. */
  30. #ifndef AudioStream_h
  31. #define AudioStream_h
  32. #ifndef __ASSEMBLER__
  33. #include <stdio.h> // for NULL
  34. #include <string.h> // for memcpy
  35. #include "kinetis.h"
  36. #endif
  37. // AUDIO_BLOCK_SAMPLES determines how many samples the audio library processes
  38. // per update. It may be reduced to achieve lower latency response to events,
  39. // at the expense of higher interrupt and DMA setup overhead.
  40. //
  41. // Less than 32 may not work with some input & output objects. Multiples of 16
  42. // should be used, since some synthesis objects generate 16 samples per loop.
  43. //
  44. // Some parts of the audio library may have hard-coded dependency on 128 samples.
  45. // Please report these on the forum with reproducible test cases.
  46. #if defined(__MK20DX128__) || defined(__MK20DX256__) || defined(__MK64FX512__) || defined(__MK66FX1M0__)
  47. #define AUDIO_BLOCK_SAMPLES 128
  48. #define AUDIO_SAMPLE_RATE 44117.64706
  49. #define AUDIO_SAMPLE_RATE_EXACT 44117.64706 // 48 MHz / 1088, or 96 MHz * 2 / 17 / 256
  50. #elif defined(__MKL26Z64__)
  51. #define AUDIO_BLOCK_SAMPLES 64
  52. #define AUDIO_SAMPLE_RATE 22058.82353
  53. #define AUDIO_SAMPLE_RATE_EXACT 22058.82353 // 48 MHz / 2176, or 96 MHz * 1 / 17 / 256
  54. #endif
  55. #ifndef __ASSEMBLER__
  56. class AudioStream;
  57. class AudioConnection;
  58. typedef struct audio_block_struct {
  59. unsigned char ref_count;
  60. unsigned char memory_pool_index;
  61. unsigned char reserved1;
  62. unsigned char reserved2;
  63. int16_t data[AUDIO_BLOCK_SAMPLES];
  64. } audio_block_t;
  65. class AudioConnection
  66. {
  67. public:
  68. AudioConnection(AudioStream &source, AudioStream &destination) :
  69. src(source), dst(destination), src_index(0), dest_index(0),
  70. next_dest(NULL)
  71. { isConnected = false;
  72. connect(); }
  73. AudioConnection(AudioStream &source, unsigned char sourceOutput,
  74. AudioStream &destination, unsigned char destinationInput) :
  75. src(source), dst(destination),
  76. src_index(sourceOutput), dest_index(destinationInput),
  77. next_dest(NULL)
  78. { isConnected = false;
  79. connect(); }
  80. friend class AudioStream;
  81. ~AudioConnection() {
  82. disconnect();
  83. }
  84. void disconnect(void);
  85. void connect(void);
  86. protected:
  87. AudioStream &src;
  88. AudioStream &dst;
  89. unsigned char src_index;
  90. unsigned char dest_index;
  91. AudioConnection *next_dest;
  92. bool isConnected;
  93. };
  94. #define AudioMemory(num) ({ \
  95. static DMAMEM audio_block_t data[num]; \
  96. AudioStream::initialize_memory(data, num); \
  97. })
  98. #define CYCLE_COUNTER_APPROX_PERCENT(n) (((n) + (F_CPU / 32 / AUDIO_SAMPLE_RATE * AUDIO_BLOCK_SAMPLES / 100)) / (F_CPU / 16 / AUDIO_SAMPLE_RATE * AUDIO_BLOCK_SAMPLES / 100))
  99. #define AudioProcessorUsage() (CYCLE_COUNTER_APPROX_PERCENT(AudioStream::cpu_cycles_total))
  100. #define AudioProcessorUsageMax() (CYCLE_COUNTER_APPROX_PERCENT(AudioStream::cpu_cycles_total_max))
  101. #define AudioProcessorUsageMaxReset() (AudioStream::cpu_cycles_total_max = AudioStream::cpu_cycles_total)
  102. #define AudioMemoryUsage() (AudioStream::memory_used)
  103. #define AudioMemoryUsageMax() (AudioStream::memory_used_max)
  104. #define AudioMemoryUsageMaxReset() (AudioStream::memory_used_max = AudioStream::memory_used)
  105. class AudioStream
  106. {
  107. public:
  108. AudioStream(unsigned char ninput, audio_block_t **iqueue) :
  109. num_inputs(ninput), inputQueue(iqueue) {
  110. active = false;
  111. destination_list = NULL;
  112. for (int i=0; i < num_inputs; i++) {
  113. inputQueue[i] = NULL;
  114. }
  115. // add to a simple list, for update_all
  116. // TODO: replace with a proper data flow analysis in update_all
  117. if (first_update == NULL) {
  118. first_update = this;
  119. } else {
  120. AudioStream *p;
  121. for (p=first_update; p->next_update; p = p->next_update) ;
  122. p->next_update = this;
  123. }
  124. next_update = NULL;
  125. cpu_cycles = 0;
  126. cpu_cycles_max = 0;
  127. numConnections = 0;
  128. }
  129. static void initialize_memory(audio_block_t *data, unsigned int num);
  130. int processorUsage(void) { return CYCLE_COUNTER_APPROX_PERCENT(cpu_cycles); }
  131. int processorUsageMax(void) { return CYCLE_COUNTER_APPROX_PERCENT(cpu_cycles_max); }
  132. void processorUsageMaxReset(void) { cpu_cycles_max = cpu_cycles; }
  133. bool isActive(void) { return active; }
  134. uint16_t cpu_cycles;
  135. uint16_t cpu_cycles_max;
  136. static uint16_t cpu_cycles_total;
  137. static uint16_t cpu_cycles_total_max;
  138. static uint8_t memory_used;
  139. static uint8_t memory_used_max;
  140. protected:
  141. bool active;
  142. unsigned char num_inputs;
  143. static audio_block_t * allocate(void);
  144. static void release(audio_block_t * block);
  145. void transmit(audio_block_t *block, unsigned char index = 0);
  146. audio_block_t * receiveReadOnly(unsigned int index = 0);
  147. audio_block_t * receiveWritable(unsigned int index = 0);
  148. static bool update_setup(void);
  149. static void update_stop(void);
  150. static void update_all(void) { NVIC_SET_PENDING(IRQ_SOFTWARE); }
  151. friend void software_isr(void);
  152. friend class AudioConnection;
  153. uint8_t numConnections;
  154. private:
  155. AudioConnection *destination_list;
  156. audio_block_t **inputQueue;
  157. static bool update_scheduled;
  158. virtual void update(void) = 0;
  159. static AudioStream *first_update; // for update_all
  160. AudioStream *next_update; // for update_all
  161. static audio_block_t *memory_pool;
  162. static uint32_t memory_pool_available_mask[6];
  163. };
  164. #endif
  165. #endif