clc
clear all
filename = 's_meter_log_2008_06_23-11_55_31_64_437432000.txt '; % day 1.5, 0.21 Hz, 0.42 Hz
interval = 2500:2700;
filename = 's_meter_log_2008_07_06-22_12_02_70_437432000.txt'; % day 13.9, 0.387 Hz, 0.7742 Hz, 1.16 Hz
interval = 3098:3170;
filename = 's_meter_log_2008_07_18-11_40_00_86_437432000.txt'; % day 25.5,  0.51455 Hz  = 30.873 RPM, 0.99333 Hz = 59.59 RPM
interval = 2300:3300;
filename = 's_meter_log_2008_07_27-11_15_09_0_437432000.txt'; % day 34.5, 0.0348 Hz, 0.592 Hz, 1.173 Hz
interval = 3250:3900;
filename = 's_meter_log_2008_07_30-10_34_53_27_437432000.txt'; % day 37.4, 1.195Hz 71.7 RPM
interval = 2234:2330;
filename = 's_meter_log_2008_08_04-21_34_50_57_437432000.txt'; % day 42.8, 0.646 Hz, 1.292 Hz
interval = 2343:2365;
filename = 's_meter_log_2008_08_04-23_11_44_24_437432000.txt'; % day 42.9, 1.304 Hz
interval = 2968:3006;
filename = 's_meter_log_2008_08_05-12_26_38_37_437432000.txt'; % day 43.5, 0.65 Hz, 1.315 Hz
interval = 3060:4170;
filename = 's_meter_log_2008_08_06-11_08_54_52_437432000.txt';% day 44.5, 0.6697 Hz, 1.3394 Hz
interval = 3820:4950;
filename = 's_meter_log_2008_08_12-11_24_23_70_437432000.txt';% day 50.5, 0.72 Hz, 1.4 Hz
interval = 2910:4000;
filename = 's_meter_log_2008_08_18-11_39_52_88_437432000.txt';% day 56.5, 0.7185 Hz, 1.44Hz
interval = 3600:4600;
filename = 's_meter_log_2008_08_21-10_59_29_43_437432000.txt';% day 59.5, 0.715, 1.395
interval = 2000:3000;
filename = 's_meter_log_2008_08_22-11_18_05_61_437432000.txt';% day 60.5, 0.7(0.0), 1.395 
interval = 1400:2400;
filename = 's_meter_log_2008_08_25-10_44_42_28_437432000.txt';% day 63.5, 0.7, 1.395 
interval = 200:1200;
filename = 's_meter_log_2008_08_25-21_40_43_64_437432000.txt';% day 63.9, 0.6815, 1.395
interval = 3100:4100;
filename = 's_meter_log_2008_08_26-21_59_17_88_437432000.txt';% day 64.9, 0.65, 1.35
interval = 2650:3650;
filename = 's_meter_log_2008_08_28-11_33_32_80_437432000.txt'; % day 66.5, 0.61, 1.225
interval = 2700:3200;
filename = 's_meter_log_2008_08_29-10_16_04_20_437432000.txt';% day 67.4, 0.48, 0.959
interval = 2300:3300;
filename = 's_meter_log_2008_08_29-11_52_09_72_437432000.txt';% day 67.5, 0.46, 0.92
interval = 3000:4000;
filename = 's_meter_log_2008_08_29-21_25_50_42_437432000.txt';% day 67.9, 0.431 0.855
interval = 200:1200;
filename = 's_meter_log_2008_08_31-21_56_04_83_437432000.txt';% day 69.9, 0.292, 0.584
interval = 2400:3400;
filename = 's_meter_log_2008_09_01-11_11_43_54_437432000.txt';% day 70.5, 0.28, 0.566
interval = 2400:3400;
filename = 's_meter_log_2008_09_01-22_14_41_70_437432000.txt';% day 70.9, 0.264, 0.57
interval = 2300:3300;
filename = 's_meter_log_2008_09_03-21_15_57_40_437432000.txt';% day 72.9, 0.258, 0.53
interval = 2900:3900;
filename = 's_meter_log_2008_09_05-10_49_56_35_437432000.txt';% day 74.5, 0.233, 0.474
interval = 2600:3600;
filename = 's_meter_log_2008_09_05-21_52_52_78_437432000.txt';% day 74.9, 0.23, 0.462
interval = 2700:3700;
filename = 's_meter_log_2008_09_07-11_29_18_72_437432000.txt';% day 76.5, 0.22, 0.464
interval = 3600:4400;
filename = 's_meter_log_2008_09_09-12_04_31_58_437432000.txt';% day 78.5, 0.25, 0.58
interval = 3300:4300;
filename = 's_meter_log_2008_09_09-21_31_18_53_437432000.txt';% day 78.9, 0.256, 0.512
interval = 2850:3350;
filename = 's_meter_log_2008_09_10-21_49_46_74_437432000.txt';% day 79.9, 0.24, 0.489
interval = 2100:2700;
filename = 's_meter_log_2008_09_12-22_27_02_56_437432000.txt';% day 81.9, 0.17, 0.38
interval = 2060:2600;
filename = 's_meter_log_2008_09_13-21_09_45_35_437432000.txt';% day 82.9, 0.17, 0.4
interval = 1590:2060;
filename = 's_meter_log_2008_09_16-22_05_09_83_437432000.txt';% day 85.9, 0.27, 0.54
interval = 2390:2530;
interval = 3450:3950;
filename = 's_meter_log_2008_09_17-22_23_48_60_437432000.txt';% day 86.9, 0.255, 0.53
interval = 2400:3400;
filename = 's_meter_log_2008_09_18-21_06_38_33_437432000.txt';% day 87.9, 0.245, 0.478
interval = 3100:3700;
filename = 's_meter_log_2008_09_19-10_21_59_21_437431000.txt';% day 90.4, 0.22, 0.454
intereval = 3000:4000;
filename = 's_meter_log_2008_09_19-21_24_58_46_437432000.txt';% day 90,9, 0.212, 0.417
interval = 2866:3800; %frequencies =   0.0160    0.2120    0.4170
filename = 's_meter_log_2008_09_20-10_40_29_28_437432000.txt';% day 91.4
interval = 1402:2487; % frequencies =  0.0140    0.1830    0.3730
filename = 's_meter_log_2008_09_20-12_16_44_46_437432000.txt';% day 91.5
interval = 2320:3377;% frequencies =   0.0140    0.1720    0.3570
filename = 's_meter_log_2008_09_20-21_43_24_66_437432000.txt';% day 91.9
interval = 1945:2635;% frequencies =    0.0210    0.1660    0.3320
filename = 's_meter_log_2008_09_21-10_59_03_40_437432000.txt';% day 92.5
interval = 1684:2768;% frequencies =    0.0130    0.1670    0.3420
filename = 's_meter_log_2008_09_21-22_01_56_88_437432000.txt';% day 92.9
interval = 1676:2743; %frequencies =    0.0130    0.1740    0.3810
filename = 's_meter_log_2008_09_22-11_17_38_59_437432000.txt';% day 93.45
interval = 1789:2917;% frequencies =    0.0130    0.1810    0.3420
filename = 's_meter_log_2008_09_22-12_54_03_25_437432000.txt';% day 93.55
interval = 2242:3281;% frequencies =    0.0140    0.1750    0.3560
filename = 's_meter_log_2008_09_22-20_45_13_25_437432000.txt';% day 93.7
interval = 2166:2522;% frequencies =    0.0140    0.1630    0.3250   
filename = 's_meter_log_2008_09_22-22_20_37_64_437432000.txt';% day 93.85
interval = 3604:3815;% frequencies =    0.0140    0.1770    0.3180    
filename = 's_meter_log_2008_09_23-19_30_05_0_437432000.txt';% day 94.8
interval = 1458:1856; % frequencies =     0.0370    0.1490    0.2970
filename = 's_meter_log_2008_09_23-22_39_21_44_437432000.txt';% day 94.9
interval = 1527:2621;% frequencies =    0.0200    0.1470    0.3070
filename = 's_meter_log_2008_09_24-10_18_47_20_437432000.txt';% day 95.4
interval = 1179:2293;% frequencies =    0.0200    0.1520    0.2980
filename = 's_meter_log_2008_09_24-11_54_51_70_437432000.txt';% day 95.5
interval = 2415:3485;% frequencies =    0.0200    0.1450    0.2970
filename = 's_meter_log_2008_09_24-21_21_46_43_437432000.txt';% day 95.8
interval = 2065:2343;% frequencies =    0.1570    0.2880    
filename = 's_meter_log_2008_09_24-22_58_12_30_437432000.txt';% day 95.9
interval = 1906:2975;% frequencies =    0.0140    0.1430    0.2920
filename = 's_meter_log_2008_09_30-12_10_14_52_437432000.txt';% day 101.5
interval = 2330:3370;% frequencies =    0.0200    0.1690    0.3310
filename = 's_meter_log_2008_09_30-21_37_01_57_437432000.txt';% day 101.8
interval = 2532:2748;% frequencies =    0.170    0.3430   
filename = 's_meter_log_2008_09_30-23_13_56_24_437432000.txt';% day 101.9
interval = 2728:3242;% frequencies =    0.0690    0.1800    0.3470
filename = 's_meter_log_2008_10_01-20_20_49_17_437432000.txt';% day 102.75
interval = 2198:3265;% frequencies =    0.0130    0.1950    0.3970
filename = 's_meter_log_2008_10_02-11_11_10_51_437432000.txt';% day 103.45
interval = 2893:3983;% frequencies =    0.0130    0.2150    0.4300
filename = 's_meter_log_2008_10_02-20_38_56_22_437432000.txt';% day 103.75
interval = 2073:2945;% frequencies =    0.0160    0.2120    0.4560
filename = 's_meter_log_2008_10_03-11_29_46_73_437432000.txt';% day 104.5
interval = 2763:3793;% frequencies =    0.0140    0.2340    0.4540
filename = 's_meter_log_2008_10_03-20_57_08_28_437432000.txt'; % day 104.8
interval = 1997:2998;% frequencies =    0.0130    0.2360    0.4720
filename = 's_meter_log_2008_10_05-21_33_50_54_437432000.txt';% day 105.8
interval = 2070:2704;% frequencies =    0.0200    0.2600    0.5490
filename = 's_meter_log_2008_10_05-23_10_37_25_437432000.txt';% day 105.9
interval = 1663:1992;% frequencies =    0.0610    0.2660    0.5530
day = 55.5 + [1.5 13.9 25.5 34.5 37.4 42.8 42.9 43.5 44.5 50.5 56.5 59.5 60.5 63.5 63.9 64.9...
  66.5 67.4 67.5 67.9 69.9 70.5 70.9 72.9 74.5 74.9 76.5 78.5 78.9 79.9 81.9 82.9 85.9 86.9 87.9...
  90.4 90.9 91.4 91.5 91.9 92.5 92.9 93.45 93.55 93.7 93.85 94.8 94.9 95.4 95.5 95.8 95.9 101.5...
  101.8 101.9 102.75 103.45 103.75 104.5 104.8 105.8 105.9];
