PlatformIO package of the Teensy core framework compatible with GCC 10 & C++20
Вы не можете выбрать более 25 тем Темы должны начинаться с буквы или цифры, могут содержать дефисы(-) и должны содержать не более 35 символов.

104 lines
3.4KB

  1. /* Audio Library for Teensy 3.X
  2. * Copyright (c) 2014, Paul Stoffregen, paul@pjrc.com
  3. *
  4. * Development of this audio library was funded by PJRC.COM, LLC by sales of
  5. * Teensy and Audio Adaptor boards. Please support PJRC's efforts to develop
  6. * open source software by purchasing Teensy or other PJRC products.
  7. *
  8. * Permission is hereby granted, free of charge, to any person obtaining a copy
  9. * of this software and associated documentation files (the "Software"), to deal
  10. * in the Software without restriction, including without limitation the rights
  11. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  12. * copies of the Software, and to permit persons to whom the Software is
  13. * furnished to do so, subject to the following conditions:
  14. *
  15. * The above copyright notice, development funding notice, and this permission
  16. * notice shall be included in all copies or substantial portions of the Software.
  17. *
  18. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  19. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  20. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  21. * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  22. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  23. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  24. * THE SOFTWARE.
  25. */
  26. #ifndef analyze_fft1024_h_
  27. #define analyze_fft1024_h_
  28. #include "Arduino.h"
  29. #include "AudioStream.h"
  30. #include "arm_math.h"
  31. // windows.c
  32. extern "C" {
  33. extern const int16_t AudioWindowHanning1024[];
  34. extern const int16_t AudioWindowBartlett1024[];
  35. extern const int16_t AudioWindowBlackman1024[];
  36. extern const int16_t AudioWindowFlattop1024[];
  37. extern const int16_t AudioWindowBlackmanHarris1024[];
  38. extern const int16_t AudioWindowNuttall1024[];
  39. extern const int16_t AudioWindowBlackmanNuttall1024[];
  40. extern const int16_t AudioWindowWelch1024[];
  41. extern const int16_t AudioWindowHamming1024[];
  42. extern const int16_t AudioWindowCosine1024[];
  43. extern const int16_t AudioWindowTukey1024[];
  44. }
  45. class AudioAnalyzeFFT1024 : public AudioStream
  46. {
  47. public:
  48. AudioAnalyzeFFT1024() : AudioStream(1, inputQueueArray),
  49. window(AudioWindowHanning1024), state(0), outputflag(false) {
  50. arm_cfft_radix4_init_q15(&fft_inst, 1024, 0, 1);
  51. }
  52. bool available() {
  53. if (outputflag == true) {
  54. outputflag = false;
  55. return true;
  56. }
  57. return false;
  58. }
  59. float read(unsigned int binNumber) {
  60. if (binNumber > 511) return 0.0;
  61. return (float)(output[binNumber]) * (1.0 / 16384.0);
  62. }
  63. float read(unsigned int binFirst, unsigned int binLast) {
  64. if (binFirst > binLast) {
  65. unsigned int tmp = binLast;
  66. binLast = binFirst;
  67. binFirst = tmp;
  68. }
  69. if (binFirst > 511) return 0.0;
  70. if (binLast > 511) binLast = 511;
  71. uint32_t sum = 0;
  72. do {
  73. sum += output[binFirst++];
  74. } while (binFirst <= binLast);
  75. return (float)sum * (1.0 / 16384.0);
  76. }
  77. void averageTogether(uint8_t n) {
  78. // not implemented yet (may never be, 86 Hz output rate is ok)
  79. }
  80. void windowFunction(const int16_t *w) {
  81. window = w;
  82. }
  83. virtual void update(void);
  84. uint16_t output[512] __attribute__ ((aligned (4)));
  85. private:
  86. void init(void);
  87. const int16_t *window;
  88. audio_block_t *blocklist[8];
  89. int16_t buffer[2048] __attribute__ ((aligned (4)));
  90. //uint32_t sum[512];
  91. //uint8_t count;
  92. uint8_t state;
  93. //uint8_t naverage;
  94. volatile bool outputflag;
  95. audio_block_t *inputQueueArray[1];
  96. arm_cfft_radix4_instance_q15 fft_inst;
  97. };
  98. #endif