ZSP_4_3

/*
 * Projekt z Zastosowania Procesorów Sygnałowych 2020
 * Projekt dla DSP TMS320C5535
 */


// Dołączenie wszelkich potrzebnych plików nagłówkowych
#include "usbstk5515.h"
#include "usbstk5515_led.h"
#include "aic3204.h"
#include "PLL.h"
#include "bargraph.h"
#include "oled.h"
#include "pushbuttons.h"
#include "Dsplib.h"
#include "testsignal.h"
#include "stdio.h"


// Wzmocnienie wejścia w dB: 0 dla wejścia liniowego, 30 dla mikrofonowego
#define WZMOCNIENIE_WEJSCIA_dB 30

// Wybór sygnału do przetwarzania
// 0: próbki z wejścia mikrofonowego
// 1: biały szum
// 2: sygnał piłokształtny
// 3: sinus (stała częstotliwość)
// 4: sygnał z testsignal.h
#define SIGNAL 0

/*MÓJ SHIT*/
int k, i, j;
int maks = 0;
#define NUM_SAMPLES 5000                                                                //ilosc probek
#define N 57
#define M 512
short wynik[NUM_SAMPLES];
int klarnet[NUM_SAMPLES];

short bufor[N + 2];
short obliczona = 0;
long y = 0;

const short filtr_fir[] = {-30, -32, -36, -41, -46, -51, -53, -50, -41,                 //wspolczynniki filtru obliczone w programie Matlab
-23, 6, 49, 106, 178, 267,372, 492, 624, 766, 914, 1064, 1212, 1353,
1482, 1594, 1687, 1755, 1797, 1811, 1797, 1755, 1687, 1594, 1482, 1353,
1212, 1064, 914, 766, 624, 492, 372, 267, 178, 106,49, 6, -23, -41
, -50, -53, -51, -46, -41, -36, -32, -30};                                              //suma współczynników = 32441; 32441/2^15 = 0,990021 (przemnożenie przez 0.99 przed zaokrągleniem)
/*MÓJ SHIT*/

void maksimum(int* tablica, int podloga, int number, int wybor){ //funkcja wyznaczająca indeks warstosci widma odpowiadającej pierwszemu istotnemu maksimum
    int znalezione = 0;
    int roznica = 0;

    for(i = 0; i < number; i++){
            if(tablica[i] > podloga){                           //porównanie wartosci próbki z ustaloną podłogą szumową
                roznica = tablica[i] - tablica[i - 1];          //liczenie pochodnej widma (różnica próbki bieżącej i próbki poprzedniej)
                if(roznica > 0){                                //gdy próbka bieżąca jest większa od poprzedniej, zostaje przypisana do maksimum
                    maks = i;
                    znalezione = 1;
                }
                else{
                    if(znalezione==1 && (roznica < 0)){        //gdy próbka bieżąca jest mniejsza od poprzedniej, a maksimum zostało już raz przypisane:
                        break;                                 //(znalezione = 1), to kończymy poszukiwania
                    }
                    else{continue;}
                }
            }
            else{continue;}
    }
    printf("Indeks maksimum: ");
    printf("%d \n", maks);
}

// Głowna procedura programu