freq1 = [0.21 0.387 0.51455 0.592 0.592 0.646 0.646 0.650 0.6697 0.72 0.7185 0.715 0.7 0.7 0.6815...
  0.65 0.61 0.48 0.46 0.431 0.292 0.28 0.264 0.258 0.233 0.23 0.22 0.25 0.25 0.24 0.17 0.17 0.27...
  0.255 0.245 0.22 0.212 0.183 0.172 0.166 0.167 0.174 0.181 0.175 0.163 0.177 0.149 0.147 0.152...
  0.145 0.15 0.143 0.169 0.170 0.18 0.195 0.215 0.212 0.234 0.236 0.26 0.266];
freq2 = [0.42 0.7742 0.9933 1.173 1.195 1.292 1.304 1.315 1.3394 1.4 1.44 1.395 1.395 1.395...
  1.395 1.35 1.225 0.959 0.92 0.855 0.584 0.566 0.57 0.53 0.474 0.462 0.464 0.58 0.512 0.489...
  0.38 0.4 0.54 0.53 0.478 0.454 0.417 0.373 0.357 0.332 0.342 0.381 0.342 0.356 0.325 0.318 0.297...
  0.307 0.298 0.297 0.3 0.292 0.331 0.343 0.347 0.397 0.43 0.456 0.454 0.472 0.549 0.553];
