|
12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182 |
-
-
-
- #include <Arduino.h>
- #include "analyze_rms.h"
- #include "utility/dspinst.h"
-
- void AudioAnalyzeRMS::update(void)
- {
- audio_block_t *block = receiveReadOnly();
- if (!block) {
- count++;
- return;
- }
- #if defined(__ARM_ARCH_7EM__)
- uint32_t *p = (uint32_t *)(block->data);
- uint32_t *end = p + AUDIO_BLOCK_SAMPLES/2;
- int64_t sum = accum;
- do {
- uint32_t n1 = *p++;
- uint32_t n2 = *p++;
- uint32_t n3 = *p++;
- uint32_t n4 = *p++;
- sum = multiply_accumulate_16tx16t_add_16bx16b(sum, n1, n1);
- sum = multiply_accumulate_16tx16t_add_16bx16b(sum, n2, n2);
- sum = multiply_accumulate_16tx16t_add_16bx16b(sum, n3, n3);
- sum = multiply_accumulate_16tx16t_add_16bx16b(sum, n4, n4);
- } while (p < end);
- accum = sum;
- count++;
- #else
- int16_t *p = block->data;
- int16_t *end = p + AUDIO_BLOCK_SAMPLES;
- int64_t sum = accum;
- do {
- int32_t n = *p++;
- sum += n * n;
- } while (p < end);
- accum = sum;
- count++;
- #endif
- release(block);
- }
-
- float AudioAnalyzeRMS::read(void)
- {
- __disable_irq();
- int64_t sum = accum;
- accum = 0;
- uint32_t num = count;
- count = 0;
- __enable_irq();
- float meansq = sum / (num * AUDIO_BLOCK_SAMPLES);
-
-
- return sqrtf(meansq) / 32767.0;
- }
-
|