%% Function quantizzatore
%function che realizza un quantizzatore ideale. In output restituisce il segnale quantizzato e il passo di quantizzazione,
% utile poi per il calcolo dell'SNRQ.Volendo è possibile aumentare il
% numero di output forniti, per esempio se si vuole che la funzione
% restituisca anche l'errore allora si modificherà la prima riga come
% [V_q,Delta,error]=.... e lo stesso si farà nel momento in cui si chiama
% la funzione

function [V_q,Delta] = quantizzatore(N_bit, V_FS, V)
N_liv=2^N_bit;                %numero livelli disponibili
Delta=2*V_FS/(N_liv-1);       %passo di quantizzazione
lev=round(V/Delta);           %vettore di livelli
for i=1:length(lev)           %ciclo for che descrive saturazione al di fuori del campo di ingresso
    if lev(i)> 2^(N_bit-1)-1
       lev(i)=2^(N_bit-1)-1;
    end
    if lev(i)< -2^(N_bit-1)
       lev(i)=-2^(N_bit-1);
    end
end
V_q=lev*Delta;
error = V_q - V;
end