%%
d = importdata(filename);

for(k=1:size(d.colheaders,2))
  evalstr = [d.colheaders{k} ' = ' 'd.data(:,k)'];
  evalc(evalstr);
end

rxok = rxok - rxok(1);
rxtotal = rxtotal - rxtotal(1);

%
dfreq1 = diff(freq1)./diff(day);
dfreq2 = diff(freq2)./diff(day);
dfreq1(end+1) = dfreq1(end);
dfreq2(end+1) = dfreq2(end);

figure1 = figure(1)
clf
axes1 = axes(...
  'XColor',[0.502 0.502 0.502],...
  'XGrid','on',...
  'YColor',[0.502 0.502 0.502],...
  'YGrid','on',...
  'ZColor',[0.502 0.502 0.502],...
  'Parent',figure1);
whitebg('w')
title('test')
subplot(311)
plot(smeter)
hold on
plot(rxtotal,'k')
plot(rxok,'r')
ylim([0 200])
grid on
handle = legend('S-meter','rx-total','rx-ok','Location','BestOutSide');
set(handle, 'TextColor', 'k')
xlabel('Sample Number [-]')
title(strrep(filename,'_','.'))

subplot(312)
y = smeter(interval);
rep = 1;
interval1 = interval(1):interval(1)+length(y)*rep-1;
y1 = repmat(y,rep,1);
%plot(time(interval1)-time(interval1(1)),y1,'b')
plot((time(interval)-time(interval(1))),y,'b')
hold on
plot((time(interval)-time(interval(1))),rxtotal(interval),'k')
plot((time(interval)-time(interval(1))),rxok(interval),'r')
grid on
handle = legend('S-meter','rx-total','rx-ok','Location','BestOutSide');
set(handle, 'TextColor', 'k')
xlabel('Time [s]')

