ZPS_4_5

else if (krok == 4) {

            lewy_wyjscie = mono_wejscie;
            prawy_wyjscie = mono_wejscie;


            wynik[j] = mono_wejscie

            rfft((DATA*)&wynik, NUM_SAMPLES, SCALE);                 //funkcja z biblioteki DSPLIB pozwalająca obliczenie widma (FFT) dla sygnału rzeczywistego

            for (i = 0; i < NUM_SAMPLES; i++){                        //obliczenie kwadratów próbek widma
                wynik[i] = _smpy(wynik[i], wynik[i]);
            }

            for(i = 2; i < NUM_SAMPLES; i = i + 2){                   //sumowanie kwadratów częsci rzeczywistych i urojonych (Re[i]^2 + Im[i+1]^2)
                wynik[k] = wynik[i] + wynik[i + 1];
                k++;
            }

           sqrt_16((DATA*)wynik, (DATA*)wynik, 512);              //obliczenie widma amplitudowego (modułu widma zespolonego)
           maksimum(wynik, 2000, NUM_SAMPLES, 1);                   //obliczenie indeksu maksimum widma
           j++;

        }