%% v11: 
% edited on 20150302
% 1. in v10, we only detected the rat's stopping location in test trial,
%    but not considering if he's still sniffing (looking for the reward location)
%    or he totally stopped. So, in v11, we detected both running speed and
%    head out distance (to circular track center). If his running speed is
%    less than 10 cm/s, and his head is out of the track, we detected this
%    location as his stop location.
% 3. same as in previous versions, the defalt running direction is 'clockwise'. If the rat runs in
%    counterclockwise direction, we rotate the data to clockwise, i.e. 
%    the angle will be 2pi-angle
% 
% the experiment is setting as:
%
% In sample trial, a piece of tape at reward location. The rat has to run 6 
% laps, and stop at the tape in each lap to get the reward. A correct/incorrect tone
% goes off when he stops at correct/incorrect spot.
% At the beginning of the sample trial, the rat was sitting in starting-zone for
% 30s, to let me sit down and close the curtain. At the end of this trial,
% he needs to be back to starting-zone, and then sitting for another 30s
% right before the test trial.
%
% In the test trial, no tape was on the track. If he stops at correct
% spot, i.e. ~0.125rad degress close to the spot, the correct tone will go off. 
% Otherwise, if he stops outside ~0.125rad degree but inside ~0.75rad degree around
% the spot, or run out of the spot without stopping, 
% the incorrect tone will go off. 
% At the end of test trial, the rat needs to be back to starting-zone. When
% he leave the track, this session ends. 


% set the missing date [0,0] as the same as the last visited data

%%
ang_RewardLoc_ontrack=Ang_RewardLoc_ontrack(ind_rewardloc);
ang_sample_reward_correct_left=max(ang_RewardLoc_ontrack-ang_crct_zone_sample,Ang_StartZone_depart_ontrack);
ang_sample_reward_correct_right=min(ang_RewardLoc_ontrack+ang_crct_zone_sample,Ang_StartZone_arrive_ontrack);
ang_sample_reward_incorrect_left=max(ang_RewardLoc_ontrack-ang_incrct_zone_sample,Ang_StartZone_depart_ontrack);
ang_sample_reward_incorrect_right=min(ang_RewardLoc_ontrack+ang_incrct_zone_sample,Ang_StartZone_arrive_ontrack);

% detect if the rat arrived at Starting-zone, if so, this session starts
locationArray_end=[];
while 1
    %Pause to let some new data load up in NetCom's buffers.
    pause(sample_time);
    %Request all new VT data that has been acquired since the last pass.
    [~, timeStampArray, locationArray, ~, VTRecsReturned, ~] = NlxGetNewVTData(vt_acq_ent);
    %Get the X and Y location value for this VT frame. The
    %locationArray is in the form [x1, y1, x2, y2, ... xN, yN].
    if ~isempty(locationArray)
        x_loc = locationArray(end - 1);
        y_loc = locationArray(end);
        if ~x_loc && ~y_loc %% if x_loc=0, y_loc=0, means it's a missing data from the video
            if isempty(locationArray_end)
                continue
            end
            x_loc=locationArray_end(1);
            y_loc=locationArray_end(2);
        end
        x0 = double(x_loc).*scale_x-x_center;
        y0 = double((-1)*y_loc).*scale_y-y_center;
        
        if x0>=0
            if x0==0 x0=0.01; end
            ang0=mod(atan(-y0/x0),2*pi);
        else
            ang0=mod(atan(-y0/x0)+pi,2*pi);
        end
        if strcmp(rot,'Counterclockwise');
            ang0=2*pi-ang0;
        end
        ang_ontrack=mod(ang0-Ang_StartZone_center,2*pi);
        locationArray_end=[x_loc,y_loc];
        distance_center=sqrt(x0^2+y0^2);
        
        if distance_center < R_outer && (ang_ontrack > Ang_StartZone_arrive_ontrack - ang_startzone_border || ang_ontrack < Ang_StartZone_depart_ontrack + ang_startzone_border)
            break
        end
    end