subplot(313)
[frq,data] = kfft(1/mean(diff(time(interval))), smeter(interval));
[b,a] = butter(1,0.2);
data_filt = filtfilt(b,a,data);
plot(frq,data,'b');
hold on
[maxtab mintab] = peakdet(data_filt, 0.00001);
[data_sorted indices] = sort(maxtab(:,2),1,'descend');
plot(frq,data_filt,'r');
plot(frq(maxtab(indices(1:3),1)),data_sorted(1:3),'ks')
plot(frq,data,'b');
plot(frq,data_filt,'r');
frequencies = sort(round(frq(maxtab(indices(1:3),1))*1000)/1000,'ascend');
for(i = 1:3)
  text(frq(maxtab(indices(i))),data_sorted(i)+5,num2str(round(frq(maxtab(indices(i)))*1000)/1000),'FontSize',10)
end
handle = legend('FFT','FFT-filtered','Sign. Freq.','Location','NorthEast');
set(handle, 'TextColor', 'k')
xlabel('Frequency [Hz]')
grid on
title('FFT');
xlabel('Frequency [Hz]');
xlim([0 max(frequencies)*2])
ylim([0 15])
print('-dpng',['tumbling_' filename(1:end-4) '.png'])

figure2 = figure(2)
clf
axes1 = axes(...
  'XColor',[0.502 0.502 0.502],...
  'XGrid','on',...
  'YColor',[0.502 0.502 0.502],...
  'YGrid','on',...
  'ZColor',[0.502 0.502 0.502],...
  'Parent',figure2);
whitebg('w')
plot(day,freq1,'b-x')
hold on
stairs(day,dfreq1,'m')
plot(day,freq2,'r-x')
stairs(day,dfreq2,'k')
grid on
handle = legend('freq1','dfreq1/dt','freq2','dfreq2/dt', 'Location', 'NorthWest')
set(handle, 'TextColor', 'k')
xlabel('Day')
ylabel('Freqency [Hz]')
%xlim([0 140])
ylim([-0.5 1.5])
print('-dpng','tumbling_freq_over_time.png')