Путеводитель по схемам Игоря2http://analogtrx.com/SMF/index.php?topic=323.0
0 Пользователей и 2 Гостей просматривают эту тему.
Это розовый шум!!
float32_t max = 0.49975586f; //максималка от -0.5 до +0.5 примерно для 12 битuint16_t count = 100;uint8_t stopGoingUp = 0;float32_t rmsPik = 0;float32_t rmsFrame = 0;void agcDo(float32_t *buffer) { float32_t agcMetrTemp = 0; float32_t pit1 = -1; float32_t pit2 = 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; uint16_t upIdxNow ; 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 upIdxNow = upIdx; if (direction) {//+++++++++++++++++++++++++++++ //если условие остановило в ++ то добиваем его до 0 if ((buffer[upIdx] >= 0 && !exitYN) || (upIdx - i < wait)) { if (p1 > pikBuf) { pikBuf = p1; } if (upIdx + 1 < FRAME_SIZE) { upIdx++; exit = 1;//не выходим } } //если условие остановило в -- то добиваем его до 0 и выходим if ((buffer[upIdxNow] < 0) && (upIdxNow - i >= wait)) { exitYN = 1; //не дадим пред условию сработать if (p1 > pikBuf) { pikBuf = p1; } if (upIdxNow + 1 < FRAME_SIZE) { upIdx++; exit = 1;//не выходим } } } else { //------------------------ //going up //если условие остановило в -- то добиваем его до 0 и выходим if ((buffer[upIdx] <= 0 && !exitYN) || (upIdx - i < wait)) { if (p1 > pikBuf) { pikBuf = p1; } if (upIdx + 1 < FRAME_SIZE) { upIdx++; exit = 1;//не выходим } } //если условие остановило в ++ то добиваем его до 0 if ((buffer[upIdxNow] > 0) && (upIdxNow - i >= wait)) { exitYN = 1; //не дадим пред условию сработать if (p1 > pikBuf) { pikBuf = p1; } if (upIdxNow + 1 < FRAME_SIZE) { upIdx++; exit = 1;//не выходим } } } //добавим блок если в нем есть глобальный пик (выброс) if (upIdx - i >= wait && max / pikBuf > agcLevel) { if (256 + upIdx < FRAME_SIZE) wait = 256; } }//while if (upIdx > i) { //если блок не пустой то... //upIdx--; 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 > 0) { 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;//применить новый коэфф } } tim = 10;//задежка отпускания if ((pit2 < pit1 && pit1 < pikBuf)) {//смотрим следующий питч если agcLevel = locNowAgc; // agcLevel -= (agcLevel - locNowAgc) / 1; tim = 30;//задежка отпускания } else if ((pit2 < pit1 && pit1 > pikBuf)) {//смотрим следующий питч если agcLevel -= (agcLevel - locNowAgc) / 5; } else { agcLevel -= (agcLevel - locNowAgc) / 2; } pit2 = pit1; pit1 = pikBuf; } else {//идем вверх///////////////////////////////////////////////////////////////////// float32_t cc; if (tim == 0) {//подождали и начинаем cc = agcLevel + (locNowAgc - agcLevel) / 600; //проверим можем нет еще откатить if (rmsFrame * cc < max - 0.3f && !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
розовый шум имеет спектр -6 дБ/октава.
спад 3дб/октава