void main(void) {

    // Inicjalizacja układu DSP
    USBSTK5515_init();          // BSL - układ uruchomieniowy
    pll_frequency_setup(100);   // ustawienie częstotliwości zegara DSP (PLL) na 100 MHz
    aic3204_hardware_init();    // kodek dźwięku AIC3204
    aic3204_init();             // jw.
    USBSTK5515_ULED_init();     // diody LED
    SAR_init_pushbuttons();     // przyciski
    oled_init();                // wyświelacz OLED 2x19 znaków

    // ustawienie częstotliwości próbkowania i wzmocnienia wejścia
    set_sampling_frequency_and_gain(48000L, WZMOCNIENIE_WEJSCIA_dB);

    // wypisanie komunikatu na wyświetlaczu
    // 2 linijki po 19 znaków, tylko wielkie angielskie litery
    oled_display_message("PROJEKT ZPS        ", "                   ");

    // 'krok' oznacza tryb pracy wybrany przyciskami
    unsigned int krok = 0;
    unsigned int poprzedni_krok = 9999;

    // zmienne do przechowywania wartości próbek
    Int16 lewy_wejscie;
    Int16 prawy_wejscie;
    Int16 lewy_wyjscie;
    Int16 prawy_wyjscie;
    Int16 mono_wejscie;

    // Przetwarzanie próbek sygnału w pętli
    while (1) {

        // odczyt próbek audio, zamiana na mono
        aic3204_codec_read(&lewy_wejscie, &prawy_wejscie);
        mono_wejscie = (lewy_wejscie >> 1) + (prawy_wejscie >> 1);

        // sprawdzamy czy wciśnięto przycisk
        // argument: maksymalna liczba obsługiwanych trybów
        krok = pushbuttons_read(4);
        if (krok == 0) // oba wciśnięte - wyjście
            break;
        else if (krok != poprzedni_krok) {
            // nastąpiła zmiana trybu - wciśnięto przycisk
            USBSTK5515_ULED_setall(0x0F); // zgaszenie wszystkich diód
            if (krok == 1) {
                // wypisanie informacji na wyświetlaczu
                oled_display_message("PROJEKT ZPS        ", "ORYGINALNY         ");
                // zapalenie diody nr 1
                USBSTK5515_ULED_on(0);
            } else if (krok == 2) {
                oled_display_message("PROJEKT ZPS        ", "FILTR              ");
                USBSTK5515_ULED_on(1);
            } else if (krok == 3) {
                oled_display_message("PROJEKT ZPS        ", "FILTR BLOK         ");
                USBSTK5515_ULED_on(2);
            } else if (krok == 4) {
                oled_display_message("PROJEKT ZPS        ", "WIDMO              ");
                USBSTK5515_ULED_on(3);
            }
            // zapisujemy nowo ustawiony tryb
            poprzedni_krok = krok;
        }


        // zadadnicze przetwarzanie w zależności od wybranego kroku

        if (krok == 1) {
            // tryb podstawowy - kopiowanie sygnału
            lewy_wyjscie = mono_wejscie;
            prawy_wyjscie = mono_wejscie;

        } else if (krok == 2) {

            for(k = 0; k < NUM_SAMPLES; k++){                                                   //pętla filtrująca sygnał z tablicy wejściowej metodą próbka po próbce
                    fir((DATA*)&mono_wejscie, (DATA*)filtr_fir, (DATA*)&obliczona, bufor, 1, N);            //wywołanie funkcji fir z biblioteki DSPLIB (liczenie pojedynczych próbek)
                    lewy_wyjscie =  obliczona;
                    prawy_wyjscie = obliczona;
                }


        } else if (krok == 3) {

            for(i = 0; i < M; i++){                                                                 //pętla iterująca próbki z sygnalu wejsciowego
                y = _smaci(y, mono_wejscie, filtr_fir[i]);                                          //mnożenie dwóch liczb Q15 sprawia, że y jest w formacie Q30
                lewy_wyjscie =  (short)(_sround(y) >> 15);                                          //zaokrąglenie i przejcie z formatu Q30 na Q15
                prawy_wyjscie = (short)(_sround(y) >> 15);                                          //zaokrąglenie i przejcie z formatu Q30 na Q15
            }

        } else if (krok == 4) {

            lewy_wyjscie = mono_wejscie;
            prawy_wyjscie = mono_wejscie;

            for (i = 0; i < NUM_SAMPLES; i++){                        //przypisanie probek nagrania dźwięku klarnetu do tablicy klarnet[]
                klarnet[i] = testsignal[i];
            }

            rfft((DATA*)klarnet, 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
                klarnet[i] = _smpy(klarnet[i], klarnet[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)
                klarnet[j] = klarnet[i] + klarnet[i + 1];
                j++;
            }

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

        }

        // zapisanie wartości na wyjście audio
        aic3204_codec_write(lewy_wyjscie, prawy_wyjscie);

    }

    // wciśnięcie obu przycisków jednocześnie kończy działanie pętli
    aic3204_disable();
    oled_display_message("KONIEC PRACY       ", "                   ");
    while(1); // nie wychodź z programu
}