findAngle.m

%% Script to find smooth angle by linear fit in local region

function [theta] = findAngle(vx,vy)

% diffVector = diff(xPosLong) + i*diff(yPosLong);
% 
% for ii = startIndex+1:length(xPosLong)-startIndex
%     theta(ii-startIndex) = angle(diffVector(ii));
%     theta(ii-startIndex) = mod(theta(ii-startIndex),2*pi);
% end



for ii = 1:length(vx)
    theta(ii) = angle(vx(ii)+i*vy(ii));
    theta(ii) = mod(theta(ii),2*pi);
end