end
sound(beep0,fs_sin);


%% sample trial

[~, timeStampArray, locationArray, ~, VTRecsReturned, ~] = NlxGetNewVTData(vt_acq_ent);
ts_sample_start1=timeStampArray(end);
pause(time_fix);
% give me 30s to sit into the track, close the curtain and prepare the
% treat
[~, timeStampArray, locationArray, ~, VTRecsReturned, ~] = NlxGetNewVTData(vt_acq_ent);
ts_sample_start2=timeStampArray(end);
sound(sound_beep_start,sound_beep_fs);

n_sample;
n_reward_lap=0;
n_running_lap=0;
locationArray_end=[];
ang_ontrack_end=0;
sign_enter=0;  % sign_enter=1 means the rat is ready to enter a reward spot;
% otherwise, sign_enter=0 means the rat is just leaving a reward spot
sign_leave=0;  % sign_leave=1 means the rat is just leaving a reward spot;
% otherwise, sign_enter=0 means the rat is just leaving a reward spot
% Note: when the rat is back to starting zone, both sign_enter and
% sign_leave are set to 0
sign_getreward=0;  % sign_reward=1 means the rat has found the reward location,
% and ready to eat the reward. (the rat headed out toward the center)
% otherwise, sign_reward=0 means the rat is not at reward location yet

