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.

148 satır
5.2KB

  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. #include "Arduino.h"
  33. #define AUDIO_BLOCK_SAMPLES 128
  34. #define AUDIO_SAMPLE_RATE 44117.64706
  35. #define AUDIO_SAMPLE_RATE_EXACT 44117.64706 // 48 MHz / 1088, or 96 MHz * 2 / 17 / 256
  36. class AudioStream;
  37. class AudioConnection;
  38. typedef struct audio_block_struct {
  39. unsigned char ref_count;
  40. unsigned char memory_pool_index;
  41. unsigned char reserved1;
  42. unsigned char reserved2;
  43. int16_t data[AUDIO_BLOCK_SAMPLES];
  44. } audio_block_t;
  45. class AudioConnection
  46. {
  47. public:
  48. AudioConnection(AudioStream &source, AudioStream &destination) :
  49. src(source), dst(destination), src_index(0), dest_index(0),
  50. next_dest(NULL)
  51. { connect(); }
  52. AudioConnection(AudioStream &source, unsigned char sourceOutput,
  53. AudioStream &destination, unsigned char destinationInput) :
  54. src(source), dst(destination),
  55. src_index(sourceOutput), dest_index(destinationInput),
  56. next_dest(NULL)
  57. { connect(); }
  58. friend class AudioStream;
  59. protected:
  60. void connect(void);
  61. AudioStream &src;
  62. AudioStream &dst;
  63. unsigned char src_index;
  64. unsigned char dest_index;
  65. AudioConnection *next_dest;
  66. };
  67. #define AudioMemory(num) ({ \
  68. static DMAMEM audio_block_t data[num]; \
  69. AudioStream::initialize_memory(data, num); \
  70. })
  71. #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))
  72. #define AudioProcessorUsage() (CYCLE_COUNTER_APPROX_PERCENT(AudioStream::cpu_cycles_total))
  73. #define AudioProcessorUsageMax() (CYCLE_COUNTER_APPROX_PERCENT(AudioStream::cpu_cycles_total_max))
  74. #define AudioProcessorUsageMaxReset() (AudioStream::cpu_cycles_total_max = AudioStream::cpu_cycles_total)
  75. #define AudioMemoryUsage() (AudioStream::memory_used)
  76. #define AudioMemoryUsageMax() (AudioStream::memory_used_max)
  77. #define AudioMemoryUsageMaxReset() (AudioStream::memory_used_max = AudioStream::memory_used)
  78. class AudioStream
  79. {
  80. public:
  81. AudioStream(unsigned char ninput, audio_block_t **iqueue) :
  82. num_inputs(ninput), inputQueue(iqueue) {
  83. active = false;
  84. destination_list = NULL;
  85. for (int i=0; i < num_inputs; i++) {
  86. inputQueue[i] = NULL;
  87. }
  88. // add to a simple list, for update_all
  89. // TODO: replace with a proper data flow analysis in update_all
  90. if (first_update == NULL) {
  91. first_update = this;
  92. } else {
  93. AudioStream *p;
  94. for (p=first_update; p->next_update; p = p->next_update) ;
  95. p->next_update = this;
  96. }
  97. next_update = NULL;
  98. cpu_cycles = 0;
  99. cpu_cycles_max = 0;
  100. }
  101. static void initialize_memory(audio_block_t *data, unsigned int num);
  102. int processorUsage(void) { return CYCLE_COUNTER_APPROX_PERCENT(cpu_cycles); }
  103. int processorUsageMax(void) { return CYCLE_COUNTER_APPROX_PERCENT(cpu_cycles_max); }
  104. void processorUsageMaxReset(void) { cpu_cycles_max = cpu_cycles; }
  105. uint16_t cpu_cycles;
  106. uint16_t cpu_cycles_max;
  107. static uint16_t cpu_cycles_total;
  108. static uint16_t cpu_cycles_total_max;
  109. static uint8_t memory_used;
  110. static uint8_t memory_used_max;
  111. protected:
  112. bool active;
  113. unsigned char num_inputs;
  114. static audio_block_t * allocate(void);
  115. static void release(audio_block_t * block);
  116. void transmit(audio_block_t *block, unsigned char index = 0);
  117. audio_block_t * receiveReadOnly(unsigned int index = 0);
  118. audio_block_t * receiveWritable(unsigned int index = 0);
  119. static bool update_setup(void);
  120. static void update_stop(void);
  121. static void update_all(void) { NVIC_SET_PENDING(IRQ_SOFTWARE); }
  122. friend void software_isr(void);
  123. friend class AudioConnection;
  124. private:
  125. AudioConnection *destination_list;
  126. audio_block_t **inputQueue;
  127. static bool update_scheduled;
  128. virtual void update(void) = 0;
  129. static AudioStream *first_update; // for update_all
  130. AudioStream *next_update; // for update_all
  131. static audio_block_t *memory_pool;
  132. static uint32_t memory_pool_available_mask[6];
  133. };
  134. #endif