root/applications/dual/SIDP/SIDPS/motor_sidps/interpol.m @ 1323

function rizeni=interpol(beta,H,C,H_tilde_on)
i=(1:4)*H_tilde_on*ones(5,1);
j=ones(1,4)*H_tilde_on*[1;2;3;4;5];
pom=H-beta(i,j);

if (pom(1)>0)
    rizeni=C(1);
else
    if (pom(end)<0 || pom(end)==0)
        rizeni=C(end)*2^pom(end);
    else
        for i=2:size(H,2)
            if (pom(i)>0)
                delka=H(i)-H(i-1);
                rizeni=(1+pom(i-1)/delka)*C(i-1)+(1-pom(i)/delka)*C(i);
                break               
            end            
        end
    end
end

end