time_stay_reward=0;
ang_sample_reward_actual=zeros(n_sample,1);
ang_sample_reward_ontrack=zeros(n_sample,1);
time_sample_reward=zeros(n_sample,1);
sign_correct_sample=zeros(n_sample,1);
while n_reward_lap<n_sample
    % get the current location
    pause(sample_time);
    [~, timeStampArray, locationArray, ~, VTRecsReturned, ~] = NlxGetNewVTData(vt_acq_ent);
    time0=timeStampArray(end);
    x_loc = locationArray(end - 1);
    y_loc = locationArray(end);
    if ~x_loc && ~y_loc %% if x_loc=0, y_loc=0 means it's a missing data from the video
        if isempty(locationArray_end)
            continue
        end
        x_loc=locationArray_end(1);
        y_loc=locationArray_end(2);
    end
    x0 = double(x_loc).*scale_x-x_center;
    y0 = double((-1)*y_loc).*scale_y-y_center;
    
    if x0>=0
        if x0==0 x0=0.01; end
        ang0=mod(atan(-y0/x0),2*pi);
    else
        ang0=mod(atan(-y0/x0)+pi,2*pi);
    end
    if strcmp(rot,'Counterclockwise');
        ang0=2*pi-ang0;
    end
    ang_ontrack=mod(ang0-Ang_StartZone_center,2*pi);
    vel_ontrack=(ang_ontrack-ang_ontrack_end)/sample_time;
    
    % check the current location
    if vel_ontrack<0 && (ang_ontrack > Ang_StartZone_arrive_ontrack - ang_startzone_border || ang_ontrack < Ang_StartZone_depart_ontrack + ang_startzone_border)
        % rat is walking back to starting zone, almost happens when the
        % rat starts and then walk back a little bit.
        sign_enter=0;
        sign_leave=0;
        sign_getreward=0;
    elseif sign_leave==0 && ang_ontrack > ang_sample_reward_incorrect_left && ang_ontrack < ang_sample_reward_incorrect_right
        % the rat is walking in reward zone
        % as soon as the rat is starting from the starting zone
        sign_enter=1;
        if time_stay_reward >= time_stay_sample
            % if the rat has stopped at reward location for "time_stay_test"
            % mark the his "turning head"-location as his final stop location
            if ang_ontrack > ang_sample_reward_correct_left && ang_ontrack < ang_sample_reward_correct_right
                % the rat stops at reward location
                sound(tone_correct,fs_tone_correct);
                sign_correct0=1;
            else % the rat make an error infront of or behind the reward location
                sound(tone_incorrect,fs_tone_incorrect);
                sign_correct0=0;
            end
            n_reward_lap=n_reward_lap+1;
            ang_sample_reward_actual(n_reward_lap)=ang_sample_reward_actual_temp;
            ang_sample_reward_ontrack(n_reward_lap)=ang_sample_reward_ontrack_temp;
            fprintf('Loc: %s \r',strcat(num2str(ang_sample_reward_ontrack_temp),' correct:',num2str(sign_correct0)));
            time_sample_reward(n_reward_lap)=time_sample_reward_temp;
            sign_correct_sample(n_reward_lap)=sign_correct0;
            sign_enter=0;
            sign_leave=1;
            sign_getreward=1;
        else % time_stay_reward < time_stay_sample
            if sign_getreward==0
                if abs(ang_ontrack-ang_ontrack_end) <= ang_nomving
                    sign_getreward=1;
                    ang_sample_reward_actual_temp=ang0;
                    ang_sample_reward_ontrack_temp=ang_ontrack;
                    time_sample_reward_temp=time0;
                    time_stay_reward=time_stay_reward+sample_time;
                end
            else % sign_getreward==1
                if abs(ang_ontrack-ang_ontrack_end) <= ang_nomving && abs(ang_ontrack-ang_sample_reward_ontrack_temp) <= distance_tostop
                    % if the rat is still staying here
                    time_stay_reward=time_stay_reward+sample_time;
                else
                    sign_getreward=0;
                    time_stay_reward=0; % reset it to 0
                end
            end
        end
    elseif sign_enter==1 && sign_leave==0 && ang_ontrack > ang_sample_reward_incorrect_right && ang_ontrack < Ang_StartZone_arrive_ontrack - ang_startzone_border
        % the rat just passed the reward zone very quickly, without stop
        sign_enter=0;
        sign_leave=1;
        sign_getreward=0;
        % the rat make an error infront of or behind the reward location
        sound(tone_incorrect,fs_tone_incorrect);
        n_reward_lap=n_reward_lap+1;
        ang_sample_reward_actual(n_reward_lap)=NaN;
        ang_sample_reward_ontrack(n_reward_lap)=NaN;
        fprintf('Loc: NaN\r');
        time_sample_reward(n_reward_lap)=NaN;
        sign_correct_sample(n_reward_lap)=NaN;
    elseif ang_ontrack > Ang_StartZone_arrive_ontrack - ang_startzone_border || ang_ontrack < Ang_StartZone_depart_ontrack + ang_startzone_border
        % the rat is back into starting-zone
        sign_enter=0;
        sign_leave=0;
        sign_getreward=0;
        time_stay_reward=0; % reset it to 0
    end
    locationArray_end=[x_loc,y_loc];
    ang_ontrack_end=ang_ontrack;
end

% as soon as the rat is back into starting-zone, this sample trial ends
while ang_ontrack > Ang_StartZone_depart_ontrack+ang_startzone_border && ang_ontrack < Ang_StartZone_arrive_ontrack-ang_startzone_border
    % if rat is still running on the track
    pause(sample_time);
    [~, timeStampArray, locationArray, ~, VTRecsReturned, ~] = NlxGetNewVTData(vt_acq_ent);
    time0=timeStampArray(end);
    x_loc = locationArray(end - 1);
    y_loc = locationArray(end);
    if ~x_loc && ~y_loc %% if x_loc=0, y_loc=1, means it's a missing data from the video
        if isempty(locationArray_end)
            continue
        end
        x_loc=locationArray_end(1);
        y_loc=locationArray_end(2);
    end
    x0 = double(x_loc).*scale_x-x_center;
    y0 = double((-1)*y_loc).*scale_y-y_center;
    
    if x0>=0
        if x0==0 x0=0.01; end
        ang0=mod(atan(-y0/x0),2*pi);
    else
        ang0=mod(atan(-y0/x0)+pi,2*pi);
    end
    if strcmp(rot,'Counterclockwise');
        ang0=2*pi-ang0;
    end
    ang_ontrack=mod(ang0-Ang_StartZone_center,2*pi);
    locationArray_end=[x_loc,y_loc];
