178 lines
4.9 KiB
C
178 lines
4.9 KiB
C
#include "vollevel_detect.h"
|
|
|
|
static const unsigned short am_va_tab[] = {
|
|
32768, 29205, 26029, 23198, 20675, 18427, 16423, 14637, 13045, 11627, 10362, 9235, 8231, 7336, 6538, 5827, 5193, 4629, 4125, 3677, 3277, 2920, 2603, 2320, 2068, 1843, 1642, 1464, 1305, 1163, 1036, 0
|
|
};
|
|
|
|
|
|
static const int rms_va_tab[] = {
|
|
134217728, 106612931, 84685661, 67268212, 53433040, 42443372, 33713969, 26779957, 21272076, 16897011,
|
|
13421773, 10661293, 8468566, 6726821, 5343304, 4244337, 3371397, 2677996, 2127208, 1689701,
|
|
1342177, 1066129, 846857, 672682, 534330, 424434, 337140, 267800, 212721, 168970,
|
|
134218, 0
|
|
};
|
|
|
|
|
|
//typedef struct _LOUDNESS_M_STRUCT_
|
|
//{
|
|
// int mutecnt;
|
|
// int rms;
|
|
// int counti;
|
|
// int maxval;
|
|
// int countperiod;
|
|
// int inv_counterpreiod;
|
|
// int errprintfcount0;
|
|
// short print_cnt;
|
|
// short print_dest;
|
|
// int dclevel;
|
|
// int rms_print;
|
|
// int maxval_print;
|
|
//}LOUDNESS_M_STRUCT;
|
|
//
|
|
|
|
|
|
void loudness_meter_init(LOUDNESS_M_STRUCT *loud_obj, int sr, int print_dest, u8 index)
|
|
{
|
|
memset(loud_obj, 0, sizeof(LOUDNESS_M_STRUCT));
|
|
loud_obj->countperiod = sr / 50;
|
|
loud_obj->inv_counterpreiod = 16777216 / loud_obj->countperiod;
|
|
loud_obj->print_dest = print_dest;
|
|
loud_obj->index = index;
|
|
}
|
|
|
|
void loudness_meter_short(LOUDNESS_M_STRUCT *loud_obj, short *data, int len)
|
|
{
|
|
int i;
|
|
int loudness_val = 0;
|
|
|
|
for (i = 0; i < len; i++) {
|
|
int tmp = data[i] * 256;
|
|
loud_obj->dclevel = (loud_obj->dclevel * 511 + tmp) >> 9;
|
|
|
|
|
|
int xabs = (data[i] > 0) ? data[i] : (-data[i]);
|
|
|
|
|
|
int xabs2 = (xabs * xabs) >> 10;
|
|
loud_obj->rms += xabs2;
|
|
|
|
loud_obj->maxval = (loud_obj->maxval > xabs) ? loud_obj->maxval : xabs;
|
|
|
|
if (xabs >= 32767) {
|
|
loud_obj->errprintfcount0++;
|
|
}
|
|
|
|
loud_obj->counti++;
|
|
if (loud_obj->counti > loud_obj->countperiod) {
|
|
|
|
if (loud_obj->maxval_print < loud_obj->maxval) {
|
|
loud_obj->maxval_print = loud_obj->maxval;
|
|
}
|
|
|
|
if (loud_obj->rms_print < loud_obj->rms) {
|
|
loud_obj->rms_print = loud_obj->rms;
|
|
}
|
|
|
|
loud_obj->counti = 0;
|
|
loud_obj->maxval = 0;
|
|
loud_obj->rms = 0;
|
|
|
|
if (loud_obj->errprintfcount0 > 2) {
|
|
loud_obj->errprintfcount0 = 0;
|
|
printf("[%d]overflow occur... \n", loud_obj->index);
|
|
}
|
|
|
|
loud_obj->print_cnt++;
|
|
|
|
if (loud_obj->print_cnt >= loud_obj->print_dest) {
|
|
|
|
int rmsval = ((__int64)loud_obj->rms_print * (__int64)loud_obj->inv_counterpreiod) >> (24 - (10 - 3));
|
|
|
|
if (rmsval > 25837266) {
|
|
printf("[%d]energy high... \n", loud_obj->index);
|
|
}
|
|
|
|
{
|
|
int compi = 0, found = 0;;
|
|
while (compi < 31) {
|
|
if (rmsval >= rms_va_tab[compi]) {
|
|
// float upval = (0 - compi) * 0.5;
|
|
// float dwonval = (0 - compi - 1) * 0.5;
|
|
// printf("rms level: %f to %f dB\n", upval, dwonval);
|
|
|
|
int upval = (0 - compi);
|
|
int dwonval = (0 - compi - 1);
|
|
printf("[%d]rms level: %d to %d dB\n", loud_obj->index, upval, dwonval);
|
|
|
|
found = 1;
|
|
break;
|
|
}
|
|
compi++;
|
|
}
|
|
|
|
if (found == 0) {
|
|
printf("[%d]rms level < -30dB \n", loud_obj->index);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
{
|
|
int compi = 0, found = 0;;
|
|
while (compi < 31) {
|
|
if (loud_obj->maxval_print >= am_va_tab[compi]) {
|
|
// float upval = (0 - compi) * 0.5;
|
|
// float dwonval = (0 - compi - 1) * 0.5;
|
|
// printf("peak level: %f to %f dB\n", upval, dwonval);
|
|
int upval = (0 - compi);
|
|
int dwonval = (0 - compi - 1);
|
|
printf("[%d]peak level: %d to %d dB\n", loud_obj->index, upval, dwonval);
|
|
|
|
found = 1;
|
|
break;
|
|
}
|
|
|
|
compi++;
|
|
}
|
|
|
|
if (found == 0) {
|
|
printf("[%d]peak level < -30dB \n", loud_obj->index);
|
|
}
|
|
}
|
|
|
|
loud_obj->print_cnt = 0;
|
|
loud_obj->maxval_print = 0;
|
|
loud_obj->rms_print = 0;
|
|
|
|
|
|
if (loud_obj->dclevel > (255 * 256)) {
|
|
printf("[%d] why ??? dc level : %d \n", loud_obj->index, loud_obj->dclevel >> 8);
|
|
}
|
|
printf("\n\n");
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
}
|
|
|
|
// return 0;
|
|
}
|
|
|
|
|
|
|
|
|
|
#if 0
|
|
|
|
loudness_meter_init(&loudness_adc, sr, 50);
|
|
|
|
while (1)
|
|
{
|
|
loudness_meter_short(&loudness_adc, datain, points);
|
|
}
|
|
|
|
#endif
|
|
|