load('h.mat');
h=h';%odwrocenie macierzy
u1 = zeros(32,1);
u1(1) = 1;
u2 = zeros (32,1);
u2(1:1:7) = [0,1,1,0.5,0.5,-1,-1];
u3 = zeros(32,1);
for i=0:31
    u3(i+1)= sin(2*pi*2*i/32) + sin(2*pi*6*i/32);
end

r1 = zeros(1,32);
r2 = zeros(1,32);
r3 = zeros(1,32);
r1(1) = u1(1);
r2(1) = u2(1);
r3(1) = u3(1);

U1 = toeplitz(u1,r1);
U2 = toeplitz(u2,r2);
U3 = toeplitz(u3,r3);

y1=U1*h;

if (y1 == h)
    disp('takie same');
else
    disp('rozne');
end


y2=U2*h;
P=pinv(h);
P=toeplitz(P);
y2c=P*y2;

figure(1);
subplot(2,1,1);
hold on;
stem(u2, 'filled', 'b');
plot(y2,'r');
title('niebieski - nadany; czerwony - odebrany');
subplot(2,1,2);
hold on;
plot(y2c,'r');
title('odebrany po korekcji');


y3=U3*h;

figure(2);
hold on;
subplot(1,1,1);
plot(u3, 'b');
plot(y3,'r');
title('niebieski - nadany; czerwony - odebrany');