clear; close all; clc;

%% Load the data
load('tetracene.mat');
[height,width,N] = size(tstack);
tstack = double(tstack);
time = (0:N-1).*dt; % time axis
xf = (0:(width-1)).*dx*1e6; % space axis for fluorescence intensity

figure(1); clf;
stack_viewer(tstack,'fix');
colormap(viridis);

%% Average pixel intensity
% Average pixel intensity in each frame
pixsum = tstackfun(tstack,@(frame) mean(frame(:)));

% Split
offset = 35; segment_length = 20; dead_points = 1; % Splitting parameters
n_segments = floor((N-offset)/(2*segment_length))*2; % Number of u/d segments
trim_region = (1+offset):n_segments/2*(2*segment_length)+offset;
% Slice pixsum
pixsum_segments = reshape(pixsum(trim_region),segment_length,n_segments);
pixsum_segments = pixsum_segments((1+dead_points):(end-dead_points),:);
% Slice time
time_segments = reshape(time(trim_region),segment_length,n_segments);
time_segments = time_segments((1+dead_points):(end-dead_points),:);

% Find center points
cp = [];
for j = 1:n_segments-1
    P1 = polyfit_fast(time_segments(:,j),pixsum_segments(:,j),2); % Fit j'th segment
    P2 = polyfit_fast(time_segments(:,j+1),pixsum_segments(:,j+1),2); % Fit j+1'st segment
    x = (time_segments(end,j) + time_segments(1,j+1))/2; % Intermediate time point
    y = (polyval_fast(P1,x) + polyval_fast(P2,x))/2; % Average of poly. fits
    cp(j) = x + 1i*y;
end
cp = diff(cp)/2 + cp(1:end-1); % Find baseline points
cfit = @(x) interp1(real(cp),sgolayfilt(imag(cp),1,3),x,'pchip'); % Interpolating fun.

% Plot
figure(2); clf; hold on;
cm = lines;
plot(time,cfit(time),'-','color',[1 1 1]*0.2);
plot(cp,'x','color',[1 1 1]*0.2);
plot(time_segments(:,1:2:end),pixsum_segments(:,1:2:end),'.','color',cm(2,:)); % Up steps
plot(time_segments(:,2:2:end),pixsum_segments(:,2:2:end),'.','color',cm(1,:)); % Down steps
%xlim([0 600]); ylim([20 30]);
grid on; box on; axis square;
xlabel('time / s'); ylabel('Intensity / counts');
title('Intensity segments + centerline');

%% Subtract the centerline from pixel intensity
steps = pixsum-(cfit(time'));

steps = reshape(steps(trim_region),segment_length*2,n_segments/2);
steps = steps((1+dead_points):(end-dead_points),:);

time_steps = reshape(time(trim_region),segment_length*2,n_segments/2);
time_steps = time_steps((1+dead_points):(end-dead_points),:);

cm = lines;
figure(3); clf; hold on;
plot(time,zeros(size(time)),'k--');
plot(time_steps,steps,'-','color',cm(5,:)); % Up steps
xlim([0 500]); ylim([-1 1]*5);
grid on; box on;
xlabel('time / s'); ylabel('\Delta Intensity / counts');
title('Intensity variation wrt. the centerline');

%% Plot average step
average_step = mean(steps(:,1:7),2); % Average step
spread_step = std(steps(:,1:7),[],2)./sqrt(7); % Standard error of the mean
time_step = time_steps(:,1)-time_steps(1,1)+1;

% p(1) = time constant, p(2) = upper level, p(3) = lower level, p(4) = dc level, p(5) = period, p(6) = phase
m = @(x,p) exponential_step_wave(x+p(6),p(1),p(2),p(3),p(4),p(5),0); % Model
w = ones(size(average_step)); w(19) = 0.01; % Omit one point in the center
fitfun = @(p) mean( w.*(average_step - m(time_step,p)).^2 );
p0 = [1.5 -3 -3.5 0 16 0];
options = optimoptions('patternsearch','MaxIterations',1e6);
pf = patternsearch(fitfun,p0,[],[],[],[],[],[],[],options);

% Plot
time_dense = linspace(-2,22,2e2); % Dense time axis for prettier plot
figure(4); clf; hold on;
plot(time_dense,zeros(size(time_dense)),'k--');
plot(time_dense,m(time_dense,pf),'k-');
errorbar(time_step,average_step,spread_step,'.','color',cm(5,:),'MarkerSize',10);
xlim([0 17]);
grid on; box on; axis square;
ylabel('\Delta Intensity / counts'); xlabel('step time / s');