end
ts_sample_stop=time0;
sound(beep0,fs_sin);

%% get the correct reward location from the sample trial
% check if there's a wrong loc in ang_sample_reward_ontrack
ang_sample_reward_ontrack0=ang_sample_reward_ontrack(~isnan(ang_sample_reward_ontrack));
if isempty(ang_sample_reward_ontrack0)
    ang_sample_reward_ontrack_mean=ang_RewardLoc_ontrack;
else
    ang_sample_reward_ontrack_mean=nanmean(ang_sample_reward_ontrack);
end
ang_test_reward_correct_left=max(ang_sample_reward_ontrack_mean-ang_crct_zone_test,Ang_StartZone_depart_ontrack);
ang_test_reward_correct_right=min(ang_sample_reward_ontrack_mean+ang_crct_zone_test,Ang_StartZone_arrive_ontrack);
ang_test_reward_incorrect_left=max(ang_sample_reward_ontrack_mean-ang_incrct_zone_test,Ang_StartZone_depart_ontrack);
ang_test_reward_incorrect_right=min(ang_sample_reward_ontrack_mean+ang_incrct_zone_test,Ang_StartZone_arrive_ontrack);


%% test trial

ts_test_start1=ts_sample_stop;
pause(time_fix);
% give me 30s to swipe the track and prepare the treat
[~, timeStampArray, locationArray, ~, VTRecsReturned, ~] = NlxGetNewVTData(vt_acq_ent);
ts_test_start2=timeStampArray(end);
sound(sound_beep_start,sound_beep_fs);

