Новая версия ару
Теперь съедает питчики
Код:
float32_t max = 0.49975586f; //максималка от -0.5 до +0.5 примерно для 12 бит
uint16_t count = 100;
float32_t pit1 = -1;
float32_t pit2 = 0;
uint8_t stopGoingUp = 0;
float32_t rmsPik = 0;
float32_t rmsFrame = 0;
void agcDo(float32_t *buffer) {
float32_t agcMetrTemp = 0;
if (tim > 0)tim--; //уменьшение задержки
stopGoingUp = 0;
for (uint16_t i = 0; i < FRAME_SIZE; i++) {
float32_t a;
//a = (buffer[i] < 0.0f) ? -1.0f * buffer[i] : buffer[i];// adc V
a = fabsf(buffer[i]);
// seach min
if (a > 0)nowAgc = max / a;
else nowAgc = max / 0.000005f;
uint16_t upIdx = i;
float32_t pikBuf = -1;
uint8_t exit = 1;
uint8_t exitYN = 0;
uint16_t wait = 48;// 1msec
int direction = 0;//напрвление вниз (отрицательная синусоида)
if (buffer[i] > 0) direction = 1;//напрвление вверх (положительная синусоида)
if (buffer[i] == 0) exit = 0; //пропустим поиск пика в блоке
while (exit) { //поиск пика в блоке от 0 до 0
exit = 0;//выходим
float32_t p1 = fabsf(buffer[upIdx]);//feature
if (upIdx < FRAME_SIZE) {
if (direction) {//+++++++++++++++++++++++++++++
//если условие остановило в ++ то добиваем его до 0
if ((buffer[upIdx] >= 0 && !exitYN) || (upIdx - i < wait)) {
upIdx++;
if (p1 > pikBuf) {
pikBuf = p1;
}
exit = 1;//не выходим
}
//если условие остановило в -- то добиваем его до 0 и выходим
if (((buffer[upIdx] < 0)) && (upIdx - i >= wait)) {
upIdx++;
exitYN = 1; //не дадим пред условию сработать
if (p1 > pikBuf) {
pikBuf = p1;
}
exit = 1;//не выходим
}
} else { //------------------------
//going up
//если условие остановило в -- то добиваем его до 0 и выходим
if ((buffer[upIdx] <= 0 && !exitYN) || (upIdx - i < wait)) {
upIdx++;
if (p1 > pikBuf) {
pikBuf = p1;
}
exit = 1;//не выходим
}
//если условие остановило в ++ то добиваем его до 0
if (((buffer[upIdx] > 0)) && (upIdx - i >= wait)) {
upIdx++;
exitYN = 1; //не дадим пред условию сработать
if (p1 > pikBuf) {
pikBuf = p1;
}
exit = 1;//не выходим
}
}
//добавим блок если в нем есть глобальный пик (выброс)
if (upIdx - i >= wait && max / pikBuf < agcLevel) {
if (256 + upIdx < FRAME_SIZE) wait = 256;
}
}
}//while
if (upIdx > i) { //если блок не пустой то...
float32_t locNowAgc;
//проверка на 0
if (pikBuf != 0) {
locNowAgc = max / pikBuf;//максимальное значение
} else locNowAgc = max / 0.00005f;
//типа среднее значение . исползуется для отката .
rmsPik = (rmsPik + pikBuf) / 2.0f;
//agcLevel == текущий уровень ару
if (locNowAgc < agcLevel) { // всплеск или питч V, идем вниз ..........................
stopGoingUp=0;
//заполним блок
if (i) {
for (uint16_t z = i; z <= upIdx; z++) {
buffer[z] *= locNowAgc;//применить новый коэфф
}
} else {//механизм сочленения с пред фреймом ...ждем первого нуля
if (buffer[0] > 0) direction = 1;//напрвление вверх (положительная синусоида)
exit = 1;
uint16_t idx0 = 0;
while (exit) {
exit = 0;//выходим
if (direction) {//+++++++++++++++++++++++++++++
if (buffer[idx0] > 0) {
idx0++;
exit = 1;//не выходим
}
} else { //------------------------
//going up
if (buffer[idx0] < 0) {
idx0++;
exit = 1;//не выходим
}
}
}//while
for (uint16_t z = 0; z <= upIdx; z++) {
if (z <= idx0)buffer[z] *= agcLevel;//применить старый коэфф
else buffer[z] *= locNowAgc;//применить новый коэфф
}
}
if ((pit2< pit1 && pit1 > pikBuf ) ) {//смотрим следующий питч если
agcLevel -= (agcLevel - locNowAgc) / 5;
} else {
// agcLevel = locNowAgc;
agcLevel -= (agcLevel - locNowAgc) / 2;
}
if ((pit2< pit1 && pit1 < pikBuf )) {//смотрим следующий питч если
// agcLevel = locNowAgc;
agcLevel -= (agcLevel - locNowAgc) / 1;
}
pit2 = pit1;
pit1 = pikBuf;
tim = 30;//задежка отпускания
// }
} else {//идем вверх/////////////////////////////////////////////////////////////////////
float32_t cc ;
if (tim == 0) {//подождали и начинаем
cc = agcLevel + (locNowAgc - agcLevel) / 600;
//проверим можем нет еще откатить
if (rmsFrame * cc < max - 0.0f && !stopGoingUp) {//дельта отката 0.4
agcLevel = cc;
} else stopGoingUp=1; //остановить откат
}
//заполним полупериод
for (uint16_t z = i; z <= upIdx; z++) {
buffer[z] *= agcLevel;//применить новый коэфф
}
}
i = upIdx; // след цикл будет стратовать от upIdx
} else { //это сидуация редкая но тоже надо . сделано по класике одного замера
if (nowAgc < agcLevel) { // всплеск V
agcLevel -= (agcLevel - nowAgc) / 2;
// tim = 10;//задежка отпускания
}
float32_t f = a * agcLevel;
//контроль вылета в out
if (f > max) {//out
if (buffer[i] >= 0) buffer[i] = max;//max
else buffer[i] = -max;//max
// agcLevel = 1;
} else
buffer[i] *= agcLevel;
}
if (a > agcMetrTemp) agcMetrTemp = a; //s-meter макс V
}//for
rmsFrame=(rmsFrame+rmsPik)/2.0f;
agcMetr = agcMetrTemp; //s-meter
}