function [pathRefined,uVrefined,refined] = refineIncidents(uV,pathOrig,Obst,minSmoothness,dperc) %init pathRefined = pathOrig(1); uVrefined = uV; vx = zeros(1,3); vy = zeros(1,3); %init incident loop vx(1) = uV(1,pathOrig(1)); vy(1) = uV(2,pathOrig(1)); %loop over incidents for iI=2:length(pathOrig)-1, vx(2:3) = uV(1,pathOrig(iI:iI+1)); vy(2:3) = uV(2,pathOrig(iI:iI+1)); [a,b,b,A,B,C] = cosinelaw(vx,vy); %check for minimal 'smoothness' if B*180/pi