n_test;
n_reward_lap=0;
locationArray_end=[];
time_stay_reward=0;
ang_ontrack_end=0;
sign_enter=0;
sign_leave=0;
sign_getreward=0;
ang_test_reward_ontrack=0;
time_test_reward=0;
distance_center_reward=NaN;
while n_reward_lap<n_test
    % get the current location
    pause(sample_time);
    [~, timeStampArray, locationArray, ~, VTRecsReturned, ~] = NlxGetNewVTData(vt_acq_ent);
    time0=timeStampArray(end);
    x_loc = locationArray(end - 1);
    y_loc = locationArray(end);
    if ~x_loc && ~y_loc %% if x_loc=0, y_loc=0 means it's a missing data from the video
        if isempty(locationArray_end)
            continue
        end
        x_loc=locationArray_end(1);
        y_loc=locationArray_end(2);
    end
    x0 = double(x_loc).*scale_x-x_center;
    y0 = double((-1)*y_loc).*scale_y-y_center;
    
    if x0>=0
        if x0==0 x0=0.01; end
        ang0=mod(atan(-y0/x0),2*pi);
    else
        ang0=mod(atan(-y0/x0)+pi,2*pi);
    end
    if strcmp(rot,'Counterclockwise');
        ang0=2*pi-ang0;
    end
    ang_ontrack=mod(ang0-Ang_StartZone_center,2*pi);
    vel_ontrack=(ang_ontrack-ang_ontrack_end)/sample_time;
    distance_center=sqrt(x0^2+y0^2);
    ind_segment=ceil(ang_ontrack/(2*pi/12));
    
    % check the current location
    if vel_ontrack<0 && (ang_ontrack > Ang_StartZone_arrive_ontrack - ang_startzone_border || ang_ontrack < Ang_StartZone_depart_ontrack + ang_startzone_border)
        % rat is walking back to starting zone, almost happens when the
        % rat starts and then walk back a little bit.
        sign_enter=0;
        sign_leave=0;
        sign_getreward=0;
    elseif sign_leave==0 && ang_ontrack > ang_test_reward_incorrect_left && ang_ontrack < ang_test_reward_incorrect_right
        % the rat is walking in reward zone
        % as soon as the rat is starting from the starting zone
        sign_enter=1;
        if time_stay_reward >= time_stay_test && distance_center_reward < R_inner_segment(ind_segment)
            % if the rat has stopped at reward location for
            % "time_stay_test" and turned to the track center
            % mark his "turning head"-location as his final stop location
            if ang_ontrack > ang_test_reward_correct_left && ang_ontrack < ang_test_reward_correct_right
                % the rat stops at reward location
                sound(tone_correct,fs_tone_correct);
                sign_correct_test=1;
            else % the rat make an error infront of or behind the reward location
                sound(tone_incorrect,fs_tone_incorrect);
                sign_correct_test=0;
            end
            n_reward_lap=n_reward_lap+1;
            ang_test_reward_actual=ang_test_reward_actual_temp;
            ang_test_reward_ontrack=ang_test_reward_ontrack_temp;
            time_test_reward=time_test_reward_temp;
            sign_enter=0;
            sign_leave=1;
            sign_getreward=1;
        else % time_stay_reward < time_stay_test
            if sign_getreward==0
                if abs(ang_ontrack-ang_ontrack_end) <= ang_nomving
                    sign_getreward=1;
                    ang_test_reward_actual_temp=ang0;
                    ang_test_reward_ontrack_temp=ang_ontrack;
                    time_test_reward_temp=time0;
                    time_stay_reward=time_stay_reward+sample_time;
                    distance_center_reward=distance_center;
                end
            else % sign_getreward==1
                if abs(ang_ontrack-ang_ontrack_end) <= ang_nomving && abs(ang_ontrack-ang_test_reward_ontrack_temp) <= distance_tostop
                    % if the rat is still staying here
                    time_stay_reward=time_stay_reward+sample_time;
                    distance_center_reward=min(distance_center_reward,distance_center);
                else
                    sign_getreward=0;
                    time_stay_reward=0; % reset it to 0
                    distance_center_reward=NaN;
                end
            end
        end
    elseif sign_enter==1 && sign_leave==0 && (ang_ontrack > Ang_StartZone_arrive_ontrack - ang_startzone_border || ang_ontrack < Ang_StartZone_depart_ontrack + ang_startzone_border)
        % the rat is back into starting-zone and he doesn't stop at all around the reward location
        n_reward_lap=n_reward_lap+1;
        ang_test_reward_actual=NaN;
        ang_test_reward_ontrack=NaN;
        time_test_reward=NaN;
        sign_correct_test=0;
        sign_enter=0;
        sign_leave=0;
    end
    locationArray_end=[x_loc,y_loc];
    ang_ontrack_end=ang_ontrack;
end
fprintf('TestLoc: %s \r',num2str(ang_test_reward_ontrack));

% as soon as the rat is back into starting-zone, this test trial ends
while ang_ontrack > Ang_StartZone_depart_ontrack+ang_startzone_border && ang_ontrack < Ang_StartZone_arrive_ontrack-ang_startzone_border
    pause(sample_time);
    [~, timeStampArray, locationArray, ~, VTRecsReturned, ~] = NlxGetNewVTData(vt_acq_ent);
    time0=timeStampArray(end);
    x_loc = locationArray(end - 1);
    y_loc = locationArray(end);
    if ~x_loc && ~y_loc %% if x_loc=0, y_loc=1, means it's a missing data from the video
        if isempty(locationArray_end)
            continue
        end
        x_loc=locationArray_end(1);
        y_loc=locationArray_end(2);
    end
    x0 = double(x_loc).*scale_x-x_center;
    y0 = double((-1)*y_loc).*scale_y-y_center;
    
    if x0>=0
        if x0==0 x0=0.01; end
        ang0=mod(atan(-y0/x0),2*pi);
    else
        ang0=mod(atan(-y0/x0)+pi,2*pi);
    end
    if strcmp(rot,'Counterclockwise');
        ang0=2*pi-ang0;
    end
    ang_ontrack=mod(ang0-Ang_StartZone_center,2*pi);
    locationArray_end=[x_loc,y_loc];
end

ts_test_stop=time0;
sound(beep0,fs_sin);